git://git.onelab.eu / linux-2.6.git / blobdiff
? search:
summary | shortlog | log | commit | commitdiff | tree
raw | inline | side by side
vserver 1.9.5.x5
[linux-2.6.git] / arch / m32r / kernel / io_mappi2.c
diff --git a/arch/m32r/kernel/io_mappi2.c b/arch/m32r/kernel/io_mappi2.c
index 7705fb0..4182cd4 100644 (file)
--- a/arch/m32r/kernel/io_mappi2.c
+++ b/arch/m32r/kernel/io_mappi2.c
@@ -4,15 +4,14 @@
  *  Typical I/O routines for Mappi2 board.
  *
  *  Copyright (c) 2001-2003  Hiroyuki Kondo, Hirokazu Takata,
- *                            Hitoshi Yamamoto, Mamoru Sakugawa
+ *                           Hitoshi Yamamoto, Mamoru Sakugawa
  */
 
-/* $Id:$ */
-
 #include <linux/config.h>
 #include <asm/m32r.h>
 #include <asm/page.h>
 #include <asm/io.h>
+#include <asm/byteorder.h>
 
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
 #include <linux/types.h>
@@ -32,29 +31,50 @@ extern void pcc_iowrite_word(int, unsigned long, void *, size_t, size_t, int);
 #define PORT2ADDR_NE(port)   _port2addr_ne(port)
 #define PORT2ADDR_USB(port)  _port2addr_usb(port)
 
-static __inline__ void *_port2addr(unsigned long port)
+static inline void *_port2addr(unsigned long port)
 {
        return (void *)(port + NONCACHE_OFFSET);
 }
 
 #define LAN_IOSTART    0x300
 #define LAN_IOEND      0x320
+
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+static inline void *__port2addr_ata(unsigned long port)
+{
+       static int      dummy_reg;
+
+       switch (port) {
+       case 0x1f0:     return (void *)0xac002000;
+       case 0x1f1:     return (void *)0xac012800;
+       case 0x1f2:     return (void *)0xac012002;
+       case 0x1f3:     return (void *)0xac012802;
+       case 0x1f4:     return (void *)0xac012004;
+       case 0x1f5:     return (void *)0xac012804;
+       case 0x1f6:     return (void *)0xac012006;
+       case 0x1f7:     return (void *)0xac012806;
+       case 0x3f6:     return (void *)0xac01200e;
+       default:        return (void *)&dummy_reg;
+       }
+}
+#endif
+
 #ifdef CONFIG_CHIP_OPSP
-static __inline__ void *_port2addr_ne(unsigned long port)
+static inline void *_port2addr_ne(unsigned long port)
 {
        return (void *)(port + NONCACHE_OFFSET + 0x10000000);
 }
 #else
-static __inline__ void *_port2addr_ne(unsigned long port)
+static inline void *_port2addr_ne(unsigned long port)
 {
        return (void *)(port + NONCACHE_OFFSET + 0x04000000);
 }
 #endif
-static __inline__ void *_port2addr_usb(unsigned long port)
+static inline void *_port2addr_usb(unsigned long port)
 {
        return (void *)(port + NONCACHE_OFFSET + 0x14000000);
 }
-static __inline__ void delay(void)
+static inline void delay(void)
 {
        __asm__ __volatile__ ("push r0; \n\t pop r0;" : : :"memory");
 }
@@ -63,51 +83,48 @@ static __inline__ void delay(void)
  * NIC I/O function
  */
 
-static __inline__ unsigned char _ne_inb(void *portp)
+static inline unsigned char _ne_inb(void *portp)
 {
        return (unsigned char) *(volatile unsigned char *)portp;
 }
 
-static __inline__ unsigned short _ne_inw(void *portp)
+static inline unsigned short _ne_inw(void *portp)
 {
-#if 1  /* byte swap */
-       unsigned short tmp,tmp2;
-       tmp = *(volatile unsigned short *)portp;
-       tmp2 = (tmp>>8|tmp<<8);
-       return tmp2;
-#else
-       return *(volatile unsigned short *)portp;
-#endif
+       return (unsigned short)le16_to_cpu(*(volatile unsigned short *)portp);
 }
 
