1 /*
2 * linux/arch/m32r/platforms/mappi2/io.c
3 *
4 * Typical I/O routines for Mappi2 board.
5 *
6 * Copyright (c) 2001-2005 Hiroyuki Kondo, Hirokazu Takata,
7 * Hitoshi Yamamoto, Mamoru Sakugawa
8 */
9
10 #include <asm/m32r.h>
11 #include <asm/page.h>
12 #include <asm/io.h>
13 #include <asm/byteorder.h>
14
15 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
16 #include <linux/types.h>
17
18 #define M32R_PCC_IOMAP_SIZE 0x1000
19
20 #define M32R_PCC_IOSTART0 0x1000
21 #define M32R_PCC_IOEND0 (M32R_PCC_IOSTART0 + M32R_PCC_IOMAP_SIZE - 1)
22
23 extern void pcc_ioread_byte(int, unsigned long, void *, size_t, size_t, int);
24 extern void pcc_ioread_word(int, unsigned long, void *, size_t, size_t, int);
25 extern void pcc_iowrite_byte(int, unsigned long, void *, size_t, size_t, int);
26 extern void pcc_iowrite_word(int, unsigned long, void *, size_t, size_t, int);
27 #endif /* CONFIG_PCMCIA && CONFIG_M32R_CFC */
28
29 #define PORT2ADDR(port) _port2addr(port)
30 #define PORT2ADDR_NE(port) _port2addr_ne(port)
31 #define PORT2ADDR_USB(port) _port2addr_usb(port)
32
_port2addr(unsigned long port)33 static inline void *_port2addr(unsigned long port)
34 {
35 return (void *)(port | NONCACHE_OFFSET);
36 }
37
38 #if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
__port2addr_ata(unsigned long port)39 static inline void *__port2addr_ata(unsigned long port)
40 {
41 static int dummy_reg;
42
43 switch (port) {
44 case 0x1f0: return (void *)(0x0c002000 | NONCACHE_OFFSET);
45 case 0x1f1: return (void *)(0x0c012800 | NONCACHE_OFFSET);
46 case 0x1f2: return (void *)(0x0c012002 | NONCACHE_OFFSET);
47 case 0x1f3: return (void *)(0x0c012802 | NONCACHE_OFFSET);
48 case 0x1f4: return (void *)(0x0c012004 | NONCACHE_OFFSET);
49 case 0x1f5: return (void *)(0x0c012804 | NONCACHE_OFFSET);
50 case 0x1f6: return (void *)(0x0c012006 | NONCACHE_OFFSET);
51 case 0x1f7: return (void *)(0x0c012806 | NONCACHE_OFFSET);
52 case 0x3f6: return (void *)(0x0c01200e | NONCACHE_OFFSET);
53 default: return (void *)&dummy_reg;
54 }
55 }
56 #endif
57
58 #define LAN_IOSTART (0x300 | NONCACHE_OFFSET)
59 #define LAN_IOEND (0x320 | NONCACHE_OFFSET)
60 #ifdef CONFIG_CHIP_OPSP
_port2addr_ne(unsigned long port)61 static inline void *_port2addr_ne(unsigned long port)
62 {
63 return (void *)(port + 0x10000000);
64 }
65 #else
_port2addr_ne(unsigned long port)66 static inline void *_port2addr_ne(unsigned long port)
67 {
68 return (void *)(port + 0x04000000);
69 }
70 #endif
_port2addr_usb(unsigned long port)71 static inline void *_port2addr_usb(unsigned long port)
72 {
73 return (void *)(port + NONCACHE_OFFSET + 0x14000000);
74 }
delay(void)75 static inline void delay(void)
76 {
77 __asm__ __volatile__ ("push r0; \n\t pop r0;" : : :"memory");
78 }
79
80 /*
81 * NIC I/O function
82 */
83
_ne_inb(void * portp)84 static inline unsigned char _ne_inb(void *portp)
85 {
86 return (unsigned char) *(volatile unsigned char *)portp;
87 }
88
_ne_inw(void * portp)89 static inline unsigned short _ne_inw(void *portp)
90 {
91 return (unsigned short)le16_to_cpu(*(volatile unsigned short *)portp);
92 }
93
_ne_insb(void * portp,void * addr,unsigned long count)94 static inline void _ne_insb(void *portp, void * addr, unsigned long count)
95 {
96 unsigned char *buf = addr;
97
98 while (count--)
99 *buf++ = *(volatile unsigned char *)portp;
100 }
101
_ne_outb(unsigned char b,void * portp)102 static inline void _ne_outb(unsigned char b, void *portp)
103 {
104 *(volatile unsigned char *)portp = (unsigned char)b;
105 }
106
_ne_outw(unsigned short w,void * portp)107 static inline void _ne_outw(unsigned short w, void *portp)
108 {
109 *(volatile unsigned short *)portp = cpu_to_le16(w);
110 }
111
_inb(unsigned long port)112 unsigned char _inb(unsigned long port)
113 {
114 if (port >= LAN_IOSTART && port < LAN_IOEND)
115 return _ne_inb(PORT2ADDR_NE(port));
116 #if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
117 else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
118 return *(volatile unsigned char *)__port2addr_ata(port);
119 }
120 #endif
121 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
122 else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
123 unsigned char b;
124 pcc_ioread_byte(0, port, &b, sizeof(b), 1, 0);
125 return b;
126 } else
127 #endif
128
129 return *(volatile unsigned char *)PORT2ADDR(port);
130 }
131
_inw(unsigned long port)132 unsigned short _inw(unsigned long port)
133 {
134 if (port >= LAN_IOSTART && port < LAN_IOEND)
135 return _ne_inw(PORT2ADDR_NE(port));
136 #if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
137 else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
138 return *(volatile unsigned short *)__port2addr_ata(port);
139 }
140 #endif
141 #if defined(CONFIG_USB)
142 else if (port >= 0x340 && port < 0x3a0)
143 return *(volatile unsigned short *)PORT2ADDR_USB(port);
144 #endif
145
146 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
147 else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
148 unsigned short w;
149 pcc_ioread_word(0, port, &w, sizeof(w), 1, 0);
150 return w;
151 } else
152 #endif
153 return *(volatile unsigned short *)PORT2ADDR(port);
154 }
155
_inl(unsigned long port)156 unsigned long _inl(unsigned long port)
157 {
158 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
159 if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
160 unsigned long l;
161 pcc_ioread_word(0, port, &l, sizeof(l), 1, 0);
162 return l;
163 } else
164 #endif
165 return *(volatile unsigned long *)PORT2ADDR(port);
166 }
167
_inb_p(unsigned long port)168 unsigned char _inb_p(unsigned long port)
169 {
170 unsigned char v = _inb(port);
171 delay();
172 return (v);
173 }
174
_inw_p(unsigned long port)175 unsigned short _inw_p(unsigned long port)
176 {
177 unsigned short v = _inw(port);
178 delay();
179 return (v);
180 }
181
_inl_p(unsigned long port)182 unsigned long _inl_p(unsigned long port)
183 {
184 unsigned long v = _inl(port);
185 delay();
186 return (v);
187 }
188
_outb(unsigned char b,unsigned long port)189 void _outb(unsigned char b, unsigned long port)
190 {
191 if (port >= LAN_IOSTART && port < LAN_IOEND)
192 _ne_outb(b, PORT2ADDR_NE(port));
193 else
194 #if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
195 if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
196 *(volatile unsigned char *)__port2addr_ata(port) = b;
197 } else
198 #endif
199 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
200 if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
201 pcc_iowrite_byte(0, port, &b, sizeof(b), 1, 0);
202 } else
203 #endif
204 *(volatile unsigned char *)PORT2ADDR(port) = b;
205 }
206
_outw(unsigned short w,unsigned long port)207 void _outw(unsigned short w, unsigned long port)
208 {
209 if (port >= LAN_IOSTART && port < LAN_IOEND)
210 _ne_outw(w, PORT2ADDR_NE(port));
211 else
212 #if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
213 if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
214 *(volatile unsigned short *)__port2addr_ata(port) = w;
215 } else
216 #endif
217 #if defined(CONFIG_USB)
218 if (port >= 0x340 && port < 0x3a0)
219 *(volatile unsigned short *)PORT2ADDR_USB(port) = w;
220 else
221 #endif
222 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
223 if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
224 pcc_iowrite_word(0, port, &w, sizeof(w), 1, 0);
225 } else
226 #endif
227 *(volatile unsigned short *)PORT2ADDR(port) = w;
228 }
229
_outl(unsigned long l,unsigned long port)230 void _outl(unsigned long l, unsigned long port)
231 {
232 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
233 if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
234 pcc_iowrite_word(0, port, &l, sizeof(l), 1, 0);
235 } else
236 #endif
237 *(volatile unsigned long *)PORT2ADDR(port) = l;
238 }
239
_outb_p(unsigned char b,unsigned long port)240 void _outb_p(unsigned char b, unsigned long port)
241 {
242 _outb(b, port);
243 delay();
244 }
245
_outw_p(unsigned short w,unsigned long port)246 void _outw_p(unsigned short w, unsigned long port)
247 {
248 _outw(w, port);
249 delay();
250 }
251
_outl_p(unsigned long l,unsigned long port)252 void _outl_p(unsigned long l, unsigned long port)
253 {
254 _outl(l, port);
255 delay();
256 }
257
_insb(unsigned int port,void * addr,unsigned long count)258 void _insb(unsigned int port, void * addr, unsigned long count)
259 {
260 if (port >= LAN_IOSTART && port < LAN_IOEND)
261 _ne_insb(PORT2ADDR_NE(port), addr, count);
262 #if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
263 else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
264 unsigned char *buf = addr;
265 unsigned char *portp = __port2addr_ata(port);
266 while (count--)
267 *buf++ = *(volatile unsigned char *)portp;
268 }
269 #endif
270 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
271 else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
272 pcc_ioread_byte(0, port, (void *)addr, sizeof(unsigned char),
273 count, 1);
274 }
275 #endif
276 else {
277 unsigned char *buf = addr;
278 unsigned char *portp = PORT2ADDR(port);
279 while (count--)
280 *buf++ = *(volatile unsigned char *)portp;
281 }
282 }
283
_insw(unsigned int port,void * addr,unsigned long count)284 void _insw(unsigned int port, void * addr, unsigned long count)
285 {
286 unsigned short *buf = addr;
287 unsigned short *portp;
288
289 if (port >= LAN_IOSTART && port < LAN_IOEND) {
290 portp = PORT2ADDR_NE(port);
291 while (count--)
292 *buf++ = *(volatile unsigned short *)portp;
293 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
294 } else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
295 pcc_ioread_word(9, port, (void *)addr, sizeof(unsigned short),
296 count, 1);
297 #endif
298 #if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
299 } else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
300 portp = __port2addr_ata(port);
301 while (count--)
302 *buf++ = *(volatile unsigned short *)portp;
303 #endif
304 } else {
305 portp = PORT2ADDR(port);
306 while (count--)
307 *buf++ = *(volatile unsigned short *)portp;
308 }
309 }
310
_insl(unsigned int port,void * addr,unsigned long count)311 void _insl(unsigned int port, void * addr, unsigned long count)
312 {
313 unsigned long *buf = addr;
314 unsigned long *portp;
315
316 portp = PORT2ADDR(port);
317 while (count--)
318 *buf++ = *(volatile unsigned long *)portp;
319 }
320
_outsb(unsigned int port,const void * addr,unsigned long count)321 void _outsb(unsigned int port, const void * addr, unsigned long count)
322 {
323 const unsigned char *buf = addr;
324 unsigned char *portp;
325
326 if (port >= LAN_IOSTART && port < LAN_IOEND) {
327 portp = PORT2ADDR_NE(port);
328 while (count--)
329 _ne_outb(*buf++, portp);
330 #if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
331 } else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
332 portp = __port2addr_ata(port);
333 while (count--)
334 *(volatile unsigned char *)portp = *buf++;
335 #endif
336 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
337 } else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
338 pcc_iowrite_byte(0, port, (void *)addr, sizeof(unsigned char),
339 count, 1);
340 #endif
341 } else {
342 portp = PORT2ADDR(port);
343 while (count--)
344 *(volatile unsigned char *)portp = *buf++;
345 }
346 }
347
_outsw(unsigned int port,const void * addr,unsigned long count)348 void _outsw(unsigned int port, const void * addr, unsigned long count)
349 {
350 const unsigned short *buf = addr;
351 unsigned short *portp;
352
353 if (port >= LAN_IOSTART && port < LAN_IOEND) {
354 portp = PORT2ADDR_NE(port);
355 while (count--)
356 *(volatile unsigned short *)portp = *buf++;
357 #if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
358 } else if ((port >= 0x1f0 && port <=0x1f7) || port == 0x3f6) {
359 portp = __port2addr_ata(port);
360 while (count--)
361 *(volatile unsigned short *)portp = *buf++;
362 #endif
363 #if defined(CONFIG_PCMCIA) && defined(CONFIG_M32R_CFC)
364 } else if (port >= M32R_PCC_IOSTART0 && port <= M32R_PCC_IOEND0) {
365 pcc_iowrite_word(9, port, (void *)addr, sizeof(unsigned short),
366 count, 1);
367 #endif
368 } else {
369 portp = PORT2ADDR(port);
370 while (count--)
371 *(volatile unsigned short *)portp = *buf++;
372 }
373 }
374
_outsl(unsigned int port,const void * addr,unsigned long count)375 void _outsl(unsigned int port, const void * addr, unsigned long count)
376 {
377 const unsigned long *buf = addr;
378 unsigned char *portp;
379
380 portp = PORT2ADDR(port);
381 while (count--)
382 *(volatile unsigned long *)portp = *buf++;
383 }
384