109 lines
		
	
	
		
			2.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			109 lines
		
	
	
		
			2.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  *	I/O routines for Titan
 | |
|  */
 | |
| #include <linux/pci.h>
 | |
| #include <asm/machvec.h>
 | |
| #include <asm/addrspace.h>
 | |
| #include <mach/titan.h>
 | |
| #include <asm/io.h>
 | |
| 
 | |
| static inline unsigned int port2adr(unsigned int port)
 | |
| {
 | |
|         maybebadio((unsigned long)port);
 | |
|         return port;
 | |
| }
 | |
| 
 | |
| u8 titan_inb(unsigned long port)
 | |
| {
 | |
|         if (PXSEG(port))
 | |
|                 return ctrl_inb(port);
 | |
|         return ctrl_inw(port2adr(port)) & 0xff;
 | |
| }
 | |
| 
 | |
| u8 titan_inb_p(unsigned long port)
 | |
| {
 | |
|         u8 v;
 | |
| 
 | |
|         if (PXSEG(port))
 | |
|                 v = ctrl_inb(port);
 | |
|         else
 | |
|                 v = ctrl_inw(port2adr(port)) & 0xff;
 | |
|         ctrl_delay();
 | |
|         return v;
 | |
| }
 | |
| 
 | |
| u16 titan_inw(unsigned long port)
 | |
| {
 | |
|         if (PXSEG(port))
 | |
|                 return ctrl_inw(port);
 | |
|         else if (port >= 0x2000)
 | |
|                 return ctrl_inw(port2adr(port));
 | |
|         else
 | |
|                 maybebadio(port);
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| u32 titan_inl(unsigned long port)
 | |
| {
 | |
|         if (PXSEG(port))
 | |
|                 return ctrl_inl(port);
 | |
|         else if (port >= 0x2000)
 | |
|                 return ctrl_inw(port2adr(port));
 | |
|         else
 | |
|                 maybebadio(port);
 | |
|         return 0;
 | |
| }
 | |
| 
 | |
| void titan_outb(u8 value, unsigned long port)
 | |
| {
 | |
|         if (PXSEG(port))
 | |
|                 ctrl_outb(value, port);
 | |
|         else
 | |
|                 ctrl_outw(value, port2adr(port));
 | |
| }
 | |
| 
 | |
| void titan_outb_p(u8 value, unsigned long port)
 | |
| {
 | |
|         if (PXSEG(port))
 | |
|                 ctrl_outb(value, port);
 | |
|         else
 | |
|                 ctrl_outw(value, port2adr(port));
 | |
|         ctrl_delay();
 | |
| }
 | |
| 
 | |
| void titan_outw(u16 value, unsigned long port)
 | |
| {
 | |
|         if (PXSEG(port))
 | |
|                 ctrl_outw(value, port);
 | |
|         else if (port >= 0x2000)
 | |
|                 ctrl_outw(value, port2adr(port));
 | |
|         else
 | |
|                 maybebadio(port);
 | |
| }
 | |
| 
 | |
| void titan_outl(u32 value, unsigned long port)
 | |
| {
 | |
|         if (PXSEG(port))
 | |
|                 ctrl_outl(value, port);
 | |
|         else
 | |
|                 maybebadio(port);
 | |
| }
 | |
| 
 | |
| void titan_insl(unsigned long port, void *dst, unsigned long count)
 | |
| {
 | |
|         maybebadio(port);
 | |
| }
 | |
| 
 | |
| void titan_outsl(unsigned long port, const void *src, unsigned long count)
 | |
| {
 | |
|         maybebadio(port);
 | |
| }
 | |
| 
 | |
| void __iomem *titan_ioport_map(unsigned long port, unsigned int size)
 | |
| {
 | |
| 	if (PXSEG(port))
 | |
| 		return (void __iomem *)port;
 | |
| 
 | |
| 	return (void __iomem *)port2adr(port);
 | |
| }
 |