git.oblomov.eu Git - linux-2.6/blob - arch/m32r/kernel/io_mappi.c

   1 /*
   2  *  linux/arch/m32r/kernel/io_mappi.c
   3  *
   4  *  Typical I/O routines for Mappi board.
   5  *
   6  *  Copyright (c) 2001-2005  Hiroyuki Kondo, Hirokazu Takata,
   7  *                           Hitoshi Yamamoto
   8  */
   9
  10 #include <linux/config.h>
  11 #include <asm/m32r.h>
  12 #include <asm/page.h>
  13 #include <asm/io.h>
  14 #include <asm/byteorder.h>
  15
  16 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_PCC)
  17 #include <linux/types.h>
  18
  19 #define M32R_PCC_IOMAP_SIZE 0x1000
  20
  21 #define M32R_PCC_IOSTART0 0x1000
  22 #define M32R_PCC_IOEND0   (M32R_PCC_IOSTART0 + M32R_PCC_IOMAP_SIZE - 1)
  23 #define M32R_PCC_IOSTART1 0x2000
  24 #define M32R_PCC_IOEND1   (M32R_PCC_IOSTART1 + M32R_PCC_IOMAP_SIZE - 1)
  25
  26 extern void pcc_ioread(int, unsigned long, void *, size_t, size_t, int);
  27 extern void pcc_iowrite(int, unsigned long, void *, size_t, size_t, int);
  28 #endif /* CONFIG_PCMCIA && CONFIG_M32R_PCC */
  29
  30 #define PORT2ADDR(port)  _port2addr(port)
  31
  32 static inline void *_port2addr(unsigned long port)
  33 {
  34         return (void *)(port | NONCACHE_OFFSET);
  35 }
  36
  37 static inline void *_port2addr_ne(unsigned long port)
  38 {
  39         return (void *)((port<<1) + NONCACHE_OFFSET + 0x0C000000);
  40 }
  41
  42 static inline void delay(void)
  43 {
  44         __asm__ __volatile__ ("push r0; \n\t pop r0;" : : :"memory");
  45 }
  46
  47 /*
  48  * NIC I/O function
  49  */
  50
  51 #define PORT2ADDR_NE(port)  _port2addr_ne(port)
  52
  53 static inline unsigned char _ne_inb(void *portp)
  54 {
  55         return (unsigned char) *(volatile unsigned short *)portp;
  56 }
  57
  58 static inline unsigned short _ne_inw(void *portp)
  59 {
  60         unsigned short tmp;
  61
  62         tmp = *(volatile unsigned short *)portp;
  63         return le16_to_cpu(tmp);
  64 }
  65
  66 static inline void _ne_outb(unsigned char b, void *portp)
  67 {
  68         *(volatile unsigned short *)portp = (unsigned short)b;
  69 }
  70
  71 static inline void _ne_outw(unsigned short w, void *portp)
  72 {
  73         *(volatile unsigned short *)portp = cpu_to_le16(w);
  74 }
  75
  76 unsigned char _inb(unsigned long port)
  77 {
  78         if (port >= 0x300 && port < 0x320)
  79                 return _ne_inb(PORT2ADDR_NE(port));
  80         else
  81 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_PCC)
  82         if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
  83                 unsigned char b;
  84                 pcc_ioread(0, port, &b, sizeof(b), 1, 0);
  85                 return b;
  86         } else  if (port >= M32R_PCC_IOSTART1 && port <= M32R_PCC_IOEND1) {
  87                 unsigned char b;
  88                 pcc_ioread(1, port, &b, sizeof(b), 1, 0);
  89                 return b;
  90         } else
  91 #endif
  92
  93         return *(volatile unsigned char *)PORT2ADDR(port);
  94 }
  95
  96 unsigned short _inw(unsigned long port)
  97 {
  98         if (port >= 0x300 && port < 0x320)
  99                 return _ne_inw(PORT2ADDR_NE(port));
 100         else
 101 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_PCC)
 102         if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
 103                 unsigned short w;
 104                 pcc_ioread(0, port, &w, sizeof(w), 1, 0);
 105                 return w;
 106         } else  if (port >= M32R_PCC_IOSTART1 && port <= M32R_PCC_IOEND1) {
 107                 unsigned short w;
 108                 pcc_ioread(1, port, &w, sizeof(w), 1, 0);
 109                 return w;
 110         } else
 111 #endif
 112         return *(volatile unsigned short *)PORT2ADDR(port);
 113 }
 114
 115 unsigned long _inl(unsigned long port)
 116 {
 117 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_PCC)
 118         if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
 119                 unsigned long l;
 120                 pcc_ioread(0, port, &l, sizeof(l), 1, 0);
 121                 return l;
 122         } else  if (port >= M32R_PCC_IOSTART1 && port <= M32R_PCC_IOEND1) {
 123                 unsigned short l;
 124                 pcc_ioread(1, port, &l, sizeof(l), 1, 0);
 125                 return l;
 126         } else
 127 #endif
 128         return *(volatile unsigned long *)PORT2ADDR(port);
 129 }
 130
 131 unsigned char _inb_p(unsigned long port)
 132 {
 133         unsigned char v = _inb(port);
 134         delay();
 135         return (v);
 136 }
 137
 138 unsigned short _inw_p(unsigned long port)
 139 {
 140         unsigned short v = _inw(port);
 141         delay();
 142         return (v);
 143 }
 144
 145 unsigned long _inl_p(unsigned long port)
 146 {
 147         unsigned long v = _inl(port);
 148         delay();
 149         return (v);
 150 }
 151
 152 void _outb(unsigned char b, unsigned long port)
 153 {
 154         if (port >= 0x300 && port < 0x320)
 155                 _ne_outb(b, PORT2ADDR_NE(port));
 156         else
 157 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_PCC)
 158         if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
 159                 pcc_iowrite(0, port, &b, sizeof(b), 1, 0);
 160         } else  if (port >= M32R_PCC_IOSTART1 && port <= M32R_PCC_IOEND1) {
 161                 pcc_iowrite(1, port, &b, sizeof(b), 1, 0);
 162         } else
 163 #endif
 164                 *(volatile unsigned char *)PORT2ADDR(port) = b;
 165 }
 166
 167 void _outw(unsigned short w, unsigned long port)
 168 {
 169         if (port >= 0x300 && port < 0x320)
 170                 _ne_outw(w, PORT2ADDR_NE(port));
 171         else
 172 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_PCC)
 173         if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
 174                 pcc_iowrite(0, port, &w, sizeof(w), 1, 0);
 175         } else  if (port >= M32R_PCC_IOSTART1 && port <= M32R_PCC_IOEND1) {
 176                 pcc_iowrite(1, port, &w, sizeof(w), 1, 0);
 177         } else
 178 #endif
 179                 *(volatile unsigned short *)PORT2ADDR(port) = w;
 180 }
 181
 182 void _outl(unsigned long l, unsigned long port)
 183 {
 184 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_PCC)
 185         if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
 186                 pcc_iowrite(0, port, &l, sizeof(l), 1, 0);
 187         } else  if (port >= M32R_PCC_IOSTART1 && port <= M32R_PCC_IOEND1) {
 188                 pcc_iowrite(1, port, &l, sizeof(l), 1, 0);
 189         } else
 190 #endif
 191         *(volatile unsigned long *)PORT2ADDR(port) = l;
 192 }
 193
 194 void _outb_p(unsigned char b, unsigned long port)
 195 {
 196         _outb(b, port);
 197         delay();
 198 }
 199
 200 void _outw_p(unsigned short w, unsigned long port)
 201 {
 202         _outw(w, port);
 203         delay();
 204 }
 205
 206 void _outl_p(unsigned long l, unsigned long port)
 207 {
 208         _outl(l, port);
 209         delay();
 210 }
 211
 212 void _insb(unsigned int port, void *addr, unsigned long count)
 213 {
 214         unsigned short *buf = addr;
 215         unsigned short *portp;
 216
 217         if (port >= 0x300 && port < 0x320){
 218                 portp = PORT2ADDR_NE(port);
 219                 while (count--)
 220                         *buf++ = *(volatile unsigned char *)portp;
 221 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_PCC)
 222         } else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
 223                 pcc_ioread(0, port, (void *)addr, sizeof(unsigned char),
 224                            count, 1);
 225         } else  if (port >= M32R_PCC_IOSTART1 && port <= M32R_PCC_IOEND1) {
 226                 pcc_ioread(1, port, (void *)addr, sizeof(unsigned char),
 227                            count, 1);
 228 #endif
 229         } else {
 230                 portp = PORT2ADDR(port);
 231                 while (count--)
 232                         *buf++ = *(volatile unsigned char *)portp;
 233         }
 234 }
 235
 236 void _insw(unsigned int port, void *addr, unsigned long count)
 237 {
 238         unsigned short *buf = addr;
 239         unsigned short *portp;
 240
 241         if (port >= 0x300 && port < 0x320) {
 242                 portp = PORT2ADDR_NE(port);
 243                 while (count--)
 244                         *buf++ = _ne_inw(portp);
 245 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_PCC)
 246         } else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
 247                 pcc_ioread(0, port, (void *)addr, sizeof(unsigned short),
 248                            count, 1);
 249         } else  if (port >= M32R_PCC_IOSTART1 && port <= M32R_PCC_IOEND1) {
 250                 pcc_ioread(1, port, (void *)addr, sizeof(unsigned short),
 251                            count, 1);
 252 #endif
 253         } else {
 254                 portp = PORT2ADDR(port);
 255                 while (count--)
 256                         *buf++ = *(volatile unsigned short *)portp;
 257         }
 258 }
 259
 260 void _insl(unsigned int port, void *addr, unsigned long count)
 261 {
 262         unsigned long *buf = addr;
 263         unsigned long *portp;
 264
 265         portp = PORT2ADDR(port);
 266         while (count--)
 267                 *buf++ = *(volatile unsigned long *)portp;
 268 }
 269
 270 void _outsb(unsigned int port, const void *addr, unsigned long count)
 271 {
 272         const unsigned char *buf = addr;
 273         unsigned char *portp;
 274
 275         if (port >= 0x300 && port < 0x320) {
 276                 portp = PORT2ADDR_NE(port);
 277                 while (count--)
 278                         _ne_outb(*buf++, portp);
 279 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_PCC)
 280         } else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
 281                 pcc_iowrite(0, port, (void *)addr, sizeof(unsigned char),
 282                             count, 1);
 283         } else if (port >= M32R_PCC_IOSTART1 && port <= M32R_PCC_IOEND1) {
 284                 pcc_iowrite(1, port, (void *)addr, sizeof(unsigned char),
 285                             count, 1);
 286 #endif
 287         } else {
 288                 portp = PORT2ADDR(port);
 289                 while (count--)
 290                         *(volatile unsigned char *)portp = *buf++;
 291         }
 292 }
 293
 294 void _outsw(unsigned int port, const void *addr, unsigned long count)
 295 {
 296         const unsigned short *buf = addr;
 297         unsigned short *portp;
 298
 299         if (port >= 0x300 && port < 0x320) {
 300                 portp = PORT2ADDR_NE(port);
 301                 while (count--)
 302                         _ne_outw(*buf++, portp);
 303 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_PCC)
 304         } else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
 305                 pcc_iowrite(0, port, (void *)addr, sizeof(unsigned short),
 306                             count, 1);
 307         } else  if (port >= M32R_PCC_IOSTART1 && port <= M32R_PCC_IOEND1) {
 308                 pcc_iowrite(1, port, (void *)addr, sizeof(unsigned short),
 309                             count, 1);
 310 #endif
 311         } else {
 312                 portp = PORT2ADDR(port);
 313                 while (count--)
 314                         *(volatile unsigned short *)portp = *buf++;
 315         }
 316 }
 317
 318 void _outsl(unsigned int port, const void *addr, unsigned long count)
 319 {
 320         const unsigned long *buf = addr;
 321         unsigned char *portp;
 322
 323         portp = PORT2ADDR(port);
 324         while (count--)
 325                 *(volatile unsigned long *)portp = *buf++;
 326 }