]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * linux/arch/m32r/kernel/io_oaks32r.c | |
3 | * | |
4 | * Typical I/O routines for OAKS32R board. | |
5 | * | |
6 | * Copyright (c) 2001-2004 Hiroyuki Kondo, Hirokazu Takata, | |
7 | * Hitoshi Yamamoto, Mamoru Sakugawa | |
8 | */ | |
9 | ||
10 | #include <linux/config.h> | |
11 | #include <asm/m32r.h> | |
12 | #include <asm/page.h> | |
13 | #include <asm/io.h> | |
14 | ||
15 | #define PORT2ADDR(port) _port2addr(port) | |
16 | ||
17 | static inline void *_port2addr(unsigned long port) | |
18 | { | |
19 | return (void *)(port + NONCACHE_OFFSET); | |
20 | } | |
21 | ||
22 | static inline void *_port2addr_ne(unsigned long port) | |
23 | { | |
24 | return (void *)((port<<1) + NONCACHE_OFFSET + 0x02000000); | |
25 | } | |
26 | ||
27 | static inline void delay(void) | |
28 | { | |
29 | __asm__ __volatile__ ("push r0; \n\t pop r0;" : : :"memory"); | |
30 | } | |
31 | ||
32 | /* | |
33 | * NIC I/O function | |
34 | */ | |
35 | ||
36 | #define PORT2ADDR_NE(port) _port2addr_ne(port) | |
37 | ||
38 | static inline unsigned char _ne_inb(void *portp) | |
39 | { | |
40 | return *(volatile unsigned char *)(portp+1); | |
41 | } | |
42 | ||
43 | static inline unsigned short _ne_inw(void *portp) | |
44 | { | |
45 | unsigned short tmp; | |
46 | ||
47 | tmp = *(unsigned short *)(portp) & 0xff; | |
48 | tmp |= *(unsigned short *)(portp+2) << 8; | |
49 | return tmp; | |
50 | } | |
51 | ||
52 | static inline void _ne_insb(void *portp, void *addr, unsigned long count) | |
53 | { | |
54 | unsigned char *buf = addr; | |
55 | while (count--) | |
56 | *buf++ = *(volatile unsigned char *)(portp+1); | |
57 | } | |
58 | ||
59 | static inline void _ne_outb(unsigned char b, void *portp) | |
60 | { | |
61 | *(volatile unsigned char *)(portp+1) = b; | |
62 | } | |
63 | ||
64 | static inline void _ne_outw(unsigned short w, void *portp) | |
65 | { | |
66 | *(volatile unsigned short *)portp = (w >> 8); | |
67 | *(volatile unsigned short *)(portp+2) = (w & 0xff); | |
68 | } | |
69 | ||
70 | unsigned char _inb(unsigned long port) | |
71 | { | |
72 | if (port >= 0x300 && port < 0x320) | |
73 | return _ne_inb(PORT2ADDR_NE(port)); | |
74 | ||
75 | return *(volatile unsigned char *)PORT2ADDR(port); | |
76 | } | |
77 | ||
78 | unsigned short _inw(unsigned long port) | |
79 | { | |
80 | if (port >= 0x300 && port < 0x320) | |
81 | return _ne_inw(PORT2ADDR_NE(port)); | |
82 | ||
83 | return *(volatile unsigned short *)PORT2ADDR(port); | |
84 | } | |
85 | ||
86 | unsigned long _inl(unsigned long port) | |
87 | { | |
88 | return *(volatile unsigned long *)PORT2ADDR(port); | |
89 | } | |
90 | ||
91 | unsigned char _inb_p(unsigned long port) | |
92 | { | |
93 | unsigned char v; | |
94 | ||
95 | if (port >= 0x300 && port < 0x320) | |
96 | v = _ne_inb(PORT2ADDR_NE(port)); | |
97 | else | |
98 | v = *(volatile unsigned char *)PORT2ADDR(port); | |
99 | ||
100 | delay(); | |
101 | return (v); | |
102 | } | |
103 | ||
104 | unsigned short _inw_p(unsigned long port) | |
105 | { | |
106 | unsigned short v; | |
107 | ||
108 | if (port >= 0x300 && port < 0x320) | |
109 | v = _ne_inw(PORT2ADDR_NE(port)); | |
110 | else | |
111 | v = *(volatile unsigned short *)PORT2ADDR(port); | |
112 | ||
113 | delay(); | |
114 | return (v); | |
115 | } | |
116 | ||
117 | unsigned long _inl_p(unsigned long port) | |
118 | { | |
119 | unsigned long v; | |
120 | ||
121 | v = *(volatile unsigned long *)PORT2ADDR(port); | |
122 | delay(); | |
123 | return (v); | |
124 | } | |
125 | ||
126 | void _outb(unsigned char b, unsigned long port) | |
127 | { | |
128 | if (port >= 0x300 && port < 0x320) | |
129 | _ne_outb(b, PORT2ADDR_NE(port)); | |
130 | else | |
131 | *(volatile unsigned char *)PORT2ADDR(port) = b; | |
132 | } | |
133 | ||
134 | void _outw(unsigned short w, unsigned long port) | |
135 | { | |
136 | if (port >= 0x300 && port < 0x320) | |
137 | _ne_outw(w, PORT2ADDR_NE(port)); | |
138 | else | |
139 | *(volatile unsigned short *)PORT2ADDR(port) = w; | |
140 | } | |
141 | ||
142 | void _outl(unsigned long l, unsigned long port) | |
143 | { | |
144 | *(volatile unsigned long *)PORT2ADDR(port) = l; | |
145 | } | |
146 | ||
147 | void _outb_p(unsigned char b, unsigned long port) | |
148 | { | |
149 | if (port >= 0x300 && port < 0x320) | |
150 | _ne_outb(b, PORT2ADDR_NE(port)); | |
151 | else | |
152 | *(volatile unsigned char *)PORT2ADDR(port) = b; | |
153 | ||
154 | delay(); | |
155 | } | |
156 | ||
157 | void _outw_p(unsigned short w, unsigned long port) | |
158 | { | |
159 | if (port >= 0x300 && port < 0x320) | |
160 | _ne_outw(w, PORT2ADDR_NE(port)); | |
161 | else | |
162 | *(volatile unsigned short *)PORT2ADDR(port) = w; | |
163 | ||
164 | delay(); | |
165 | } | |
166 | ||
167 | void _outl_p(unsigned long l, unsigned long port) | |
168 | { | |
169 | *(volatile unsigned long *)PORT2ADDR(port) = l; | |
170 | delay(); | |
171 | } | |
172 | ||
173 | void _insb(unsigned int port, void *addr, unsigned long count) | |
174 | { | |
175 | if (port >= 0x300 && port < 0x320) | |
176 | _ne_insb(PORT2ADDR_NE(port), addr, count); | |
177 | else { | |
178 | unsigned char *buf = addr; | |
179 | unsigned char *portp = PORT2ADDR(port); | |
180 | while (count--) | |
181 | *buf++ = *(volatile unsigned char *)portp; | |
182 | } | |
183 | } | |
184 | ||
185 | void _insw(unsigned int port, void *addr, unsigned long count) | |
186 | { | |
187 | unsigned short *buf = addr; | |
188 | unsigned short *portp; | |
189 | ||
190 | if (port >= 0x300 && port < 0x320) { | |
191 | portp = PORT2ADDR_NE(port); | |
192 | while (count--) | |
193 | *buf++ = _ne_inw(portp); | |
194 | } else { | |
195 | portp = PORT2ADDR(port); | |
196 | while (count--) | |
197 | *buf++ = *(volatile unsigned short *)portp; | |
198 | } | |
199 | } | |
200 | ||
201 | void _insl(unsigned int port, void *addr, unsigned long count) | |
202 | { | |
203 | unsigned long *buf = addr; | |
204 | unsigned long *portp; | |
205 | ||
206 | portp = PORT2ADDR(port); | |
207 | while (count--) | |
208 | *buf++ = *(volatile unsigned long *)portp; | |
209 | } | |
210 | ||
211 | void _outsb(unsigned int port, const void *addr, unsigned long count) | |
212 | { | |
213 | const unsigned char *buf = addr; | |
214 | unsigned char *portp; | |
215 | ||
216 | if (port >= 0x300 && port < 0x320) { | |
217 | portp = PORT2ADDR_NE(port); | |
218 | while (count--) | |
219 | _ne_outb(*buf++, portp); | |
220 | } else { | |
221 | portp = PORT2ADDR(port); | |
222 | while (count--) | |
223 | *(volatile unsigned char *)portp = *buf++; | |
224 | } | |
225 | } | |
226 | ||
227 | void _outsw(unsigned int port, const void *addr, unsigned long count) | |
228 | { | |
229 | const unsigned short *buf = addr; | |
230 | unsigned short *portp; | |
231 | ||
232 | if (port >= 0x300 && port < 0x320) { | |
233 | portp = PORT2ADDR_NE(port); | |
234 | while (count--) | |
235 | _ne_outw(*buf++, portp); | |
236 | } else { | |
237 | portp = PORT2ADDR(port); | |
238 | while (count--) | |
239 | *(volatile unsigned short *)portp = *buf++; | |
240 | } | |
241 | } | |
242 | ||
243 | void _outsl(unsigned int port, const void *addr, unsigned long count) | |
244 | { | |
245 | const unsigned long *buf = addr; | |
246 | unsigned char *portp; | |
247 | ||
248 | portp = PORT2ADDR(port); | |
249 | while (count--) | |
250 | *(volatile unsigned long *)portp = *buf++; | |
251 | } |