diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/net/wan/n2.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/net/wan/n2.c')
-rw-r--r-- | drivers/net/wan/n2.c | 562 |
1 files changed, 562 insertions, 0 deletions
diff --git a/drivers/net/wan/n2.c b/drivers/net/wan/n2.c new file mode 100644 index 000000000000..cd32751b64eb --- /dev/null +++ b/drivers/net/wan/n2.c | |||
@@ -0,0 +1,562 @@ | |||
1 | /* | ||
2 | * SDL Inc. RISCom/N2 synchronous serial card driver for Linux | ||
3 | * | ||
4 | * Copyright (C) 1998-2003 Krzysztof Halasa <khc@pm.waw.pl> | ||
5 | * | ||
6 | * This program is free software; you can redistribute it and/or modify it | ||
7 | * under the terms of version 2 of the GNU General Public License | ||
8 | * as published by the Free Software Foundation. | ||
9 | * | ||
10 | * For information see http://hq.pm.waw.pl/hdlc/ | ||
11 | * | ||
12 | * Note: integrated CSU/DSU/DDS are not supported by this driver | ||
13 | * | ||
14 | * Sources of information: | ||
15 | * Hitachi HD64570 SCA User's Manual | ||
16 | * SDL Inc. PPP/HDLC/CISCO driver | ||
17 | */ | ||
18 | |||
19 | #include <linux/module.h> | ||
20 | #include <linux/kernel.h> | ||
21 | #include <linux/slab.h> | ||
22 | #include <linux/types.h> | ||
23 | #include <linux/fcntl.h> | ||
24 | #include <linux/in.h> | ||
25 | #include <linux/string.h> | ||
26 | #include <linux/errno.h> | ||
27 | #include <linux/init.h> | ||
28 | #include <linux/ioport.h> | ||
29 | #include <linux/moduleparam.h> | ||
30 | #include <linux/netdevice.h> | ||
31 | #include <linux/hdlc.h> | ||
32 | #include <asm/io.h> | ||
33 | #include "hd64570.h" | ||
34 | |||
35 | |||
36 | static const char* version = "SDL RISCom/N2 driver version: 1.15"; | ||
37 | static const char* devname = "RISCom/N2"; | ||
38 | |||
39 | #undef DEBUG_PKT | ||
40 | #define DEBUG_RINGS | ||
41 | |||
42 | #define USE_WINDOWSIZE 16384 | ||
43 | #define USE_BUS16BITS 1 | ||
44 | #define CLOCK_BASE 9830400 /* 9.8304 MHz */ | ||
45 | #define MAX_PAGES 16 /* 16 RAM pages at max */ | ||
46 | #define MAX_RAM_SIZE 0x80000 /* 512 KB */ | ||
47 | #if MAX_RAM_SIZE > MAX_PAGES * USE_WINDOWSIZE | ||
48 | #undef MAX_RAM_SIZE | ||
49 | #define MAX_RAM_SIZE (MAX_PAGES * USE_WINDOWSIZE) | ||
50 | #endif | ||
51 | #define N2_IOPORTS 0x10 | ||
52 | #define NEED_DETECT_RAM | ||
53 | #define NEED_SCA_MSCI_INTR | ||
54 | #define MAX_TX_BUFFERS 10 | ||
55 | |||
56 | static char *hw = NULL; /* pointer to hw=xxx command line string */ | ||
57 | |||
58 | /* RISCom/N2 Board Registers */ | ||
59 | |||
60 | /* PC Control Register */ | ||
61 | #define N2_PCR 0 | ||
62 | #define PCR_RUNSCA 1 /* Run 64570 */ | ||
63 | #define PCR_VPM 2 /* Enable VPM - needed if using RAM above 1 MB */ | ||
64 | #define PCR_ENWIN 4 /* Open window */ | ||
65 | #define PCR_BUS16 8 /* 16-bit bus */ | ||
66 | |||
67 | |||
68 | /* Memory Base Address Register */ | ||
69 | #define N2_BAR 2 | ||
70 | |||
71 | |||
72 | /* Page Scan Register */ | ||
73 | #define N2_PSR 4 | ||
74 | #define WIN16K 0x00 | ||
75 | #define WIN32K 0x20 | ||
76 | #define WIN64K 0x40 | ||
77 | #define PSR_WINBITS 0x60 | ||
78 | #define PSR_DMAEN 0x80 | ||
79 | #define PSR_PAGEBITS 0x0F | ||
80 | |||
81 | |||
82 | /* Modem Control Reg */ | ||
83 | #define N2_MCR 6 | ||
84 | #define CLOCK_OUT_PORT1 0x80 | ||
85 | #define CLOCK_OUT_PORT0 0x40 | ||
86 | #define TX422_PORT1 0x20 | ||
87 | #define TX422_PORT0 0x10 | ||
88 | #define DSR_PORT1 0x08 | ||
89 | #define DSR_PORT0 0x04 | ||
90 | #define DTR_PORT1 0x02 | ||
91 | #define DTR_PORT0 0x01 | ||
92 | |||
93 | |||
94 | typedef struct port_s { | ||
95 | struct net_device *dev; | ||
96 | struct card_s *card; | ||
97 | spinlock_t lock; /* TX lock */ | ||
98 | sync_serial_settings settings; | ||
99 | int valid; /* port enabled */ | ||
100 | int rxpart; /* partial frame received, next frame invalid*/ | ||
101 | unsigned short encoding; | ||
102 | unsigned short parity; | ||
103 | u16 rxin; /* rx ring buffer 'in' pointer */ | ||
104 | u16 txin; /* tx ring buffer 'in' and 'last' pointers */ | ||
105 | u16 txlast; | ||
106 | u8 rxs, txs, tmc; /* SCA registers */ | ||
107 | u8 phy_node; /* physical port # - 0 or 1 */ | ||
108 | u8 log_node; /* logical port # */ | ||
109 | }port_t; | ||
110 | |||
111 | |||
112 | |||
113 | typedef struct card_s { | ||
114 | u8 __iomem *winbase; /* ISA window base address */ | ||
115 | u32 phy_winbase; /* ISA physical base address */ | ||
116 | u32 ram_size; /* number of bytes */ | ||
117 | u16 io; /* IO Base address */ | ||
118 | u16 buff_offset; /* offset of first buffer of first channel */ | ||
119 | u16 rx_ring_buffers; /* number of buffers in a ring */ | ||
120 | u16 tx_ring_buffers; | ||
121 | u8 irq; /* IRQ (3-15) */ | ||
122 | |||
123 | port_t ports[2]; | ||
124 | struct card_s *next_card; | ||
125 | }card_t; | ||
126 | |||
127 | |||
128 | static card_t *first_card; | ||
129 | static card_t **new_card = &first_card; | ||
130 | |||
131 | |||
132 | #define sca_reg(reg, card) (0x8000 | (card)->io | \ | ||
133 | ((reg) & 0x0F) | (((reg) & 0xF0) << 6)) | ||
134 | #define sca_in(reg, card) inb(sca_reg(reg, card)) | ||
135 | #define sca_out(value, reg, card) outb(value, sca_reg(reg, card)) | ||
136 | #define sca_inw(reg, card) inw(sca_reg(reg, card)) | ||
137 | #define sca_outw(value, reg, card) outw(value, sca_reg(reg, card)) | ||
138 | |||
139 | #define port_to_card(port) ((port)->card) | ||
140 | #define log_node(port) ((port)->log_node) | ||
141 | #define phy_node(port) ((port)->phy_node) | ||
142 | #define winsize(card) (USE_WINDOWSIZE) | ||
143 | #define winbase(card) ((card)->winbase) | ||
144 | #define get_port(card, port) ((card)->ports[port].valid ? \ | ||
145 | &(card)->ports[port] : NULL) | ||
146 | |||
147 | |||
148 | |||
149 | static __inline__ u8 sca_get_page(card_t *card) | ||
150 | { | ||
151 | return inb(card->io + N2_PSR) & PSR_PAGEBITS; | ||
152 | } | ||
153 | |||
154 | |||
155 | static __inline__ void openwin(card_t *card, u8 page) | ||
156 | { | ||
157 | u8 psr = inb(card->io + N2_PSR); | ||
158 | outb((psr & ~PSR_PAGEBITS) | page, card->io + N2_PSR); | ||
159 | } | ||
160 | |||
161 | |||
162 | |||
163 | #include "hd6457x.c" | ||
164 | |||
165 | |||
166 | |||
167 | static void n2_set_iface(port_t *port) | ||
168 | { | ||
169 | card_t *card = port->card; | ||
170 | int io = card->io; | ||
171 | u8 mcr = inb(io + N2_MCR); | ||
172 | u8 msci = get_msci(port); | ||
173 | u8 rxs = port->rxs & CLK_BRG_MASK; | ||
174 | u8 txs = port->txs & CLK_BRG_MASK; | ||
175 | |||
176 | switch(port->settings.clock_type) { | ||
177 | case CLOCK_INT: | ||
178 | mcr |= port->phy_node ? CLOCK_OUT_PORT1 : CLOCK_OUT_PORT0; | ||
179 | rxs |= CLK_BRG_RX; /* BRG output */ | ||
180 | txs |= CLK_RXCLK_TX; /* RX clock */ | ||
181 | break; | ||
182 | |||
183 | case CLOCK_TXINT: | ||
184 | mcr |= port->phy_node ? CLOCK_OUT_PORT1 : CLOCK_OUT_PORT0; | ||
185 | rxs |= CLK_LINE_RX; /* RXC input */ | ||
186 | txs |= CLK_BRG_TX; /* BRG output */ | ||
187 | break; | ||
188 | |||
189 | case CLOCK_TXFROMRX: | ||
190 | mcr |= port->phy_node ? CLOCK_OUT_PORT1 : CLOCK_OUT_PORT0; | ||
191 | rxs |= CLK_LINE_RX; /* RXC input */ | ||
192 | txs |= CLK_RXCLK_TX; /* RX clock */ | ||
193 | break; | ||
194 | |||
195 | default: /* Clock EXTernal */ | ||
196 | mcr &= port->phy_node ? ~CLOCK_OUT_PORT1 : ~CLOCK_OUT_PORT0; | ||
197 | rxs |= CLK_LINE_RX; /* RXC input */ | ||
198 | txs |= CLK_LINE_TX; /* TXC input */ | ||
199 | } | ||
200 | |||
201 | outb(mcr, io + N2_MCR); | ||
202 | port->rxs = rxs; | ||
203 | port->txs = txs; | ||
204 | sca_out(rxs, msci + RXS, card); | ||
205 | sca_out(txs, msci + TXS, card); | ||
206 | sca_set_port(port); | ||
207 | } | ||
208 | |||
209 | |||
210 | |||
211 | static int n2_open(struct net_device *dev) | ||
212 | { | ||
213 | port_t *port = dev_to_port(dev); | ||
214 | int io = port->card->io; | ||
215 | u8 mcr = inb(io + N2_MCR) | (port->phy_node ? TX422_PORT1:TX422_PORT0); | ||
216 | int result; | ||
217 | |||
218 | result = hdlc_open(dev); | ||
219 | if (result) | ||
220 | return result; | ||
221 | |||
222 | mcr &= port->phy_node ? ~DTR_PORT1 : ~DTR_PORT0; /* set DTR ON */ | ||
223 | outb(mcr, io + N2_MCR); | ||
224 | |||
225 | outb(inb(io + N2_PCR) | PCR_ENWIN, io + N2_PCR); /* open window */ | ||
226 | outb(inb(io + N2_PSR) | PSR_DMAEN, io + N2_PSR); /* enable dma */ | ||
227 | sca_open(dev); | ||
228 | n2_set_iface(port); | ||
229 | return 0; | ||
230 | } | ||
231 | |||
232 | |||
233 | |||
234 | static int n2_close(struct net_device *dev) | ||
235 | { | ||
236 | port_t *port = dev_to_port(dev); | ||
237 | int io = port->card->io; | ||
238 | u8 mcr = inb(io+N2_MCR) | (port->phy_node ? TX422_PORT1 : TX422_PORT0); | ||
239 | |||
240 | sca_close(dev); | ||
241 | mcr |= port->phy_node ? DTR_PORT1 : DTR_PORT0; /* set DTR OFF */ | ||
242 | outb(mcr, io + N2_MCR); | ||
243 | hdlc_close(dev); | ||
244 | return 0; | ||
245 | } | ||
246 | |||
247 | |||
248 | |||
249 | static int n2_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) | ||
250 | { | ||
251 | const size_t size = sizeof(sync_serial_settings); | ||
252 | sync_serial_settings new_line; | ||
253 | sync_serial_settings __user *line = ifr->ifr_settings.ifs_ifsu.sync; | ||
254 | port_t *port = dev_to_port(dev); | ||
255 | |||
256 | #ifdef DEBUG_RINGS | ||
257 | if (cmd == SIOCDEVPRIVATE) { | ||
258 | sca_dump_rings(dev); | ||
259 | return 0; | ||
260 | } | ||
261 | #endif | ||
262 | if (cmd != SIOCWANDEV) | ||
263 | return hdlc_ioctl(dev, ifr, cmd); | ||
264 | |||
265 | switch(ifr->ifr_settings.type) { | ||
266 | case IF_GET_IFACE: | ||
267 | ifr->ifr_settings.type = IF_IFACE_SYNC_SERIAL; | ||
268 | if (ifr->ifr_settings.size < size) { | ||
269 | ifr->ifr_settings.size = size; /* data size wanted */ | ||
270 | return -ENOBUFS; | ||
271 | } | ||
272 | if (copy_to_user(line, &port->settings, size)) | ||
273 | return -EFAULT; | ||
274 | return 0; | ||
275 | |||
276 | case IF_IFACE_SYNC_SERIAL: | ||
277 | if(!capable(CAP_NET_ADMIN)) | ||
278 | return -EPERM; | ||
279 | |||
280 | if (copy_from_user(&new_line, line, size)) | ||
281 | return -EFAULT; | ||
282 | |||
283 | if (new_line.clock_type != CLOCK_EXT && | ||
284 | new_line.clock_type != CLOCK_TXFROMRX && | ||
285 | new_line.clock_type != CLOCK_INT && | ||
286 | new_line.clock_type != CLOCK_TXINT) | ||
287 | return -EINVAL; /* No such clock setting */ | ||
288 | |||
289 | if (new_line.loopback != 0 && new_line.loopback != 1) | ||
290 | return -EINVAL; | ||
291 | |||
292 | memcpy(&port->settings, &new_line, size); /* Update settings */ | ||
293 | n2_set_iface(port); | ||
294 | return 0; | ||
295 | |||
296 | default: | ||
297 | return hdlc_ioctl(dev, ifr, cmd); | ||
298 | } | ||
299 | } | ||
300 | |||
301 | |||
302 | |||
303 | static void n2_destroy_card(card_t *card) | ||
304 | { | ||
305 | int cnt; | ||
306 | |||
307 | for (cnt = 0; cnt < 2; cnt++) | ||
308 | if (card->ports[cnt].card) { | ||
309 | struct net_device *dev = port_to_dev(&card->ports[cnt]); | ||
310 | unregister_hdlc_device(dev); | ||
311 | } | ||
312 | |||
313 | if (card->irq) | ||
314 | free_irq(card->irq, card); | ||
315 | |||
316 | if (card->winbase) { | ||
317 | iounmap(card->winbase); | ||
318 | release_mem_region(card->phy_winbase, USE_WINDOWSIZE); | ||
319 | } | ||
320 | |||
321 | if (card->io) | ||
322 | release_region(card->io, N2_IOPORTS); | ||
323 | if (card->ports[0].dev) | ||
324 | free_netdev(card->ports[0].dev); | ||
325 | if (card->ports[1].dev) | ||
326 | free_netdev(card->ports[1].dev); | ||
327 | kfree(card); | ||
328 | } | ||
329 | |||
330 | |||
331 | |||
332 | static int __init n2_run(unsigned long io, unsigned long irq, | ||
333 | unsigned long winbase, long valid0, long valid1) | ||
334 | { | ||
335 | card_t *card; | ||
336 | u8 cnt, pcr; | ||
337 | int i; | ||
338 | |||
339 | if (io < 0x200 || io > 0x3FF || (io % N2_IOPORTS) != 0) { | ||
340 | printk(KERN_ERR "n2: invalid I/O port value\n"); | ||
341 | return -ENODEV; | ||
342 | } | ||
343 | |||
344 | if (irq < 3 || irq > 15 || irq == 6) /* FIXME */ { | ||
345 | printk(KERN_ERR "n2: invalid IRQ value\n"); | ||
346 | return -ENODEV; | ||
347 | } | ||
348 | |||
349 | if (winbase < 0xA0000 || winbase > 0xFFFFF || (winbase & 0xFFF) != 0) { | ||
350 | printk(KERN_ERR "n2: invalid RAM value\n"); | ||
351 | return -ENODEV; | ||
352 | } | ||
353 | |||
354 | card = kmalloc(sizeof(card_t), GFP_KERNEL); | ||
355 | if (card == NULL) { | ||
356 | printk(KERN_ERR "n2: unable to allocate memory\n"); | ||
357 | return -ENOBUFS; | ||
358 | } | ||
359 | memset(card, 0, sizeof(card_t)); | ||
360 | |||
361 | card->ports[0].dev = alloc_hdlcdev(&card->ports[0]); | ||
362 | card->ports[1].dev = alloc_hdlcdev(&card->ports[1]); | ||
363 | if (!card->ports[0].dev || !card->ports[1].dev) { | ||
364 | printk(KERN_ERR "n2: unable to allocate memory\n"); | ||
365 | n2_destroy_card(card); | ||
366 | return -ENOMEM; | ||
367 | } | ||
368 | |||
369 | if (!request_region(io, N2_IOPORTS, devname)) { | ||
370 | printk(KERN_ERR "n2: I/O port region in use\n"); | ||
371 | n2_destroy_card(card); | ||
372 | return -EBUSY; | ||
373 | } | ||
374 | card->io = io; | ||
375 | |||
376 | if (request_irq(irq, &sca_intr, 0, devname, card)) { | ||
377 | printk(KERN_ERR "n2: could not allocate IRQ\n"); | ||
378 | n2_destroy_card(card); | ||
379 | return(-EBUSY); | ||
380 | } | ||
381 | card->irq = irq; | ||
382 | |||
383 | if (!request_mem_region(winbase, USE_WINDOWSIZE, devname)) { | ||
384 | printk(KERN_ERR "n2: could not request RAM window\n"); | ||
385 | n2_destroy_card(card); | ||
386 | return(-EBUSY); | ||
387 | } | ||
388 | card->phy_winbase = winbase; | ||
389 | card->winbase = ioremap(winbase, USE_WINDOWSIZE); | ||
390 | |||
391 | outb(0, io + N2_PCR); | ||
392 | outb(winbase >> 12, io + N2_BAR); | ||
393 | |||
394 | switch (USE_WINDOWSIZE) { | ||
395 | case 16384: | ||
396 | outb(WIN16K, io + N2_PSR); | ||
397 | break; | ||
398 | |||
399 | case 32768: | ||
400 | outb(WIN32K, io + N2_PSR); | ||
401 | break; | ||
402 | |||
403 | case 65536: | ||
404 | outb(WIN64K, io + N2_PSR); | ||
405 | break; | ||
406 | |||
407 | default: | ||
408 | printk(KERN_ERR "n2: invalid window size\n"); | ||
409 | n2_destroy_card(card); | ||
410 | return -ENODEV; | ||
411 | } | ||
412 | |||
413 | pcr = PCR_ENWIN | PCR_VPM | (USE_BUS16BITS ? PCR_BUS16 : 0); | ||
414 | outb(pcr, io + N2_PCR); | ||
415 | |||
416 | card->ram_size = sca_detect_ram(card, card->winbase, MAX_RAM_SIZE); | ||
417 | |||
418 | /* number of TX + RX buffers for one port */ | ||
419 | i = card->ram_size / ((valid0 + valid1) * (sizeof(pkt_desc) + | ||
420 | HDLC_MAX_MRU)); | ||
421 | |||
422 | card->tx_ring_buffers = min(i / 2, MAX_TX_BUFFERS); | ||
423 | card->rx_ring_buffers = i - card->tx_ring_buffers; | ||
424 | |||
425 | card->buff_offset = (valid0 + valid1) * sizeof(pkt_desc) * | ||
426 | (card->tx_ring_buffers + card->rx_ring_buffers); | ||
427 | |||
428 | printk(KERN_INFO "n2: RISCom/N2 %u KB RAM, IRQ%u, " | ||
429 | "using %u TX + %u RX packets rings\n", card->ram_size / 1024, | ||
430 | card->irq, card->tx_ring_buffers, card->rx_ring_buffers); | ||
431 | |||
432 | if (card->tx_ring_buffers < 1) { | ||
433 | printk(KERN_ERR "n2: RAM test failed\n"); | ||
434 | n2_destroy_card(card); | ||
435 | return -EIO; | ||
436 | } | ||
437 | |||
438 | pcr |= PCR_RUNSCA; /* run SCA */ | ||
439 | outb(pcr, io + N2_PCR); | ||
440 | outb(0, io + N2_MCR); | ||
441 | |||
442 | sca_init(card, 0); | ||
443 | for (cnt = 0; cnt < 2; cnt++) { | ||
444 | port_t *port = &card->ports[cnt]; | ||
445 | struct net_device *dev = port_to_dev(port); | ||
446 | hdlc_device *hdlc = dev_to_hdlc(dev); | ||
447 | |||
448 | if ((cnt == 0 && !valid0) || (cnt == 1 && !valid1)) | ||
449 | continue; | ||
450 | |||
451 | port->phy_node = cnt; | ||
452 | port->valid = 1; | ||
453 | |||
454 | if ((cnt == 1) && valid0) | ||
455 | port->log_node = 1; | ||
456 | |||
457 | spin_lock_init(&port->lock); | ||
458 | SET_MODULE_OWNER(dev); | ||
459 | dev->irq = irq; | ||
460 | dev->mem_start = winbase; | ||
461 | dev->mem_end = winbase + USE_WINDOWSIZE - 1; | ||
462 | dev->tx_queue_len = 50; | ||
463 | dev->do_ioctl = n2_ioctl; | ||
464 | dev->open = n2_open; | ||
465 | dev->stop = n2_close; | ||
466 | hdlc->attach = sca_attach; | ||
467 | hdlc->xmit = sca_xmit; | ||
468 | port->settings.clock_type = CLOCK_EXT; | ||
469 | port->card = card; | ||
470 | |||
471 | if (register_hdlc_device(dev)) { | ||
472 | printk(KERN_WARNING "n2: unable to register hdlc " | ||
473 | "device\n"); | ||
474 | port->card = NULL; | ||
475 | n2_destroy_card(card); | ||
476 | return -ENOBUFS; | ||
477 | } | ||
478 | sca_init_sync_port(port); /* Set up SCA memory */ | ||
479 | |||
480 | printk(KERN_INFO "%s: RISCom/N2 node %d\n", | ||
481 | dev->name, port->phy_node); | ||
482 | } | ||
483 | |||
484 | *new_card = card; | ||
485 | new_card = &card->next_card; | ||
486 | |||
487 | return 0; | ||
488 | } | ||
489 | |||
490 | |||
491 | |||
492 | static int __init n2_init(void) | ||
493 | { | ||
494 | if (hw==NULL) { | ||
495 | #ifdef MODULE | ||
496 | printk(KERN_INFO "n2: no card initialized\n"); | ||
497 | #endif | ||
498 | return -ENOSYS; /* no parameters specified, abort */ | ||
499 | } | ||
500 | |||
501 | printk(KERN_INFO "%s\n", version); | ||
502 | |||
503 | do { | ||
504 | unsigned long io, irq, ram; | ||
505 | long valid[2] = { 0, 0 }; /* Default = both ports disabled */ | ||
506 | |||
507 | io = simple_strtoul(hw, &hw, 0); | ||
508 | |||
509 | if (*hw++ != ',') | ||
510 | break; | ||
511 | irq = simple_strtoul(hw, &hw, 0); | ||
512 | |||
513 | if (*hw++ != ',') | ||
514 | break; | ||
515 | ram = simple_strtoul(hw, &hw, 0); | ||
516 | |||
517 | if (*hw++ != ',') | ||
518 | break; | ||
519 | while(1) { | ||
520 | if (*hw == '0' && !valid[0]) | ||
521 | valid[0] = 1; /* Port 0 enabled */ | ||
522 | else if (*hw == '1' && !valid[1]) | ||
523 | valid[1] = 1; /* Port 1 enabled */ | ||
524 | else | ||
525 | break; | ||
526 | hw++; | ||
527 | } | ||
528 | |||
529 | if (!valid[0] && !valid[1]) | ||
530 | break; /* at least one port must be used */ | ||
531 | |||
532 | if (*hw == ':' || *hw == '\x0') | ||
533 | n2_run(io, irq, ram, valid[0], valid[1]); | ||
534 | |||
535 | if (*hw == '\x0') | ||
536 | return first_card ? 0 : -ENOSYS; | ||
537 | }while(*hw++ == ':'); | ||
538 | |||
539 | printk(KERN_ERR "n2: invalid hardware parameters\n"); | ||
540 | return first_card ? 0 : -ENOSYS; | ||
541 | } | ||
542 | |||
543 | |||
544 | static void __exit n2_cleanup(void) | ||
545 | { | ||
546 | card_t *card = first_card; | ||
547 | |||
548 | while (card) { | ||
549 | card_t *ptr = card; | ||
550 | card = card->next_card; | ||
551 | n2_destroy_card(ptr); | ||
552 | } | ||
553 | } | ||
554 | |||
555 | |||
556 | module_init(n2_init); | ||
557 | module_exit(n2_cleanup); | ||
558 | |||
559 | MODULE_AUTHOR("Krzysztof Halasa <khc@pm.waw.pl>"); | ||
560 | MODULE_DESCRIPTION("RISCom/N2 serial port driver"); | ||
561 | MODULE_LICENSE("GPL v2"); | ||
562 | module_param(hw, charp, 0444); /* hw=io,irq,ram,ports:io,irq,... */ | ||