-static __inline__ void _ne_insb(void *portp, void * addr, unsigned long count)
+static inline void _ne_insb(void *portp, void * addr, unsigned long count)
 {
-       unsigned short tmp;
        unsigned char *buf = addr;
 
-       tmp = *(volatile unsigned char *)portp;
-       while (count--) *buf++ = *(volatile unsigned char *)portp;
+       while (count--)
+               *buf++ = *(volatile unsigned char *)portp;
 }
 
-static __inline__ void _ne_outb(unsigned char b, void *portp)
+static inline void _ne_outb(unsigned char b, void *portp)
 {
        *(volatile unsigned char *)portp = (unsigned char)b;
 }
 
-static __inline__ void _ne_outw(unsigned short w, void *portp)
+static inline void _ne_outw(unsigned short w, void *portp)
 {
-       *(volatile unsigned short *)portp = (w>>8|w<<8);
+       *(volatile unsigned short *)portp = cpu_to_le16(w);
 }
 
 unsigned char _inb(unsigned long port)
 {
        if (port >= LAN_IOSTART && port < LAN_IOEND)
                return _ne_inb(PORT2ADDR_NE(port));
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               return *(volatile unsigned char *)__port2addr_ata(port);
+       }
+#endif
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          unsigned char b;
-          pcc_ioread_byte(0, port, &b, sizeof(b), 1, 0);
-          return b;
+               unsigned char b;
+               pcc_ioread_byte(0, port, &b, sizeof(b), 1, 0);
+               return b;
        } else
 #endif
 
@@ -118,16 +135,21 @@ unsigned short _inw(unsigned long port)
 {
        if (port >= LAN_IOSTART && port < LAN_IOEND)
                return _ne_inw(PORT2ADDR_NE(port));
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               return *(volatile unsigned short *)__port2addr_ata(port);
+       }
+#endif
 #if defined(CONFIG_USB)
-        else if (port >= 0x340 && port < 0x3a0)
-         return *(volatile unsigned short *)PORT2ADDR_USB(port);
+       else if (port >= 0x340 && port < 0x3a0)
+               return *(volatile unsigned short *)PORT2ADDR_USB(port);
 #endif
 
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
-         else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          unsigned short w;
-          pcc_ioread_word(0, port, &w, sizeof(w), 1, 0);
-          return w;
+       else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
+               unsigned short w;
+               pcc_ioread_word(0, port, &w, sizeof(w), 1, 0);
+               return w;
        } else
 #endif
        return *(volatile unsigned short *)PORT2ADDR(port);
@@ -137,9 +159,9 @@ unsigned long _inl(unsigned long port)
 {
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          unsigned long l;
-          pcc_ioread_word(0, port, &l, sizeof(l), 1, 0);
-          return l;
+               unsigned long l;
+               pcc_ioread_word(0, port, &l, sizeof(l), 1, 0);
+               return l;
        } else
 #endif
        return *(volatile unsigned long *)PORT2ADDR(port);
@@ -149,14 +171,19 @@ unsigned char _inb_p(unsigned long port)
 {
        unsigned char  v;
 
-       if (port >= 0x300 && port < 0x320)
+       if (port >= LAN_IOSTART && port < LAN_IOEND)
                v = _ne_inb(PORT2ADDR_NE(port));
        else
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               return *(volatile unsigned char *)__port2addr_ata(port);
+       } else
+#endif
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          unsigned char b;
-          pcc_ioread_byte(0, port, &b, sizeof(b), 1, 0);
-          return b;
+               unsigned char b;
+               pcc_ioread_byte(0, port, &b, sizeof(b), 1, 0);
+               return b;
        } else
 #endif
                v = *(volatile unsigned char *)PORT2ADDR(port);
@@ -169,19 +196,24 @@ unsigned short _inw_p(unsigned long port)
 {
        unsigned short  v;
 
-       if (port >= 0x300 && port < 0x320)
+       if (port >= LAN_IOSTART && port < LAN_IOEND)
                v = _ne_inw(PORT2ADDR_NE(port));
        else
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               return *(volatile unsigned short *)__port2addr_ata(port);
+       } else
+#endif
 #if defined(CONFIG_USB)
-         if (port >= 0x340 && port < 0x3a0)
+       if (port >= 0x340 && port < 0x3a0)
                v = *(volatile unsigned short *)PORT2ADDR_USB(port);
-         else
+       else
 #endif
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          unsigned short w;
-          pcc_ioread_word(0, port, &w, sizeof(w), 1, 0);
-          return w;
+               unsigned short w;
+               pcc_ioread_word(0, port, &w, sizeof(w), 1, 0);
+               return w;
        } else
 #endif
                v = *(volatile unsigned short *)PORT2ADDR(port);
