]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | |
2 | /* rio_linux.c -- Linux driver for the Specialix RIO series cards. | |
3 | * | |
4 | * | |
5 | * (C) 1999 R.E.Wolff@BitWizard.nl | |
6 | * | |
7 | * Specialix pays for the development and support of this driver. | |
8 | * Please DO contact support@specialix.co.uk if you require | |
9 | * support. But please read the documentation (rio.txt) first. | |
10 | * | |
11 | * | |
12 | * | |
13 | * This program is free software; you can redistribute it and/or | |
14 | * modify it under the terms of the GNU General Public License as | |
15 | * published by the Free Software Foundation; either version 2 of | |
16 | * the License, or (at your option) any later version. | |
17 | * | |
18 | * This program is distributed in the hope that it will be | |
19 | * useful, but WITHOUT ANY WARRANTY; without even the implied | |
20 | * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR | |
21 | * PURPOSE. See the GNU General Public License for more details. | |
22 | * | |
23 | * You should have received a copy of the GNU General Public | |
24 | * License along with this program; if not, write to the Free | |
25 | * Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, | |
26 | * USA. | |
27 | * | |
28 | * Revision history: | |
29 | * $Log: rio.c,v $ | |
30 | * Revision 1.1 1999/07/11 10:13:54 wolff | |
31 | * Initial revision | |
32 | * | |
33 | * */ | |
34 | ||
35 | #include <linux/module.h> | |
1da177e4 LT |
36 | #include <linux/kdev_t.h> |
37 | #include <asm/io.h> | |
38 | #include <linux/kernel.h> | |
39 | #include <linux/sched.h> | |
40 | #include <linux/ioport.h> | |
41 | #include <linux/interrupt.h> | |
42 | #include <linux/errno.h> | |
43 | #include <linux/tty.h> | |
44 | #include <linux/tty_flip.h> | |
45 | #include <linux/mm.h> | |
46 | #include <linux/serial.h> | |
47 | #include <linux/fcntl.h> | |
48 | #include <linux/major.h> | |
49 | #include <linux/delay.h> | |
50 | #include <linux/pci.h> | |
51 | #include <linux/slab.h> | |
52 | #include <linux/miscdevice.h> | |
53 | #include <linux/init.h> | |
54 | ||
55 | #include <linux/generic_serial.h> | |
56 | #include <asm/uaccess.h> | |
57 | ||
1da177e4 | 58 | #include "linux_compat.h" |
1da177e4 LT |
59 | #include "pkt.h" |
60 | #include "daemon.h" | |
61 | #include "rio.h" | |
62 | #include "riospace.h" | |
1da177e4 LT |
63 | #include "cmdpkt.h" |
64 | #include "map.h" | |
1da177e4 LT |
65 | #include "rup.h" |
66 | #include "port.h" | |
67 | #include "riodrvr.h" | |
68 | #include "rioinfo.h" | |
69 | #include "func.h" | |
70 | #include "errors.h" | |
71 | #include "pci.h" | |
72 | ||
73 | #include "parmmap.h" | |
74 | #include "unixrup.h" | |
75 | #include "board.h" | |
76 | #include "host.h" | |
1da177e4 LT |
77 | #include "phb.h" |
78 | #include "link.h" | |
79 | #include "cmdblk.h" | |
80 | #include "route.h" | |
1da177e4 LT |
81 | #include "cirrus.h" |
82 | #include "rioioctl.h" | |
83 | #include "param.h" | |
1da177e4 LT |
84 | #include "protsts.h" |
85 | #include "rioboard.h" | |
86 | ||
87 | ||
88 | #include "rio_linux.h" | |
89 | ||
90 | /* I don't think that this driver can handle more than 512 ports on | |
91 | one machine. Specialix specifies max 4 boards in one machine. I don't | |
92 | know why. If you want to try anyway you'll have to increase the number | |
93 | of boards in rio.h. You'll have to allocate more majors if you need | |
94 | more than 512 ports.... */ | |
95 | ||
96 | #ifndef RIO_NORMAL_MAJOR0 | |
97 | /* This allows overriding on the compiler commandline, or in a "major.h" | |
98 | include or something like that */ | |
99 | #define RIO_NORMAL_MAJOR0 154 | |
100 | #define RIO_NORMAL_MAJOR1 156 | |
101 | #endif | |
102 | ||
103 | #ifndef PCI_DEVICE_ID_SPECIALIX_SX_XIO_IO8 | |
104 | #define PCI_DEVICE_ID_SPECIALIX_SX_XIO_IO8 0x2000 | |
105 | #endif | |
106 | ||
8d8706e2 | 107 | #ifndef RIO_WINDOW_LEN |
1da177e4 LT |
108 | #define RIO_WINDOW_LEN 0x10000 |
109 | #endif | |
110 | ||
111 | ||
112 | /* Configurable options: | |
113 | (Don't be too sure that it'll work if you toggle them) */ | |
114 | ||
115 | /* Am I paranoid or not ? ;-) */ | |
116 | #undef RIO_PARANOIA_CHECK | |
117 | ||
118 | ||
119 | /* 20 -> 2000 per second. The card should rate-limit interrupts at 1000 | |
120 | Hz, but it is user configurable. I don't recommend going above 1000 | |
121 | Hz. The interrupt ratelimit might trigger if the interrupt is | |
122 | shared with a very active other device. | |
123 | undef this if you want to disable the check.... | |
124 | */ | |
125 | #define IRQ_RATE_LIMIT 200 | |
126 | ||
1da177e4 LT |
127 | |
128 | /* These constants are derived from SCO Source */ | |
129 | static struct Conf | |
8d8706e2 AM |
130 | RIOConf = { |
131 | /* locator */ "RIO Config here", | |
132 | /* startuptime */ HZ * 2, | |
133 | /* how long to wait for card to run */ | |
134 | /* slowcook */ 0, | |
135 | /* TRUE -> always use line disc. */ | |
136 | /* intrpolltime */ 1, | |
137 | /* The frequency of OUR polls */ | |
138 | /* breakinterval */ 25, | |
139 | /* x10 mS XXX: units seem to be 1ms not 10! -- REW */ | |
140 | /* timer */ 10, | |
141 | /* mS */ | |
142 | /* RtaLoadBase */ 0x7000, | |
143 | /* HostLoadBase */ 0x7C00, | |
144 | /* XpHz */ 5, | |
145 | /* number of Xprint hits per second */ | |
146 | /* XpCps */ 120, | |
147 | /* Xprint characters per second */ | |
148 | /* XpOn */ "\033d#", | |
149 | /* start Xprint for a wyse 60 */ | |
150 | /* XpOff */ "\024", | |
151 | /* end Xprint for a wyse 60 */ | |
152 | /* MaxXpCps */ 2000, | |
153 | /* highest Xprint speed */ | |
154 | /* MinXpCps */ 10, | |
155 | /* slowest Xprint speed */ | |
156 | /* SpinCmds */ 1, | |
157 | /* non-zero for mega fast boots */ | |
158 | /* First Addr */ 0x0A0000, | |
159 | /* First address to look at */ | |
160 | /* Last Addr */ 0xFF0000, | |
161 | /* Last address looked at */ | |
162 | /* BufferSize */ 1024, | |
163 | /* Bytes per port of buffering */ | |
164 | /* LowWater */ 256, | |
165 | /* how much data left before wakeup */ | |
166 | /* LineLength */ 80, | |
167 | /* how wide is the console? */ | |
168 | /* CmdTimeout */ HZ, | |
169 | /* how long a close command may take */ | |
1da177e4 LT |
170 | }; |
171 | ||
172 | ||
173 | ||
174 | ||
175 | /* Function prototypes */ | |
176 | ||
8d8706e2 AM |
177 | static void rio_disable_tx_interrupts(void *ptr); |
178 | static void rio_enable_tx_interrupts(void *ptr); | |
179 | static void rio_disable_rx_interrupts(void *ptr); | |
180 | static void rio_enable_rx_interrupts(void *ptr); | |
181 | static int rio_get_CD(void *ptr); | |
182 | static void rio_shutdown_port(void *ptr); | |
183 | static int rio_set_real_termios(void *ptr); | |
184 | static void rio_hungup(void *ptr); | |
185 | static void rio_close(void *ptr); | |
186 | static int rio_chars_in_buffer(void *ptr); | |
187 | static int rio_fw_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg); | |
1da177e4 LT |
188 | static int rio_init_drivers(void); |
189 | ||
8d8706e2 | 190 | static void my_hd(void *addr, int len); |
1da177e4 LT |
191 | |
192 | static struct tty_driver *rio_driver, *rio_driver2; | |
193 | ||
194 | /* The name "p" is a bit non-descript. But that's what the rio-lynxos | |
195 | sources use all over the place. */ | |
196 | struct rio_info *p; | |
197 | ||
198 | int rio_debug; | |
199 | ||
200 | ||
201 | /* You can have the driver poll your card. | |
202 | - Set rio_poll to 1 to poll every timer tick (10ms on Intel). | |
203 | This is used when the card cannot use an interrupt for some reason. | |
204 | */ | |
205 | static int rio_poll = 1; | |
206 | ||
207 | ||
208 | /* These are the only open spaces in my computer. Yours may have more | |
209 | or less.... */ | |
8d8706e2 | 210 | static int rio_probe_addrs[] = { 0xc0000, 0xd0000, 0xe0000 }; |
1da177e4 | 211 | |
fe971071 | 212 | #define NR_RIO_ADDRS ARRAY_SIZE(rio_probe_addrs) |
1da177e4 LT |
213 | |
214 | ||
215 | /* Set the mask to all-ones. This alas, only supports 32 interrupts. | |
216 | Some architectures may need more. -- Changed to LONG to | |
217 | support up to 64 bits on 64bit architectures. -- REW 20/06/99 */ | |
408b664a | 218 | static long rio_irqmask = -1; |
1da177e4 LT |
219 | |
220 | MODULE_AUTHOR("Rogier Wolff <R.E.Wolff@bitwizard.nl>, Patrick van de Lageweg <patrick@bitwizard.nl>"); | |
221 | MODULE_DESCRIPTION("RIO driver"); | |
222 | MODULE_LICENSE("GPL"); | |
223 | module_param(rio_poll, int, 0); | |
224 | module_param(rio_debug, int, 0644); | |
225 | module_param(rio_irqmask, long, 0); | |
226 | ||
227 | static struct real_driver rio_real_driver = { | |
8d8706e2 AM |
228 | rio_disable_tx_interrupts, |
229 | rio_enable_tx_interrupts, | |
230 | rio_disable_rx_interrupts, | |
231 | rio_enable_rx_interrupts, | |
232 | rio_get_CD, | |
233 | rio_shutdown_port, | |
234 | rio_set_real_termios, | |
235 | rio_chars_in_buffer, | |
236 | rio_close, | |
237 | rio_hungup, | |
238 | NULL | |
1da177e4 LT |
239 | }; |
240 | ||
241 | /* | |
242 | * Firmware loader driver specific routines | |
243 | * | |
244 | */ | |
245 | ||
62322d25 | 246 | static const struct file_operations rio_fw_fops = { |
8d8706e2 AM |
247 | .owner = THIS_MODULE, |
248 | .ioctl = rio_fw_ioctl, | |
1da177e4 LT |
249 | }; |
250 | ||
251 | static struct miscdevice rio_fw_device = { | |
252 | RIOCTL_MISC_MINOR, "rioctl", &rio_fw_fops | |
253 | }; | |
254 | ||
255 | ||
256 | ||
257 | ||
258 | ||
259 | #ifdef RIO_PARANOIA_CHECK | |
260 | ||
261 | /* This doesn't work. Who's paranoid around here? Not me! */ | |
262 | ||
8d8706e2 | 263 | static inline int rio_paranoia_check(struct rio_port const *port, char *name, const char *routine) |
1da177e4 LT |
264 | { |
265 | ||
8d8706e2 AM |
266 | static const char *badmagic = KERN_ERR "rio: Warning: bad rio port magic number for device %s in %s\n"; |
267 | static const char *badinfo = KERN_ERR "rio: Warning: null rio port for device %s in %s\n"; | |
268 | ||
269 | if (!port) { | |
270 | printk(badinfo, name, routine); | |
271 | return 1; | |
272 | } | |
273 | if (port->magic != RIO_MAGIC) { | |
274 | printk(badmagic, name, routine); | |
275 | return 1; | |
276 | } | |
277 | ||
278 | return 0; | |
1da177e4 LT |
279 | } |
280 | #else | |
281 | #define rio_paranoia_check(a,b,c) 0 | |
282 | #endif | |
283 | ||
284 | ||
285 | #ifdef DEBUG | |
8d8706e2 | 286 | static void my_hd(void *ad, int len) |
1da177e4 | 287 | { |
8d8706e2 AM |
288 | int i, j, ch; |
289 | unsigned char *addr = ad; | |
290 | ||
291 | for (i = 0; i < len; i += 16) { | |
00d83a54 | 292 | rio_dprintk(RIO_DEBUG_PARAM, "%08lx ", (unsigned long) addr + i); |
8d8706e2 AM |
293 | for (j = 0; j < 16; j++) { |
294 | rio_dprintk(RIO_DEBUG_PARAM, "%02x %s", addr[j + i], (j == 7) ? " " : ""); | |
295 | } | |
296 | for (j = 0; j < 16; j++) { | |
297 | ch = addr[j + i]; | |
298 | rio_dprintk(RIO_DEBUG_PARAM, "%c", (ch < 0x20) ? '.' : ((ch > 0x7f) ? '.' : ch)); | |
299 | } | |
300 | rio_dprintk(RIO_DEBUG_PARAM, "\n"); | |
301 | } | |
1da177e4 LT |
302 | } |
303 | #else | |
304 | #define my_hd(ad,len) do{/* nothing*/ } while (0) | |
305 | #endif | |
306 | ||
307 | ||
8d8706e2 AM |
308 | /* Delay a number of jiffies, allowing a signal to interrupt */ |
309 | int RIODelay(struct Port *PortP, int njiffies) | |
1da177e4 | 310 | { |
8d8706e2 | 311 | func_enter(); |
1da177e4 | 312 | |
8d8706e2 AM |
313 | rio_dprintk(RIO_DEBUG_DELAY, "delaying %d jiffies\n", njiffies); |
314 | msleep_interruptible(jiffies_to_msecs(njiffies)); | |
315 | func_exit(); | |
1da177e4 | 316 | |
8d8706e2 AM |
317 | if (signal_pending(current)) |
318 | return RIO_FAIL; | |
319 | else | |
320 | return !RIO_FAIL; | |
1da177e4 LT |
321 | } |
322 | ||
323 | ||
8d8706e2 AM |
324 | /* Delay a number of jiffies, disallowing a signal to interrupt */ |
325 | int RIODelay_ni(struct Port *PortP, int njiffies) | |
1da177e4 | 326 | { |
8d8706e2 | 327 | func_enter(); |
1da177e4 | 328 | |
8d8706e2 AM |
329 | rio_dprintk(RIO_DEBUG_DELAY, "delaying %d jiffies (ni)\n", njiffies); |
330 | msleep(jiffies_to_msecs(njiffies)); | |
331 | func_exit(); | |
332 | return !RIO_FAIL; | |
1da177e4 LT |
333 | } |
334 | ||
38d0d001 | 335 | void rio_copy_to_card(void *from, void __iomem *to, int len) |
00d83a54 | 336 | { |
ae5b28a5 | 337 | rio_copy_toio(to, from, len); |
00d83a54 | 338 | } |
1da177e4 LT |
339 | |
340 | int rio_minor(struct tty_struct *tty) | |
341 | { | |
342 | return tty->index + (tty->driver == rio_driver) ? 0 : 256; | |
343 | } | |
344 | ||
8d8706e2 | 345 | static int rio_set_real_termios(void *ptr) |
1da177e4 | 346 | { |
554b7c80 | 347 | return RIOParam((struct Port *) ptr, CONFIG, 1, 1); |
1da177e4 LT |
348 | } |
349 | ||
350 | ||
8d8706e2 | 351 | static void rio_reset_interrupt(struct Host *HostP) |
1da177e4 | 352 | { |
8d8706e2 | 353 | func_enter(); |
1da177e4 | 354 | |
8d8706e2 AM |
355 | switch (HostP->Type) { |
356 | case RIO_AT: | |
357 | case RIO_MCA: | |
358 | case RIO_PCI: | |
00d83a54 | 359 | writeb(0xFF, &HostP->ResetInt); |
8d8706e2 | 360 | } |
1da177e4 | 361 | |
8d8706e2 | 362 | func_exit(); |
1da177e4 LT |
363 | } |
364 | ||
365 | ||
7d12e780 | 366 | static irqreturn_t rio_interrupt(int irq, void *ptr) |
1da177e4 | 367 | { |
8d8706e2 AM |
368 | struct Host *HostP; |
369 | func_enter(); | |
1da177e4 | 370 | |
8d8706e2 AM |
371 | HostP = (struct Host *) ptr; /* &p->RIOHosts[(long)ptr]; */ |
372 | rio_dprintk(RIO_DEBUG_IFLOW, "rio: enter rio_interrupt (%d/%d)\n", irq, HostP->Ivec); | |
1da177e4 | 373 | |
8d8706e2 AM |
374 | /* AAargh! The order in which to do these things is essential and |
375 | not trivial. | |
1da177e4 | 376 | |
8d8706e2 AM |
377 | - hardware twiddling goes before "recursive". Otherwise when we |
378 | poll the card, and a recursive interrupt happens, we won't | |
379 | ack the card, so it might keep on interrupting us. (especially | |
380 | level sensitive interrupt systems like PCI). | |
1da177e4 | 381 | |
8d8706e2 AM |
382 | - Rate limit goes before hardware twiddling. Otherwise we won't |
383 | catch a card that has gone bonkers. | |
1da177e4 | 384 | |
8d8706e2 AM |
385 | - The "initialized" test goes after the hardware twiddling. Otherwise |
386 | the card will stick us in the interrupt routine again. | |
387 | ||
388 | - The initialized test goes before recursive. | |
389 | */ | |
1da177e4 | 390 | |
8d8706e2 AM |
391 | rio_dprintk(RIO_DEBUG_IFLOW, "rio: We've have noticed the interrupt\n"); |
392 | if (HostP->Ivec == irq) { | |
393 | /* Tell the card we've noticed the interrupt. */ | |
394 | rio_reset_interrupt(HostP); | |
395 | } | |
396 | ||
397 | if ((HostP->Flags & RUN_STATE) != RC_RUNNING) | |
398 | return IRQ_HANDLED; | |
399 | ||
400 | if (test_and_set_bit(RIO_BOARD_INTR_LOCK, &HostP->locks)) { | |
00d83a54 | 401 | printk(KERN_ERR "Recursive interrupt! (host %p/irq%d)\n", ptr, HostP->Ivec); |
8d8706e2 AM |
402 | return IRQ_HANDLED; |
403 | } | |
404 | ||
405 | RIOServiceHost(p, HostP, irq); | |
406 | ||
00d83a54 | 407 | rio_dprintk(RIO_DEBUG_IFLOW, "riointr() doing host %p type %d\n", ptr, HostP->Type); |
8d8706e2 AM |
408 | |
409 | clear_bit(RIO_BOARD_INTR_LOCK, &HostP->locks); | |
410 | rio_dprintk(RIO_DEBUG_IFLOW, "rio: exit rio_interrupt (%d/%d)\n", irq, HostP->Ivec); | |
411 | func_exit(); | |
412 | return IRQ_HANDLED; | |
1da177e4 LT |
413 | } |
414 | ||
415 | ||
8d8706e2 | 416 | static void rio_pollfunc(unsigned long data) |
1da177e4 | 417 | { |
8d8706e2 | 418 | func_enter(); |
1da177e4 | 419 | |
7d12e780 | 420 | rio_interrupt(0, &p->RIOHosts[data]); |
8d8706e2 AM |
421 | p->RIOHosts[data].timer.expires = jiffies + rio_poll; |
422 | add_timer(&p->RIOHosts[data].timer); | |
1da177e4 | 423 | |
8d8706e2 | 424 | func_exit(); |
1da177e4 LT |
425 | } |
426 | ||
427 | ||
428 | /* ********************************************************************** * | |
429 | * Here are the routines that actually * | |
430 | * interface with the generic_serial driver * | |
431 | * ********************************************************************** */ | |
432 | ||
433 | /* Ehhm. I don't know how to fiddle with interrupts on the Specialix | |
434 | cards. .... Hmm. Ok I figured it out. You don't. -- REW */ | |
435 | ||
8d8706e2 | 436 | static void rio_disable_tx_interrupts(void *ptr) |
1da177e4 | 437 | { |
8d8706e2 | 438 | func_enter(); |
1da177e4 | 439 | |
8d8706e2 | 440 | /* port->gs.flags &= ~GS_TX_INTEN; */ |
1da177e4 | 441 | |
8d8706e2 | 442 | func_exit(); |
1da177e4 LT |
443 | } |
444 | ||
445 | ||
8d8706e2 | 446 | static void rio_enable_tx_interrupts(void *ptr) |
1da177e4 | 447 | { |
8d8706e2 AM |
448 | struct Port *PortP = ptr; |
449 | /* int hn; */ | |
1da177e4 | 450 | |
8d8706e2 | 451 | func_enter(); |
1da177e4 | 452 | |
8d8706e2 | 453 | /* hn = PortP->HostP - p->RIOHosts; |
1da177e4 | 454 | |
8d8706e2 AM |
455 | rio_dprintk (RIO_DEBUG_TTY, "Pushing host %d\n", hn); |
456 | rio_interrupt (-1,(void *) hn, NULL); */ | |
1da177e4 | 457 | |
8d8706e2 | 458 | RIOTxEnable((char *) PortP); |
1da177e4 | 459 | |
8d8706e2 AM |
460 | /* |
461 | * In general we cannot count on "tx empty" interrupts, although | |
462 | * the interrupt routine seems to be able to tell the difference. | |
463 | */ | |
464 | PortP->gs.flags &= ~GS_TX_INTEN; | |
1da177e4 | 465 | |
8d8706e2 | 466 | func_exit(); |
1da177e4 LT |
467 | } |
468 | ||
469 | ||
8d8706e2 | 470 | static void rio_disable_rx_interrupts(void *ptr) |
1da177e4 | 471 | { |
8d8706e2 AM |
472 | func_enter(); |
473 | func_exit(); | |
1da177e4 LT |
474 | } |
475 | ||
8d8706e2 | 476 | static void rio_enable_rx_interrupts(void *ptr) |
1da177e4 | 477 | { |
8d8706e2 AM |
478 | /* struct rio_port *port = ptr; */ |
479 | func_enter(); | |
480 | func_exit(); | |
1da177e4 LT |
481 | } |
482 | ||
483 | ||
484 | /* Jeez. Isn't this simple? */ | |
8d8706e2 | 485 | static int rio_get_CD(void *ptr) |
1da177e4 | 486 | { |
8d8706e2 AM |
487 | struct Port *PortP = ptr; |
488 | int rv; | |
489 | ||
490 | func_enter(); | |
491 | rv = (PortP->ModemState & MSVR1_CD) != 0; | |
1da177e4 | 492 | |
8d8706e2 | 493 | rio_dprintk(RIO_DEBUG_INIT, "Getting CD status: %d\n", rv); |
1da177e4 | 494 | |
8d8706e2 AM |
495 | func_exit(); |
496 | return rv; | |
1da177e4 LT |
497 | } |
498 | ||
499 | ||
500 | /* Jeez. Isn't this simple? Actually, we can sync with the actual port | |
501 | by just pushing stuff into the queue going to the port... */ | |
8d8706e2 | 502 | static int rio_chars_in_buffer(void *ptr) |
1da177e4 | 503 | { |
8d8706e2 | 504 | func_enter(); |
1da177e4 | 505 | |
8d8706e2 AM |
506 | func_exit(); |
507 | return 0; | |
1da177e4 LT |
508 | } |
509 | ||
510 | ||
511 | /* Nothing special here... */ | |
8d8706e2 | 512 | static void rio_shutdown_port(void *ptr) |
1da177e4 | 513 | { |
8d8706e2 | 514 | struct Port *PortP; |
1da177e4 | 515 | |
8d8706e2 | 516 | func_enter(); |
1da177e4 | 517 | |
8d8706e2 AM |
518 | PortP = (struct Port *) ptr; |
519 | PortP->gs.tty = NULL; | |
8d8706e2 | 520 | func_exit(); |
1da177e4 LT |
521 | } |
522 | ||
523 | ||
524 | /* I haven't the foggiest why the decrement use count has to happen | |
525 | here. The whole linux serial drivers stuff needs to be redesigned. | |
526 | My guess is that this is a hack to minimize the impact of a bug | |
527 | elsewhere. Thinking about it some more. (try it sometime) Try | |
528 | running minicom on a serial port that is driven by a modularized | |
529 | driver. Have the modem hangup. Then remove the driver module. Then | |
530 | exit minicom. I expect an "oops". -- REW */ | |
8d8706e2 | 531 | static void rio_hungup(void *ptr) |
1da177e4 | 532 | { |
8d8706e2 AM |
533 | struct Port *PortP; |
534 | ||
535 | func_enter(); | |
1da177e4 | 536 | |
8d8706e2 AM |
537 | PortP = (struct Port *) ptr; |
538 | PortP->gs.tty = NULL; | |
1da177e4 | 539 | |
8d8706e2 | 540 | func_exit(); |
1da177e4 LT |
541 | } |
542 | ||
543 | ||
544 | /* The standard serial_close would become shorter if you'd wrap it like | |
545 | this. | |
546 | rs_close (...){save_flags;cli;real_close();dec_use_count;restore_flags;} | |
547 | */ | |
8d8706e2 | 548 | static void rio_close(void *ptr) |
1da177e4 | 549 | { |
8d8706e2 | 550 | struct Port *PortP; |
1da177e4 | 551 | |
8d8706e2 | 552 | func_enter(); |
1da177e4 | 553 | |
8d8706e2 | 554 | PortP = (struct Port *) ptr; |
1da177e4 | 555 | |
8d8706e2 | 556 | riotclose(ptr); |
1da177e4 | 557 | |
8d8706e2 AM |
558 | if (PortP->gs.count) { |
559 | printk(KERN_ERR "WARNING port count:%d\n", PortP->gs.count); | |
560 | PortP->gs.count = 0; | |
561 | } | |
1da177e4 | 562 | |
8d8706e2 AM |
563 | PortP->gs.tty = NULL; |
564 | func_exit(); | |
1da177e4 LT |
565 | } |
566 | ||
567 | ||
568 | ||
8d8706e2 | 569 | static int rio_fw_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg) |
1da177e4 | 570 | { |
8d8706e2 AM |
571 | int rc = 0; |
572 | func_enter(); | |
1da177e4 | 573 | |
8d8706e2 | 574 | /* The "dev" argument isn't used. */ |
d886cb58 | 575 | rc = riocontrol(p, 0, cmd, arg, capable(CAP_SYS_ADMIN)); |
1da177e4 | 576 | |
8d8706e2 AM |
577 | func_exit(); |
578 | return rc; | |
1da177e4 LT |
579 | } |
580 | ||
8d8706e2 | 581 | extern int RIOShortCommand(struct rio_info *p, struct Port *PortP, int command, int len, int arg); |
1da177e4 | 582 | |
8d8706e2 | 583 | static int rio_ioctl(struct tty_struct *tty, struct file *filp, unsigned int cmd, unsigned long arg) |
1da177e4 | 584 | { |
d886cb58 | 585 | void __user *argp = (void __user *)arg; |
8d8706e2 AM |
586 | int rc; |
587 | struct Port *PortP; | |
588 | int ival; | |
1da177e4 | 589 | |
8d8706e2 | 590 | func_enter(); |
1da177e4 | 591 | |
8d8706e2 | 592 | PortP = (struct Port *) tty->driver_data; |
1da177e4 | 593 | |
8d8706e2 AM |
594 | rc = 0; |
595 | switch (cmd) { | |
8d8706e2 | 596 | case TIOCSSOFTCAR: |
d886cb58 | 597 | if ((rc = get_user(ival, (unsigned __user *) argp)) == 0) { |
8d8706e2 AM |
598 | tty->termios->c_cflag = (tty->termios->c_cflag & ~CLOCAL) | (ival ? CLOCAL : 0); |
599 | } | |
600 | break; | |
601 | case TIOCGSERIAL: | |
602 | rc = -EFAULT; | |
d886cb58 AV |
603 | if (access_ok(VERIFY_WRITE, argp, sizeof(struct serial_struct))) |
604 | rc = gs_getserial(&PortP->gs, argp); | |
8d8706e2 AM |
605 | break; |
606 | case TCSBRK: | |
607 | if (PortP->State & RIO_DELETED) { | |
608 | rio_dprintk(RIO_DEBUG_TTY, "BREAK on deleted RTA\n"); | |
609 | rc = -EIO; | |
610 | } else { | |
611 | if (RIOShortCommand(p, PortP, SBREAK, 2, 250) == RIO_FAIL) { | |
612 | rio_dprintk(RIO_DEBUG_INTR, "SBREAK RIOShortCommand failed\n"); | |
613 | rc = -EIO; | |
614 | } | |
615 | } | |
616 | break; | |
617 | case TCSBRKP: | |
618 | if (PortP->State & RIO_DELETED) { | |
619 | rio_dprintk(RIO_DEBUG_TTY, "BREAK on deleted RTA\n"); | |
620 | rc = -EIO; | |
621 | } else { | |
622 | int l; | |
623 | l = arg ? arg * 100 : 250; | |
624 | if (l > 255) | |
625 | l = 255; | |
626 | if (RIOShortCommand(p, PortP, SBREAK, 2, arg ? arg * 100 : 250) == RIO_FAIL) { | |
627 | rio_dprintk(RIO_DEBUG_INTR, "SBREAK RIOShortCommand failed\n"); | |
628 | rc = -EIO; | |
629 | } | |
630 | } | |
631 | break; | |
632 | case TIOCSSERIAL: | |
633 | rc = -EFAULT; | |
d886cb58 AV |
634 | if (access_ok(VERIFY_READ, argp, sizeof(struct serial_struct))) |
635 | rc = gs_setserial(&PortP->gs, argp); | |
8d8706e2 | 636 | break; |
8d8706e2 AM |
637 | default: |
638 | rc = -ENOIOCTLCMD; | |
639 | break; | |
640 | } | |
641 | func_exit(); | |
642 | return rc; | |
1da177e4 LT |
643 | } |
644 | ||
645 | ||
646 | /* The throttle/unthrottle scheme for the Specialix card is different | |
647 | * from other drivers and deserves some explanation. | |
648 | * The Specialix hardware takes care of XON/XOFF | |
649 | * and CTS/RTS flow control itself. This means that all we have to | |
650 | * do when signalled by the upper tty layer to throttle/unthrottle is | |
651 | * to make a note of it here. When we come to read characters from the | |
652 | * rx buffers on the card (rio_receive_chars()) we look to see if the | |
653 | * upper layer can accept more (as noted here in rio_rx_throt[]). | |
654 | * If it can't we simply don't remove chars from the cards buffer. | |
655 | * When the tty layer can accept chars, we again note that here and when | |
656 | * rio_receive_chars() is called it will remove them from the cards buffer. | |
657 | * The card will notice that a ports buffer has drained below some low | |
658 | * water mark and will unflow control the line itself, using whatever | |
659 | * flow control scheme is in use for that port. -- Simon Allen | |
660 | */ | |
661 | ||
8d8706e2 | 662 | static void rio_throttle(struct tty_struct *tty) |
1da177e4 | 663 | { |
8d8706e2 AM |
664 | struct Port *port = (struct Port *) tty->driver_data; |
665 | ||
666 | func_enter(); | |
667 | /* If the port is using any type of input flow | |
668 | * control then throttle the port. | |
669 | */ | |
670 | ||
671 | if ((tty->termios->c_cflag & CRTSCTS) || (I_IXOFF(tty))) { | |
672 | port->State |= RIO_THROTTLE_RX; | |
673 | } | |
674 | ||
675 | func_exit(); | |
1da177e4 LT |
676 | } |
677 | ||
678 | ||
8d8706e2 | 679 | static void rio_unthrottle(struct tty_struct *tty) |
1da177e4 | 680 | { |
8d8706e2 | 681 | struct Port *port = (struct Port *) tty->driver_data; |
1da177e4 | 682 | |
8d8706e2 AM |
683 | func_enter(); |
684 | /* Always unthrottle even if flow control is not enabled on | |
685 | * this port in case we disabled flow control while the port | |
686 | * was throttled | |
687 | */ | |
1da177e4 | 688 | |
8d8706e2 | 689 | port->State &= ~RIO_THROTTLE_RX; |
1da177e4 | 690 | |
8d8706e2 AM |
691 | func_exit(); |
692 | return; | |
1da177e4 LT |
693 | } |
694 | ||
695 | ||
696 | ||
697 | ||
698 | ||
699 | /* ********************************************************************** * | |
700 | * Here are the initialization routines. * | |
701 | * ********************************************************************** */ | |
702 | ||
703 | ||
8d8706e2 | 704 | static struct vpd_prom *get_VPD_PROM(struct Host *hp) |
1da177e4 | 705 | { |
8d8706e2 AM |
706 | static struct vpd_prom vpdp; |
707 | char *p; | |
708 | int i; | |
709 | ||
710 | func_enter(); | |
711 | rio_dprintk(RIO_DEBUG_PROBE, "Going to verify vpd prom at %p.\n", hp->Caddr + RIO_VPD_ROM); | |
1da177e4 | 712 | |
8d8706e2 AM |
713 | p = (char *) &vpdp; |
714 | for (i = 0; i < sizeof(struct vpd_prom); i++) | |
715 | *p++ = readb(hp->Caddr + RIO_VPD_ROM + i * 2); | |
716 | /* read_rio_byte (hp, RIO_VPD_ROM + i*2); */ | |
1da177e4 | 717 | |
8d8706e2 AM |
718 | /* Terminate the identifier string. |
719 | *** requires one extra byte in struct vpd_prom *** */ | |
720 | *p++ = 0; | |
1da177e4 | 721 | |
8d8706e2 AM |
722 | if (rio_debug & RIO_DEBUG_PROBE) |
723 | my_hd((char *) &vpdp, 0x20); | |
1da177e4 | 724 | |
8d8706e2 | 725 | func_exit(); |
1da177e4 | 726 | |
8d8706e2 | 727 | return &vpdp; |
1da177e4 LT |
728 | } |
729 | ||
b68e31d0 | 730 | static const struct tty_operations rio_ops = { |
8d8706e2 | 731 | .open = riotopen, |
1da177e4 LT |
732 | .close = gs_close, |
733 | .write = gs_write, | |
734 | .put_char = gs_put_char, | |
735 | .flush_chars = gs_flush_chars, | |
736 | .write_room = gs_write_room, | |
737 | .chars_in_buffer = gs_chars_in_buffer, | |
738 | .flush_buffer = gs_flush_buffer, | |
739 | .ioctl = rio_ioctl, | |
740 | .throttle = rio_throttle, | |
741 | .unthrottle = rio_unthrottle, | |
742 | .set_termios = gs_set_termios, | |
743 | .stop = gs_stop, | |
744 | .start = gs_start, | |
745 | .hangup = gs_hangup, | |
746 | }; | |
747 | ||
748 | static int rio_init_drivers(void) | |
749 | { | |
750 | int error = -ENOMEM; | |
751 | ||
752 | rio_driver = alloc_tty_driver(256); | |
753 | if (!rio_driver) | |
754 | goto out; | |
755 | rio_driver2 = alloc_tty_driver(256); | |
756 | if (!rio_driver2) | |
757 | goto out1; | |
758 | ||
759 | func_enter(); | |
760 | ||
761 | rio_driver->owner = THIS_MODULE; | |
762 | rio_driver->driver_name = "specialix_rio"; | |
763 | rio_driver->name = "ttySR"; | |
764 | rio_driver->major = RIO_NORMAL_MAJOR0; | |
765 | rio_driver->type = TTY_DRIVER_TYPE_SERIAL; | |
766 | rio_driver->subtype = SERIAL_TYPE_NORMAL; | |
767 | rio_driver->init_termios = tty_std_termios; | |
768 | rio_driver->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL; | |
769 | rio_driver->flags = TTY_DRIVER_REAL_RAW; | |
770 | tty_set_operations(rio_driver, &rio_ops); | |
771 | ||
772 | rio_driver2->owner = THIS_MODULE; | |
773 | rio_driver2->driver_name = "specialix_rio"; | |
774 | rio_driver2->name = "ttySR"; | |
775 | rio_driver2->major = RIO_NORMAL_MAJOR1; | |
776 | rio_driver2->type = TTY_DRIVER_TYPE_SERIAL; | |
777 | rio_driver2->subtype = SERIAL_TYPE_NORMAL; | |
778 | rio_driver2->init_termios = tty_std_termios; | |
779 | rio_driver2->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL; | |
780 | rio_driver2->flags = TTY_DRIVER_REAL_RAW; | |
781 | tty_set_operations(rio_driver2, &rio_ops); | |
782 | ||
8d8706e2 | 783 | rio_dprintk(RIO_DEBUG_INIT, "set_termios = %p\n", gs_set_termios); |
1da177e4 LT |
784 | |
785 | if ((error = tty_register_driver(rio_driver))) | |
786 | goto out2; | |
787 | if ((error = tty_register_driver(rio_driver2))) | |
788 | goto out3; | |
789 | func_exit(); | |
790 | return 0; | |
8d8706e2 | 791 | out3: |
1da177e4 | 792 | tty_unregister_driver(rio_driver); |
8d8706e2 | 793 | out2: |
1da177e4 | 794 | put_tty_driver(rio_driver2); |
8d8706e2 | 795 | out1: |
1da177e4 | 796 | put_tty_driver(rio_driver); |
8d8706e2 AM |
797 | out: |
798 | printk(KERN_ERR "rio: Couldn't register a rio driver, error = %d\n", error); | |
1da177e4 LT |
799 | return 1; |
800 | } | |
801 | ||
802 | ||
8d8706e2 | 803 | static void *ckmalloc(int size) |
1da177e4 | 804 | { |
8d8706e2 | 805 | void *p; |
1da177e4 | 806 | |
8d8706e2 AM |
807 | p = kmalloc(size, GFP_KERNEL); |
808 | if (p) | |
809 | memset(p, 0, size); | |
810 | return p; | |
1da177e4 LT |
811 | } |
812 | ||
813 | ||
814 | ||
8d8706e2 | 815 | static int rio_init_datastructures(void) |
1da177e4 | 816 | { |
8d8706e2 AM |
817 | int i; |
818 | struct Port *port; | |
819 | func_enter(); | |
820 | ||
821 | /* Many drivers statically allocate the maximum number of ports | |
822 | There is no reason not to allocate them dynamically. Is there? -- REW */ | |
823 | /* However, the RIO driver allows users to configure their first | |
824 | RTA as the ports numbered 504-511. We therefore need to allocate | |
825 | the whole range. :-( -- REW */ | |
826 | ||
1da177e4 LT |
827 | #define RI_SZ sizeof(struct rio_info) |
828 | #define HOST_SZ sizeof(struct Host) | |
829 | #define PORT_SZ sizeof(struct Port *) | |
830 | #define TMIO_SZ sizeof(struct termios *) | |
00d83a54 | 831 | rio_dprintk(RIO_DEBUG_INIT, "getting : %Zd %Zd %Zd %Zd %Zd bytes\n", RI_SZ, RIO_HOSTS * HOST_SZ, RIO_PORTS * PORT_SZ, RIO_PORTS * TMIO_SZ, RIO_PORTS * TMIO_SZ); |
8d8706e2 AM |
832 | |
833 | if (!(p = ckmalloc(RI_SZ))) | |
834 | goto free0; | |
835 | if (!(p->RIOHosts = ckmalloc(RIO_HOSTS * HOST_SZ))) | |
836 | goto free1; | |
837 | if (!(p->RIOPortp = ckmalloc(RIO_PORTS * PORT_SZ))) | |
838 | goto free2; | |
839 | p->RIOConf = RIOConf; | |
840 | rio_dprintk(RIO_DEBUG_INIT, "Got : %p %p %p\n", p, p->RIOHosts, p->RIOPortp); | |
1da177e4 LT |
841 | |
842 | #if 1 | |
8d8706e2 AM |
843 | for (i = 0; i < RIO_PORTS; i++) { |
844 | port = p->RIOPortp[i] = ckmalloc(sizeof(struct Port)); | |
845 | if (!port) { | |
846 | goto free6; | |
847 | } | |
848 | rio_dprintk(RIO_DEBUG_INIT, "initing port %d (%d)\n", i, port->Mapped); | |
849 | port->PortNum = i; | |
850 | port->gs.magic = RIO_MAGIC; | |
851 | port->gs.close_delay = HZ / 2; | |
852 | port->gs.closing_wait = 30 * HZ; | |
853 | port->gs.rd = &rio_real_driver; | |
854 | spin_lock_init(&port->portSem); | |
855 | /* | |
856 | * Initializing wait queue | |
857 | */ | |
858 | init_waitqueue_head(&port->gs.open_wait); | |
859 | init_waitqueue_head(&port->gs.close_wait); | |
860 | } | |
1da177e4 | 861 | #else |
8d8706e2 | 862 | /* We could postpone initializing them to when they are configured. */ |
1da177e4 LT |
863 | #endif |
864 | ||
865 | ||
1da177e4 | 866 | |
8d8706e2 AM |
867 | if (rio_debug & RIO_DEBUG_INIT) { |
868 | my_hd(&rio_real_driver, sizeof(rio_real_driver)); | |
869 | } | |
870 | ||
1da177e4 | 871 | |
8d8706e2 AM |
872 | func_exit(); |
873 | return 0; | |
874 | ||
875 | free6:for (i--; i >= 0; i--) | |
876 | kfree(p->RIOPortp[i]); | |
1da177e4 LT |
877 | /*free5: |
878 | free4: | |
8d8706e2 AM |
879 | free3:*/ kfree(p->RIOPortp); |
880 | free2:kfree(p->RIOHosts); | |
881 | free1: | |
882 | rio_dprintk(RIO_DEBUG_INIT, "Not enough memory! %p %p %p\n", p, p->RIOHosts, p->RIOPortp); | |
883 | kfree(p); | |
884 | free0: | |
885 | return -ENOMEM; | |
1da177e4 LT |
886 | } |
887 | ||
8d8706e2 | 888 | static void __exit rio_release_drivers(void) |
1da177e4 | 889 | { |
8d8706e2 AM |
890 | func_enter(); |
891 | tty_unregister_driver(rio_driver2); | |
892 | tty_unregister_driver(rio_driver); | |
893 | put_tty_driver(rio_driver2); | |
894 | put_tty_driver(rio_driver); | |
895 | func_exit(); | |
1da177e4 LT |
896 | } |
897 | ||
898 | ||
899 | #ifdef CONFIG_PCI | |
900 | /* This was written for SX, but applies to RIO too... | |
901 | (including bugs....) | |
902 | ||
903 | There is another bit besides Bit 17. Turning that bit off | |
904 | (on boards shipped with the fix in the eeprom) results in a | |
905 | hang on the next access to the card. | |
8d8706e2 | 906 | */ |
1da177e4 LT |
907 | |
908 | /******************************************************** | |
909 | * Setting bit 17 in the CNTRL register of the PLX 9050 * | |
910 | * chip forces a retry on writes while a read is pending.* | |
911 | * This is to prevent the card locking up on Intel Xeon * | |
912 | * multiprocessor systems with the NX chipset. -- NV * | |
913 | ********************************************************/ | |
914 | ||
915 | /* Newer cards are produced with this bit set from the configuration | |
916 | EEprom. As the bit is read/write for the CPU, we can fix it here, | |
917 | if we detect that it isn't set correctly. -- REW */ | |
918 | ||
8d8706e2 | 919 | static void fix_rio_pci(struct pci_dev *pdev) |
1da177e4 | 920 | { |
00d83a54 | 921 | unsigned long hwbase; |
d886cb58 | 922 | unsigned char __iomem *rebase; |
8d8706e2 | 923 | unsigned int t; |
1da177e4 LT |
924 | |
925 | #define CNTRL_REG_OFFSET 0x50 | |
926 | #define CNTRL_REG_GOODVALUE 0x18260000 | |
927 | ||
00d83a54 AC |
928 | hwbase = pci_resource_start(pdev, 0); |
929 | rebase = ioremap(hwbase, 0x80); | |
8d8706e2 AM |
930 | t = readl(rebase + CNTRL_REG_OFFSET); |
931 | if (t != CNTRL_REG_GOODVALUE) { | |
932 | printk(KERN_DEBUG "rio: performing cntrl reg fix: %08x -> %08x\n", t, CNTRL_REG_GOODVALUE); | |
933 | writel(CNTRL_REG_GOODVALUE, rebase + CNTRL_REG_OFFSET); | |
934 | } | |
00d83a54 | 935 | iounmap(rebase); |
1da177e4 LT |
936 | } |
937 | #endif | |
938 | ||
939 | ||
8d8706e2 | 940 | static int __init rio_init(void) |
1da177e4 | 941 | { |
8d8706e2 AM |
942 | int found = 0; |
943 | int i; | |
944 | struct Host *hp; | |
945 | int retval; | |
946 | struct vpd_prom *vpdp; | |
947 | int okboard; | |
1da177e4 LT |
948 | |
949 | #ifdef CONFIG_PCI | |
8d8706e2 | 950 | struct pci_dev *pdev = NULL; |
8d8706e2 | 951 | unsigned short tshort; |
1da177e4 LT |
952 | #endif |
953 | ||
8d8706e2 AM |
954 | func_enter(); |
955 | rio_dprintk(RIO_DEBUG_INIT, "Initing rio module... (rio_debug=%d)\n", rio_debug); | |
956 | ||
957 | if (abs((long) (&rio_debug) - rio_debug) < 0x10000) { | |
958 | printk(KERN_WARNING "rio: rio_debug is an address, instead of a value. " "Assuming -1. Was %x/%p.\n", rio_debug, &rio_debug); | |
959 | rio_debug = -1; | |
960 | } | |
961 | ||
962 | if (misc_register(&rio_fw_device) < 0) { | |
963 | printk(KERN_ERR "RIO: Unable to register firmware loader driver.\n"); | |
964 | return -EIO; | |
965 | } | |
966 | ||
967 | retval = rio_init_datastructures(); | |
968 | if (retval < 0) { | |
969 | misc_deregister(&rio_fw_device); | |
970 | return retval; | |
971 | } | |
1da177e4 | 972 | #ifdef CONFIG_PCI |
8d8706e2 AM |
973 | /* First look for the JET devices: */ |
974 | while ((pdev = pci_get_device(PCI_VENDOR_ID_SPECIALIX, PCI_DEVICE_ID_SPECIALIX_SX_XIO_IO8, pdev))) { | |
554b7c80 AC |
975 | u32 tint; |
976 | ||
8d8706e2 AM |
977 | if (pci_enable_device(pdev)) |
978 | continue; | |
979 | ||
980 | /* Specialix has a whole bunch of cards with | |
981 | 0x2000 as the device ID. They say its because | |
982 | the standard requires it. Stupid standard. */ | |
983 | /* It seems that reading a word doesn't work reliably on 2.0. | |
984 | Also, reading a non-aligned dword doesn't work. So we read the | |
985 | whole dword at 0x2c and extract the word at 0x2e (SUBSYSTEM_ID) | |
986 | ourselves */ | |
8d8706e2 AM |
987 | pci_read_config_dword(pdev, 0x2c, &tint); |
988 | tshort = (tint >> 16) & 0xffff; | |
989 | rio_dprintk(RIO_DEBUG_PROBE, "Got a specialix card: %x.\n", tint); | |
990 | if (tshort != 0x0100) { | |
991 | rio_dprintk(RIO_DEBUG_PROBE, "But it's not a RIO card (%d)...\n", tshort); | |
992 | continue; | |
993 | } | |
994 | rio_dprintk(RIO_DEBUG_PROBE, "cp1\n"); | |
995 | ||
8d8706e2 | 996 | hp = &p->RIOHosts[p->RIONumHosts]; |
554b7c80 | 997 | hp->PaddrP = pci_resource_start(pdev, 2); |
8d8706e2 AM |
998 | hp->Ivec = pdev->irq; |
999 | if (((1 << hp->Ivec) & rio_irqmask) == 0) | |
1000 | hp->Ivec = 0; | |
1001 | hp->Caddr = ioremap(p->RIOHosts[p->RIONumHosts].PaddrP, RIO_WINDOW_LEN); | |
d886cb58 | 1002 | hp->CardP = (struct DpRam __iomem *) hp->Caddr; |
8d8706e2 | 1003 | hp->Type = RIO_PCI; |
00d83a54 | 1004 | hp->Copy = rio_copy_to_card; |
8d8706e2 AM |
1005 | hp->Mode = RIO_PCI_BOOT_FROM_RAM; |
1006 | spin_lock_init(&hp->HostLock); | |
1007 | rio_reset_interrupt(hp); | |
1008 | rio_start_card_running(hp); | |
1009 | ||
1010 | rio_dprintk(RIO_DEBUG_PROBE, "Going to test it (%p/%p).\n", (void *) p->RIOHosts[p->RIONumHosts].PaddrP, p->RIOHosts[p->RIONumHosts].Caddr); | |
554b7c80 | 1011 | if (RIOBoardTest(p->RIOHosts[p->RIONumHosts].PaddrP, p->RIOHosts[p->RIONumHosts].Caddr, RIO_PCI, 0) == 0) { |
8d8706e2 | 1012 | rio_dprintk(RIO_DEBUG_INIT, "Done RIOBoardTest\n"); |
00d83a54 | 1013 | writeb(0xFF, &p->RIOHosts[p->RIONumHosts].ResetInt); |
8d8706e2 | 1014 | p->RIOHosts[p->RIONumHosts].UniqueNum = |
00d83a54 AC |
1015 | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[0]) & 0xFF) << 0) | |
1016 | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[1]) & 0xFF) << 8) | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[2]) & 0xFF) << 16) | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[3]) & 0xFF) << 24); | |
8d8706e2 AM |
1017 | rio_dprintk(RIO_DEBUG_PROBE, "Hmm Tested ok, uniqid = %x.\n", p->RIOHosts[p->RIONumHosts].UniqueNum); |
1018 | ||
1019 | fix_rio_pci(pdev); | |
554b7c80 | 1020 | p->RIOLastPCISearch = 0; |
8d8706e2 AM |
1021 | p->RIONumHosts++; |
1022 | found++; | |
1023 | } else { | |
d886cb58 | 1024 | iounmap(p->RIOHosts[p->RIONumHosts].Caddr); |
8d8706e2 AM |
1025 | } |
1026 | } | |
1027 | ||
1028 | /* Then look for the older PCI card.... : */ | |
1029 | ||
1030 | /* These older PCI cards have problems (only byte-mode access is | |
1031 | supported), which makes them a bit awkward to support. | |
1032 | They also have problems sharing interrupts. Be careful. | |
1033 | (The driver now refuses to share interrupts for these | |
1034 | cards. This should be sufficient). | |
1035 | */ | |
1036 | ||
1037 | /* Then look for the older RIO/PCI devices: */ | |
1038 | while ((pdev = pci_get_device(PCI_VENDOR_ID_SPECIALIX, PCI_DEVICE_ID_SPECIALIX_RIO, pdev))) { | |
1039 | if (pci_enable_device(pdev)) | |
1040 | continue; | |
1da177e4 LT |
1041 | |
1042 | #ifdef CONFIG_RIO_OLDPCI | |
8d8706e2 | 1043 | hp = &p->RIOHosts[p->RIONumHosts]; |
554b7c80 | 1044 | hp->PaddrP = pci_resource_start(pdev, 0); |
8d8706e2 AM |
1045 | hp->Ivec = pdev->irq; |
1046 | if (((1 << hp->Ivec) & rio_irqmask) == 0) | |
1047 | hp->Ivec = 0; | |
1048 | hp->Ivec |= 0x8000; /* Mark as non-sharable */ | |
1049 | hp->Caddr = ioremap(p->RIOHosts[p->RIONumHosts].PaddrP, RIO_WINDOW_LEN); | |
d886cb58 | 1050 | hp->CardP = (struct DpRam __iomem *) hp->Caddr; |
8d8706e2 | 1051 | hp->Type = RIO_PCI; |
00d83a54 | 1052 | hp->Copy = rio_copy_to_card; |
8d8706e2 AM |
1053 | hp->Mode = RIO_PCI_BOOT_FROM_RAM; |
1054 | spin_lock_init(&hp->HostLock); | |
1055 | ||
1056 | rio_dprintk(RIO_DEBUG_PROBE, "Ivec: %x\n", hp->Ivec); | |
1057 | rio_dprintk(RIO_DEBUG_PROBE, "Mode: %x\n", hp->Mode); | |
1058 | ||
1059 | rio_reset_interrupt(hp); | |
1060 | rio_start_card_running(hp); | |
1061 | rio_dprintk(RIO_DEBUG_PROBE, "Going to test it (%p/%p).\n", (void *) p->RIOHosts[p->RIONumHosts].PaddrP, p->RIOHosts[p->RIONumHosts].Caddr); | |
554b7c80 | 1062 | if (RIOBoardTest(p->RIOHosts[p->RIONumHosts].PaddrP, p->RIOHosts[p->RIONumHosts].Caddr, RIO_PCI, 0) == 0) { |
00d83a54 | 1063 | writeb(0xFF, &p->RIOHosts[p->RIONumHosts].ResetInt); |
8d8706e2 | 1064 | p->RIOHosts[p->RIONumHosts].UniqueNum = |
00d83a54 AC |
1065 | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[0]) & 0xFF) << 0) | |
1066 | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[1]) & 0xFF) << 8) | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[2]) & 0xFF) << 16) | ((readb(&p->RIOHosts[p->RIONumHosts].Unique[3]) & 0xFF) << 24); | |
8d8706e2 AM |
1067 | rio_dprintk(RIO_DEBUG_PROBE, "Hmm Tested ok, uniqid = %x.\n", p->RIOHosts[p->RIONumHosts].UniqueNum); |
1068 | ||
554b7c80 | 1069 | p->RIOLastPCISearch = 0; |
8d8706e2 AM |
1070 | p->RIONumHosts++; |
1071 | found++; | |
1072 | } else { | |
d886cb58 | 1073 | iounmap(p->RIOHosts[p->RIONumHosts].Caddr); |
8d8706e2 | 1074 | } |
1da177e4 | 1075 | #else |
8d8706e2 | 1076 | printk(KERN_ERR "Found an older RIO PCI card, but the driver is not " "compiled to support it.\n"); |
1da177e4 | 1077 | #endif |
8d8706e2 AM |
1078 | } |
1079 | #endif /* PCI */ | |
1080 | ||
1081 | /* Now probe for ISA cards... */ | |
1082 | for (i = 0; i < NR_RIO_ADDRS; i++) { | |
1083 | hp = &p->RIOHosts[p->RIONumHosts]; | |
1084 | hp->PaddrP = rio_probe_addrs[i]; | |
1085 | /* There was something about the IRQs of these cards. 'Forget what.--REW */ | |
1086 | hp->Ivec = 0; | |
1087 | hp->Caddr = ioremap(p->RIOHosts[p->RIONumHosts].PaddrP, RIO_WINDOW_LEN); | |
d886cb58 | 1088 | hp->CardP = (struct DpRam __iomem *) hp->Caddr; |
8d8706e2 | 1089 | hp->Type = RIO_AT; |
00d83a54 AC |
1090 | hp->Copy = rio_copy_to_card; /* AT card PCI???? - PVDL |
1091 | * -- YES! this is now a normal copy. Only the | |
8d8706e2 AM |
1092 | * old PCI card uses the special PCI copy. |
1093 | * Moreover, the ISA card will work with the | |
1094 | * special PCI copy anyway. -- REW */ | |
1095 | hp->Mode = 0; | |
1096 | spin_lock_init(&hp->HostLock); | |
1097 | ||
1098 | vpdp = get_VPD_PROM(hp); | |
1099 | rio_dprintk(RIO_DEBUG_PROBE, "Got VPD ROM\n"); | |
1100 | okboard = 0; | |
1101 | if ((strncmp(vpdp->identifier, RIO_ISA_IDENT, 16) == 0) || (strncmp(vpdp->identifier, RIO_ISA2_IDENT, 16) == 0) || (strncmp(vpdp->identifier, RIO_ISA3_IDENT, 16) == 0)) { | |
1102 | /* Board is present... */ | |
554b7c80 | 1103 | if (RIOBoardTest(hp->PaddrP, hp->Caddr, RIO_AT, 0) == 0) { |
8d8706e2 AM |
1104 | /* ... and feeling fine!!!! */ |
1105 | rio_dprintk(RIO_DEBUG_PROBE, "Hmm Tested ok, uniqid = %x.\n", p->RIOHosts[p->RIONumHosts].UniqueNum); | |
1106 | if (RIOAssignAT(p, hp->PaddrP, hp->Caddr, 0)) { | |
1107 | rio_dprintk(RIO_DEBUG_PROBE, "Hmm Tested ok, host%d uniqid = %x.\n", p->RIONumHosts, p->RIOHosts[p->RIONumHosts - 1].UniqueNum); | |
1108 | okboard++; | |
1109 | found++; | |
1110 | } | |
1111 | } | |
1112 | ||
1113 | if (!okboard) | |
d886cb58 | 1114 | iounmap(hp->Caddr); |
8d8706e2 AM |
1115 | } |
1116 | } | |
1117 | ||
1118 | ||
1119 | for (i = 0; i < p->RIONumHosts; i++) { | |
1120 | hp = &p->RIOHosts[i]; | |
1121 | if (hp->Ivec) { | |
5d8c8a2e | 1122 | int mode = IRQF_SHARED; |
8d8706e2 AM |
1123 | if (hp->Ivec & 0x8000) { |
1124 | mode = 0; | |
1125 | hp->Ivec &= 0x7fff; | |
1126 | } | |
1127 | rio_dprintk(RIO_DEBUG_INIT, "Requesting interrupt hp: %p rio_interrupt: %d Mode: %x\n", hp, hp->Ivec, hp->Mode); | |
1128 | retval = request_irq(hp->Ivec, rio_interrupt, mode, "rio", hp); | |
1129 | rio_dprintk(RIO_DEBUG_INIT, "Return value from request_irq: %d\n", retval); | |
1130 | if (retval) { | |
1131 | printk(KERN_ERR "rio: Cannot allocate irq %d.\n", hp->Ivec); | |
1132 | hp->Ivec = 0; | |
1133 | } | |
1134 | rio_dprintk(RIO_DEBUG_INIT, "Got irq %d.\n", hp->Ivec); | |
1135 | if (hp->Ivec != 0) { | |
1136 | rio_dprintk(RIO_DEBUG_INIT, "Enabling interrupts on rio card.\n"); | |
1137 | hp->Mode |= RIO_PCI_INT_ENABLE; | |
1138 | } else | |
1139 | hp->Mode &= !RIO_PCI_INT_ENABLE; | |
1140 | rio_dprintk(RIO_DEBUG_INIT, "New Mode: %x\n", hp->Mode); | |
1141 | rio_start_card_running(hp); | |
1142 | } | |
1143 | /* Init the timer "always" to make sure that it can safely be | |
1144 | deleted when we unload... */ | |
1145 | ||
1146 | init_timer(&hp->timer); | |
1147 | if (!hp->Ivec) { | |
1148 | rio_dprintk(RIO_DEBUG_INIT, "Starting polling at %dj intervals.\n", rio_poll); | |
1149 | hp->timer.data = i; | |
1150 | hp->timer.function = rio_pollfunc; | |
1151 | hp->timer.expires = jiffies + rio_poll; | |
1152 | add_timer(&hp->timer); | |
1153 | } | |
1154 | } | |
1155 | ||
1156 | if (found) { | |
1157 | rio_dprintk(RIO_DEBUG_INIT, "rio: total of %d boards detected.\n", found); | |
1158 | rio_init_drivers(); | |
1159 | } else { | |
1160 | /* deregister the misc device we created earlier */ | |
1161 | misc_deregister(&rio_fw_device); | |
1162 | } | |
1163 | ||
1164 | func_exit(); | |
1165 | return found ? 0 : -EIO; | |
1da177e4 LT |
1166 | } |
1167 | ||
1168 | ||
8d8706e2 | 1169 | static void __exit rio_exit(void) |
1da177e4 | 1170 | { |
8d8706e2 AM |
1171 | int i; |
1172 | struct Host *hp; | |
1173 | ||
1174 | func_enter(); | |
1da177e4 | 1175 | |
8d8706e2 AM |
1176 | for (i = 0, hp = p->RIOHosts; i < p->RIONumHosts; i++, hp++) { |
1177 | RIOHostReset(hp->Type, hp->CardP, hp->Slot); | |
1178 | if (hp->Ivec) { | |
1179 | free_irq(hp->Ivec, hp); | |
1180 | rio_dprintk(RIO_DEBUG_INIT, "freed irq %d.\n", hp->Ivec); | |
1181 | } | |
1182 | /* It is safe/allowed to del_timer a non-active timer */ | |
1183 | del_timer(&hp->timer); | |
1184 | } | |
1da177e4 | 1185 | |
8d8706e2 AM |
1186 | if (misc_deregister(&rio_fw_device) < 0) { |
1187 | printk(KERN_INFO "rio: couldn't deregister control-device\n"); | |
1188 | } | |
1da177e4 LT |
1189 | |
1190 | ||
8d8706e2 | 1191 | rio_dprintk(RIO_DEBUG_CLEANUP, "Cleaning up drivers\n"); |
1da177e4 | 1192 | |
8d8706e2 | 1193 | rio_release_drivers(); |
1da177e4 | 1194 | |
8d8706e2 AM |
1195 | /* Release dynamically allocated memory */ |
1196 | kfree(p->RIOPortp); | |
1197 | kfree(p->RIOHosts); | |
1198 | kfree(p); | |
1da177e4 | 1199 | |
8d8706e2 | 1200 | func_exit(); |
1da177e4 LT |
1201 | } |
1202 | ||
1203 | module_init(rio_init); | |
1204 | module_exit(rio_exit); |