sched: clean up wakeup balancing, move wake_affine()
[wrt350n-kernel.git] / drivers / net / tokenring / skisa.c
blob41b6999a0f33487719f56898a489c9748b975f7f
1 /*
2 * skisa.c: A network driver for SK-NET TMS380-based ISA token ring cards.
4 * Based on tmspci written 1999 by Adam Fritzler
5 *
6 * Written 2000 by Jochen Friedrich
7 * Dedicated to my girlfriend Steffi Bopp
9 * This software may be used and distributed according to the terms
10 * of the GNU General Public License, incorporated herein by reference.
12 * This driver module supports the following cards:
13 * - SysKonnect TR4/16(+) ISA (SK-4190)
15 * Maintainer(s):
16 * AF Adam Fritzler
17 * JF Jochen Friedrich jochen@scram.de
19 * Modification History:
20 * 14-Jan-01 JF Created
21 * 28-Oct-02 JF Fixed probe of card for static compilation.
22 * Fixed module init to not make hotplug go wild.
23 * 09-Nov-02 JF Fixed early bail out on out of memory
24 * situations if multiple cards are found.
25 * Cleaned up some unnecessary console SPAM.
26 * 09-Dec-02 JF Fixed module reference counting.
27 * 02-Jan-03 JF Renamed to skisa.c
30 static const char version[] = "skisa.c: v1.03 09/12/2002 by Jochen Friedrich\n";
32 #include <linux/module.h>
33 #include <linux/kernel.h>
34 #include <linux/errno.h>
35 #include <linux/pci.h>
36 #include <linux/init.h>
37 #include <linux/netdevice.h>
38 #include <linux/trdevice.h>
39 #include <linux/platform_device.h>
41 #include <asm/system.h>
42 #include <asm/io.h>
43 #include <asm/irq.h>
44 #include <asm/pci.h>
45 #include <asm/dma.h>
47 #include "tms380tr.h"
49 #define SK_ISA_IO_EXTENT 32
51 /* A zero-terminated list of I/O addresses to be probed. */
52 static unsigned int portlist[] __initdata = {
53 0x0A20, 0x1A20, 0x0B20, 0x1B20, 0x0980, 0x1980, 0x0900, 0x1900,// SK
57 /* A zero-terminated list of IRQs to be probed.
58 * Used again after initial probe for sktr_chipset_init, called from sktr_open.
60 static const unsigned short irqlist[] = {
61 3, 5, 9, 10, 11, 12, 15,
65 /* A zero-terminated list of DMAs to be probed. */
66 static int dmalist[] __initdata = {
67 5, 6, 7,
71 static char isa_cardname[] = "SK NET TR 4/16 ISA\0";
72 static u64 dma_mask = ISA_MAX_ADDRESS;
73 static int sk_isa_open(struct net_device *dev);
74 static void sk_isa_read_eeprom(struct net_device *dev);
75 static unsigned short sk_isa_setnselout_pins(struct net_device *dev);
77 static unsigned short sk_isa_sifreadb(struct net_device *dev, unsigned short reg)
79 return inb(dev->base_addr + reg);
82 static unsigned short sk_isa_sifreadw(struct net_device *dev, unsigned short reg)
84 return inw(dev->base_addr + reg);
87 static void sk_isa_sifwriteb(struct net_device *dev, unsigned short val, unsigned short reg)
89 outb(val, dev->base_addr + reg);
92 static void sk_isa_sifwritew(struct net_device *dev, unsigned short val, unsigned short reg)
94 outw(val, dev->base_addr + reg);
98 static int __init sk_isa_probe1(struct net_device *dev, int ioaddr)
100 unsigned char old, chk1, chk2;
102 if (!request_region(ioaddr, SK_ISA_IO_EXTENT, isa_cardname))
103 return -ENODEV;
105 old = inb(ioaddr + SIFADR); /* Get the old SIFADR value */
107 chk1 = 0; /* Begin with check value 0 */
108 do {
109 /* Write new SIFADR value */
110 outb(chk1, ioaddr + SIFADR);
112 /* Read, invert and write */
113 chk2 = inb(ioaddr + SIFADD);
114 chk2 ^= 0x0FE;
115 outb(chk2, ioaddr + SIFADR);
117 /* Read, invert and compare */
118 chk2 = inb(ioaddr + SIFADD);
119 chk2 ^= 0x0FE;
121 if(chk1 != chk2) {
122 release_region(ioaddr, SK_ISA_IO_EXTENT);
123 return -ENODEV;
126 chk1 -= 2;
127 } while(chk1 != 0); /* Repeat 128 times (all byte values) */
129 /* Restore the SIFADR value */
130 outb(old, ioaddr + SIFADR);
132 dev->base_addr = ioaddr;
133 return 0;
136 static int __init setup_card(struct net_device *dev, struct device *pdev)
138 struct net_local *tp;
139 static int versionprinted;
140 const unsigned *port;
141 int j, err = 0;
142 DECLARE_MAC_BUF(mac);
144 if (!dev)
145 return -ENOMEM;
147 if (dev->base_addr) /* probe specific location */
148 err = sk_isa_probe1(dev, dev->base_addr);
149 else {
150 for (port = portlist; *port; port++) {
151 err = sk_isa_probe1(dev, *port);
152 if (!err)
153 break;
156 if (err)
157 goto out5;
159 /* At this point we have found a valid card. */
161 if (versionprinted++ == 0)
162 printk(KERN_DEBUG "%s", version);
164 err = -EIO;
165 pdev->dma_mask = &dma_mask;
166 if (tmsdev_init(dev, pdev))
167 goto out4;
169 dev->base_addr &= ~3;
171 sk_isa_read_eeprom(dev);
173 printk(KERN_DEBUG "skisa.c: Ring Station Address: %s\n",
174 print_mac(mac, dev->dev_addr));
176 tp = netdev_priv(dev);
177 tp->setnselout = sk_isa_setnselout_pins;
179 tp->sifreadb = sk_isa_sifreadb;
180 tp->sifreadw = sk_isa_sifreadw;
181 tp->sifwriteb = sk_isa_sifwriteb;
182 tp->sifwritew = sk_isa_sifwritew;
184 memcpy(tp->ProductID, isa_cardname, PROD_ID_SIZE + 1);
186 tp->tmspriv = NULL;
188 dev->open = sk_isa_open;
189 dev->stop = tms380tr_close;
191 if (dev->irq == 0)
193 for(j = 0; irqlist[j] != 0; j++)
195 dev->irq = irqlist[j];
196 if (!request_irq(dev->irq, tms380tr_interrupt, 0,
197 isa_cardname, dev))
198 break;
201 if(irqlist[j] == 0)
203 printk(KERN_INFO "skisa.c: AutoSelect no IRQ available\n");
204 goto out3;
207 else
209 for(j = 0; irqlist[j] != 0; j++)
210 if (irqlist[j] == dev->irq)
211 break;
212 if (irqlist[j] == 0)
214 printk(KERN_INFO "skisa.c: Illegal IRQ %d specified\n",
215 dev->irq);
216 goto out3;
218 if (request_irq(dev->irq, tms380tr_interrupt, 0,
219 isa_cardname, dev))
221 printk(KERN_INFO "skisa.c: Selected IRQ %d not available\n",
222 dev->irq);
223 goto out3;
227 if (dev->dma == 0)
229 for(j = 0; dmalist[j] != 0; j++)
231 dev->dma = dmalist[j];
232 if (!request_dma(dev->dma, isa_cardname))
233 break;
236 if(dmalist[j] == 0)
238 printk(KERN_INFO "skisa.c: AutoSelect no DMA available\n");
239 goto out2;
242 else
244 for(j = 0; dmalist[j] != 0; j++)
245 if (dmalist[j] == dev->dma)
246 break;
247 if (dmalist[j] == 0)
249 printk(KERN_INFO "skisa.c: Illegal DMA %d specified\n",
250 dev->dma);
251 goto out2;
253 if (request_dma(dev->dma, isa_cardname))
255 printk(KERN_INFO "skisa.c: Selected DMA %d not available\n",
256 dev->dma);
257 goto out2;
261 err = register_netdev(dev);
262 if (err)
263 goto out;
265 printk(KERN_DEBUG "%s: IO: %#4lx IRQ: %d DMA: %d\n",
266 dev->name, dev->base_addr, dev->irq, dev->dma);
268 return 0;
269 out:
270 free_dma(dev->dma);
271 out2:
272 free_irq(dev->irq, dev);
273 out3:
274 tmsdev_term(dev);
275 out4:
276 release_region(dev->base_addr, SK_ISA_IO_EXTENT);
277 out5:
278 return err;
282 * Reads MAC address from adapter RAM, which should've read it from
283 * the onboard ROM.
285 * Calling this on a board that does not support it can be a very
286 * dangerous thing. The Madge board, for instance, will lock your
287 * machine hard when this is called. Luckily, its supported in a
288 * separate driver. --ASF
290 static void sk_isa_read_eeprom(struct net_device *dev)
292 int i;
294 /* Address: 0000:0000 */
295 sk_isa_sifwritew(dev, 0, SIFADX);
296 sk_isa_sifwritew(dev, 0, SIFADR);
298 /* Read six byte MAC address data */
299 dev->addr_len = 6;
300 for(i = 0; i < 6; i++)
301 dev->dev_addr[i] = sk_isa_sifreadw(dev, SIFINC) >> 8;
304 unsigned short sk_isa_setnselout_pins(struct net_device *dev)
306 return 0;
309 static int sk_isa_open(struct net_device *dev)
311 struct net_local *tp = netdev_priv(dev);
312 unsigned short val = 0;
313 unsigned short oldval;
314 int i;
316 val = 0;
317 for(i = 0; irqlist[i] != 0; i++)
319 if(irqlist[i] == dev->irq)
320 break;
323 val |= CYCLE_TIME << 2;
324 val |= i << 4;
325 i = dev->dma - 5;
326 val |= i;
327 if(tp->DataRate == SPEED_4)
328 val |= LINE_SPEED_BIT;
329 else
330 val &= ~LINE_SPEED_BIT;
331 oldval = sk_isa_sifreadb(dev, POSREG);
332 /* Leave cycle bits alone */
333 oldval |= 0xf3;
334 val &= oldval;
335 sk_isa_sifwriteb(dev, val, POSREG);
337 return tms380tr_open(dev);
340 #define ISATR_MAX_ADAPTERS 3
342 static int io[ISATR_MAX_ADAPTERS];
343 static int irq[ISATR_MAX_ADAPTERS];
344 static int dma[ISATR_MAX_ADAPTERS];
346 MODULE_LICENSE("GPL");
348 module_param_array(io, int, NULL, 0);
349 module_param_array(irq, int, NULL, 0);
350 module_param_array(dma, int, NULL, 0);
352 static struct platform_device *sk_isa_dev[ISATR_MAX_ADAPTERS];
354 static struct platform_driver sk_isa_driver = {
355 .driver = {
356 .name = "skisa",
360 static int __init sk_isa_init(void)
362 struct net_device *dev;
363 struct platform_device *pdev;
364 int i, num = 0, err = 0;
366 err = platform_driver_register(&sk_isa_driver);
367 if (err)
368 return err;
370 for (i = 0; i < ISATR_MAX_ADAPTERS ; i++) {
371 dev = alloc_trdev(sizeof(struct net_local));
372 if (!dev)
373 continue;
375 dev->base_addr = io[i];
376 dev->irq = irq[i];
377 dev->dma = dma[i];
378 pdev = platform_device_register_simple("skisa",
379 i, NULL, 0);
380 if (IS_ERR(pdev)) {
381 free_netdev(dev);
382 continue;
384 err = setup_card(dev, &pdev->dev);
385 if (!err) {
386 sk_isa_dev[i] = pdev;
387 platform_set_drvdata(sk_isa_dev[i], dev);
388 ++num;
389 } else {
390 platform_device_unregister(pdev);
391 free_netdev(dev);
395 printk(KERN_NOTICE "skisa.c: %d cards found.\n", num);
396 /* Probe for cards. */
397 if (num == 0) {
398 printk(KERN_NOTICE "skisa.c: No cards found.\n");
399 platform_driver_unregister(&sk_isa_driver);
400 return -ENODEV;
402 return 0;
405 static void __exit sk_isa_cleanup(void)
407 struct net_device *dev;
408 int i;
410 for (i = 0; i < ISATR_MAX_ADAPTERS ; i++) {
411 struct platform_device *pdev = sk_isa_dev[i];
413 if (!pdev)
414 continue;
415 dev = platform_get_drvdata(pdev);
416 unregister_netdev(dev);
417 release_region(dev->base_addr, SK_ISA_IO_EXTENT);
418 free_irq(dev->irq, dev);
419 free_dma(dev->dma);
420 tmsdev_term(dev);
421 free_netdev(dev);
422 platform_set_drvdata(pdev, NULL);
423 platform_device_unregister(pdev);
425 platform_driver_unregister(&sk_isa_driver);
428 module_init(sk_isa_init);
429 module_exit(sk_isa_cleanup);