@@ -204,9 +236,14 @@ void _outb(unsigned char b, unsigned long port)
        if (port >= LAN_IOSTART && port < LAN_IOEND)
                _ne_outb(b, PORT2ADDR_NE(port));
        else
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               *(volatile unsigned char *)__port2addr_ata(port) = b;
+       } else
+#endif
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          pcc_iowrite_byte(0, port, &b, sizeof(b), 1, 0);
+               pcc_iowrite_byte(0, port, &b, sizeof(b), 1, 0);
        } else
 #endif
                *(volatile unsigned char *)PORT2ADDR(port) = b;
@@ -217,14 +254,19 @@ void _outw(unsigned short w, unsigned long port)
        if (port >= LAN_IOSTART && port < LAN_IOEND)
                _ne_outw(w, PORT2ADDR_NE(port));
        else
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               *(volatile unsigned short *)__port2addr_ata(port) = w;
+       } else
+#endif
 #if defined(CONFIG_USB)
-         if (port >= 0x340 && port < 0x3a0)
-           *(volatile unsigned short *)PORT2ADDR_USB(port) = w;
+       if (port >= 0x340 && port < 0x3a0)
+               *(volatile unsigned short *)PORT2ADDR_USB(port) = w;
        else
 #endif
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          pcc_iowrite_word(0, port, &w, sizeof(w), 1, 0);
+               pcc_iowrite_word(0, port, &w, sizeof(w), 1, 0);
        } else
 #endif
                *(volatile unsigned short *)PORT2ADDR(port) = w;
@@ -234,7 +276,7 @@ void _outl(unsigned long l, unsigned long port)
 {
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          pcc_iowrite_word(0, port, &l, sizeof(l), 1, 0);
+               pcc_iowrite_word(0, port, &l, sizeof(l), 1, 0);
        } else
 #endif
        *(volatile unsigned long *)PORT2ADDR(port) = l;
@@ -245,9 +287,14 @@ void _outb_p(unsigned char b, unsigned long port)
        if (port >= LAN_IOSTART && port < LAN_IOEND)
                _ne_outb(b, PORT2ADDR_NE(port));
        else
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               *(volatile unsigned char *)__port2addr_ata(port) = b;
+       } else
+#endif
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          pcc_iowrite_byte(0, port, &b, sizeof(b), 1, 0);
+               pcc_iowrite_byte(0, port, &b, sizeof(b), 1, 0);
        } else
 #endif
                *(volatile unsigned char *)PORT2ADDR(port) = b;
@@ -260,6 +307,11 @@ void _outw_p(unsigned short w, unsigned long port)
        if (port >= LAN_IOSTART && port < LAN_IOEND)
                _ne_outw(w, PORT2ADDR_NE(port));
        else
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               *(volatile unsigned short *)__port2addr_ata(port) = w;
+       } else
+#endif
 #if defined(CONFIG_USB)
          if (port >= 0x340 && port < 0x3a0)
                *(volatile unsigned short *)PORT2ADDR_USB(port) = w;
@@ -267,7 +319,7 @@ void _outw_p(unsigned short w, unsigned long port)
 #endif
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          pcc_iowrite_word(0, port, &w, sizeof(w), 1, 0);
+               pcc_iowrite_word(0, port, &w, sizeof(w), 1, 0);
        } else
 #endif
                *(volatile unsigned short *)PORT2ADDR(port) = w;
@@ -285,15 +337,25 @@ void _insb(unsigned int port, void * addr, unsigned long count)
 {
        if (port >= LAN_IOSTART && port < LAN_IOEND)
                _ne_insb(PORT2ADDR_NE(port), addr, count);
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               unsigned char *buf = addr;
+               unsigned char *portp = __port2addr_ata(port);
+               while (count--)
+                       *buf++ = *(volatile unsigned char *)portp;
+       }
+#endif
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
-         else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          pcc_ioread_byte(0, port, (void *)addr, sizeof(unsigned char), count, 1);
+       else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
+               pcc_ioread_byte(0, port, (void *)addr, sizeof(unsigned char),
+                               count, 1);
        }
 #endif
        else {
                unsigned char *buf = addr;
                unsigned char *portp = PORT2ADDR(port);
-               while(count--) *buf++ = *(volatile unsigned char *)portp;
+               while (count--)
+                       *buf++ = *(volatile unsigned char *)portp;
        }
 }
 
