blob: 8c694213035b684d049361f3121b25d7def2f6ff [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/* 3c509.c: A 3c509 EtherLink3 ethernet driver for linux. */
2/*
3 Written 1993-2000 by Donald Becker.
4
5 Copyright 1994-2000 by Donald Becker.
6 Copyright 1993 United States Government as represented by the
7 Director, National Security Agency. This software may be used and
8 distributed according to the terms of the GNU General Public License,
9 incorporated herein by reference.
10
11 This driver is for the 3Com EtherLinkIII series.
12
13 The author may be reached as becker@scyld.com, or C/O
14 Scyld Computing Corporation
15 410 Severn Ave., Suite 210
16 Annapolis MD 21403
17
18 Known limitations:
19 Because of the way 3c509 ISA detection works it's difficult to predict
20 a priori which of several ISA-mode cards will be detected first.
21
22 This driver does not use predictive interrupt mode, resulting in higher
23 packet latency but lower overhead. If interrupts are disabled for an
24 unusually long time it could also result in missed packets, but in
25 practice this rarely happens.
26
27
28 FIXES:
29 Alan Cox: Removed the 'Unexpected interrupt' bug.
30 Michael Meskes: Upgraded to Donald Becker's version 1.07.
Jeff Garzik6aa20a22006-09-13 13:24:59 -040031 Alan Cox: Increased the eeprom delay. Regardless of
Linus Torvalds1da177e2005-04-16 15:20:36 -070032 what the docs say some people definitely
33 get problems with lower (but in card spec)
34 delays
35 v1.10 4/21/97 Fixed module code so that multiple cards may be detected,
36 other cleanups. -djb
37 Andrea Arcangeli: Upgraded to Donald Becker's version 1.12.
38 Rick Payne: Fixed SMP race condition
39 v1.13 9/8/97 Made 'max_interrupt_work' an insmod-settable variable -djb
40 v1.14 10/15/97 Avoided waiting..discard message for fast machines -djb
41 v1.15 1/31/98 Faster recovery for Tx errors. -djb
42 v1.16 2/3/98 Different ID port handling to avoid sound cards. -djb
Francois Camie1f8e872008-10-15 22:01:59 -070043 v1.18 12Mar2001 Andrew Morton
Linus Torvalds1da177e2005-04-16 15:20:36 -070044 - Avoid bogus detect of 3c590's (Andrzej Krzysztofowicz)
45 - Reviewed against 1.18 from scyld.com
46 v1.18a 17Nov2001 Jeff Garzik <jgarzik@pobox.com>
47 - ethtool support
48 v1.18b 1Mar2002 Zwane Mwaikambo <zwane@commfireservices.com>
49 - Power Management support
50 v1.18c 1Mar2002 David Ruggiero <jdr@farfalle.com>
51 - Full duplex support
52 v1.19 16Oct2002 Zwane Mwaikambo <zwane@linuxpower.ca>
53 - Additional ethtool features
54 v1.19a 28Oct2002 Davud Ruggiero <jdr@farfalle.com>
55 - Increase *read_eeprom udelay to workaround oops with 2 cards.
56 v1.19b 08Nov2002 Marc Zyngier <maz@wild-wind.fr.eu.org>
Ondrej Zaryac4bed12008-03-28 14:41:23 -070057 - Introduce driver model for EISA cards.
58 v1.20 04Feb2008 Ondrej Zary <linux@rainbow-software.org>
59 - convert to isa_driver and pnp_driver and some cleanups
Linus Torvalds1da177e2005-04-16 15:20:36 -070060*/
61
62#define DRV_NAME "3c509"
Ondrej Zaryac4bed12008-03-28 14:41:23 -070063#define DRV_VERSION "1.20"
64#define DRV_RELDATE "04Feb2008"
Linus Torvalds1da177e2005-04-16 15:20:36 -070065
66/* A few values that may be tweaked. */
67
68/* Time in jiffies before concluding the transmitter is hung. */
69#define TX_TIMEOUT (400*HZ/1000)
Linus Torvalds1da177e2005-04-16 15:20:36 -070070
Linus Torvalds1da177e2005-04-16 15:20:36 -070071#include <linux/module.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070072#include <linux/mca.h>
Ondrej Zaryac4bed12008-03-28 14:41:23 -070073#include <linux/isa.h>
74#include <linux/pnp.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070075#include <linux/string.h>
76#include <linux/interrupt.h>
77#include <linux/errno.h>
78#include <linux/in.h>
79#include <linux/slab.h>
80#include <linux/ioport.h>
81#include <linux/init.h>
82#include <linux/netdevice.h>
83#include <linux/etherdevice.h>
84#include <linux/pm.h>
85#include <linux/skbuff.h>
86#include <linux/delay.h> /* for udelay() */
87#include <linux/spinlock.h>
88#include <linux/ethtool.h>
89#include <linux/device.h>
90#include <linux/eisa.h>
91#include <linux/bitops.h>
92
93#include <asm/uaccess.h>
94#include <asm/io.h>
95#include <asm/irq.h>
96
Al Viro37b2a172008-11-01 18:20:19 +000097static char version[] __devinitdata = DRV_NAME ".c:" DRV_VERSION " " DRV_RELDATE " becker@scyld.com\n";
Linus Torvalds1da177e2005-04-16 15:20:36 -070098
99#ifdef EL3_DEBUG
100static int el3_debug = EL3_DEBUG;
101#else
102static int el3_debug = 2;
103#endif
104
105/* Used to do a global count of all the cards in the system. Must be
106 * a global variable so that the mca/eisa probe routines can increment
107 * it */
108static int el3_cards = 0;
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700109#define EL3_MAX_CARDS 8
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110
111/* To minimize the size of the driver source I only define operating
112 constants if they are used several times. You'll need the manual
113 anyway if you want to understand driver details. */
114/* Offsets from base I/O address. */
115#define EL3_DATA 0x00
116#define EL3_CMD 0x0e
117#define EL3_STATUS 0x0e
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700118#define EEPROM_READ 0x80
Linus Torvalds1da177e2005-04-16 15:20:36 -0700119
120#define EL3_IO_EXTENT 16
121
122#define EL3WINDOW(win_num) outw(SelectWindow + (win_num), ioaddr + EL3_CMD)
123
124
125/* The top five bits written to EL3_CMD are a command, the lower
126 11 bits are the parameter, if applicable. */
127enum c509cmd {
128 TotalReset = 0<<11, SelectWindow = 1<<11, StartCoax = 2<<11,
129 RxDisable = 3<<11, RxEnable = 4<<11, RxReset = 5<<11, RxDiscard = 8<<11,
130 TxEnable = 9<<11, TxDisable = 10<<11, TxReset = 11<<11,
131 FakeIntr = 12<<11, AckIntr = 13<<11, SetIntrEnb = 14<<11,
132 SetStatusEnb = 15<<11, SetRxFilter = 16<<11, SetRxThreshold = 17<<11,
133 SetTxThreshold = 18<<11, SetTxStart = 19<<11, StatsEnable = 21<<11,
134 StatsDisable = 22<<11, StopCoax = 23<<11, PowerUp = 27<<11,
135 PowerDown = 28<<11, PowerAuto = 29<<11};
136
137enum c509status {
138 IntLatch = 0x0001, AdapterFailure = 0x0002, TxComplete = 0x0004,
139 TxAvailable = 0x0008, RxComplete = 0x0010, RxEarly = 0x0020,
140 IntReq = 0x0040, StatsFull = 0x0080, CmdBusy = 0x1000, };
141
142/* The SetRxFilter command accepts the following classes: */
143enum RxFilter {
144 RxStation = 1, RxMulticast = 2, RxBroadcast = 4, RxProm = 8 };
145
146/* Register window 1 offsets, the window used in normal operation. */
147#define TX_FIFO 0x00
148#define RX_FIFO 0x00
149#define RX_STATUS 0x08
150#define TX_STATUS 0x0B
151#define TX_FREE 0x0C /* Remaining free bytes in Tx buffer. */
152
153#define WN0_CONF_CTRL 0x04 /* Window 0: Configuration control register */
154#define WN0_ADDR_CONF 0x06 /* Window 0: Address configuration register */
155#define WN0_IRQ 0x08 /* Window 0: Set IRQ line in bits 12-15. */
156#define WN4_MEDIA 0x0A /* Window 4: Various transcvr/media bits. */
157#define MEDIA_TP 0x00C0 /* Enable link beat and jabber for 10baseT. */
158#define WN4_NETDIAG 0x06 /* Window 4: Net diagnostic */
Jeff Garzik6aa20a22006-09-13 13:24:59 -0400159#define FD_ENABLE 0x8000 /* Enable full-duplex ("external loopback") */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160
161/*
162 * Must be a power of two (we use a binary and in the
163 * circular queue)
164 */
165#define SKB_QUEUE_SIZE 64
166
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700167enum el3_cardtype { EL3_ISA, EL3_PNP, EL3_MCA, EL3_EISA };
168
Linus Torvalds1da177e2005-04-16 15:20:36 -0700169struct el3_private {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700170 spinlock_t lock;
171 /* skb send-queue */
172 int head, size;
173 struct sk_buff *queue[SKB_QUEUE_SIZE];
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700174 enum el3_cardtype type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700175};
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700176static int id_port;
177static int current_tag;
178static struct net_device *el3_devs[EL3_MAX_CARDS];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700180/* Parameters that may be passed into the module. */
181static int debug = -1;
182static int irq[] = {-1, -1, -1, -1, -1, -1, -1, -1};
183/* Maximum events (Rx packets, etc.) to handle at each interrupt. */
184static int max_interrupt_work = 10;
185#ifdef CONFIG_PNP
186static int nopnp;
187#endif
188
Al Viro37b2a172008-11-01 18:20:19 +0000189static int __devinit el3_common_init(struct net_device *dev);
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700190static void el3_common_remove(struct net_device *dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700191static ushort id_read_eeprom(int index);
192static ushort read_eeprom(int ioaddr, int index);
193static int el3_open(struct net_device *dev);
194static int el3_start_xmit(struct sk_buff *skb, struct net_device *dev);
David Howells7d12e782006-10-05 14:55:46 +0100195static irqreturn_t el3_interrupt(int irq, void *dev_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196static void update_stats(struct net_device *dev);
197static struct net_device_stats *el3_get_stats(struct net_device *dev);
198static int el3_rx(struct net_device *dev);
199static int el3_close(struct net_device *dev);
200static void set_multicast_list(struct net_device *dev);
201static void el3_tx_timeout (struct net_device *dev);
202static void el3_down(struct net_device *dev);
203static void el3_up(struct net_device *dev);
Jeff Garzik7282d492006-09-13 14:30:00 -0400204static const struct ethtool_ops ethtool_ops;
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700205#ifdef CONFIG_PM
Pekka Enberg60a89ff2006-03-08 00:06:28 -0800206static int el3_suspend(struct device *, pm_message_t);
207static int el3_resume(struct device *);
208#else
209#define el3_suspend NULL
210#define el3_resume NULL
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211#endif
Pekka Enberg60a89ff2006-03-08 00:06:28 -0800212
213
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214/* generic device remove for all device types */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215static int el3_device_remove (struct device *device);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700216#ifdef CONFIG_NET_POLL_CONTROLLER
217static void el3_poll_controller(struct net_device *dev);
218#endif
219
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700220/* Return 0 on success, 1 on error, 2 when found already detected PnP card */
221static int el3_isa_id_sequence(__be16 *phys_addr)
222{
223 short lrs_state = 0xff;
224 int i;
225
226 /* ISA boards are detected by sending the ID sequence to the
227 ID_PORT. We find cards past the first by setting the 'current_tag'
228 on cards as they are found. Cards with their tag set will not
229 respond to subsequent ID sequences. */
230
231 outb(0x00, id_port);
232 outb(0x00, id_port);
233 for (i = 0; i < 255; i++) {
234 outb(lrs_state, id_port);
235 lrs_state <<= 1;
236 lrs_state = lrs_state & 0x100 ? lrs_state ^ 0xcf : lrs_state;
237 }
238 /* For the first probe, clear all board's tag registers. */
239 if (current_tag == 0)
240 outb(0xd0, id_port);
241 else /* Otherwise kill off already-found boards. */
242 outb(0xd8, id_port);
243 if (id_read_eeprom(7) != 0x6d50)
244 return 1;
245 /* Read in EEPROM data, which does contention-select.
246 Only the lowest address board will stay "on-line".
247 3Com got the byte order backwards. */
248 for (i = 0; i < 3; i++)
249 phys_addr[i] = htons(id_read_eeprom(i));
250#ifdef CONFIG_PNP
251 if (!nopnp) {
252 /* The ISA PnP 3c509 cards respond to the ID sequence too.
253 This check is needed in order not to register them twice. */
254 for (i = 0; i < el3_cards; i++) {
255 struct el3_private *lp = netdev_priv(el3_devs[i]);
256 if (lp->type == EL3_PNP
257 && !memcmp(phys_addr, el3_devs[i]->dev_addr,
258 ETH_ALEN)) {
259 if (el3_debug > 3)
260 printk(KERN_DEBUG "3c509 with address %02x %02x %02x %02x %02x %02x was found by ISAPnP\n",
261 phys_addr[0] & 0xff, phys_addr[0] >> 8,
262 phys_addr[1] & 0xff, phys_addr[1] >> 8,
263 phys_addr[2] & 0xff, phys_addr[2] >> 8);
264 /* Set the adaptor tag so that the next card can be found. */
265 outb(0xd0 + ++current_tag, id_port);
266 return 2;
267 }
268 }
269 }
270#endif /* CONFIG_PNP */
271 return 0;
272
273}
274
275static void __devinit el3_dev_fill(struct net_device *dev, __be16 *phys_addr,
276 int ioaddr, int irq, int if_port,
277 enum el3_cardtype type)
278{
279 struct el3_private *lp = netdev_priv(dev);
280
281 memcpy(dev->dev_addr, phys_addr, ETH_ALEN);
282 dev->base_addr = ioaddr;
283 dev->irq = irq;
284 dev->if_port = if_port;
285 lp->type = type;
286}
287
288static int __devinit el3_isa_match(struct device *pdev,
289 unsigned int ndev)
290{
291 struct net_device *dev;
292 int ioaddr, isa_irq, if_port, err;
293 unsigned int iobase;
294 __be16 phys_addr[3];
295
296 while ((err = el3_isa_id_sequence(phys_addr)) == 2)
297 ; /* Skip to next card when PnP card found */
298 if (err == 1)
299 return 0;
300
301 iobase = id_read_eeprom(8);
302 if_port = iobase >> 14;
303 ioaddr = 0x200 + ((iobase & 0x1f) << 4);
304 if (irq[el3_cards] > 1 && irq[el3_cards] < 16)
305 isa_irq = irq[el3_cards];
306 else
307 isa_irq = id_read_eeprom(9) >> 12;
308
309 dev = alloc_etherdev(sizeof(struct el3_private));
310 if (!dev)
311 return -ENOMEM;
312
313 netdev_boot_setup_check(dev);
314
315 if (!request_region(ioaddr, EL3_IO_EXTENT, "3c509-isa")) {
316 free_netdev(dev);
317 return 0;
318 }
319
320 /* Set the adaptor tag so that the next card can be found. */
321 outb(0xd0 + ++current_tag, id_port);
322
323 /* Activate the adaptor at the EEPROM location. */
324 outb((ioaddr >> 4) | 0xe0, id_port);
325
326 EL3WINDOW(0);
327 if (inw(ioaddr) != 0x6d50) {
328 free_netdev(dev);
329 return 0;
330 }
331
332 /* Free the interrupt so that some other card can use it. */
333 outw(0x0f00, ioaddr + WN0_IRQ);
334
335 el3_dev_fill(dev, phys_addr, ioaddr, isa_irq, if_port, EL3_ISA);
336 dev_set_drvdata(pdev, dev);
337 if (el3_common_init(dev)) {
338 free_netdev(dev);
339 return 0;
340 }
341
342 el3_devs[el3_cards++] = dev;
343 return 1;
344}
345
346static int __devexit el3_isa_remove(struct device *pdev,
347 unsigned int ndev)
348{
349 el3_device_remove(pdev);
350 dev_set_drvdata(pdev, NULL);
351 return 0;
352}
353
354#ifdef CONFIG_PM
355static int el3_isa_suspend(struct device *dev, unsigned int n,
356 pm_message_t state)
357{
358 current_tag = 0;
359 return el3_suspend(dev, state);
360}
361
362static int el3_isa_resume(struct device *dev, unsigned int n)
363{
364 struct net_device *ndev = dev_get_drvdata(dev);
365 int ioaddr = ndev->base_addr, err;
366 __be16 phys_addr[3];
367
368 while ((err = el3_isa_id_sequence(phys_addr)) == 2)
369 ; /* Skip to next card when PnP card found */
370 if (err == 1)
371 return 0;
372 /* Set the adaptor tag so that the next card can be found. */
373 outb(0xd0 + ++current_tag, id_port);
374 /* Enable the card */
375 outb((ioaddr >> 4) | 0xe0, id_port);
376 EL3WINDOW(0);
377 if (inw(ioaddr) != 0x6d50)
378 return 1;
379 /* Free the interrupt so that some other card can use it. */
380 outw(0x0f00, ioaddr + WN0_IRQ);
381 return el3_resume(dev);
382}
383#endif
384
385static struct isa_driver el3_isa_driver = {
386 .match = el3_isa_match,
387 .remove = __devexit_p(el3_isa_remove),
388#ifdef CONFIG_PM
389 .suspend = el3_isa_suspend,
390 .resume = el3_isa_resume,
391#endif
392 .driver = {
393 .name = "3c509"
394 },
395};
396static int isa_registered;
397
398#ifdef CONFIG_PNP
399static struct pnp_device_id el3_pnp_ids[] = {
400 { .id = "TCM5090" }, /* 3Com Etherlink III (TP) */
401 { .id = "TCM5091" }, /* 3Com Etherlink III */
402 { .id = "TCM5094" }, /* 3Com Etherlink III (combo) */
403 { .id = "TCM5095" }, /* 3Com Etherlink III (TPO) */
404 { .id = "TCM5098" }, /* 3Com Etherlink III (TPC) */
405 { .id = "PNP80f7" }, /* 3Com Etherlink III compatible */
406 { .id = "PNP80f8" }, /* 3Com Etherlink III compatible */
407 { .id = "" }
408};
409MODULE_DEVICE_TABLE(pnp, el3_pnp_ids);
410
411static int __devinit el3_pnp_probe(struct pnp_dev *pdev,
412 const struct pnp_device_id *id)
413{
414 short i;
415 int ioaddr, irq, if_port;
Al Viro4ec7ffa2008-05-21 06:32:11 +0100416 __be16 phys_addr[3];
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700417 struct net_device *dev = NULL;
418 int err;
419
420 ioaddr = pnp_port_start(pdev, 0);
421 if (!request_region(ioaddr, EL3_IO_EXTENT, "3c509-pnp"))
422 return -EBUSY;
423 irq = pnp_irq(pdev, 0);
424 EL3WINDOW(0);
425 for (i = 0; i < 3; i++)
426 phys_addr[i] = htons(read_eeprom(ioaddr, i));
427 if_port = read_eeprom(ioaddr, 8) >> 14;
428 dev = alloc_etherdev(sizeof(struct el3_private));
429 if (!dev) {
430 release_region(ioaddr, EL3_IO_EXTENT);
431 return -ENOMEM;
432 }
433 SET_NETDEV_DEV(dev, &pdev->dev);
434 netdev_boot_setup_check(dev);
435
436 el3_dev_fill(dev, phys_addr, ioaddr, irq, if_port, EL3_PNP);
437 pnp_set_drvdata(pdev, dev);
438 err = el3_common_init(dev);
439
440 if (err) {
441 pnp_set_drvdata(pdev, NULL);
442 free_netdev(dev);
443 return err;
444 }
445
446 el3_devs[el3_cards++] = dev;
447 return 0;
448}
449
450static void __devexit el3_pnp_remove(struct pnp_dev *pdev)
451{
452 el3_common_remove(pnp_get_drvdata(pdev));
453 pnp_set_drvdata(pdev, NULL);
454}
455
456#ifdef CONFIG_PM
457static int el3_pnp_suspend(struct pnp_dev *pdev, pm_message_t state)
458{
459 return el3_suspend(&pdev->dev, state);
460}
461
462static int el3_pnp_resume(struct pnp_dev *pdev)
463{
464 return el3_resume(&pdev->dev);
465}
466#endif
467
468static struct pnp_driver el3_pnp_driver = {
469 .name = "3c509",
470 .id_table = el3_pnp_ids,
471 .probe = el3_pnp_probe,
472 .remove = __devexit_p(el3_pnp_remove),
473#ifdef CONFIG_PM
474 .suspend = el3_pnp_suspend,
475 .resume = el3_pnp_resume,
476#endif
477};
478static int pnp_registered;
479#endif /* CONFIG_PNP */
480
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481#ifdef CONFIG_EISA
482static struct eisa_device_id el3_eisa_ids[] = {
483 { "TCM5092" },
484 { "TCM5093" },
Adrian Bunkf04e3f02005-05-16 21:13:03 +0200485 { "TCM5095" },
Linus Torvalds1da177e2005-04-16 15:20:36 -0700486 { "" }
487};
Michael Tokarev07563c72006-09-27 01:50:56 -0700488MODULE_DEVICE_TABLE(eisa, el3_eisa_ids);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700489
490static int el3_eisa_probe (struct device *device);
491
492static struct eisa_driver el3_eisa_driver = {
493 .id_table = el3_eisa_ids,
494 .driver = {
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700495 .name = "3c579",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700496 .probe = el3_eisa_probe,
Pekka Enberg60a89ff2006-03-08 00:06:28 -0800497 .remove = __devexit_p (el3_device_remove),
498 .suspend = el3_suspend,
499 .resume = el3_resume,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700500 }
501};
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700502static int eisa_registered;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700503#endif
504
505#ifdef CONFIG_MCA
506static int el3_mca_probe(struct device *dev);
507
508static short el3_mca_adapter_ids[] __initdata = {
509 0x627c,
510 0x627d,
511 0x62db,
512 0x62f6,
513 0x62f7,
514 0x0000
515};
516
517static char *el3_mca_adapter_names[] __initdata = {
518 "3Com 3c529 EtherLink III (10base2)",
519 "3Com 3c529 EtherLink III (10baseT)",
520 "3Com 3c529 EtherLink III (test mode)",
521 "3Com 3c529 EtherLink III (TP or coax)",
522 "3Com 3c529 EtherLink III (TP)",
523 NULL
524};
525
526static struct mca_driver el3_mca_driver = {
527 .id_table = el3_mca_adapter_ids,
528 .driver = {
529 .name = "3c529",
530 .bus = &mca_bus_type,
531 .probe = el3_mca_probe,
532 .remove = __devexit_p(el3_device_remove),
Pekka Enberg60a89ff2006-03-08 00:06:28 -0800533 .suspend = el3_suspend,
534 .resume = el3_resume,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535 },
536};
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700537static int mca_registered;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538#endif /* CONFIG_MCA */
539
Al Viro37b2a172008-11-01 18:20:19 +0000540static int __devinit el3_common_init(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700541{
542 struct el3_private *lp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700543 int err;
Joe Perches0795af52007-10-03 17:59:30 -0700544 const char *if_names[] = {"10baseT", "AUI", "undefined", "BNC"};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545
546 spin_lock_init(&lp->lock);
547
548 if (dev->mem_start & 0x05) { /* xcvr codes 1/3/4/12 */
549 dev->if_port = (dev->mem_start & 0x0f);
550 } else { /* xcvr codes 0/8 */
551 /* use eeprom value, but save user's full-duplex selection */
552 dev->if_port |= (dev->mem_start & 0x08);
553 }
554
555 /* The EL3-specific entries in the device structure. */
556 dev->open = &el3_open;
557 dev->hard_start_xmit = &el3_start_xmit;
558 dev->stop = &el3_close;
559 dev->get_stats = &el3_get_stats;
560 dev->set_multicast_list = &set_multicast_list;
561 dev->tx_timeout = el3_tx_timeout;
562 dev->watchdog_timeo = TX_TIMEOUT;
563#ifdef CONFIG_NET_POLL_CONTROLLER
564 dev->poll_controller = el3_poll_controller;
565#endif
566 SET_ETHTOOL_OPS(dev, &ethtool_ops);
567
568 err = register_netdev(dev);
569 if (err) {
570 printk(KERN_ERR "Failed to register 3c5x9 at %#3.3lx, IRQ %d.\n",
571 dev->base_addr, dev->irq);
572 release_region(dev->base_addr, EL3_IO_EXTENT);
573 return err;
574 }
575
Joe Perches0795af52007-10-03 17:59:30 -0700576 printk(KERN_INFO "%s: 3c5x9 found at %#3.3lx, %s port, "
Johannes Berge1749612008-10-27 15:59:26 -0700577 "address %pM, IRQ %d.\n",
Joe Perches0795af52007-10-03 17:59:30 -0700578 dev->name, dev->base_addr, if_names[(dev->if_port & 0x03)],
Johannes Berge1749612008-10-27 15:59:26 -0700579 dev->dev_addr, dev->irq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700580
581 if (el3_debug > 0)
Markus Dahms2c2a8c52007-05-09 07:58:10 +0200582 printk(KERN_INFO "%s", version);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583 return 0;
584
585}
586
587static void el3_common_remove (struct net_device *dev)
588{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589 unregister_netdev (dev);
590 release_region(dev->base_addr, EL3_IO_EXTENT);
591 free_netdev (dev);
592}
593
Linus Torvalds1da177e2005-04-16 15:20:36 -0700594#ifdef CONFIG_MCA
595static int __init el3_mca_probe(struct device *device)
596{
597 /* Based on Erik Nygren's (nygren@mit.edu) 3c529 patch,
598 * heavily modified by Chris Beauregard
599 * (cpbeaure@csclub.uwaterloo.ca) to support standard MCA
600 * probing.
601 *
602 * redone for multi-card detection by ZP Gu (zpg@castle.net)
603 * now works as a module */
604
Linus Torvalds1da177e2005-04-16 15:20:36 -0700605 short i;
606 int ioaddr, irq, if_port;
Al Viro4ec7ffa2008-05-21 06:32:11 +0100607 __be16 phys_addr[3];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700608 struct net_device *dev = NULL;
609 u_char pos4, pos5;
610 struct mca_device *mdev = to_mca_device(device);
611 int slot = mdev->slot;
612 int err;
613
614 pos4 = mca_device_read_stored_pos(mdev, 4);
615 pos5 = mca_device_read_stored_pos(mdev, 5);
616
617 ioaddr = ((short)((pos4&0xfc)|0x02)) << 8;
618 irq = pos5 & 0x0f;
619
620
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700621 printk(KERN_INFO "3c529: found %s at slot %d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700622 el3_mca_adapter_names[mdev->index], slot + 1);
623
624 /* claim the slot */
625 strncpy(mdev->name, el3_mca_adapter_names[mdev->index],
626 sizeof(mdev->name));
627 mca_device_set_claim(mdev, 1);
628
629 if_port = pos4 & 0x03;
630
631 irq = mca_device_transform_irq(mdev, irq);
Jeff Garzik6aa20a22006-09-13 13:24:59 -0400632 ioaddr = mca_device_transform_ioport(mdev, ioaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700633 if (el3_debug > 2) {
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700634 printk(KERN_DEBUG "3c529: irq %d ioaddr 0x%x ifport %d\n", irq, ioaddr, if_port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700635 }
636 EL3WINDOW(0);
Al Viro4ec7ffa2008-05-21 06:32:11 +0100637 for (i = 0; i < 3; i++)
638 phys_addr[i] = htons(read_eeprom(ioaddr, i));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700639
640 dev = alloc_etherdev(sizeof (struct el3_private));
641 if (dev == NULL) {
Al Viro4ec7ffa2008-05-21 06:32:11 +0100642 release_region(ioaddr, EL3_IO_EXTENT);
643 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644 }
645
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646 netdev_boot_setup_check(dev);
647
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700648 el3_dev_fill(dev, phys_addr, ioaddr, irq, if_port, EL3_MCA);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700649 device->driver_data = dev;
650 err = el3_common_init(dev);
651
652 if (err) {
653 device->driver_data = NULL;
654 free_netdev(dev);
655 return -ENOMEM;
656 }
657
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700658 el3_devs[el3_cards++] = dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700659 return 0;
660}
Jeff Garzik6aa20a22006-09-13 13:24:59 -0400661
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662#endif /* CONFIG_MCA */
663
664#ifdef CONFIG_EISA
665static int __init el3_eisa_probe (struct device *device)
666{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700667 short i;
668 int ioaddr, irq, if_port;
Al Viro4ec7ffa2008-05-21 06:32:11 +0100669 __be16 phys_addr[3];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670 struct net_device *dev = NULL;
671 struct eisa_device *edev;
672 int err;
673
674 /* Yeepee, The driver framework is calling us ! */
675 edev = to_eisa_device (device);
676 ioaddr = edev->base_addr;
Jeff Garzik6aa20a22006-09-13 13:24:59 -0400677
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700678 if (!request_region(ioaddr, EL3_IO_EXTENT, "3c579-eisa"))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700679 return -EBUSY;
680
681 /* Change the register set to the configuration window 0. */
682 outw(SelectWindow | 0, ioaddr + 0xC80 + EL3_CMD);
683
684 irq = inw(ioaddr + WN0_IRQ) >> 12;
685 if_port = inw(ioaddr + 6)>>14;
686 for (i = 0; i < 3; i++)
687 phys_addr[i] = htons(read_eeprom(ioaddr, i));
688
689 /* Restore the "Product ID" to the EEPROM read register. */
690 read_eeprom(ioaddr, 3);
691
692 dev = alloc_etherdev(sizeof (struct el3_private));
693 if (dev == NULL) {
694 release_region(ioaddr, EL3_IO_EXTENT);
695 return -ENOMEM;
696 }
697
Linus Torvalds1da177e2005-04-16 15:20:36 -0700698 netdev_boot_setup_check(dev);
699
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700700 el3_dev_fill(dev, phys_addr, ioaddr, irq, if_port, EL3_EISA);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700701 eisa_set_drvdata (edev, dev);
702 err = el3_common_init(dev);
703
704 if (err) {
705 eisa_set_drvdata (edev, NULL);
706 free_netdev(dev);
707 return err;
708 }
709
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700710 el3_devs[el3_cards++] = dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700711 return 0;
712}
713#endif
714
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715/* This remove works for all device types.
716 *
717 * The net dev must be stored in the driver_data field */
718static int __devexit el3_device_remove (struct device *device)
719{
720 struct net_device *dev;
721
722 dev = device->driver_data;
723
724 el3_common_remove (dev);
725 return 0;
726}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700727
728/* Read a word from the EEPROM using the regular EEPROM access register.
729 Assume that we are in register window zero.
730 */
731static ushort read_eeprom(int ioaddr, int index)
732{
733 outw(EEPROM_READ + index, ioaddr + 10);
Jeff Garzik6aa20a22006-09-13 13:24:59 -0400734 /* Pause for at least 162 us. for the read to take place.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700735 Some chips seem to require much longer */
736 mdelay(2);
737 return inw(ioaddr + 12);
738}
739
740/* Read a word from the EEPROM when in the ISA ID probe state. */
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700741static ushort id_read_eeprom(int index)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742{
743 int bit, word = 0;
744
745 /* Issue read command, and pause for at least 162 us. for it to complete.
746 Assume extra-fast 16Mhz bus. */
747 outb(EEPROM_READ + index, id_port);
748
749 /* Pause for at least 162 us. for the read to take place. */
750 /* Some chips seem to require much longer */
751 mdelay(4);
Jeff Garzik6aa20a22006-09-13 13:24:59 -0400752
Linus Torvalds1da177e2005-04-16 15:20:36 -0700753 for (bit = 15; bit >= 0; bit--)
754 word = (word << 1) + (inb(id_port) & 0x01);
755
756 if (el3_debug > 3)
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700757 printk(KERN_DEBUG " 3c509 EEPROM word %d %#4.4x.\n", index, word);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700758
759 return word;
760}
761
762
763static int
764el3_open(struct net_device *dev)
765{
766 int ioaddr = dev->base_addr;
767 int i;
768
769 outw(TxReset, ioaddr + EL3_CMD);
770 outw(RxReset, ioaddr + EL3_CMD);
771 outw(SetStatusEnb | 0x00, ioaddr + EL3_CMD);
772
773 i = request_irq(dev->irq, &el3_interrupt, 0, dev->name, dev);
774 if (i)
775 return i;
776
777 EL3WINDOW(0);
778 if (el3_debug > 3)
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700779 printk(KERN_DEBUG "%s: Opening, IRQ %d status@%x %4.4x.\n", dev->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700780 dev->irq, ioaddr + EL3_STATUS, inw(ioaddr + EL3_STATUS));
781
782 el3_up(dev);
783
784 if (el3_debug > 3)
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700785 printk(KERN_DEBUG "%s: Opened 3c509 IRQ %d status %4.4x.\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700786 dev->name, dev->irq, inw(ioaddr + EL3_STATUS));
787
788 return 0;
789}
790
791static void
792el3_tx_timeout (struct net_device *dev)
793{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700794 int ioaddr = dev->base_addr;
795
796 /* Transmitter timeout, serious problems. */
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700797 printk(KERN_WARNING "%s: transmit timed out, Tx_status %2.2x status %4.4x "
Linus Torvalds1da177e2005-04-16 15:20:36 -0700798 "Tx FIFO room %d.\n",
799 dev->name, inb(ioaddr + TX_STATUS), inw(ioaddr + EL3_STATUS),
800 inw(ioaddr + TX_FREE));
Paulius Zaleckas815f8802008-04-29 02:45:43 +0300801 dev->stats.tx_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700802 dev->trans_start = jiffies;
803 /* Issue TX_RESET and TX_START commands. */
804 outw(TxReset, ioaddr + EL3_CMD);
805 outw(TxEnable, ioaddr + EL3_CMD);
806 netif_wake_queue(dev);
807}
808
809
810static int
811el3_start_xmit(struct sk_buff *skb, struct net_device *dev)
812{
813 struct el3_private *lp = netdev_priv(dev);
814 int ioaddr = dev->base_addr;
815 unsigned long flags;
816
817 netif_stop_queue (dev);
818
Paulius Zaleckas815f8802008-04-29 02:45:43 +0300819 dev->stats.tx_bytes += skb->len;
Jeff Garzik6aa20a22006-09-13 13:24:59 -0400820
Linus Torvalds1da177e2005-04-16 15:20:36 -0700821 if (el3_debug > 4) {
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700822 printk(KERN_DEBUG "%s: el3_start_xmit(length = %u) called, status %4.4x.\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700823 dev->name, skb->len, inw(ioaddr + EL3_STATUS));
824 }
825#if 0
826#ifndef final_version
827 { /* Error-checking code, delete someday. */
828 ushort status = inw(ioaddr + EL3_STATUS);
829 if (status & 0x0001 /* IRQ line active, missed one. */
830 && inw(ioaddr + EL3_STATUS) & 1) { /* Make sure. */
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700831 printk(KERN_DEBUG "%s: Missed interrupt, status then %04x now %04x"
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832 " Tx %2.2x Rx %4.4x.\n", dev->name, status,
833 inw(ioaddr + EL3_STATUS), inb(ioaddr + TX_STATUS),
834 inw(ioaddr + RX_STATUS));
835 /* Fake interrupt trigger by masking, acknowledge interrupts. */
836 outw(SetStatusEnb | 0x00, ioaddr + EL3_CMD);
837 outw(AckIntr | IntLatch | TxAvailable | RxEarly | IntReq,
838 ioaddr + EL3_CMD);
839 outw(SetStatusEnb | 0xff, ioaddr + EL3_CMD);
840 }
841 }
842#endif
843#endif
844 /*
845 * We lock the driver against other processors. Note
846 * we don't need to lock versus the IRQ as we suspended
847 * that. This means that we lose the ability to take
848 * an RX during a TX upload. That sucks a bit with SMP
849 * on an original 3c509 (2K buffer)
850 *
851 * Using disable_irq stops us crapping on other
852 * time sensitive devices.
853 */
854
855 spin_lock_irqsave(&lp->lock, flags);
856
857 /* Put out the doubleword header... */
858 outw(skb->len, ioaddr + TX_FIFO);
859 outw(0x00, ioaddr + TX_FIFO);
860 /* ... and the packet rounded to a doubleword. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700861 outsl(ioaddr + TX_FIFO, skb->data, (skb->len + 3) >> 2);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700862
863 dev->trans_start = jiffies;
864 if (inw(ioaddr + TX_FREE) > 1536)
865 netif_start_queue(dev);
866 else
867 /* Interrupt us when the FIFO has room for max-sized packet. */
868 outw(SetTxThreshold + 1536, ioaddr + EL3_CMD);
869
870 spin_unlock_irqrestore(&lp->lock, flags);
871
872 dev_kfree_skb (skb);
873
874 /* Clear the Tx status stack. */
875 {
876 short tx_status;
877 int i = 4;
878
879 while (--i > 0 && (tx_status = inb(ioaddr + TX_STATUS)) > 0) {
Paulius Zaleckas815f8802008-04-29 02:45:43 +0300880 if (tx_status & 0x38) dev->stats.tx_aborted_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700881 if (tx_status & 0x30) outw(TxReset, ioaddr + EL3_CMD);
882 if (tx_status & 0x3C) outw(TxEnable, ioaddr + EL3_CMD);
883 outb(0x00, ioaddr + TX_STATUS); /* Pop the status stack. */
884 }
885 }
886 return 0;
887}
888
889/* The EL3 interrupt handler. */
890static irqreturn_t
David Howells7d12e782006-10-05 14:55:46 +0100891el3_interrupt(int irq, void *dev_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700892{
Jeff Garzikc31f28e2006-10-06 14:56:04 -0400893 struct net_device *dev = dev_id;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700894 struct el3_private *lp;
895 int ioaddr, status;
896 int i = max_interrupt_work;
897
Linus Torvalds1da177e2005-04-16 15:20:36 -0700898 lp = netdev_priv(dev);
899 spin_lock(&lp->lock);
900
901 ioaddr = dev->base_addr;
902
903 if (el3_debug > 4) {
904 status = inw(ioaddr + EL3_STATUS);
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700905 printk(KERN_DEBUG "%s: interrupt, status %4.4x.\n", dev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700906 }
907
908 while ((status = inw(ioaddr + EL3_STATUS)) &
909 (IntLatch | RxComplete | StatsFull)) {
910
911 if (status & RxComplete)
912 el3_rx(dev);
913
914 if (status & TxAvailable) {
915 if (el3_debug > 5)
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700916 printk(KERN_DEBUG " TX room bit was handled.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700917 /* There's room in the FIFO for a full-sized packet. */
918 outw(AckIntr | TxAvailable, ioaddr + EL3_CMD);
919 netif_wake_queue (dev);
920 }
921 if (status & (AdapterFailure | RxEarly | StatsFull | TxComplete)) {
922 /* Handle all uncommon interrupts. */
923 if (status & StatsFull) /* Empty statistics. */
924 update_stats(dev);
925 if (status & RxEarly) { /* Rx early is unused. */
926 el3_rx(dev);
927 outw(AckIntr | RxEarly, ioaddr + EL3_CMD);
928 }
929 if (status & TxComplete) { /* Really Tx error. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700930 short tx_status;
931 int i = 4;
932
933 while (--i>0 && (tx_status = inb(ioaddr + TX_STATUS)) > 0) {
Paulius Zaleckas815f8802008-04-29 02:45:43 +0300934 if (tx_status & 0x38) dev->stats.tx_aborted_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700935 if (tx_status & 0x30) outw(TxReset, ioaddr + EL3_CMD);
936 if (tx_status & 0x3C) outw(TxEnable, ioaddr + EL3_CMD);
937 outb(0x00, ioaddr + TX_STATUS); /* Pop the status stack. */
938 }
939 }
940 if (status & AdapterFailure) {
941 /* Adapter failure requires Rx reset and reinit. */
942 outw(RxReset, ioaddr + EL3_CMD);
943 /* Set the Rx filter to the current state. */
944 outw(SetRxFilter | RxStation | RxBroadcast
945 | (dev->flags & IFF_ALLMULTI ? RxMulticast : 0)
946 | (dev->flags & IFF_PROMISC ? RxProm : 0),
947 ioaddr + EL3_CMD);
948 outw(RxEnable, ioaddr + EL3_CMD); /* Re-enable the receiver. */
949 outw(AckIntr | AdapterFailure, ioaddr + EL3_CMD);
950 }
951 }
952
953 if (--i < 0) {
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700954 printk(KERN_ERR "%s: Infinite loop in interrupt, status %4.4x.\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700955 dev->name, status);
956 /* Clear all interrupts. */
957 outw(AckIntr | 0xFF, ioaddr + EL3_CMD);
958 break;
959 }
960 /* Acknowledge the IRQ. */
961 outw(AckIntr | IntReq | IntLatch, ioaddr + EL3_CMD); /* Ack IRQ */
962 }
963
964 if (el3_debug > 4) {
Ondrej Zaryac4bed12008-03-28 14:41:23 -0700965 printk(KERN_DEBUG "%s: exiting interrupt, status %4.4x.\n", dev->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700966 inw(ioaddr + EL3_STATUS));
967 }
968 spin_unlock(&lp->lock);
969 return IRQ_HANDLED;
970}
971
972
973#ifdef CONFIG_NET_POLL_CONTROLLER
974/*
975 * Polling receive - used by netconsole and other diagnostic tools
976 * to allow network i/o with interrupts disabled.
977 */
978static void el3_poll_controller(struct net_device *dev)
979{
980 disable_irq(dev->irq);
David Howells7d12e782006-10-05 14:55:46 +0100981 el3_interrupt(dev->irq, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700982 enable_irq(dev->irq);
983}
984#endif
985
986static struct net_device_stats *
987el3_get_stats(struct net_device *dev)
988{
989 struct el3_private *lp = netdev_priv(dev);
990 unsigned long flags;
991
992 /*
993 * This is fast enough not to bother with disable IRQ
994 * stuff.
995 */
Jeff Garzik6aa20a22006-09-13 13:24:59 -0400996
Linus Torvalds1da177e2005-04-16 15:20:36 -0700997 spin_lock_irqsave(&lp->lock, flags);
998 update_stats(dev);
999 spin_unlock_irqrestore(&lp->lock, flags);
Paulius Zaleckas815f8802008-04-29 02:45:43 +03001000 return &dev->stats;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001001}
1002
1003/* Update statistics. We change to register window 6, so this should be run
1004 single-threaded if the device is active. This is expected to be a rare
1005 operation, and it's simpler for the rest of the driver to assume that
1006 window 1 is always valid rather than use a special window-state variable.
1007 */
1008static void update_stats(struct net_device *dev)
1009{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001010 int ioaddr = dev->base_addr;
1011
1012 if (el3_debug > 5)
1013 printk(" Updating the statistics.\n");
1014 /* Turn off statistics updates while reading. */
1015 outw(StatsDisable, ioaddr + EL3_CMD);
1016 /* Switch to the stats window, and read everything. */
1017 EL3WINDOW(6);
Paulius Zaleckas815f8802008-04-29 02:45:43 +03001018 dev->stats.tx_carrier_errors += inb(ioaddr + 0);
1019 dev->stats.tx_heartbeat_errors += inb(ioaddr + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001020 /* Multiple collisions. */ inb(ioaddr + 2);
Paulius Zaleckas815f8802008-04-29 02:45:43 +03001021 dev->stats.collisions += inb(ioaddr + 3);
1022 dev->stats.tx_window_errors += inb(ioaddr + 4);
1023 dev->stats.rx_fifo_errors += inb(ioaddr + 5);
1024 dev->stats.tx_packets += inb(ioaddr + 6);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001025 /* Rx packets */ inb(ioaddr + 7);
1026 /* Tx deferrals */ inb(ioaddr + 8);
1027 inw(ioaddr + 10); /* Total Rx and Tx octets. */
1028 inw(ioaddr + 12);
1029
1030 /* Back to window 1, and turn statistics back on. */
1031 EL3WINDOW(1);
1032 outw(StatsEnable, ioaddr + EL3_CMD);
1033 return;
1034}
1035
1036static int
1037el3_rx(struct net_device *dev)
1038{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039 int ioaddr = dev->base_addr;
1040 short rx_status;
1041
1042 if (el3_debug > 5)
1043 printk(" In rx_packet(), status %4.4x, rx_status %4.4x.\n",
1044 inw(ioaddr+EL3_STATUS), inw(ioaddr+RX_STATUS));
1045 while ((rx_status = inw(ioaddr + RX_STATUS)) > 0) {
1046 if (rx_status & 0x4000) { /* Error, update stats. */
1047 short error = rx_status & 0x3800;
1048
1049 outw(RxDiscard, ioaddr + EL3_CMD);
Paulius Zaleckas815f8802008-04-29 02:45:43 +03001050 dev->stats.rx_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001051 switch (error) {
Paulius Zaleckas815f8802008-04-29 02:45:43 +03001052 case 0x0000: dev->stats.rx_over_errors++; break;
1053 case 0x0800: dev->stats.rx_length_errors++; break;
1054 case 0x1000: dev->stats.rx_frame_errors++; break;
1055 case 0x1800: dev->stats.rx_length_errors++; break;
1056 case 0x2000: dev->stats.rx_frame_errors++; break;
1057 case 0x2800: dev->stats.rx_crc_errors++; break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001058 }
1059 } else {
1060 short pkt_len = rx_status & 0x7ff;
1061 struct sk_buff *skb;
1062
1063 skb = dev_alloc_skb(pkt_len+5);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001064 if (el3_debug > 4)
1065 printk("Receiving packet size %d status %4.4x.\n",
1066 pkt_len, rx_status);
1067 if (skb != NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001068 skb_reserve(skb, 2); /* Align IP on 16 byte */
1069
1070 /* 'skb->data' points to the start of sk_buff data area. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001071 insl(ioaddr + RX_FIFO, skb_put(skb,pkt_len),
1072 (pkt_len + 3) >> 2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001073
1074 outw(RxDiscard, ioaddr + EL3_CMD); /* Pop top Rx packet. */
1075 skb->protocol = eth_type_trans(skb,dev);
1076 netif_rx(skb);
Wang Chenf7f312a2008-05-20 17:13:52 +08001077 dev->stats.rx_bytes += pkt_len;
Paulius Zaleckas815f8802008-04-29 02:45:43 +03001078 dev->stats.rx_packets++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001079 continue;
1080 }
1081 outw(RxDiscard, ioaddr + EL3_CMD);
Paulius Zaleckas815f8802008-04-29 02:45:43 +03001082 dev->stats.rx_dropped++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001083 if (el3_debug)
1084 printk("%s: Couldn't allocate a sk_buff of size %d.\n",
1085 dev->name, pkt_len);
1086 }
1087 inw(ioaddr + EL3_STATUS); /* Delay. */
1088 while (inw(ioaddr + EL3_STATUS) & 0x1000)
1089 printk(KERN_DEBUG " Waiting for 3c509 to discard packet, status %x.\n",
1090 inw(ioaddr + EL3_STATUS) );
1091 }
1092
1093 return 0;
1094}
1095
1096/*
1097 * Set or clear the multicast filter for this adaptor.
1098 */
1099static void
1100set_multicast_list(struct net_device *dev)
1101{
1102 unsigned long flags;
1103 struct el3_private *lp = netdev_priv(dev);
1104 int ioaddr = dev->base_addr;
1105
1106 if (el3_debug > 1) {
1107 static int old;
1108 if (old != dev->mc_count) {
1109 old = dev->mc_count;
1110 printk("%s: Setting Rx mode to %d addresses.\n", dev->name, dev->mc_count);
1111 }
1112 }
1113 spin_lock_irqsave(&lp->lock, flags);
1114 if (dev->flags&IFF_PROMISC) {
1115 outw(SetRxFilter | RxStation | RxMulticast | RxBroadcast | RxProm,
1116 ioaddr + EL3_CMD);
1117 }
1118 else if (dev->mc_count || (dev->flags&IFF_ALLMULTI)) {
1119 outw(SetRxFilter | RxStation | RxMulticast | RxBroadcast, ioaddr + EL3_CMD);
1120 }
1121 else
1122 outw(SetRxFilter | RxStation | RxBroadcast, ioaddr + EL3_CMD);
1123 spin_unlock_irqrestore(&lp->lock, flags);
1124}
1125
1126static int
1127el3_close(struct net_device *dev)
1128{
1129 int ioaddr = dev->base_addr;
1130 struct el3_private *lp = netdev_priv(dev);
Jeff Garzik6aa20a22006-09-13 13:24:59 -04001131
Linus Torvalds1da177e2005-04-16 15:20:36 -07001132 if (el3_debug > 2)
1133 printk("%s: Shutting down ethercard.\n", dev->name);
1134
1135 el3_down(dev);
1136
1137 free_irq(dev->irq, dev);
1138 /* Switching back to window 0 disables the IRQ. */
1139 EL3WINDOW(0);
1140 if (lp->type != EL3_EISA) {
1141 /* But we explicitly zero the IRQ line select anyway. Don't do
1142 * it on EISA cards, it prevents the module from getting an
1143 * IRQ after unload+reload... */
1144 outw(0x0f00, ioaddr + WN0_IRQ);
1145 }
1146
1147 return 0;
1148}
1149
Jeff Garzik6aa20a22006-09-13 13:24:59 -04001150static int
Linus Torvalds1da177e2005-04-16 15:20:36 -07001151el3_link_ok(struct net_device *dev)
1152{
1153 int ioaddr = dev->base_addr;
1154 u16 tmp;
1155
1156 EL3WINDOW(4);
1157 tmp = inw(ioaddr + WN4_MEDIA);
1158 EL3WINDOW(1);
1159 return tmp & (1<<11);
1160}
1161
1162static int
1163el3_netdev_get_ecmd(struct net_device *dev, struct ethtool_cmd *ecmd)
1164{
1165 u16 tmp;
1166 int ioaddr = dev->base_addr;
Jeff Garzik6aa20a22006-09-13 13:24:59 -04001167
Linus Torvalds1da177e2005-04-16 15:20:36 -07001168 EL3WINDOW(0);
Jeff Garzik6aa20a22006-09-13 13:24:59 -04001169 /* obtain current transceiver via WN4_MEDIA? */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001170 tmp = inw(ioaddr + WN0_ADDR_CONF);
1171 ecmd->transceiver = XCVR_INTERNAL;
1172 switch (tmp >> 14) {
1173 case 0:
1174 ecmd->port = PORT_TP;
1175 break;
1176 case 1:
1177 ecmd->port = PORT_AUI;
1178 ecmd->transceiver = XCVR_EXTERNAL;
1179 break;
1180 case 3:
1181 ecmd->port = PORT_BNC;
1182 default:
1183 break;
1184 }
1185
1186 ecmd->duplex = DUPLEX_HALF;
1187 ecmd->supported = 0;
1188 tmp = inw(ioaddr + WN0_CONF_CTRL);
1189 if (tmp & (1<<13))
1190 ecmd->supported |= SUPPORTED_AUI;
1191 if (tmp & (1<<12))
1192 ecmd->supported |= SUPPORTED_BNC;
1193 if (tmp & (1<<9)) {
1194 ecmd->supported |= SUPPORTED_TP | SUPPORTED_10baseT_Half |
1195 SUPPORTED_10baseT_Full; /* hmm... */
1196 EL3WINDOW(4);
1197 tmp = inw(ioaddr + WN4_NETDIAG);
1198 if (tmp & FD_ENABLE)
1199 ecmd->duplex = DUPLEX_FULL;
1200 }
1201
1202 ecmd->speed = SPEED_10;
1203 EL3WINDOW(1);
1204 return 0;
1205}
1206
1207static int
1208el3_netdev_set_ecmd(struct net_device *dev, struct ethtool_cmd *ecmd)
1209{
1210 u16 tmp;
1211 int ioaddr = dev->base_addr;
1212
1213 if (ecmd->speed != SPEED_10)
1214 return -EINVAL;
1215 if ((ecmd->duplex != DUPLEX_HALF) && (ecmd->duplex != DUPLEX_FULL))
1216 return -EINVAL;
1217 if ((ecmd->transceiver != XCVR_INTERNAL) && (ecmd->transceiver != XCVR_EXTERNAL))
1218 return -EINVAL;
1219
1220 /* change XCVR type */
1221 EL3WINDOW(0);
1222 tmp = inw(ioaddr + WN0_ADDR_CONF);
1223 switch (ecmd->port) {
1224 case PORT_TP:
1225 tmp &= ~(3<<14);
1226 dev->if_port = 0;
1227 break;
1228 case PORT_AUI:
1229 tmp |= (1<<14);
1230 dev->if_port = 1;
1231 break;
1232 case PORT_BNC:
1233 tmp |= (3<<14);
1234 dev->if_port = 3;
1235 break;
1236 default:
1237 return -EINVAL;
1238 }
1239
1240 outw(tmp, ioaddr + WN0_ADDR_CONF);
1241 if (dev->if_port == 3) {
1242 /* fire up the DC-DC convertor if BNC gets enabled */
1243 tmp = inw(ioaddr + WN0_ADDR_CONF);
1244 if (tmp & (3 << 14)) {
1245 outw(StartCoax, ioaddr + EL3_CMD);
1246 udelay(800);
1247 } else
1248 return -EIO;
1249 }
1250
1251 EL3WINDOW(4);
1252 tmp = inw(ioaddr + WN4_NETDIAG);
1253 if (ecmd->duplex == DUPLEX_FULL)
1254 tmp |= FD_ENABLE;
1255 else
1256 tmp &= ~FD_ENABLE;
1257 outw(tmp, ioaddr + WN4_NETDIAG);
1258 EL3WINDOW(1);
1259
1260 return 0;
1261}
1262
1263static void el3_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
1264{
1265 strcpy(info->driver, DRV_NAME);
1266 strcpy(info->version, DRV_VERSION);
1267}
1268
1269static int el3_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
1270{
1271 struct el3_private *lp = netdev_priv(dev);
1272 int ret;
1273
1274 spin_lock_irq(&lp->lock);
1275 ret = el3_netdev_get_ecmd(dev, ecmd);
1276 spin_unlock_irq(&lp->lock);
1277 return ret;
1278}
1279
1280static int el3_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd)
1281{
1282 struct el3_private *lp = netdev_priv(dev);
1283 int ret;
1284
1285 spin_lock_irq(&lp->lock);
1286 ret = el3_netdev_set_ecmd(dev, ecmd);
1287 spin_unlock_irq(&lp->lock);
1288 return ret;
1289}
1290
1291static u32 el3_get_link(struct net_device *dev)
1292{
1293 struct el3_private *lp = netdev_priv(dev);
1294 u32 ret;
1295
1296 spin_lock_irq(&lp->lock);
1297 ret = el3_link_ok(dev);
1298 spin_unlock_irq(&lp->lock);
1299 return ret;
1300}
1301
1302static u32 el3_get_msglevel(struct net_device *dev)
1303{
1304 return el3_debug;
1305}
1306
1307static void el3_set_msglevel(struct net_device *dev, u32 v)
1308{
1309 el3_debug = v;
1310}
1311
Jeff Garzik7282d492006-09-13 14:30:00 -04001312static const struct ethtool_ops ethtool_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001313 .get_drvinfo = el3_get_drvinfo,
1314 .get_settings = el3_get_settings,
1315 .set_settings = el3_set_settings,
1316 .get_link = el3_get_link,
1317 .get_msglevel = el3_get_msglevel,
1318 .set_msglevel = el3_set_msglevel,
1319};
1320
1321static void
1322el3_down(struct net_device *dev)
1323{
1324 int ioaddr = dev->base_addr;
1325
1326 netif_stop_queue(dev);
1327
1328 /* Turn off statistics ASAP. We update lp->stats below. */
1329 outw(StatsDisable, ioaddr + EL3_CMD);
1330
1331 /* Disable the receiver and transmitter. */
1332 outw(RxDisable, ioaddr + EL3_CMD);
1333 outw(TxDisable, ioaddr + EL3_CMD);
1334
1335 if (dev->if_port == 3)
1336 /* Turn off thinnet power. Green! */
1337 outw(StopCoax, ioaddr + EL3_CMD);
1338 else if (dev->if_port == 0) {
1339 /* Disable link beat and jabber, if_port may change here next open(). */
1340 EL3WINDOW(4);
1341 outw(inw(ioaddr + WN4_MEDIA) & ~MEDIA_TP, ioaddr + WN4_MEDIA);
1342 }
1343
1344 outw(SetIntrEnb | 0x0000, ioaddr + EL3_CMD);
1345
1346 update_stats(dev);
1347}
1348
1349static void
1350el3_up(struct net_device *dev)
1351{
1352 int i, sw_info, net_diag;
1353 int ioaddr = dev->base_addr;
Jeff Garzik6aa20a22006-09-13 13:24:59 -04001354
Linus Torvalds1da177e2005-04-16 15:20:36 -07001355 /* Activating the board required and does no harm otherwise */
1356 outw(0x0001, ioaddr + 4);
1357
1358 /* Set the IRQ line. */
1359 outw((dev->irq << 12) | 0x0f00, ioaddr + WN0_IRQ);
1360
1361 /* Set the station address in window 2 each time opened. */
1362 EL3WINDOW(2);
1363
1364 for (i = 0; i < 6; i++)
1365 outb(dev->dev_addr[i], ioaddr + i);
1366
1367 if ((dev->if_port & 0x03) == 3) /* BNC interface */
1368 /* Start the thinnet transceiver. We should really wait 50ms...*/
1369 outw(StartCoax, ioaddr + EL3_CMD);
1370 else if ((dev->if_port & 0x03) == 0) { /* 10baseT interface */
1371 /* Combine secondary sw_info word (the adapter level) and primary
1372 sw_info word (duplex setting plus other useless bits) */
1373 EL3WINDOW(0);
Jeff Garzik6aa20a22006-09-13 13:24:59 -04001374 sw_info = (read_eeprom(ioaddr, 0x14) & 0x400f) |
Linus Torvalds1da177e2005-04-16 15:20:36 -07001375 (read_eeprom(ioaddr, 0x0d) & 0xBff0);
1376
1377 EL3WINDOW(4);
1378 net_diag = inw(ioaddr + WN4_NETDIAG);
1379 net_diag = (net_diag | FD_ENABLE); /* temporarily assume full-duplex will be set */
1380 printk("%s: ", dev->name);
1381 switch (dev->if_port & 0x0c) {
1382 case 12:
1383 /* force full-duplex mode if 3c5x9b */
1384 if (sw_info & 0x000f) {
1385 printk("Forcing 3c5x9b full-duplex mode");
1386 break;
1387 }
1388 case 8:
1389 /* set full-duplex mode based on eeprom config setting */
1390 if ((sw_info & 0x000f) && (sw_info & 0x8000)) {
1391 printk("Setting 3c5x9b full-duplex mode (from EEPROM configuration bit)");
1392 break;
1393 }
1394 default:
1395 /* xcvr=(0 || 4) OR user has an old 3c5x9 non "B" model */
1396 printk("Setting 3c5x9/3c5x9B half-duplex mode");
1397 net_diag = (net_diag & ~FD_ENABLE); /* disable full duplex */
1398 }
1399
1400 outw(net_diag, ioaddr + WN4_NETDIAG);
1401 printk(" if_port: %d, sw_info: %4.4x\n", dev->if_port, sw_info);
1402 if (el3_debug > 3)
1403 printk("%s: 3c5x9 net diag word is now: %4.4x.\n", dev->name, net_diag);
1404 /* Enable link beat and jabber check. */
1405 outw(inw(ioaddr + WN4_MEDIA) | MEDIA_TP, ioaddr + WN4_MEDIA);
1406 }
1407
1408 /* Switch to the stats window, and clear all stats by reading. */
1409 outw(StatsDisable, ioaddr + EL3_CMD);
1410 EL3WINDOW(6);
1411 for (i = 0; i < 9; i++)
1412 inb(ioaddr + i);
1413 inw(ioaddr + 10);
1414 inw(ioaddr + 12);
1415
1416 /* Switch to register set 1 for normal use. */
1417 EL3WINDOW(1);
1418
1419 /* Accept b-case and phys addr only. */
1420 outw(SetRxFilter | RxStation | RxBroadcast, ioaddr + EL3_CMD);
1421 outw(StatsEnable, ioaddr + EL3_CMD); /* Turn on statistics. */
1422
1423 outw(RxEnable, ioaddr + EL3_CMD); /* Enable the receiver. */
1424 outw(TxEnable, ioaddr + EL3_CMD); /* Enable transmitter. */
1425 /* Allow status bits to be seen. */
1426 outw(SetStatusEnb | 0xff, ioaddr + EL3_CMD);
1427 /* Ack all pending events, and set active indicator mask. */
1428 outw(AckIntr | IntLatch | TxAvailable | RxEarly | IntReq,
1429 ioaddr + EL3_CMD);
1430 outw(SetIntrEnb | IntLatch|TxAvailable|TxComplete|RxComplete|StatsFull,
1431 ioaddr + EL3_CMD);
1432
1433 netif_start_queue(dev);
1434}
1435
1436/* Power Management support functions */
Ondrej Zaryac4bed12008-03-28 14:41:23 -07001437#ifdef CONFIG_PM
Linus Torvalds1da177e2005-04-16 15:20:36 -07001438
1439static int
Pekka Enberg60a89ff2006-03-08 00:06:28 -08001440el3_suspend(struct device *pdev, pm_message_t state)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001441{
1442 unsigned long flags;
1443 struct net_device *dev;
1444 struct el3_private *lp;
1445 int ioaddr;
Jeff Garzik6aa20a22006-09-13 13:24:59 -04001446
Pekka Enberg60a89ff2006-03-08 00:06:28 -08001447 dev = pdev->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001448 lp = netdev_priv(dev);
1449 ioaddr = dev->base_addr;
1450
1451 spin_lock_irqsave(&lp->lock, flags);
1452
1453 if (netif_running(dev))
1454 netif_device_detach(dev);
1455
1456 el3_down(dev);
1457 outw(PowerDown, ioaddr + EL3_CMD);
1458
1459 spin_unlock_irqrestore(&lp->lock, flags);
1460 return 0;
1461}
1462
1463static int
Pekka Enberg60a89ff2006-03-08 00:06:28 -08001464el3_resume(struct device *pdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001465{
1466 unsigned long flags;
1467 struct net_device *dev;
1468 struct el3_private *lp;
1469 int ioaddr;
Jeff Garzik6aa20a22006-09-13 13:24:59 -04001470
Pekka Enberg60a89ff2006-03-08 00:06:28 -08001471 dev = pdev->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001472 lp = netdev_priv(dev);
1473 ioaddr = dev->base_addr;
1474
1475 spin_lock_irqsave(&lp->lock, flags);
1476
1477 outw(PowerUp, ioaddr + EL3_CMD);
Ondrej Zary152abd12009-02-06 22:04:08 -08001478 EL3WINDOW(0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001479 el3_up(dev);
1480
1481 if (netif_running(dev))
1482 netif_device_attach(dev);
Jeff Garzik6aa20a22006-09-13 13:24:59 -04001483
Linus Torvalds1da177e2005-04-16 15:20:36 -07001484 spin_unlock_irqrestore(&lp->lock, flags);
1485 return 0;
1486}
1487
Ondrej Zaryac4bed12008-03-28 14:41:23 -07001488#endif /* CONFIG_PM */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001489
1490module_param(debug,int, 0);
1491module_param_array(irq, int, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001492module_param(max_interrupt_work, int, 0);
1493MODULE_PARM_DESC(debug, "debug level (0-6)");
1494MODULE_PARM_DESC(irq, "IRQ number(s) (assigned)");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001495MODULE_PARM_DESC(max_interrupt_work, "maximum events handled per interrupt");
Ondrej Zaryac4bed12008-03-28 14:41:23 -07001496#ifdef CONFIG_PNP
Linus Torvalds1da177e2005-04-16 15:20:36 -07001497module_param(nopnp, int, 0);
1498MODULE_PARM_DESC(nopnp, "disable ISA PnP support (0-1)");
Ondrej Zaryac4bed12008-03-28 14:41:23 -07001499#endif /* CONFIG_PNP */
1500MODULE_DESCRIPTION("3Com Etherlink III (3c509, 3c509B, 3c529, 3c579) ethernet driver");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001501MODULE_LICENSE("GPL");
1502
1503static int __init el3_init_module(void)
1504{
Andrew Morton0992a5d2006-03-08 00:06:27 -08001505 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001506
1507 if (debug >= 0)
1508 el3_debug = debug;
1509
Ondrej Zaryac4bed12008-03-28 14:41:23 -07001510#ifdef CONFIG_PNP
1511 if (!nopnp) {
1512 ret = pnp_register_driver(&el3_pnp_driver);
1513 if (!ret)
1514 pnp_registered = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001515 }
Ondrej Zaryac4bed12008-03-28 14:41:23 -07001516#endif
1517 /* Select an open I/O location at 0x1*0 to do ISA contention select. */
1518 /* Start with 0x110 to avoid some sound cards.*/
1519 for (id_port = 0x110 ; id_port < 0x200; id_port += 0x10) {
1520 if (!request_region(id_port, 1, "3c509-control"))
1521 continue;
1522 outb(0x00, id_port);
1523 outb(0xff, id_port);
1524 if (inb(id_port) & 0x01)
1525 break;
1526 else
1527 release_region(id_port, 1);
1528 }
1529 if (id_port >= 0x200) {
1530 id_port = 0;
1531 printk(KERN_ERR "No I/O port available for 3c509 activation.\n");
1532 } else {
1533 ret = isa_register_driver(&el3_isa_driver, EL3_MAX_CARDS);
1534 if (!ret)
1535 isa_registered = 1;
1536 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001537#ifdef CONFIG_EISA
Andrew Morton0992a5d2006-03-08 00:06:27 -08001538 ret = eisa_driver_register(&el3_eisa_driver);
Ondrej Zaryac4bed12008-03-28 14:41:23 -07001539 if (!ret)
1540 eisa_registered = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001541#endif
1542#ifdef CONFIG_MCA
Ondrej Zaryac4bed12008-03-28 14:41:23 -07001543 ret = mca_register_driver(&el3_mca_driver);
1544 if (!ret)
1545 mca_registered = 1;
1546#endif
1547
1548#ifdef CONFIG_PNP
1549 if (pnp_registered)
1550 ret = 0;
1551#endif
1552 if (isa_registered)
1553 ret = 0;
1554#ifdef CONFIG_EISA
1555 if (eisa_registered)
1556 ret = 0;
1557#endif
1558#ifdef CONFIG_MCA
1559 if (mca_registered)
1560 ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001561#endif
Andrew Morton0992a5d2006-03-08 00:06:27 -08001562 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001563}
1564
1565static void __exit el3_cleanup_module(void)
1566{
Ondrej Zaryac4bed12008-03-28 14:41:23 -07001567#ifdef CONFIG_PNP
1568 if (pnp_registered)
1569 pnp_unregister_driver(&el3_pnp_driver);
1570#endif
1571 if (isa_registered)
1572 isa_unregister_driver(&el3_isa_driver);
1573 if (id_port)
1574 release_region(id_port, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001575#ifdef CONFIG_EISA
Ondrej Zaryac4bed12008-03-28 14:41:23 -07001576 if (eisa_registered)
1577 eisa_driver_unregister(&el3_eisa_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001578#endif
1579#ifdef CONFIG_MCA
Ondrej Zaryac4bed12008-03-28 14:41:23 -07001580 if (mca_registered)
1581 mca_unregister_driver(&el3_mca_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001582#endif
1583}
1584
1585module_init (el3_init_module);
1586module_exit (el3_cleanup_module);