git://git.onelab.eu / linux-2.6.git / blobdiff
? search:
summary | shortlog | log | commit | commitdiff | tree
raw | inline | side by side
This commit was manufactured by cvs2svn to create tag
[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 4182cd4..7705fb0 100644 (file)
--- a/arch/m32r/kernel/io_mappi2.c
+++ b/arch/m32r/kernel/io_mappi2.c
@@ -4,14 +4,15 @@
  *  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>
@@ -31,50 +32,29 @@ 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");
 }
@@ -83,48 +63,51 @@ 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)
 {
-       return (unsigned short)le16_to_cpu(*(volatile unsigned short *)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
 }
 
-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;
 
-       while (count--)
-               *buf++ = *(volatile unsigned char *)portp;
+       tmp = *(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 = cpu_to_le16(w);
+       *(volatile unsigned short *)portp = (w>>8|w<<8);
 }
 
 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
 
@@ -135,21 +118,16 @@ 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);
@@ -159,9 +137,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);
@@ -171,19 +149,14 @@ unsigned char _inb_p(unsigned long port)
 {
        unsigned char  v;
 
-       if (port >= LAN_IOSTART && port < LAN_IOEND)
+       if (port >= 0x300 && port < 0x320)
                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);
@@ -196,24 +169,19 @@ unsigned short _inw_p(unsigned long port)
 {
        unsigned short  v;
 
-       if (port >= LAN_IOSTART && port < LAN_IOEND)
+       if (port >= 0x300 && port < 0x320)
                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);
@@ -236,14 +204,9 @@ 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;
@@ -254,19 +217,14 @@ 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;
@@ -276,7 +234,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;
@@ -287,14 +245,9 @@ 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;
@@ -307,11 +260,6 @@ 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;
@@ -319,7 +267,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;
@@ -337,25 +285,15 @@ 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;
        }
 }
 
@@ -364,25 +302,16 @@ 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);
-#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;
+          pcc_ioread_word(9, port, (void *)addr, sizeof(unsigned short), count, 1);
 #endif
        } else {
                portp = PORT2ADDR(port);
-               while (count--)
-                       *buf++ = *(volatile unsigned short *)portp;
+               while (count--) *buf++ = *(volatile unsigned short *)portp;
        }
 }
 
@@ -392,8 +321,7 @@ 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)
@@ -401,25 +329,16 @@ 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);
-#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
+               while (count--) _ne_outb(*buf++, portp);
 #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++;
        }
 }
 
@@ -428,25 +347,16 @@ 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++;
-#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
+               while (count--) *(volatile unsigned short *)portp = *buf++;
 #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++;
        }
 }
 
@@ -456,6 +366,5 @@ 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