@@ -302,16 +364,25 @@ void _insw(unsigned int port, void * addr, unsigned long count)
        unsigned short *buf = addr;
        unsigned short *portp;
 
-       if (port >= LAN_IOSTART && port < LAN_IOEND)
+       if (port >= LAN_IOSTART && port < LAN_IOEND) {
                portp = PORT2ADDR_NE(port);
-               while (count--) *buf++ = *(volatile unsigned short *)portp;
+               while (count--)
+                       *buf++ = *(volatile unsigned short *)portp;
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        } else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          pcc_ioread_word(9, port, (void *)addr, sizeof(unsigned short), count, 1);
+               pcc_ioread_word(9, port, (void *)addr, sizeof(unsigned short),
+                               count, 1);
+#endif
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       } else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               portp = __port2addr_ata(port);
+               while (count--)
+                       *buf++ = *(volatile unsigned short *)portp;
 #endif
        } else {
                portp = PORT2ADDR(port);
-               while (count--) *buf++ = *(volatile unsigned short *)portp;
+               while (count--)
+                       *buf++ = *(volatile unsigned short *)portp;
        }
 }
 
@@ -321,7 +392,8 @@ void _insl(unsigned int port, void * addr, unsigned long count)
        unsigned long *portp;
 
        portp = PORT2ADDR(port);
-       while (count--) *buf++ = *(volatile unsigned long *)portp;
+       while (count--)
+               *buf++ = *(volatile unsigned long *)portp;
 }
 
 void _outsb(unsigned int port, const void * addr, unsigned long count)
@@ -329,16 +401,25 @@ void _outsb(unsigned int port, const void * addr, unsigned long count)
        const unsigned char *buf = addr;
        unsigned char *portp;
 
-       if (port >= LAN_IOSTART && port < LAN_IOEND)
+       if (port >= LAN_IOSTART && port < LAN_IOEND) {
                portp = PORT2ADDR_NE(port);
-               while (count--) _ne_outb(*buf++, portp);
+               while (count--)
+                       _ne_outb(*buf++, portp);
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       } else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               portp = __port2addr_ata(port);
+               while (count--)
+                       *(volatile unsigned char *)portp = *buf++;
+#endif
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        } else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          pcc_iowrite_byte(0, port, (void *)addr, sizeof(unsigned char), count, 1);
+               pcc_iowrite_byte(0, port, (void *)addr, sizeof(unsigned char),
+                                count, 1);
 #endif
        } else {
                portp = PORT2ADDR(port);
-               while(count--) *(volatile unsigned char *)portp = *buf++;
+               while (count--)
+                       *(volatile unsigned char *)portp = *buf++;
        }
 }
 
@@ -347,16 +428,25 @@ void _outsw(unsigned int port, const void * addr, unsigned long count)
        const unsigned short *buf = addr;
        unsigned short *portp;
 
-       if (port >= LAN_IOSTART && port < LAN_IOEND)
+       if (port >= LAN_IOSTART && port < LAN_IOEND) {
                portp = PORT2ADDR_NE(port);
-               while (count--) *(volatile unsigned short *)portp = *buf++;
+               while (count--)
+                       *(volatile unsigned short *)portp = *buf++;
+#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
+       } else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
+               portp = __port2addr_ata(port);
+               while (count--)
+                       *(volatile unsigned short *)portp = *buf++;
+#endif
 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
        } else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
-          pcc_iowrite_word(9, port, (void *)addr, sizeof(unsigned short), count, 1);
+               pcc_iowrite_word(9, port, (void *)addr, sizeof(unsigned short),
+                                count, 1);
 #endif
        } else {
                portp = PORT2ADDR(port);
-               while(count--) *(volatile unsigned short *)portp = *buf++;
+               while (count--)
+                       *(volatile unsigned short *)portp = *buf++;
        }
 }
 
@@ -366,5 +456,6 @@ void _outsl(unsigned int port, const void * addr, unsigned long count)
        unsigned char *portp;
 
        portp = PORT2ADDR(port);
-       while(count--) *(volatile unsigned long *)portp = *buf++;
+       while (count--)
+               *(volatile unsigned long *)portp = *buf++;
 }
linux-2.6