1
2
3
4
5
6
7
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
23extern void pcc_ioread_byte(int, unsigned long, void *, size_t, size_t, int);
24extern void pcc_ioread_word(int, unsigned long, void *, size_t, size_t, int);
25extern void pcc_iowrite_byte(int, unsigned long, void *, size_t, size_t, int);
26extern void pcc_iowrite_word(int, unsigned long, void *, size_t, size_t, int);
27#endif
28
29#define PORT2ADDR(port) _port2addr(port)
30#define PORT2ADDR_NE(port) _port2addr_ne(port)
31#define PORT2ADDR_USB(port) _port2addr_usb(port)
32
33static inline void *_port2addr(unsigned long port)
34{
35 return (void *)(port | NONCACHE_OFFSET);
36}
37
38#if defined(CONFIG_IDE) && !defined(CONFIG_M32R_CFC)
39static 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
61static inline void *_port2addr_ne(unsigned long port)
62{
63 return (void *)(port + 0x10000000);
64}
65#else
66static inline void *_port2addr_ne(unsigned long port)
67{
68 return (void *)(port + 0x04000000);
69}
70#endif
71static inline void *_port2addr_usb(unsigned long port)
72{
73 return (void *)(port + NONCACHE_OFFSET + 0x14000000);
74}
75static inline void delay(void)
76{
77 __asm__ __volatile__ ("push r0; \n\t pop r0;" : : :"memory");
78}
79
80
81
82
83
84static inline unsigned char _ne_inb(void *portp)
85{
86 return (unsigned char) *(volatile unsigned char *)portp;
87}
88
89static inline unsigned short _ne_inw(void *portp)
90{
91 return (unsigned short)le16_to_cpu(*(volatile unsigned short *)portp);
92}
93
94static 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
102static inline void _ne_outb(unsigned char b, void *portp)
103{
104 *(volatile unsigned char *)portp = (unsigned char)b;
105}
106
107static inline void _ne_outw(unsigned short w, void *portp)
108{
109 *(volatile unsigned short *)portp = cpu_to_le16(w);
110}
111
112unsigned 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
132unsigned 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
156unsigned 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
168unsigned char _inb_p(unsigned long port)
169{
170 unsigned char v = _inb(port);
171 delay();
172 return (v);
173}
174
175unsigned short _inw_p(unsigned long port)
176{
177 unsigned short v = _inw(port);
178 delay();
179 return (v);
180}
181
182unsigned long _inl_p(unsigned long port)
183{
184 unsigned long v = _inl(port);
185 delay();
186 return (v);
187}
188
189void _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
207void _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
230void _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
240void _outb_p(unsigned char b, unsigned long port)
241{
242 _outb(b, port);
243 delay();
244}
245
246void _outw_p(unsigned short w, unsigned long port)
247{
248 _outw(w, port);
249 delay();
250}
251
252void _outl_p(unsigned long l, unsigned long port)
253{
254 _outl(l, port);
255 delay();
256}
257
258void _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
284void _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
311void _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
321void _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
348void _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
375void _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
