1*4882a593Smuzhiyun /* 3c509.c: A 3c509 EtherLink3 ethernet driver for linux. */
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun Written 1993-2000 by Donald Becker.
4*4882a593Smuzhiyun
5*4882a593Smuzhiyun Copyright 1994-2000 by Donald Becker.
6*4882a593Smuzhiyun Copyright 1993 United States Government as represented by the
7*4882a593Smuzhiyun Director, National Security Agency. This software may be used and
8*4882a593Smuzhiyun distributed according to the terms of the GNU General Public License,
9*4882a593Smuzhiyun incorporated herein by reference.
10*4882a593Smuzhiyun
11*4882a593Smuzhiyun This driver is for the 3Com EtherLinkIII series.
12*4882a593Smuzhiyun
13*4882a593Smuzhiyun The author may be reached as becker@scyld.com, or C/O
14*4882a593Smuzhiyun Scyld Computing Corporation
15*4882a593Smuzhiyun 410 Severn Ave., Suite 210
16*4882a593Smuzhiyun Annapolis MD 21403
17*4882a593Smuzhiyun
18*4882a593Smuzhiyun Known limitations:
19*4882a593Smuzhiyun Because of the way 3c509 ISA detection works it's difficult to predict
20*4882a593Smuzhiyun a priori which of several ISA-mode cards will be detected first.
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun This driver does not use predictive interrupt mode, resulting in higher
23*4882a593Smuzhiyun packet latency but lower overhead. If interrupts are disabled for an
24*4882a593Smuzhiyun unusually long time it could also result in missed packets, but in
25*4882a593Smuzhiyun practice this rarely happens.
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun
28*4882a593Smuzhiyun FIXES:
29*4882a593Smuzhiyun Alan Cox: Removed the 'Unexpected interrupt' bug.
30*4882a593Smuzhiyun Michael Meskes: Upgraded to Donald Becker's version 1.07.
31*4882a593Smuzhiyun Alan Cox: Increased the eeprom delay. Regardless of
32*4882a593Smuzhiyun what the docs say some people definitely
33*4882a593Smuzhiyun get problems with lower (but in card spec)
34*4882a593Smuzhiyun delays
35*4882a593Smuzhiyun v1.10 4/21/97 Fixed module code so that multiple cards may be detected,
36*4882a593Smuzhiyun other cleanups. -djb
37*4882a593Smuzhiyun Andrea Arcangeli: Upgraded to Donald Becker's version 1.12.
38*4882a593Smuzhiyun Rick Payne: Fixed SMP race condition
39*4882a593Smuzhiyun v1.13 9/8/97 Made 'max_interrupt_work' an insmod-settable variable -djb
40*4882a593Smuzhiyun v1.14 10/15/97 Avoided waiting..discard message for fast machines -djb
41*4882a593Smuzhiyun v1.15 1/31/98 Faster recovery for Tx errors. -djb
42*4882a593Smuzhiyun v1.16 2/3/98 Different ID port handling to avoid sound cards. -djb
43*4882a593Smuzhiyun v1.18 12Mar2001 Andrew Morton
44*4882a593Smuzhiyun - Avoid bogus detect of 3c590's (Andrzej Krzysztofowicz)
45*4882a593Smuzhiyun - Reviewed against 1.18 from scyld.com
46*4882a593Smuzhiyun v1.18a 17Nov2001 Jeff Garzik <jgarzik@pobox.com>
47*4882a593Smuzhiyun - ethtool support
48*4882a593Smuzhiyun v1.18b 1Mar2002 Zwane Mwaikambo <zwane@commfireservices.com>
49*4882a593Smuzhiyun - Power Management support
50*4882a593Smuzhiyun v1.18c 1Mar2002 David Ruggiero <jdr@farfalle.com>
51*4882a593Smuzhiyun - Full duplex support
52*4882a593Smuzhiyun v1.19 16Oct2002 Zwane Mwaikambo <zwane@linuxpower.ca>
53*4882a593Smuzhiyun - Additional ethtool features
54*4882a593Smuzhiyun v1.19a 28Oct2002 Davud Ruggiero <jdr@farfalle.com>
55*4882a593Smuzhiyun - Increase *read_eeprom udelay to workaround oops with 2 cards.
56*4882a593Smuzhiyun v1.19b 08Nov2002 Marc Zyngier <maz@wild-wind.fr.eu.org>
57*4882a593Smuzhiyun - Introduce driver model for EISA cards.
58*4882a593Smuzhiyun v1.20 04Feb2008 Ondrej Zary <linux@rainbow-software.org>
59*4882a593Smuzhiyun - convert to isa_driver and pnp_driver and some cleanups
60*4882a593Smuzhiyun */
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun #define DRV_NAME "3c509"
63*4882a593Smuzhiyun
64*4882a593Smuzhiyun /* A few values that may be tweaked. */
65*4882a593Smuzhiyun
66*4882a593Smuzhiyun /* Time in jiffies before concluding the transmitter is hung. */
67*4882a593Smuzhiyun #define TX_TIMEOUT (400*HZ/1000)
68*4882a593Smuzhiyun
69*4882a593Smuzhiyun #include <linux/module.h>
70*4882a593Smuzhiyun #include <linux/isa.h>
71*4882a593Smuzhiyun #include <linux/pnp.h>
72*4882a593Smuzhiyun #include <linux/string.h>
73*4882a593Smuzhiyun #include <linux/interrupt.h>
74*4882a593Smuzhiyun #include <linux/errno.h>
75*4882a593Smuzhiyun #include <linux/in.h>
76*4882a593Smuzhiyun #include <linux/ioport.h>
77*4882a593Smuzhiyun #include <linux/init.h>
78*4882a593Smuzhiyun #include <linux/netdevice.h>
79*4882a593Smuzhiyun #include <linux/etherdevice.h>
80*4882a593Smuzhiyun #include <linux/pm.h>
81*4882a593Smuzhiyun #include <linux/skbuff.h>
82*4882a593Smuzhiyun #include <linux/delay.h> /* for udelay() */
83*4882a593Smuzhiyun #include <linux/spinlock.h>
84*4882a593Smuzhiyun #include <linux/ethtool.h>
85*4882a593Smuzhiyun #include <linux/device.h>
86*4882a593Smuzhiyun #include <linux/eisa.h>
87*4882a593Smuzhiyun #include <linux/bitops.h>
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun #include <linux/uaccess.h>
90*4882a593Smuzhiyun #include <asm/io.h>
91*4882a593Smuzhiyun #include <asm/irq.h>
92*4882a593Smuzhiyun
93*4882a593Smuzhiyun #ifdef EL3_DEBUG
94*4882a593Smuzhiyun static int el3_debug = EL3_DEBUG;
95*4882a593Smuzhiyun #else
96*4882a593Smuzhiyun static int el3_debug = 2;
97*4882a593Smuzhiyun #endif
98*4882a593Smuzhiyun
99*4882a593Smuzhiyun /* Used to do a global count of all the cards in the system. Must be
100*4882a593Smuzhiyun * a global variable so that the eisa probe routines can increment
101*4882a593Smuzhiyun * it */
102*4882a593Smuzhiyun static int el3_cards = 0;
103*4882a593Smuzhiyun #define EL3_MAX_CARDS 8
104*4882a593Smuzhiyun
105*4882a593Smuzhiyun /* To minimize the size of the driver source I only define operating
106*4882a593Smuzhiyun constants if they are used several times. You'll need the manual
107*4882a593Smuzhiyun anyway if you want to understand driver details. */
108*4882a593Smuzhiyun /* Offsets from base I/O address. */
109*4882a593Smuzhiyun #define EL3_DATA 0x00
110*4882a593Smuzhiyun #define EL3_CMD 0x0e
111*4882a593Smuzhiyun #define EL3_STATUS 0x0e
112*4882a593Smuzhiyun #define EEPROM_READ 0x80
113*4882a593Smuzhiyun
114*4882a593Smuzhiyun #define EL3_IO_EXTENT 16
115*4882a593Smuzhiyun
116*4882a593Smuzhiyun #define EL3WINDOW(win_num) outw(SelectWindow + (win_num), ioaddr + EL3_CMD)
117*4882a593Smuzhiyun
118*4882a593Smuzhiyun
119*4882a593Smuzhiyun /* The top five bits written to EL3_CMD are a command, the lower
120*4882a593Smuzhiyun 11 bits are the parameter, if applicable. */
121*4882a593Smuzhiyun enum c509cmd {
122*4882a593Smuzhiyun TotalReset = 0<<11, SelectWindow = 1<<11, StartCoax = 2<<11,
123*4882a593Smuzhiyun RxDisable = 3<<11, RxEnable = 4<<11, RxReset = 5<<11, RxDiscard = 8<<11,
124*4882a593Smuzhiyun TxEnable = 9<<11, TxDisable = 10<<11, TxReset = 11<<11,
125*4882a593Smuzhiyun FakeIntr = 12<<11, AckIntr = 13<<11, SetIntrEnb = 14<<11,
126*4882a593Smuzhiyun SetStatusEnb = 15<<11, SetRxFilter = 16<<11, SetRxThreshold = 17<<11,
127*4882a593Smuzhiyun SetTxThreshold = 18<<11, SetTxStart = 19<<11, StatsEnable = 21<<11,
128*4882a593Smuzhiyun StatsDisable = 22<<11, StopCoax = 23<<11, PowerUp = 27<<11,
129*4882a593Smuzhiyun PowerDown = 28<<11, PowerAuto = 29<<11};
130*4882a593Smuzhiyun
131*4882a593Smuzhiyun enum c509status {
132*4882a593Smuzhiyun IntLatch = 0x0001, AdapterFailure = 0x0002, TxComplete = 0x0004,
133*4882a593Smuzhiyun TxAvailable = 0x0008, RxComplete = 0x0010, RxEarly = 0x0020,
134*4882a593Smuzhiyun IntReq = 0x0040, StatsFull = 0x0080, CmdBusy = 0x1000, };
135*4882a593Smuzhiyun
136*4882a593Smuzhiyun /* The SetRxFilter command accepts the following classes: */
137*4882a593Smuzhiyun enum RxFilter {
138*4882a593Smuzhiyun RxStation = 1, RxMulticast = 2, RxBroadcast = 4, RxProm = 8 };
139*4882a593Smuzhiyun
140*4882a593Smuzhiyun /* Register window 1 offsets, the window used in normal operation. */
141*4882a593Smuzhiyun #define TX_FIFO 0x00
142*4882a593Smuzhiyun #define RX_FIFO 0x00
143*4882a593Smuzhiyun #define RX_STATUS 0x08
144*4882a593Smuzhiyun #define TX_STATUS 0x0B
145*4882a593Smuzhiyun #define TX_FREE 0x0C /* Remaining free bytes in Tx buffer. */
146*4882a593Smuzhiyun
147*4882a593Smuzhiyun #define WN0_CONF_CTRL 0x04 /* Window 0: Configuration control register */
148*4882a593Smuzhiyun #define WN0_ADDR_CONF 0x06 /* Window 0: Address configuration register */
149*4882a593Smuzhiyun #define WN0_IRQ 0x08 /* Window 0: Set IRQ line in bits 12-15. */
150*4882a593Smuzhiyun #define WN4_MEDIA 0x0A /* Window 4: Various transcvr/media bits. */
151*4882a593Smuzhiyun #define MEDIA_TP 0x00C0 /* Enable link beat and jabber for 10baseT. */
152*4882a593Smuzhiyun #define WN4_NETDIAG 0x06 /* Window 4: Net diagnostic */
153*4882a593Smuzhiyun #define FD_ENABLE 0x8000 /* Enable full-duplex ("external loopback") */
154*4882a593Smuzhiyun
155*4882a593Smuzhiyun /*
156*4882a593Smuzhiyun * Must be a power of two (we use a binary and in the
157*4882a593Smuzhiyun * circular queue)
158*4882a593Smuzhiyun */
159*4882a593Smuzhiyun #define SKB_QUEUE_SIZE 64
160*4882a593Smuzhiyun
161*4882a593Smuzhiyun enum el3_cardtype { EL3_ISA, EL3_PNP, EL3_EISA };
162*4882a593Smuzhiyun
163*4882a593Smuzhiyun struct el3_private {
164*4882a593Smuzhiyun spinlock_t lock;
165*4882a593Smuzhiyun /* skb send-queue */
166*4882a593Smuzhiyun int head, size;
167*4882a593Smuzhiyun struct sk_buff *queue[SKB_QUEUE_SIZE];
168*4882a593Smuzhiyun enum el3_cardtype type;
169*4882a593Smuzhiyun };
170*4882a593Smuzhiyun static int id_port;
171*4882a593Smuzhiyun static int current_tag;
172*4882a593Smuzhiyun static struct net_device *el3_devs[EL3_MAX_CARDS];
173*4882a593Smuzhiyun
174*4882a593Smuzhiyun /* Parameters that may be passed into the module. */
175*4882a593Smuzhiyun static int debug = -1;
176*4882a593Smuzhiyun static int irq[] = {-1, -1, -1, -1, -1, -1, -1, -1};
177*4882a593Smuzhiyun /* Maximum events (Rx packets, etc.) to handle at each interrupt. */
178*4882a593Smuzhiyun static int max_interrupt_work = 10;
179*4882a593Smuzhiyun #ifdef CONFIG_PNP
180*4882a593Smuzhiyun static int nopnp;
181*4882a593Smuzhiyun #endif
182*4882a593Smuzhiyun
183*4882a593Smuzhiyun static int el3_common_init(struct net_device *dev);
184*4882a593Smuzhiyun static void el3_common_remove(struct net_device *dev);
185*4882a593Smuzhiyun static ushort id_read_eeprom(int index);
186*4882a593Smuzhiyun static ushort read_eeprom(int ioaddr, int index);
187*4882a593Smuzhiyun static int el3_open(struct net_device *dev);
188*4882a593Smuzhiyun static netdev_tx_t el3_start_xmit(struct sk_buff *skb, struct net_device *dev);
189*4882a593Smuzhiyun static irqreturn_t el3_interrupt(int irq, void *dev_id);
190*4882a593Smuzhiyun static void update_stats(struct net_device *dev);
191*4882a593Smuzhiyun static struct net_device_stats *el3_get_stats(struct net_device *dev);
192*4882a593Smuzhiyun static int el3_rx(struct net_device *dev);
193*4882a593Smuzhiyun static int el3_close(struct net_device *dev);
194*4882a593Smuzhiyun static void set_multicast_list(struct net_device *dev);
195*4882a593Smuzhiyun static void el3_tx_timeout (struct net_device *dev, unsigned int txqueue);
196*4882a593Smuzhiyun static void el3_down(struct net_device *dev);
197*4882a593Smuzhiyun static void el3_up(struct net_device *dev);
198*4882a593Smuzhiyun static const struct ethtool_ops ethtool_ops;
199*4882a593Smuzhiyun #ifdef CONFIG_PM
200*4882a593Smuzhiyun static int el3_suspend(struct device *, pm_message_t);
201*4882a593Smuzhiyun static int el3_resume(struct device *);
202*4882a593Smuzhiyun #else
203*4882a593Smuzhiyun #define el3_suspend NULL
204*4882a593Smuzhiyun #define el3_resume NULL
205*4882a593Smuzhiyun #endif
206*4882a593Smuzhiyun
207*4882a593Smuzhiyun
208*4882a593Smuzhiyun /* generic device remove for all device types */
209*4882a593Smuzhiyun static int el3_device_remove (struct device *device);
210*4882a593Smuzhiyun #ifdef CONFIG_NET_POLL_CONTROLLER
211*4882a593Smuzhiyun static void el3_poll_controller(struct net_device *dev);
212*4882a593Smuzhiyun #endif
213*4882a593Smuzhiyun
214*4882a593Smuzhiyun /* Return 0 on success, 1 on error, 2 when found already detected PnP card */
el3_isa_id_sequence(__be16 * phys_addr)215*4882a593Smuzhiyun static int el3_isa_id_sequence(__be16 *phys_addr)
216*4882a593Smuzhiyun {
217*4882a593Smuzhiyun short lrs_state = 0xff;
218*4882a593Smuzhiyun int i;
219*4882a593Smuzhiyun
220*4882a593Smuzhiyun /* ISA boards are detected by sending the ID sequence to the
221*4882a593Smuzhiyun ID_PORT. We find cards past the first by setting the 'current_tag'
222*4882a593Smuzhiyun on cards as they are found. Cards with their tag set will not
223*4882a593Smuzhiyun respond to subsequent ID sequences. */
224*4882a593Smuzhiyun
225*4882a593Smuzhiyun outb(0x00, id_port);
226*4882a593Smuzhiyun outb(0x00, id_port);
227*4882a593Smuzhiyun for (i = 0; i < 255; i++) {
228*4882a593Smuzhiyun outb(lrs_state, id_port);
229*4882a593Smuzhiyun lrs_state <<= 1;
230*4882a593Smuzhiyun lrs_state = lrs_state & 0x100 ? lrs_state ^ 0xcf : lrs_state;
231*4882a593Smuzhiyun }
232*4882a593Smuzhiyun /* For the first probe, clear all board's tag registers. */
233*4882a593Smuzhiyun if (current_tag == 0)
234*4882a593Smuzhiyun outb(0xd0, id_port);
235*4882a593Smuzhiyun else /* Otherwise kill off already-found boards. */
236*4882a593Smuzhiyun outb(0xd8, id_port);
237*4882a593Smuzhiyun if (id_read_eeprom(7) != 0x6d50)
238*4882a593Smuzhiyun return 1;
239*4882a593Smuzhiyun /* Read in EEPROM data, which does contention-select.
240*4882a593Smuzhiyun Only the lowest address board will stay "on-line".
241*4882a593Smuzhiyun 3Com got the byte order backwards. */
242*4882a593Smuzhiyun for (i = 0; i < 3; i++)
243*4882a593Smuzhiyun phys_addr[i] = htons(id_read_eeprom(i));
244*4882a593Smuzhiyun #ifdef CONFIG_PNP
245*4882a593Smuzhiyun if (!nopnp) {
246*4882a593Smuzhiyun /* The ISA PnP 3c509 cards respond to the ID sequence too.
247*4882a593Smuzhiyun This check is needed in order not to register them twice. */
248*4882a593Smuzhiyun for (i = 0; i < el3_cards; i++) {
249*4882a593Smuzhiyun struct el3_private *lp = netdev_priv(el3_devs[i]);
250*4882a593Smuzhiyun if (lp->type == EL3_PNP &&
251*4882a593Smuzhiyun ether_addr_equal((u8 *)phys_addr, el3_devs[i]->dev_addr)) {
252*4882a593Smuzhiyun if (el3_debug > 3)
253*4882a593Smuzhiyun pr_debug("3c509 with address %02x %02x %02x %02x %02x %02x was found by ISAPnP\n",
254*4882a593Smuzhiyun phys_addr[0] & 0xff, phys_addr[0] >> 8,
255*4882a593Smuzhiyun phys_addr[1] & 0xff, phys_addr[1] >> 8,
256*4882a593Smuzhiyun phys_addr[2] & 0xff, phys_addr[2] >> 8);
257*4882a593Smuzhiyun /* Set the adaptor tag so that the next card can be found. */
258*4882a593Smuzhiyun outb(0xd0 + ++current_tag, id_port);
259*4882a593Smuzhiyun return 2;
260*4882a593Smuzhiyun }
261*4882a593Smuzhiyun }
262*4882a593Smuzhiyun }
263*4882a593Smuzhiyun #endif /* CONFIG_PNP */
264*4882a593Smuzhiyun return 0;
265*4882a593Smuzhiyun
266*4882a593Smuzhiyun }
267*4882a593Smuzhiyun
el3_dev_fill(struct net_device * dev,__be16 * phys_addr,int ioaddr,int irq,int if_port,enum el3_cardtype type)268*4882a593Smuzhiyun static void el3_dev_fill(struct net_device *dev, __be16 *phys_addr, int ioaddr,
269*4882a593Smuzhiyun int irq, int if_port, enum el3_cardtype type)
270*4882a593Smuzhiyun {
271*4882a593Smuzhiyun struct el3_private *lp = netdev_priv(dev);
272*4882a593Smuzhiyun
273*4882a593Smuzhiyun memcpy(dev->dev_addr, phys_addr, ETH_ALEN);
274*4882a593Smuzhiyun dev->base_addr = ioaddr;
275*4882a593Smuzhiyun dev->irq = irq;
276*4882a593Smuzhiyun dev->if_port = if_port;
277*4882a593Smuzhiyun lp->type = type;
278*4882a593Smuzhiyun }
279*4882a593Smuzhiyun
el3_isa_match(struct device * pdev,unsigned int ndev)280*4882a593Smuzhiyun static int el3_isa_match(struct device *pdev, unsigned int ndev)
281*4882a593Smuzhiyun {
282*4882a593Smuzhiyun struct net_device *dev;
283*4882a593Smuzhiyun int ioaddr, isa_irq, if_port, err;
284*4882a593Smuzhiyun unsigned int iobase;
285*4882a593Smuzhiyun __be16 phys_addr[3];
286*4882a593Smuzhiyun
287*4882a593Smuzhiyun while ((err = el3_isa_id_sequence(phys_addr)) == 2)
288*4882a593Smuzhiyun ; /* Skip to next card when PnP card found */
289*4882a593Smuzhiyun if (err == 1)
290*4882a593Smuzhiyun return 0;
291*4882a593Smuzhiyun
292*4882a593Smuzhiyun iobase = id_read_eeprom(8);
293*4882a593Smuzhiyun if_port = iobase >> 14;
294*4882a593Smuzhiyun ioaddr = 0x200 + ((iobase & 0x1f) << 4);
295*4882a593Smuzhiyun if (irq[el3_cards] > 1 && irq[el3_cards] < 16)
296*4882a593Smuzhiyun isa_irq = irq[el3_cards];
297*4882a593Smuzhiyun else
298*4882a593Smuzhiyun isa_irq = id_read_eeprom(9) >> 12;
299*4882a593Smuzhiyun
300*4882a593Smuzhiyun dev = alloc_etherdev(sizeof(struct el3_private));
301*4882a593Smuzhiyun if (!dev)
302*4882a593Smuzhiyun return -ENOMEM;
303*4882a593Smuzhiyun
304*4882a593Smuzhiyun SET_NETDEV_DEV(dev, pdev);
305*4882a593Smuzhiyun netdev_boot_setup_check(dev);
306*4882a593Smuzhiyun
307*4882a593Smuzhiyun if (!request_region(ioaddr, EL3_IO_EXTENT, "3c509-isa")) {
308*4882a593Smuzhiyun free_netdev(dev);
309*4882a593Smuzhiyun return 0;
310*4882a593Smuzhiyun }
311*4882a593Smuzhiyun
312*4882a593Smuzhiyun /* Set the adaptor tag so that the next card can be found. */
313*4882a593Smuzhiyun outb(0xd0 + ++current_tag, id_port);
314*4882a593Smuzhiyun
315*4882a593Smuzhiyun /* Activate the adaptor at the EEPROM location. */
316*4882a593Smuzhiyun outb((ioaddr >> 4) | 0xe0, id_port);
317*4882a593Smuzhiyun
318*4882a593Smuzhiyun EL3WINDOW(0);
319*4882a593Smuzhiyun if (inw(ioaddr) != 0x6d50) {
320*4882a593Smuzhiyun free_netdev(dev);
321*4882a593Smuzhiyun return 0;
322*4882a593Smuzhiyun }
323*4882a593Smuzhiyun
324*4882a593Smuzhiyun /* Free the interrupt so that some other card can use it. */
325*4882a593Smuzhiyun outw(0x0f00, ioaddr + WN0_IRQ);
326*4882a593Smuzhiyun
327*4882a593Smuzhiyun el3_dev_fill(dev, phys_addr, ioaddr, isa_irq, if_port, EL3_ISA);
328*4882a593Smuzhiyun dev_set_drvdata(pdev, dev);
329*4882a593Smuzhiyun if (el3_common_init(dev)) {
330*4882a593Smuzhiyun free_netdev(dev);
331*4882a593Smuzhiyun return 0;
332*4882a593Smuzhiyun }
333*4882a593Smuzhiyun
334*4882a593Smuzhiyun el3_devs[el3_cards++] = dev;
335*4882a593Smuzhiyun return 1;
336*4882a593Smuzhiyun }
337*4882a593Smuzhiyun
el3_isa_remove(struct device * pdev,unsigned int ndev)338*4882a593Smuzhiyun static int el3_isa_remove(struct device *pdev,
339*4882a593Smuzhiyun unsigned int ndev)
340*4882a593Smuzhiyun {
341*4882a593Smuzhiyun el3_device_remove(pdev);
342*4882a593Smuzhiyun dev_set_drvdata(pdev, NULL);
343*4882a593Smuzhiyun return 0;
344*4882a593Smuzhiyun }
345*4882a593Smuzhiyun
346*4882a593Smuzhiyun #ifdef CONFIG_PM
el3_isa_suspend(struct device * dev,unsigned int n,pm_message_t state)347*4882a593Smuzhiyun static int el3_isa_suspend(struct device *dev, unsigned int n,
348*4882a593Smuzhiyun pm_message_t state)
349*4882a593Smuzhiyun {
350*4882a593Smuzhiyun current_tag = 0;
351*4882a593Smuzhiyun return el3_suspend(dev, state);
352*4882a593Smuzhiyun }
353*4882a593Smuzhiyun
el3_isa_resume(struct device * dev,unsigned int n)354*4882a593Smuzhiyun static int el3_isa_resume(struct device *dev, unsigned int n)
355*4882a593Smuzhiyun {
356*4882a593Smuzhiyun struct net_device *ndev = dev_get_drvdata(dev);
357*4882a593Smuzhiyun int ioaddr = ndev->base_addr, err;
358*4882a593Smuzhiyun __be16 phys_addr[3];
359*4882a593Smuzhiyun
360*4882a593Smuzhiyun while ((err = el3_isa_id_sequence(phys_addr)) == 2)
361*4882a593Smuzhiyun ; /* Skip to next card when PnP card found */
362*4882a593Smuzhiyun if (err == 1)
363*4882a593Smuzhiyun return 0;
364*4882a593Smuzhiyun /* Set the adaptor tag so that the next card can be found. */
365*4882a593Smuzhiyun outb(0xd0 + ++current_tag, id_port);
366*4882a593Smuzhiyun /* Enable the card */
367*4882a593Smuzhiyun outb((ioaddr >> 4) | 0xe0, id_port);
368*4882a593Smuzhiyun EL3WINDOW(0);
369*4882a593Smuzhiyun if (inw(ioaddr) != 0x6d50)
370*4882a593Smuzhiyun return 1;
371*4882a593Smuzhiyun /* Free the interrupt so that some other card can use it. */
372*4882a593Smuzhiyun outw(0x0f00, ioaddr + WN0_IRQ);
373*4882a593Smuzhiyun return el3_resume(dev);
374*4882a593Smuzhiyun }
375*4882a593Smuzhiyun #endif
376*4882a593Smuzhiyun
377*4882a593Smuzhiyun static struct isa_driver el3_isa_driver = {
378*4882a593Smuzhiyun .match = el3_isa_match,
379*4882a593Smuzhiyun .remove = el3_isa_remove,
380*4882a593Smuzhiyun #ifdef CONFIG_PM
381*4882a593Smuzhiyun .suspend = el3_isa_suspend,
382*4882a593Smuzhiyun .resume = el3_isa_resume,
383*4882a593Smuzhiyun #endif
384*4882a593Smuzhiyun .driver = {
385*4882a593Smuzhiyun .name = "3c509"
386*4882a593Smuzhiyun },
387*4882a593Smuzhiyun };
388*4882a593Smuzhiyun static int isa_registered;
389*4882a593Smuzhiyun
390*4882a593Smuzhiyun #ifdef CONFIG_PNP
391*4882a593Smuzhiyun static const struct pnp_device_id el3_pnp_ids[] = {
392*4882a593Smuzhiyun { .id = "TCM5090" }, /* 3Com Etherlink III (TP) */
393*4882a593Smuzhiyun { .id = "TCM5091" }, /* 3Com Etherlink III */
394*4882a593Smuzhiyun { .id = "TCM5094" }, /* 3Com Etherlink III (combo) */
395*4882a593Smuzhiyun { .id = "TCM5095" }, /* 3Com Etherlink III (TPO) */
396*4882a593Smuzhiyun { .id = "TCM5098" }, /* 3Com Etherlink III (TPC) */
397*4882a593Smuzhiyun { .id = "PNP80f7" }, /* 3Com Etherlink III compatible */
398*4882a593Smuzhiyun { .id = "PNP80f8" }, /* 3Com Etherlink III compatible */
399*4882a593Smuzhiyun { .id = "" }
400*4882a593Smuzhiyun };
401*4882a593Smuzhiyun MODULE_DEVICE_TABLE(pnp, el3_pnp_ids);
402*4882a593Smuzhiyun
el3_pnp_probe(struct pnp_dev * pdev,const struct pnp_device_id * id)403*4882a593Smuzhiyun static int el3_pnp_probe(struct pnp_dev *pdev, const struct pnp_device_id *id)
404*4882a593Smuzhiyun {
405*4882a593Smuzhiyun short i;
406*4882a593Smuzhiyun int ioaddr, irq, if_port;
407*4882a593Smuzhiyun __be16 phys_addr[3];
408*4882a593Smuzhiyun struct net_device *dev = NULL;
409*4882a593Smuzhiyun int err;
410*4882a593Smuzhiyun
411*4882a593Smuzhiyun ioaddr = pnp_port_start(pdev, 0);
412*4882a593Smuzhiyun if (!request_region(ioaddr, EL3_IO_EXTENT, "3c509-pnp"))
413*4882a593Smuzhiyun return -EBUSY;
414*4882a593Smuzhiyun irq = pnp_irq(pdev, 0);
415*4882a593Smuzhiyun EL3WINDOW(0);
416*4882a593Smuzhiyun for (i = 0; i < 3; i++)
417*4882a593Smuzhiyun phys_addr[i] = htons(read_eeprom(ioaddr, i));
418*4882a593Smuzhiyun if_port = read_eeprom(ioaddr, 8) >> 14;
419*4882a593Smuzhiyun dev = alloc_etherdev(sizeof(struct el3_private));
420*4882a593Smuzhiyun if (!dev) {
421*4882a593Smuzhiyun release_region(ioaddr, EL3_IO_EXTENT);
422*4882a593Smuzhiyun return -ENOMEM;
423*4882a593Smuzhiyun }
424*4882a593Smuzhiyun SET_NETDEV_DEV(dev, &pdev->dev);
425*4882a593Smuzhiyun netdev_boot_setup_check(dev);
426*4882a593Smuzhiyun
427*4882a593Smuzhiyun el3_dev_fill(dev, phys_addr, ioaddr, irq, if_port, EL3_PNP);
428*4882a593Smuzhiyun pnp_set_drvdata(pdev, dev);
429*4882a593Smuzhiyun err = el3_common_init(dev);
430*4882a593Smuzhiyun
431*4882a593Smuzhiyun if (err) {
432*4882a593Smuzhiyun pnp_set_drvdata(pdev, NULL);
433*4882a593Smuzhiyun free_netdev(dev);
434*4882a593Smuzhiyun return err;
435*4882a593Smuzhiyun }
436*4882a593Smuzhiyun
437*4882a593Smuzhiyun el3_devs[el3_cards++] = dev;
438*4882a593Smuzhiyun return 0;
439*4882a593Smuzhiyun }
440*4882a593Smuzhiyun
el3_pnp_remove(struct pnp_dev * pdev)441*4882a593Smuzhiyun static void el3_pnp_remove(struct pnp_dev *pdev)
442*4882a593Smuzhiyun {
443*4882a593Smuzhiyun el3_common_remove(pnp_get_drvdata(pdev));
444*4882a593Smuzhiyun pnp_set_drvdata(pdev, NULL);
445*4882a593Smuzhiyun }
446*4882a593Smuzhiyun
447*4882a593Smuzhiyun #ifdef CONFIG_PM
el3_pnp_suspend(struct pnp_dev * pdev,pm_message_t state)448*4882a593Smuzhiyun static int el3_pnp_suspend(struct pnp_dev *pdev, pm_message_t state)
449*4882a593Smuzhiyun {
450*4882a593Smuzhiyun return el3_suspend(&pdev->dev, state);
451*4882a593Smuzhiyun }
452*4882a593Smuzhiyun
el3_pnp_resume(struct pnp_dev * pdev)453*4882a593Smuzhiyun static int el3_pnp_resume(struct pnp_dev *pdev)
454*4882a593Smuzhiyun {
455*4882a593Smuzhiyun return el3_resume(&pdev->dev);
456*4882a593Smuzhiyun }
457*4882a593Smuzhiyun #endif
458*4882a593Smuzhiyun
459*4882a593Smuzhiyun static struct pnp_driver el3_pnp_driver = {
460*4882a593Smuzhiyun .name = "3c509",
461*4882a593Smuzhiyun .id_table = el3_pnp_ids,
462*4882a593Smuzhiyun .probe = el3_pnp_probe,
463*4882a593Smuzhiyun .remove = el3_pnp_remove,
464*4882a593Smuzhiyun #ifdef CONFIG_PM
465*4882a593Smuzhiyun .suspend = el3_pnp_suspend,
466*4882a593Smuzhiyun .resume = el3_pnp_resume,
467*4882a593Smuzhiyun #endif
468*4882a593Smuzhiyun };
469*4882a593Smuzhiyun static int pnp_registered;
470*4882a593Smuzhiyun #endif /* CONFIG_PNP */
471*4882a593Smuzhiyun
472*4882a593Smuzhiyun #ifdef CONFIG_EISA
473*4882a593Smuzhiyun static const struct eisa_device_id el3_eisa_ids[] = {
474*4882a593Smuzhiyun { "TCM5090" },
475*4882a593Smuzhiyun { "TCM5091" },
476*4882a593Smuzhiyun { "TCM5092" },
477*4882a593Smuzhiyun { "TCM5093" },
478*4882a593Smuzhiyun { "TCM5094" },
479*4882a593Smuzhiyun { "TCM5095" },
480*4882a593Smuzhiyun { "TCM5098" },
481*4882a593Smuzhiyun { "" }
482*4882a593Smuzhiyun };
483*4882a593Smuzhiyun MODULE_DEVICE_TABLE(eisa, el3_eisa_ids);
484*4882a593Smuzhiyun
485*4882a593Smuzhiyun static int el3_eisa_probe (struct device *device);
486*4882a593Smuzhiyun
487*4882a593Smuzhiyun static struct eisa_driver el3_eisa_driver = {
488*4882a593Smuzhiyun .id_table = el3_eisa_ids,
489*4882a593Smuzhiyun .driver = {
490*4882a593Smuzhiyun .name = "3c579",
491*4882a593Smuzhiyun .probe = el3_eisa_probe,
492*4882a593Smuzhiyun .remove = el3_device_remove,
493*4882a593Smuzhiyun .suspend = el3_suspend,
494*4882a593Smuzhiyun .resume = el3_resume,
495*4882a593Smuzhiyun }
496*4882a593Smuzhiyun };
497*4882a593Smuzhiyun static int eisa_registered;
498*4882a593Smuzhiyun #endif
499*4882a593Smuzhiyun
500*4882a593Smuzhiyun static const struct net_device_ops netdev_ops = {
501*4882a593Smuzhiyun .ndo_open = el3_open,
502*4882a593Smuzhiyun .ndo_stop = el3_close,
503*4882a593Smuzhiyun .ndo_start_xmit = el3_start_xmit,
504*4882a593Smuzhiyun .ndo_get_stats = el3_get_stats,
505*4882a593Smuzhiyun .ndo_set_rx_mode = set_multicast_list,
506*4882a593Smuzhiyun .ndo_tx_timeout = el3_tx_timeout,
507*4882a593Smuzhiyun .ndo_set_mac_address = eth_mac_addr,
508*4882a593Smuzhiyun .ndo_validate_addr = eth_validate_addr,
509*4882a593Smuzhiyun #ifdef CONFIG_NET_POLL_CONTROLLER
510*4882a593Smuzhiyun .ndo_poll_controller = el3_poll_controller,
511*4882a593Smuzhiyun #endif
512*4882a593Smuzhiyun };
513*4882a593Smuzhiyun
el3_common_init(struct net_device * dev)514*4882a593Smuzhiyun static int el3_common_init(struct net_device *dev)
515*4882a593Smuzhiyun {
516*4882a593Smuzhiyun struct el3_private *lp = netdev_priv(dev);
517*4882a593Smuzhiyun int err;
518*4882a593Smuzhiyun const char *if_names[] = {"10baseT", "AUI", "undefined", "BNC"};
519*4882a593Smuzhiyun
520*4882a593Smuzhiyun spin_lock_init(&lp->lock);
521*4882a593Smuzhiyun
522*4882a593Smuzhiyun if (dev->mem_start & 0x05) { /* xcvr codes 1/3/4/12 */
523*4882a593Smuzhiyun dev->if_port = (dev->mem_start & 0x0f);
524*4882a593Smuzhiyun } else { /* xcvr codes 0/8 */
525*4882a593Smuzhiyun /* use eeprom value, but save user's full-duplex selection */
526*4882a593Smuzhiyun dev->if_port |= (dev->mem_start & 0x08);
527*4882a593Smuzhiyun }
528*4882a593Smuzhiyun
529*4882a593Smuzhiyun /* The EL3-specific entries in the device structure. */
530*4882a593Smuzhiyun dev->netdev_ops = &netdev_ops;
531*4882a593Smuzhiyun dev->watchdog_timeo = TX_TIMEOUT;
532*4882a593Smuzhiyun dev->ethtool_ops = ðtool_ops;
533*4882a593Smuzhiyun
534*4882a593Smuzhiyun err = register_netdev(dev);
535*4882a593Smuzhiyun if (err) {
536*4882a593Smuzhiyun pr_err("Failed to register 3c5x9 at %#3.3lx, IRQ %d.\n",
537*4882a593Smuzhiyun dev->base_addr, dev->irq);
538*4882a593Smuzhiyun release_region(dev->base_addr, EL3_IO_EXTENT);
539*4882a593Smuzhiyun return err;
540*4882a593Smuzhiyun }
541*4882a593Smuzhiyun
542*4882a593Smuzhiyun pr_info("%s: 3c5x9 found at %#3.3lx, %s port, address %pM, IRQ %d.\n",
543*4882a593Smuzhiyun dev->name, dev->base_addr, if_names[(dev->if_port & 0x03)],
544*4882a593Smuzhiyun dev->dev_addr, dev->irq);
545*4882a593Smuzhiyun
546*4882a593Smuzhiyun return 0;
547*4882a593Smuzhiyun
548*4882a593Smuzhiyun }
549*4882a593Smuzhiyun
el3_common_remove(struct net_device * dev)550*4882a593Smuzhiyun static void el3_common_remove (struct net_device *dev)
551*4882a593Smuzhiyun {
552*4882a593Smuzhiyun unregister_netdev (dev);
553*4882a593Smuzhiyun release_region(dev->base_addr, EL3_IO_EXTENT);
554*4882a593Smuzhiyun free_netdev (dev);
555*4882a593Smuzhiyun }
556*4882a593Smuzhiyun
557*4882a593Smuzhiyun #ifdef CONFIG_EISA
el3_eisa_probe(struct device * device)558*4882a593Smuzhiyun static int el3_eisa_probe(struct device *device)
559*4882a593Smuzhiyun {
560*4882a593Smuzhiyun short i;
561*4882a593Smuzhiyun int ioaddr, irq, if_port;
562*4882a593Smuzhiyun __be16 phys_addr[3];
563*4882a593Smuzhiyun struct net_device *dev = NULL;
564*4882a593Smuzhiyun struct eisa_device *edev;
565*4882a593Smuzhiyun int err;
566*4882a593Smuzhiyun
567*4882a593Smuzhiyun /* Yeepee, The driver framework is calling us ! */
568*4882a593Smuzhiyun edev = to_eisa_device (device);
569*4882a593Smuzhiyun ioaddr = edev->base_addr;
570*4882a593Smuzhiyun
571*4882a593Smuzhiyun if (!request_region(ioaddr, EL3_IO_EXTENT, "3c579-eisa"))
572*4882a593Smuzhiyun return -EBUSY;
573*4882a593Smuzhiyun
574*4882a593Smuzhiyun /* Change the register set to the configuration window 0. */
575*4882a593Smuzhiyun outw(SelectWindow | 0, ioaddr + 0xC80 + EL3_CMD);
576*4882a593Smuzhiyun
577*4882a593Smuzhiyun irq = inw(ioaddr + WN0_IRQ) >> 12;
578*4882a593Smuzhiyun if_port = inw(ioaddr + 6)>>14;
579*4882a593Smuzhiyun for (i = 0; i < 3; i++)
580*4882a593Smuzhiyun phys_addr[i] = htons(read_eeprom(ioaddr, i));
581*4882a593Smuzhiyun
582*4882a593Smuzhiyun /* Restore the "Product ID" to the EEPROM read register. */
583*4882a593Smuzhiyun read_eeprom(ioaddr, 3);
584*4882a593Smuzhiyun
585*4882a593Smuzhiyun dev = alloc_etherdev(sizeof (struct el3_private));
586*4882a593Smuzhiyun if (dev == NULL) {
587*4882a593Smuzhiyun release_region(ioaddr, EL3_IO_EXTENT);
588*4882a593Smuzhiyun return -ENOMEM;
589*4882a593Smuzhiyun }
590*4882a593Smuzhiyun
591*4882a593Smuzhiyun SET_NETDEV_DEV(dev, device);
592*4882a593Smuzhiyun netdev_boot_setup_check(dev);
593*4882a593Smuzhiyun
594*4882a593Smuzhiyun el3_dev_fill(dev, phys_addr, ioaddr, irq, if_port, EL3_EISA);
595*4882a593Smuzhiyun eisa_set_drvdata (edev, dev);
596*4882a593Smuzhiyun err = el3_common_init(dev);
597*4882a593Smuzhiyun
598*4882a593Smuzhiyun if (err) {
599*4882a593Smuzhiyun eisa_set_drvdata (edev, NULL);
600*4882a593Smuzhiyun free_netdev(dev);
601*4882a593Smuzhiyun return err;
602*4882a593Smuzhiyun }
603*4882a593Smuzhiyun
604*4882a593Smuzhiyun el3_devs[el3_cards++] = dev;
605*4882a593Smuzhiyun return 0;
606*4882a593Smuzhiyun }
607*4882a593Smuzhiyun #endif
608*4882a593Smuzhiyun
609*4882a593Smuzhiyun /* This remove works for all device types.
610*4882a593Smuzhiyun *
611*4882a593Smuzhiyun * The net dev must be stored in the driver data field */
el3_device_remove(struct device * device)612*4882a593Smuzhiyun static int el3_device_remove(struct device *device)
613*4882a593Smuzhiyun {
614*4882a593Smuzhiyun struct net_device *dev;
615*4882a593Smuzhiyun
616*4882a593Smuzhiyun dev = dev_get_drvdata(device);
617*4882a593Smuzhiyun
618*4882a593Smuzhiyun el3_common_remove (dev);
619*4882a593Smuzhiyun return 0;
620*4882a593Smuzhiyun }
621*4882a593Smuzhiyun
622*4882a593Smuzhiyun /* Read a word from the EEPROM using the regular EEPROM access register.
623*4882a593Smuzhiyun Assume that we are in register window zero.
624*4882a593Smuzhiyun */
read_eeprom(int ioaddr,int index)625*4882a593Smuzhiyun static ushort read_eeprom(int ioaddr, int index)
626*4882a593Smuzhiyun {
627*4882a593Smuzhiyun outw(EEPROM_READ + index, ioaddr + 10);
628*4882a593Smuzhiyun /* Pause for at least 162 us. for the read to take place.
629*4882a593Smuzhiyun Some chips seem to require much longer */
630*4882a593Smuzhiyun mdelay(2);
631*4882a593Smuzhiyun return inw(ioaddr + 12);
632*4882a593Smuzhiyun }
633*4882a593Smuzhiyun
634*4882a593Smuzhiyun /* Read a word from the EEPROM when in the ISA ID probe state. */
id_read_eeprom(int index)635*4882a593Smuzhiyun static ushort id_read_eeprom(int index)
636*4882a593Smuzhiyun {
637*4882a593Smuzhiyun int bit, word = 0;
638*4882a593Smuzhiyun
639*4882a593Smuzhiyun /* Issue read command, and pause for at least 162 us. for it to complete.
640*4882a593Smuzhiyun Assume extra-fast 16Mhz bus. */
641*4882a593Smuzhiyun outb(EEPROM_READ + index, id_port);
642*4882a593Smuzhiyun
643*4882a593Smuzhiyun /* Pause for at least 162 us. for the read to take place. */
644*4882a593Smuzhiyun /* Some chips seem to require much longer */
645*4882a593Smuzhiyun mdelay(4);
646*4882a593Smuzhiyun
647*4882a593Smuzhiyun for (bit = 15; bit >= 0; bit--)
648*4882a593Smuzhiyun word = (word << 1) + (inb(id_port) & 0x01);
649*4882a593Smuzhiyun
650*4882a593Smuzhiyun if (el3_debug > 3)
651*4882a593Smuzhiyun pr_debug(" 3c509 EEPROM word %d %#4.4x.\n", index, word);
652*4882a593Smuzhiyun
653*4882a593Smuzhiyun return word;
654*4882a593Smuzhiyun }
655*4882a593Smuzhiyun
656*4882a593Smuzhiyun
657*4882a593Smuzhiyun static int
el3_open(struct net_device * dev)658*4882a593Smuzhiyun el3_open(struct net_device *dev)
659*4882a593Smuzhiyun {
660*4882a593Smuzhiyun int ioaddr = dev->base_addr;
661*4882a593Smuzhiyun int i;
662*4882a593Smuzhiyun
663*4882a593Smuzhiyun outw(TxReset, ioaddr + EL3_CMD);
664*4882a593Smuzhiyun outw(RxReset, ioaddr + EL3_CMD);
665*4882a593Smuzhiyun outw(SetStatusEnb | 0x00, ioaddr + EL3_CMD);
666*4882a593Smuzhiyun
667*4882a593Smuzhiyun i = request_irq(dev->irq, el3_interrupt, 0, dev->name, dev);
668*4882a593Smuzhiyun if (i)
669*4882a593Smuzhiyun return i;
670*4882a593Smuzhiyun
671*4882a593Smuzhiyun EL3WINDOW(0);
672*4882a593Smuzhiyun if (el3_debug > 3)
673*4882a593Smuzhiyun pr_debug("%s: Opening, IRQ %d status@%x %4.4x.\n", dev->name,
674*4882a593Smuzhiyun dev->irq, ioaddr + EL3_STATUS, inw(ioaddr + EL3_STATUS));
675*4882a593Smuzhiyun
676*4882a593Smuzhiyun el3_up(dev);
677*4882a593Smuzhiyun
678*4882a593Smuzhiyun if (el3_debug > 3)
679*4882a593Smuzhiyun pr_debug("%s: Opened 3c509 IRQ %d status %4.4x.\n",
680*4882a593Smuzhiyun dev->name, dev->irq, inw(ioaddr + EL3_STATUS));
681*4882a593Smuzhiyun
682*4882a593Smuzhiyun return 0;
683*4882a593Smuzhiyun }
684*4882a593Smuzhiyun
685*4882a593Smuzhiyun static void
el3_tx_timeout(struct net_device * dev,unsigned int txqueue)686*4882a593Smuzhiyun el3_tx_timeout (struct net_device *dev, unsigned int txqueue)
687*4882a593Smuzhiyun {
688*4882a593Smuzhiyun int ioaddr = dev->base_addr;
689*4882a593Smuzhiyun
690*4882a593Smuzhiyun /* Transmitter timeout, serious problems. */
691*4882a593Smuzhiyun pr_warn("%s: transmit timed out, Tx_status %2.2x status %4.4x Tx FIFO room %d\n",
692*4882a593Smuzhiyun dev->name, inb(ioaddr + TX_STATUS), inw(ioaddr + EL3_STATUS),
693*4882a593Smuzhiyun inw(ioaddr + TX_FREE));
694*4882a593Smuzhiyun dev->stats.tx_errors++;
695*4882a593Smuzhiyun netif_trans_update(dev); /* prevent tx timeout */
696*4882a593Smuzhiyun /* Issue TX_RESET and TX_START commands. */
697*4882a593Smuzhiyun outw(TxReset, ioaddr + EL3_CMD);
698*4882a593Smuzhiyun outw(TxEnable, ioaddr + EL3_CMD);
699*4882a593Smuzhiyun netif_wake_queue(dev);
700*4882a593Smuzhiyun }
701*4882a593Smuzhiyun
702*4882a593Smuzhiyun
703*4882a593Smuzhiyun static netdev_tx_t
el3_start_xmit(struct sk_buff * skb,struct net_device * dev)704*4882a593Smuzhiyun el3_start_xmit(struct sk_buff *skb, struct net_device *dev)
705*4882a593Smuzhiyun {
706*4882a593Smuzhiyun struct el3_private *lp = netdev_priv(dev);
707*4882a593Smuzhiyun int ioaddr = dev->base_addr;
708*4882a593Smuzhiyun unsigned long flags;
709*4882a593Smuzhiyun
710*4882a593Smuzhiyun netif_stop_queue (dev);
711*4882a593Smuzhiyun
712*4882a593Smuzhiyun dev->stats.tx_bytes += skb->len;
713*4882a593Smuzhiyun
714*4882a593Smuzhiyun if (el3_debug > 4) {
715*4882a593Smuzhiyun pr_debug("%s: el3_start_xmit(length = %u) called, status %4.4x.\n",
716*4882a593Smuzhiyun dev->name, skb->len, inw(ioaddr + EL3_STATUS));
717*4882a593Smuzhiyun }
718*4882a593Smuzhiyun /*
719*4882a593Smuzhiyun * We lock the driver against other processors. Note
720*4882a593Smuzhiyun * we don't need to lock versus the IRQ as we suspended
721*4882a593Smuzhiyun * that. This means that we lose the ability to take
722*4882a593Smuzhiyun * an RX during a TX upload. That sucks a bit with SMP
723*4882a593Smuzhiyun * on an original 3c509 (2K buffer)
724*4882a593Smuzhiyun *
725*4882a593Smuzhiyun * Using disable_irq stops us crapping on other
726*4882a593Smuzhiyun * time sensitive devices.
727*4882a593Smuzhiyun */
728*4882a593Smuzhiyun
729*4882a593Smuzhiyun spin_lock_irqsave(&lp->lock, flags);
730*4882a593Smuzhiyun
731*4882a593Smuzhiyun /* Put out the doubleword header... */
732*4882a593Smuzhiyun outw(skb->len, ioaddr + TX_FIFO);
733*4882a593Smuzhiyun outw(0x00, ioaddr + TX_FIFO);
734*4882a593Smuzhiyun /* ... and the packet rounded to a doubleword. */
735*4882a593Smuzhiyun outsl(ioaddr + TX_FIFO, skb->data, (skb->len + 3) >> 2);
736*4882a593Smuzhiyun
737*4882a593Smuzhiyun if (inw(ioaddr + TX_FREE) > 1536)
738*4882a593Smuzhiyun netif_start_queue(dev);
739*4882a593Smuzhiyun else
740*4882a593Smuzhiyun /* Interrupt us when the FIFO has room for max-sized packet. */
741*4882a593Smuzhiyun outw(SetTxThreshold + 1536, ioaddr + EL3_CMD);
742*4882a593Smuzhiyun
743*4882a593Smuzhiyun spin_unlock_irqrestore(&lp->lock, flags);
744*4882a593Smuzhiyun
745*4882a593Smuzhiyun dev_consume_skb_any (skb);
746*4882a593Smuzhiyun
747*4882a593Smuzhiyun /* Clear the Tx status stack. */
748*4882a593Smuzhiyun {
749*4882a593Smuzhiyun short tx_status;
750*4882a593Smuzhiyun int i = 4;
751*4882a593Smuzhiyun
752*4882a593Smuzhiyun while (--i > 0 && (tx_status = inb(ioaddr + TX_STATUS)) > 0) {
753*4882a593Smuzhiyun if (tx_status & 0x38) dev->stats.tx_aborted_errors++;
754*4882a593Smuzhiyun if (tx_status & 0x30) outw(TxReset, ioaddr + EL3_CMD);
755*4882a593Smuzhiyun if (tx_status & 0x3C) outw(TxEnable, ioaddr + EL3_CMD);
756*4882a593Smuzhiyun outb(0x00, ioaddr + TX_STATUS); /* Pop the status stack. */
757*4882a593Smuzhiyun }
758*4882a593Smuzhiyun }
759*4882a593Smuzhiyun return NETDEV_TX_OK;
760*4882a593Smuzhiyun }
761*4882a593Smuzhiyun
762*4882a593Smuzhiyun /* The EL3 interrupt handler. */
763*4882a593Smuzhiyun static irqreturn_t
el3_interrupt(int irq,void * dev_id)764*4882a593Smuzhiyun el3_interrupt(int irq, void *dev_id)
765*4882a593Smuzhiyun {
766*4882a593Smuzhiyun struct net_device *dev = dev_id;
767*4882a593Smuzhiyun struct el3_private *lp;
768*4882a593Smuzhiyun int ioaddr, status;
769*4882a593Smuzhiyun int i = max_interrupt_work;
770*4882a593Smuzhiyun
771*4882a593Smuzhiyun lp = netdev_priv(dev);
772*4882a593Smuzhiyun spin_lock(&lp->lock);
773*4882a593Smuzhiyun
774*4882a593Smuzhiyun ioaddr = dev->base_addr;
775*4882a593Smuzhiyun
776*4882a593Smuzhiyun if (el3_debug > 4) {
777*4882a593Smuzhiyun status = inw(ioaddr + EL3_STATUS);
778*4882a593Smuzhiyun pr_debug("%s: interrupt, status %4.4x.\n", dev->name, status);
779*4882a593Smuzhiyun }
780*4882a593Smuzhiyun
781*4882a593Smuzhiyun while ((status = inw(ioaddr + EL3_STATUS)) &
782*4882a593Smuzhiyun (IntLatch | RxComplete | StatsFull)) {
783*4882a593Smuzhiyun
784*4882a593Smuzhiyun if (status & RxComplete)
785*4882a593Smuzhiyun el3_rx(dev);
786*4882a593Smuzhiyun
787*4882a593Smuzhiyun if (status & TxAvailable) {
788*4882a593Smuzhiyun if (el3_debug > 5)
789*4882a593Smuzhiyun pr_debug(" TX room bit was handled.\n");
790*4882a593Smuzhiyun /* There's room in the FIFO for a full-sized packet. */
791*4882a593Smuzhiyun outw(AckIntr | TxAvailable, ioaddr + EL3_CMD);
792*4882a593Smuzhiyun netif_wake_queue (dev);
793*4882a593Smuzhiyun }
794*4882a593Smuzhiyun if (status & (AdapterFailure | RxEarly | StatsFull | TxComplete)) {
795*4882a593Smuzhiyun /* Handle all uncommon interrupts. */
796*4882a593Smuzhiyun if (status & StatsFull) /* Empty statistics. */
797*4882a593Smuzhiyun update_stats(dev);
798*4882a593Smuzhiyun if (status & RxEarly) { /* Rx early is unused. */
799*4882a593Smuzhiyun el3_rx(dev);
800*4882a593Smuzhiyun outw(AckIntr | RxEarly, ioaddr + EL3_CMD);
801*4882a593Smuzhiyun }
802*4882a593Smuzhiyun if (status & TxComplete) { /* Really Tx error. */
803*4882a593Smuzhiyun short tx_status;
804*4882a593Smuzhiyun int i = 4;
805*4882a593Smuzhiyun
806*4882a593Smuzhiyun while (--i>0 && (tx_status = inb(ioaddr + TX_STATUS)) > 0) {
807*4882a593Smuzhiyun if (tx_status & 0x38) dev->stats.tx_aborted_errors++;
808*4882a593Smuzhiyun if (tx_status & 0x30) outw(TxReset, ioaddr + EL3_CMD);
809*4882a593Smuzhiyun if (tx_status & 0x3C) outw(TxEnable, ioaddr + EL3_CMD);
810*4882a593Smuzhiyun outb(0x00, ioaddr + TX_STATUS); /* Pop the status stack. */
811*4882a593Smuzhiyun }
812*4882a593Smuzhiyun }
813*4882a593Smuzhiyun if (status & AdapterFailure) {
814*4882a593Smuzhiyun /* Adapter failure requires Rx reset and reinit. */
815*4882a593Smuzhiyun outw(RxReset, ioaddr + EL3_CMD);
816*4882a593Smuzhiyun /* Set the Rx filter to the current state. */
817*4882a593Smuzhiyun outw(SetRxFilter | RxStation | RxBroadcast
818*4882a593Smuzhiyun | (dev->flags & IFF_ALLMULTI ? RxMulticast : 0)
819*4882a593Smuzhiyun | (dev->flags & IFF_PROMISC ? RxProm : 0),
820*4882a593Smuzhiyun ioaddr + EL3_CMD);
821*4882a593Smuzhiyun outw(RxEnable, ioaddr + EL3_CMD); /* Re-enable the receiver. */
822*4882a593Smuzhiyun outw(AckIntr | AdapterFailure, ioaddr + EL3_CMD);
823*4882a593Smuzhiyun }
824*4882a593Smuzhiyun }
825*4882a593Smuzhiyun
826*4882a593Smuzhiyun if (--i < 0) {
827*4882a593Smuzhiyun pr_err("%s: Infinite loop in interrupt, status %4.4x.\n",
828*4882a593Smuzhiyun dev->name, status);
829*4882a593Smuzhiyun /* Clear all interrupts. */
830*4882a593Smuzhiyun outw(AckIntr | 0xFF, ioaddr + EL3_CMD);
831*4882a593Smuzhiyun break;
832*4882a593Smuzhiyun }
833*4882a593Smuzhiyun /* Acknowledge the IRQ. */
834*4882a593Smuzhiyun outw(AckIntr | IntReq | IntLatch, ioaddr + EL3_CMD); /* Ack IRQ */
835*4882a593Smuzhiyun }
836*4882a593Smuzhiyun
837*4882a593Smuzhiyun if (el3_debug > 4) {
838*4882a593Smuzhiyun pr_debug("%s: exiting interrupt, status %4.4x.\n", dev->name,
839*4882a593Smuzhiyun inw(ioaddr + EL3_STATUS));
840*4882a593Smuzhiyun }
841*4882a593Smuzhiyun spin_unlock(&lp->lock);
842*4882a593Smuzhiyun return IRQ_HANDLED;
843*4882a593Smuzhiyun }
844*4882a593Smuzhiyun
845*4882a593Smuzhiyun
846*4882a593Smuzhiyun #ifdef CONFIG_NET_POLL_CONTROLLER
847*4882a593Smuzhiyun /*
848*4882a593Smuzhiyun * Polling receive - used by netconsole and other diagnostic tools
849*4882a593Smuzhiyun * to allow network i/o with interrupts disabled.
850*4882a593Smuzhiyun */
el3_poll_controller(struct net_device * dev)851*4882a593Smuzhiyun static void el3_poll_controller(struct net_device *dev)
852*4882a593Smuzhiyun {
853*4882a593Smuzhiyun disable_irq(dev->irq);
854*4882a593Smuzhiyun el3_interrupt(dev->irq, dev);
855*4882a593Smuzhiyun enable_irq(dev->irq);
856*4882a593Smuzhiyun }
857*4882a593Smuzhiyun #endif
858*4882a593Smuzhiyun
859*4882a593Smuzhiyun static struct net_device_stats *
el3_get_stats(struct net_device * dev)860*4882a593Smuzhiyun el3_get_stats(struct net_device *dev)
861*4882a593Smuzhiyun {
862*4882a593Smuzhiyun struct el3_private *lp = netdev_priv(dev);
863*4882a593Smuzhiyun unsigned long flags;
864*4882a593Smuzhiyun
865*4882a593Smuzhiyun /*
866*4882a593Smuzhiyun * This is fast enough not to bother with disable IRQ
867*4882a593Smuzhiyun * stuff.
868*4882a593Smuzhiyun */
869*4882a593Smuzhiyun
870*4882a593Smuzhiyun spin_lock_irqsave(&lp->lock, flags);
871*4882a593Smuzhiyun update_stats(dev);
872*4882a593Smuzhiyun spin_unlock_irqrestore(&lp->lock, flags);
873*4882a593Smuzhiyun return &dev->stats;
874*4882a593Smuzhiyun }
875*4882a593Smuzhiyun
876*4882a593Smuzhiyun /* Update statistics. We change to register window 6, so this should be run
877*4882a593Smuzhiyun single-threaded if the device is active. This is expected to be a rare
878*4882a593Smuzhiyun operation, and it's simpler for the rest of the driver to assume that
879*4882a593Smuzhiyun window 1 is always valid rather than use a special window-state variable.
880*4882a593Smuzhiyun */
update_stats(struct net_device * dev)881*4882a593Smuzhiyun static void update_stats(struct net_device *dev)
882*4882a593Smuzhiyun {
883*4882a593Smuzhiyun int ioaddr = dev->base_addr;
884*4882a593Smuzhiyun
885*4882a593Smuzhiyun if (el3_debug > 5)
886*4882a593Smuzhiyun pr_debug(" Updating the statistics.\n");
887*4882a593Smuzhiyun /* Turn off statistics updates while reading. */
888*4882a593Smuzhiyun outw(StatsDisable, ioaddr + EL3_CMD);
889*4882a593Smuzhiyun /* Switch to the stats window, and read everything. */
890*4882a593Smuzhiyun EL3WINDOW(6);
891*4882a593Smuzhiyun dev->stats.tx_carrier_errors += inb(ioaddr + 0);
892*4882a593Smuzhiyun dev->stats.tx_heartbeat_errors += inb(ioaddr + 1);
893*4882a593Smuzhiyun /* Multiple collisions. */ inb(ioaddr + 2);
894*4882a593Smuzhiyun dev->stats.collisions += inb(ioaddr + 3);
895*4882a593Smuzhiyun dev->stats.tx_window_errors += inb(ioaddr + 4);
896*4882a593Smuzhiyun dev->stats.rx_fifo_errors += inb(ioaddr + 5);
897*4882a593Smuzhiyun dev->stats.tx_packets += inb(ioaddr + 6);
898*4882a593Smuzhiyun /* Rx packets */ inb(ioaddr + 7);
899*4882a593Smuzhiyun /* Tx deferrals */ inb(ioaddr + 8);
900*4882a593Smuzhiyun inw(ioaddr + 10); /* Total Rx and Tx octets. */
901*4882a593Smuzhiyun inw(ioaddr + 12);
902*4882a593Smuzhiyun
903*4882a593Smuzhiyun /* Back to window 1, and turn statistics back on. */
904*4882a593Smuzhiyun EL3WINDOW(1);
905*4882a593Smuzhiyun outw(StatsEnable, ioaddr + EL3_CMD);
906*4882a593Smuzhiyun }
907*4882a593Smuzhiyun
908*4882a593Smuzhiyun static int
el3_rx(struct net_device * dev)909*4882a593Smuzhiyun el3_rx(struct net_device *dev)
910*4882a593Smuzhiyun {
911*4882a593Smuzhiyun int ioaddr = dev->base_addr;
912*4882a593Smuzhiyun short rx_status;
913*4882a593Smuzhiyun
914*4882a593Smuzhiyun if (el3_debug > 5)
915*4882a593Smuzhiyun pr_debug(" In rx_packet(), status %4.4x, rx_status %4.4x.\n",
916*4882a593Smuzhiyun inw(ioaddr+EL3_STATUS), inw(ioaddr+RX_STATUS));
917*4882a593Smuzhiyun while ((rx_status = inw(ioaddr + RX_STATUS)) > 0) {
918*4882a593Smuzhiyun if (rx_status & 0x4000) { /* Error, update stats. */
919*4882a593Smuzhiyun short error = rx_status & 0x3800;
920*4882a593Smuzhiyun
921*4882a593Smuzhiyun outw(RxDiscard, ioaddr + EL3_CMD);
922*4882a593Smuzhiyun dev->stats.rx_errors++;
923*4882a593Smuzhiyun switch (error) {
924*4882a593Smuzhiyun case 0x0000: dev->stats.rx_over_errors++; break;
925*4882a593Smuzhiyun case 0x0800: dev->stats.rx_length_errors++; break;
926*4882a593Smuzhiyun case 0x1000: dev->stats.rx_frame_errors++; break;
927*4882a593Smuzhiyun case 0x1800: dev->stats.rx_length_errors++; break;
928*4882a593Smuzhiyun case 0x2000: dev->stats.rx_frame_errors++; break;
929*4882a593Smuzhiyun case 0x2800: dev->stats.rx_crc_errors++; break;
930*4882a593Smuzhiyun }
931*4882a593Smuzhiyun } else {
932*4882a593Smuzhiyun short pkt_len = rx_status & 0x7ff;
933*4882a593Smuzhiyun struct sk_buff *skb;
934*4882a593Smuzhiyun
935*4882a593Smuzhiyun skb = netdev_alloc_skb(dev, pkt_len + 5);
936*4882a593Smuzhiyun if (el3_debug > 4)
937*4882a593Smuzhiyun pr_debug("Receiving packet size %d status %4.4x.\n",
938*4882a593Smuzhiyun pkt_len, rx_status);
939*4882a593Smuzhiyun if (skb != NULL) {
940*4882a593Smuzhiyun skb_reserve(skb, 2); /* Align IP on 16 byte */
941*4882a593Smuzhiyun
942*4882a593Smuzhiyun /* 'skb->data' points to the start of sk_buff data area. */
943*4882a593Smuzhiyun insl(ioaddr + RX_FIFO, skb_put(skb,pkt_len),
944*4882a593Smuzhiyun (pkt_len + 3) >> 2);
945*4882a593Smuzhiyun
946*4882a593Smuzhiyun outw(RxDiscard, ioaddr + EL3_CMD); /* Pop top Rx packet. */
947*4882a593Smuzhiyun skb->protocol = eth_type_trans(skb,dev);
948*4882a593Smuzhiyun netif_rx(skb);
949*4882a593Smuzhiyun dev->stats.rx_bytes += pkt_len;
950*4882a593Smuzhiyun dev->stats.rx_packets++;
951*4882a593Smuzhiyun continue;
952*4882a593Smuzhiyun }
953*4882a593Smuzhiyun outw(RxDiscard, ioaddr + EL3_CMD);
954*4882a593Smuzhiyun dev->stats.rx_dropped++;
955*4882a593Smuzhiyun if (el3_debug)
956*4882a593Smuzhiyun pr_debug("%s: Couldn't allocate a sk_buff of size %d.\n",
957*4882a593Smuzhiyun dev->name, pkt_len);
958*4882a593Smuzhiyun }
959*4882a593Smuzhiyun inw(ioaddr + EL3_STATUS); /* Delay. */
960*4882a593Smuzhiyun while (inw(ioaddr + EL3_STATUS) & 0x1000)
961*4882a593Smuzhiyun pr_debug(" Waiting for 3c509 to discard packet, status %x.\n",
962*4882a593Smuzhiyun inw(ioaddr + EL3_STATUS) );
963*4882a593Smuzhiyun }
964*4882a593Smuzhiyun
965*4882a593Smuzhiyun return 0;
966*4882a593Smuzhiyun }
967*4882a593Smuzhiyun
968*4882a593Smuzhiyun /*
969*4882a593Smuzhiyun * Set or clear the multicast filter for this adaptor.
970*4882a593Smuzhiyun */
971*4882a593Smuzhiyun static void
set_multicast_list(struct net_device * dev)972*4882a593Smuzhiyun set_multicast_list(struct net_device *dev)
973*4882a593Smuzhiyun {
974*4882a593Smuzhiyun unsigned long flags;
975*4882a593Smuzhiyun struct el3_private *lp = netdev_priv(dev);
976*4882a593Smuzhiyun int ioaddr = dev->base_addr;
977*4882a593Smuzhiyun int mc_count = netdev_mc_count(dev);
978*4882a593Smuzhiyun
979*4882a593Smuzhiyun if (el3_debug > 1) {
980*4882a593Smuzhiyun static int old;
981*4882a593Smuzhiyun if (old != mc_count) {
982*4882a593Smuzhiyun old = mc_count;
983*4882a593Smuzhiyun pr_debug("%s: Setting Rx mode to %d addresses.\n",
984*4882a593Smuzhiyun dev->name, mc_count);
985*4882a593Smuzhiyun }
986*4882a593Smuzhiyun }
987*4882a593Smuzhiyun spin_lock_irqsave(&lp->lock, flags);
988*4882a593Smuzhiyun if (dev->flags&IFF_PROMISC) {
989*4882a593Smuzhiyun outw(SetRxFilter | RxStation | RxMulticast | RxBroadcast | RxProm,
990*4882a593Smuzhiyun ioaddr + EL3_CMD);
991*4882a593Smuzhiyun }
992*4882a593Smuzhiyun else if (mc_count || (dev->flags&IFF_ALLMULTI)) {
993*4882a593Smuzhiyun outw(SetRxFilter | RxStation | RxMulticast | RxBroadcast, ioaddr + EL3_CMD);
994*4882a593Smuzhiyun }
995*4882a593Smuzhiyun else
996*4882a593Smuzhiyun outw(SetRxFilter | RxStation | RxBroadcast, ioaddr + EL3_CMD);
997*4882a593Smuzhiyun spin_unlock_irqrestore(&lp->lock, flags);
998*4882a593Smuzhiyun }
999*4882a593Smuzhiyun
1000*4882a593Smuzhiyun static int
el3_close(struct net_device * dev)1001*4882a593Smuzhiyun el3_close(struct net_device *dev)
1002*4882a593Smuzhiyun {
1003*4882a593Smuzhiyun int ioaddr = dev->base_addr;
1004*4882a593Smuzhiyun struct el3_private *lp = netdev_priv(dev);
1005*4882a593Smuzhiyun
1006*4882a593Smuzhiyun if (el3_debug > 2)
1007*4882a593Smuzhiyun pr_debug("%s: Shutting down ethercard.\n", dev->name);
1008*4882a593Smuzhiyun
1009*4882a593Smuzhiyun el3_down(dev);
1010*4882a593Smuzhiyun
1011*4882a593Smuzhiyun free_irq(dev->irq, dev);
1012*4882a593Smuzhiyun /* Switching back to window 0 disables the IRQ. */
1013*4882a593Smuzhiyun EL3WINDOW(0);
1014*4882a593Smuzhiyun if (lp->type != EL3_EISA) {
1015*4882a593Smuzhiyun /* But we explicitly zero the IRQ line select anyway. Don't do
1016*4882a593Smuzhiyun * it on EISA cards, it prevents the module from getting an
1017*4882a593Smuzhiyun * IRQ after unload+reload... */
1018*4882a593Smuzhiyun outw(0x0f00, ioaddr + WN0_IRQ);
1019*4882a593Smuzhiyun }
1020*4882a593Smuzhiyun
1021*4882a593Smuzhiyun return 0;
1022*4882a593Smuzhiyun }
1023*4882a593Smuzhiyun
1024*4882a593Smuzhiyun static int
el3_link_ok(struct net_device * dev)1025*4882a593Smuzhiyun el3_link_ok(struct net_device *dev)
1026*4882a593Smuzhiyun {
1027*4882a593Smuzhiyun int ioaddr = dev->base_addr;
1028*4882a593Smuzhiyun u16 tmp;
1029*4882a593Smuzhiyun
1030*4882a593Smuzhiyun EL3WINDOW(4);
1031*4882a593Smuzhiyun tmp = inw(ioaddr + WN4_MEDIA);
1032*4882a593Smuzhiyun EL3WINDOW(1);
1033*4882a593Smuzhiyun return tmp & (1<<11);
1034*4882a593Smuzhiyun }
1035*4882a593Smuzhiyun
1036*4882a593Smuzhiyun static void
el3_netdev_get_ecmd(struct net_device * dev,struct ethtool_link_ksettings * cmd)1037*4882a593Smuzhiyun el3_netdev_get_ecmd(struct net_device *dev, struct ethtool_link_ksettings *cmd)
1038*4882a593Smuzhiyun {
1039*4882a593Smuzhiyun u16 tmp;
1040*4882a593Smuzhiyun int ioaddr = dev->base_addr;
1041*4882a593Smuzhiyun u32 supported;
1042*4882a593Smuzhiyun
1043*4882a593Smuzhiyun EL3WINDOW(0);
1044*4882a593Smuzhiyun /* obtain current transceiver via WN4_MEDIA? */
1045*4882a593Smuzhiyun tmp = inw(ioaddr + WN0_ADDR_CONF);
1046*4882a593Smuzhiyun switch (tmp >> 14) {
1047*4882a593Smuzhiyun case 0:
1048*4882a593Smuzhiyun cmd->base.port = PORT_TP;
1049*4882a593Smuzhiyun break;
1050*4882a593Smuzhiyun case 1:
1051*4882a593Smuzhiyun cmd->base.port = PORT_AUI;
1052*4882a593Smuzhiyun break;
1053*4882a593Smuzhiyun case 3:
1054*4882a593Smuzhiyun cmd->base.port = PORT_BNC;
1055*4882a593Smuzhiyun default:
1056*4882a593Smuzhiyun break;
1057*4882a593Smuzhiyun }
1058*4882a593Smuzhiyun
1059*4882a593Smuzhiyun cmd->base.duplex = DUPLEX_HALF;
1060*4882a593Smuzhiyun supported = 0;
1061*4882a593Smuzhiyun tmp = inw(ioaddr + WN0_CONF_CTRL);
1062*4882a593Smuzhiyun if (tmp & (1<<13))
1063*4882a593Smuzhiyun supported |= SUPPORTED_AUI;
1064*4882a593Smuzhiyun if (tmp & (1<<12))
1065*4882a593Smuzhiyun supported |= SUPPORTED_BNC;
1066*4882a593Smuzhiyun if (tmp & (1<<9)) {
1067*4882a593Smuzhiyun supported |= SUPPORTED_TP | SUPPORTED_10baseT_Half |
1068*4882a593Smuzhiyun SUPPORTED_10baseT_Full; /* hmm... */
1069*4882a593Smuzhiyun EL3WINDOW(4);
1070*4882a593Smuzhiyun tmp = inw(ioaddr + WN4_NETDIAG);
1071*4882a593Smuzhiyun if (tmp & FD_ENABLE)
1072*4882a593Smuzhiyun cmd->base.duplex = DUPLEX_FULL;
1073*4882a593Smuzhiyun }
1074*4882a593Smuzhiyun
1075*4882a593Smuzhiyun ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.supported,
1076*4882a593Smuzhiyun supported);
1077*4882a593Smuzhiyun cmd->base.speed = SPEED_10;
1078*4882a593Smuzhiyun EL3WINDOW(1);
1079*4882a593Smuzhiyun }
1080*4882a593Smuzhiyun
1081*4882a593Smuzhiyun static int
el3_netdev_set_ecmd(struct net_device * dev,const struct ethtool_link_ksettings * cmd)1082*4882a593Smuzhiyun el3_netdev_set_ecmd(struct net_device *dev,
1083*4882a593Smuzhiyun const struct ethtool_link_ksettings *cmd)
1084*4882a593Smuzhiyun {
1085*4882a593Smuzhiyun u16 tmp;
1086*4882a593Smuzhiyun int ioaddr = dev->base_addr;
1087*4882a593Smuzhiyun
1088*4882a593Smuzhiyun if (cmd->base.speed != SPEED_10)
1089*4882a593Smuzhiyun return -EINVAL;
1090*4882a593Smuzhiyun if ((cmd->base.duplex != DUPLEX_HALF) &&
1091*4882a593Smuzhiyun (cmd->base.duplex != DUPLEX_FULL))
1092*4882a593Smuzhiyun return -EINVAL;
1093*4882a593Smuzhiyun
1094*4882a593Smuzhiyun /* change XCVR type */
1095*4882a593Smuzhiyun EL3WINDOW(0);
1096*4882a593Smuzhiyun tmp = inw(ioaddr + WN0_ADDR_CONF);
1097*4882a593Smuzhiyun switch (cmd->base.port) {
1098*4882a593Smuzhiyun case PORT_TP:
1099*4882a593Smuzhiyun tmp &= ~(3<<14);
1100*4882a593Smuzhiyun dev->if_port = 0;
1101*4882a593Smuzhiyun break;
1102*4882a593Smuzhiyun case PORT_AUI:
1103*4882a593Smuzhiyun tmp |= (1<<14);
1104*4882a593Smuzhiyun dev->if_port = 1;
1105*4882a593Smuzhiyun break;
1106*4882a593Smuzhiyun case PORT_BNC:
1107*4882a593Smuzhiyun tmp |= (3<<14);
1108*4882a593Smuzhiyun dev->if_port = 3;
1109*4882a593Smuzhiyun break;
1110*4882a593Smuzhiyun default:
1111*4882a593Smuzhiyun return -EINVAL;
1112*4882a593Smuzhiyun }
1113*4882a593Smuzhiyun
1114*4882a593Smuzhiyun outw(tmp, ioaddr + WN0_ADDR_CONF);
1115*4882a593Smuzhiyun if (dev->if_port == 3) {
1116*4882a593Smuzhiyun /* fire up the DC-DC convertor if BNC gets enabled */
1117*4882a593Smuzhiyun tmp = inw(ioaddr + WN0_ADDR_CONF);
1118*4882a593Smuzhiyun if (tmp & (3 << 14)) {
1119*4882a593Smuzhiyun outw(StartCoax, ioaddr + EL3_CMD);
1120*4882a593Smuzhiyun udelay(800);
1121*4882a593Smuzhiyun } else
1122*4882a593Smuzhiyun return -EIO;
1123*4882a593Smuzhiyun }
1124*4882a593Smuzhiyun
1125*4882a593Smuzhiyun EL3WINDOW(4);
1126*4882a593Smuzhiyun tmp = inw(ioaddr + WN4_NETDIAG);
1127*4882a593Smuzhiyun if (cmd->base.duplex == DUPLEX_FULL)
1128*4882a593Smuzhiyun tmp |= FD_ENABLE;
1129*4882a593Smuzhiyun else
1130*4882a593Smuzhiyun tmp &= ~FD_ENABLE;
1131*4882a593Smuzhiyun outw(tmp, ioaddr + WN4_NETDIAG);
1132*4882a593Smuzhiyun EL3WINDOW(1);
1133*4882a593Smuzhiyun
1134*4882a593Smuzhiyun return 0;
1135*4882a593Smuzhiyun }
1136*4882a593Smuzhiyun
el3_get_drvinfo(struct net_device * dev,struct ethtool_drvinfo * info)1137*4882a593Smuzhiyun static void el3_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
1138*4882a593Smuzhiyun {
1139*4882a593Smuzhiyun strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
1140*4882a593Smuzhiyun }
1141*4882a593Smuzhiyun
el3_get_link_ksettings(struct net_device * dev,struct ethtool_link_ksettings * cmd)1142*4882a593Smuzhiyun static int el3_get_link_ksettings(struct net_device *dev,
1143*4882a593Smuzhiyun struct ethtool_link_ksettings *cmd)
1144*4882a593Smuzhiyun {
1145*4882a593Smuzhiyun struct el3_private *lp = netdev_priv(dev);
1146*4882a593Smuzhiyun
1147*4882a593Smuzhiyun spin_lock_irq(&lp->lock);
1148*4882a593Smuzhiyun el3_netdev_get_ecmd(dev, cmd);
1149*4882a593Smuzhiyun spin_unlock_irq(&lp->lock);
1150*4882a593Smuzhiyun return 0;
1151*4882a593Smuzhiyun }
1152*4882a593Smuzhiyun
el3_set_link_ksettings(struct net_device * dev,const struct ethtool_link_ksettings * cmd)1153*4882a593Smuzhiyun static int el3_set_link_ksettings(struct net_device *dev,
1154*4882a593Smuzhiyun const struct ethtool_link_ksettings *cmd)
1155*4882a593Smuzhiyun {
1156*4882a593Smuzhiyun struct el3_private *lp = netdev_priv(dev);
1157*4882a593Smuzhiyun int ret;
1158*4882a593Smuzhiyun
1159*4882a593Smuzhiyun spin_lock_irq(&lp->lock);
1160*4882a593Smuzhiyun ret = el3_netdev_set_ecmd(dev, cmd);
1161*4882a593Smuzhiyun spin_unlock_irq(&lp->lock);
1162*4882a593Smuzhiyun return ret;
1163*4882a593Smuzhiyun }
1164*4882a593Smuzhiyun
el3_get_link(struct net_device * dev)1165*4882a593Smuzhiyun static u32 el3_get_link(struct net_device *dev)
1166*4882a593Smuzhiyun {
1167*4882a593Smuzhiyun struct el3_private *lp = netdev_priv(dev);
1168*4882a593Smuzhiyun u32 ret;
1169*4882a593Smuzhiyun
1170*4882a593Smuzhiyun spin_lock_irq(&lp->lock);
1171*4882a593Smuzhiyun ret = el3_link_ok(dev);
1172*4882a593Smuzhiyun spin_unlock_irq(&lp->lock);
1173*4882a593Smuzhiyun return ret;
1174*4882a593Smuzhiyun }
1175*4882a593Smuzhiyun
el3_get_msglevel(struct net_device * dev)1176*4882a593Smuzhiyun static u32 el3_get_msglevel(struct net_device *dev)
1177*4882a593Smuzhiyun {
1178*4882a593Smuzhiyun return el3_debug;
1179*4882a593Smuzhiyun }
1180*4882a593Smuzhiyun
el3_set_msglevel(struct net_device * dev,u32 v)1181*4882a593Smuzhiyun static void el3_set_msglevel(struct net_device *dev, u32 v)
1182*4882a593Smuzhiyun {
1183*4882a593Smuzhiyun el3_debug = v;
1184*4882a593Smuzhiyun }
1185*4882a593Smuzhiyun
1186*4882a593Smuzhiyun static const struct ethtool_ops ethtool_ops = {
1187*4882a593Smuzhiyun .get_drvinfo = el3_get_drvinfo,
1188*4882a593Smuzhiyun .get_link = el3_get_link,
1189*4882a593Smuzhiyun .get_msglevel = el3_get_msglevel,
1190*4882a593Smuzhiyun .set_msglevel = el3_set_msglevel,
1191*4882a593Smuzhiyun .get_link_ksettings = el3_get_link_ksettings,
1192*4882a593Smuzhiyun .set_link_ksettings = el3_set_link_ksettings,
1193*4882a593Smuzhiyun };
1194*4882a593Smuzhiyun
1195*4882a593Smuzhiyun static void
el3_down(struct net_device * dev)1196*4882a593Smuzhiyun el3_down(struct net_device *dev)
1197*4882a593Smuzhiyun {
1198*4882a593Smuzhiyun int ioaddr = dev->base_addr;
1199*4882a593Smuzhiyun
1200*4882a593Smuzhiyun netif_stop_queue(dev);
1201*4882a593Smuzhiyun
1202*4882a593Smuzhiyun /* Turn off statistics ASAP. We update lp->stats below. */
1203*4882a593Smuzhiyun outw(StatsDisable, ioaddr + EL3_CMD);
1204*4882a593Smuzhiyun
1205*4882a593Smuzhiyun /* Disable the receiver and transmitter. */
1206*4882a593Smuzhiyun outw(RxDisable, ioaddr + EL3_CMD);
1207*4882a593Smuzhiyun outw(TxDisable, ioaddr + EL3_CMD);
1208*4882a593Smuzhiyun
1209*4882a593Smuzhiyun if (dev->if_port == 3)
1210*4882a593Smuzhiyun /* Turn off thinnet power. Green! */
1211*4882a593Smuzhiyun outw(StopCoax, ioaddr + EL3_CMD);
1212*4882a593Smuzhiyun else if (dev->if_port == 0) {
1213*4882a593Smuzhiyun /* Disable link beat and jabber, if_port may change here next open(). */
1214*4882a593Smuzhiyun EL3WINDOW(4);
1215*4882a593Smuzhiyun outw(inw(ioaddr + WN4_MEDIA) & ~MEDIA_TP, ioaddr + WN4_MEDIA);
1216*4882a593Smuzhiyun }
1217*4882a593Smuzhiyun
1218*4882a593Smuzhiyun outw(SetIntrEnb | 0x0000, ioaddr + EL3_CMD);
1219*4882a593Smuzhiyun
1220*4882a593Smuzhiyun update_stats(dev);
1221*4882a593Smuzhiyun }
1222*4882a593Smuzhiyun
1223*4882a593Smuzhiyun static void
el3_up(struct net_device * dev)1224*4882a593Smuzhiyun el3_up(struct net_device *dev)
1225*4882a593Smuzhiyun {
1226*4882a593Smuzhiyun int i, sw_info, net_diag;
1227*4882a593Smuzhiyun int ioaddr = dev->base_addr;
1228*4882a593Smuzhiyun
1229*4882a593Smuzhiyun /* Activating the board required and does no harm otherwise */
1230*4882a593Smuzhiyun outw(0x0001, ioaddr + 4);
1231*4882a593Smuzhiyun
1232*4882a593Smuzhiyun /* Set the IRQ line. */
1233*4882a593Smuzhiyun outw((dev->irq << 12) | 0x0f00, ioaddr + WN0_IRQ);
1234*4882a593Smuzhiyun
1235*4882a593Smuzhiyun /* Set the station address in window 2 each time opened. */
1236*4882a593Smuzhiyun EL3WINDOW(2);
1237*4882a593Smuzhiyun
1238*4882a593Smuzhiyun for (i = 0; i < 6; i++)
1239*4882a593Smuzhiyun outb(dev->dev_addr[i], ioaddr + i);
1240*4882a593Smuzhiyun
1241*4882a593Smuzhiyun if ((dev->if_port & 0x03) == 3) /* BNC interface */
1242*4882a593Smuzhiyun /* Start the thinnet transceiver. We should really wait 50ms...*/
1243*4882a593Smuzhiyun outw(StartCoax, ioaddr + EL3_CMD);
1244*4882a593Smuzhiyun else if ((dev->if_port & 0x03) == 0) { /* 10baseT interface */
1245*4882a593Smuzhiyun /* Combine secondary sw_info word (the adapter level) and primary
1246*4882a593Smuzhiyun sw_info word (duplex setting plus other useless bits) */
1247*4882a593Smuzhiyun EL3WINDOW(0);
1248*4882a593Smuzhiyun sw_info = (read_eeprom(ioaddr, 0x14) & 0x400f) |
1249*4882a593Smuzhiyun (read_eeprom(ioaddr, 0x0d) & 0xBff0);
1250*4882a593Smuzhiyun
1251*4882a593Smuzhiyun EL3WINDOW(4);
1252*4882a593Smuzhiyun net_diag = inw(ioaddr + WN4_NETDIAG);
1253*4882a593Smuzhiyun net_diag = (net_diag | FD_ENABLE); /* temporarily assume full-duplex will be set */
1254*4882a593Smuzhiyun pr_info("%s: ", dev->name);
1255*4882a593Smuzhiyun switch (dev->if_port & 0x0c) {
1256*4882a593Smuzhiyun case 12:
1257*4882a593Smuzhiyun /* force full-duplex mode if 3c5x9b */
1258*4882a593Smuzhiyun if (sw_info & 0x000f) {
1259*4882a593Smuzhiyun pr_cont("Forcing 3c5x9b full-duplex mode");
1260*4882a593Smuzhiyun break;
1261*4882a593Smuzhiyun }
1262*4882a593Smuzhiyun fallthrough;
1263*4882a593Smuzhiyun case 8:
1264*4882a593Smuzhiyun /* set full-duplex mode based on eeprom config setting */
1265*4882a593Smuzhiyun if ((sw_info & 0x000f) && (sw_info & 0x8000)) {
1266*4882a593Smuzhiyun pr_cont("Setting 3c5x9b full-duplex mode (from EEPROM configuration bit)");
1267*4882a593Smuzhiyun break;
1268*4882a593Smuzhiyun }
1269*4882a593Smuzhiyun fallthrough;
1270*4882a593Smuzhiyun default:
1271*4882a593Smuzhiyun /* xcvr=(0 || 4) OR user has an old 3c5x9 non "B" model */
1272*4882a593Smuzhiyun pr_cont("Setting 3c5x9/3c5x9B half-duplex mode");
1273*4882a593Smuzhiyun net_diag = (net_diag & ~FD_ENABLE); /* disable full duplex */
1274*4882a593Smuzhiyun }
1275*4882a593Smuzhiyun
1276*4882a593Smuzhiyun outw(net_diag, ioaddr + WN4_NETDIAG);
1277*4882a593Smuzhiyun pr_cont(" if_port: %d, sw_info: %4.4x\n", dev->if_port, sw_info);
1278*4882a593Smuzhiyun if (el3_debug > 3)
1279*4882a593Smuzhiyun pr_debug("%s: 3c5x9 net diag word is now: %4.4x.\n", dev->name, net_diag);
1280*4882a593Smuzhiyun /* Enable link beat and jabber check. */
1281*4882a593Smuzhiyun outw(inw(ioaddr + WN4_MEDIA) | MEDIA_TP, ioaddr + WN4_MEDIA);
1282*4882a593Smuzhiyun }
1283*4882a593Smuzhiyun
1284*4882a593Smuzhiyun /* Switch to the stats window, and clear all stats by reading. */
1285*4882a593Smuzhiyun outw(StatsDisable, ioaddr + EL3_CMD);
1286*4882a593Smuzhiyun EL3WINDOW(6);
1287*4882a593Smuzhiyun for (i = 0; i < 9; i++)
1288*4882a593Smuzhiyun inb(ioaddr + i);
1289*4882a593Smuzhiyun inw(ioaddr + 10);
1290*4882a593Smuzhiyun inw(ioaddr + 12);
1291*4882a593Smuzhiyun
1292*4882a593Smuzhiyun /* Switch to register set 1 for normal use. */
1293*4882a593Smuzhiyun EL3WINDOW(1);
1294*4882a593Smuzhiyun
1295*4882a593Smuzhiyun /* Accept b-case and phys addr only. */
1296*4882a593Smuzhiyun outw(SetRxFilter | RxStation | RxBroadcast, ioaddr + EL3_CMD);
1297*4882a593Smuzhiyun outw(StatsEnable, ioaddr + EL3_CMD); /* Turn on statistics. */
1298*4882a593Smuzhiyun
1299*4882a593Smuzhiyun outw(RxEnable, ioaddr + EL3_CMD); /* Enable the receiver. */
1300*4882a593Smuzhiyun outw(TxEnable, ioaddr + EL3_CMD); /* Enable transmitter. */
1301*4882a593Smuzhiyun /* Allow status bits to be seen. */
1302*4882a593Smuzhiyun outw(SetStatusEnb | 0xff, ioaddr + EL3_CMD);
1303*4882a593Smuzhiyun /* Ack all pending events, and set active indicator mask. */
1304*4882a593Smuzhiyun outw(AckIntr | IntLatch | TxAvailable | RxEarly | IntReq,
1305*4882a593Smuzhiyun ioaddr + EL3_CMD);
1306*4882a593Smuzhiyun outw(SetIntrEnb | IntLatch|TxAvailable|TxComplete|RxComplete|StatsFull,
1307*4882a593Smuzhiyun ioaddr + EL3_CMD);
1308*4882a593Smuzhiyun
1309*4882a593Smuzhiyun netif_start_queue(dev);
1310*4882a593Smuzhiyun }
1311*4882a593Smuzhiyun
1312*4882a593Smuzhiyun /* Power Management support functions */
1313*4882a593Smuzhiyun #ifdef CONFIG_PM
1314*4882a593Smuzhiyun
1315*4882a593Smuzhiyun static int
el3_suspend(struct device * pdev,pm_message_t state)1316*4882a593Smuzhiyun el3_suspend(struct device *pdev, pm_message_t state)
1317*4882a593Smuzhiyun {
1318*4882a593Smuzhiyun unsigned long flags;
1319*4882a593Smuzhiyun struct net_device *dev;
1320*4882a593Smuzhiyun struct el3_private *lp;
1321*4882a593Smuzhiyun int ioaddr;
1322*4882a593Smuzhiyun
1323*4882a593Smuzhiyun dev = dev_get_drvdata(pdev);
1324*4882a593Smuzhiyun lp = netdev_priv(dev);
1325*4882a593Smuzhiyun ioaddr = dev->base_addr;
1326*4882a593Smuzhiyun
1327*4882a593Smuzhiyun spin_lock_irqsave(&lp->lock, flags);
1328*4882a593Smuzhiyun
1329*4882a593Smuzhiyun if (netif_running(dev))
1330*4882a593Smuzhiyun netif_device_detach(dev);
1331*4882a593Smuzhiyun
1332*4882a593Smuzhiyun el3_down(dev);
1333*4882a593Smuzhiyun outw(PowerDown, ioaddr + EL3_CMD);
1334*4882a593Smuzhiyun
1335*4882a593Smuzhiyun spin_unlock_irqrestore(&lp->lock, flags);
1336*4882a593Smuzhiyun return 0;
1337*4882a593Smuzhiyun }
1338*4882a593Smuzhiyun
1339*4882a593Smuzhiyun static int
el3_resume(struct device * pdev)1340*4882a593Smuzhiyun el3_resume(struct device *pdev)
1341*4882a593Smuzhiyun {
1342*4882a593Smuzhiyun unsigned long flags;
1343*4882a593Smuzhiyun struct net_device *dev;
1344*4882a593Smuzhiyun struct el3_private *lp;
1345*4882a593Smuzhiyun int ioaddr;
1346*4882a593Smuzhiyun
1347*4882a593Smuzhiyun dev = dev_get_drvdata(pdev);
1348*4882a593Smuzhiyun lp = netdev_priv(dev);
1349*4882a593Smuzhiyun ioaddr = dev->base_addr;
1350*4882a593Smuzhiyun
1351*4882a593Smuzhiyun spin_lock_irqsave(&lp->lock, flags);
1352*4882a593Smuzhiyun
1353*4882a593Smuzhiyun outw(PowerUp, ioaddr + EL3_CMD);
1354*4882a593Smuzhiyun EL3WINDOW(0);
1355*4882a593Smuzhiyun el3_up(dev);
1356*4882a593Smuzhiyun
1357*4882a593Smuzhiyun if (netif_running(dev))
1358*4882a593Smuzhiyun netif_device_attach(dev);
1359*4882a593Smuzhiyun
1360*4882a593Smuzhiyun spin_unlock_irqrestore(&lp->lock, flags);
1361*4882a593Smuzhiyun return 0;
1362*4882a593Smuzhiyun }
1363*4882a593Smuzhiyun
1364*4882a593Smuzhiyun #endif /* CONFIG_PM */
1365*4882a593Smuzhiyun
1366*4882a593Smuzhiyun module_param(debug,int, 0);
1367*4882a593Smuzhiyun module_param_hw_array(irq, int, irq, NULL, 0);
1368*4882a593Smuzhiyun module_param(max_interrupt_work, int, 0);
1369*4882a593Smuzhiyun MODULE_PARM_DESC(debug, "debug level (0-6)");
1370*4882a593Smuzhiyun MODULE_PARM_DESC(irq, "IRQ number(s) (assigned)");
1371*4882a593Smuzhiyun MODULE_PARM_DESC(max_interrupt_work, "maximum events handled per interrupt");
1372*4882a593Smuzhiyun #ifdef CONFIG_PNP
1373*4882a593Smuzhiyun module_param(nopnp, int, 0);
1374*4882a593Smuzhiyun MODULE_PARM_DESC(nopnp, "disable ISA PnP support (0-1)");
1375*4882a593Smuzhiyun #endif /* CONFIG_PNP */
1376*4882a593Smuzhiyun MODULE_DESCRIPTION("3Com Etherlink III (3c509, 3c509B, 3c529, 3c579) ethernet driver");
1377*4882a593Smuzhiyun MODULE_LICENSE("GPL");
1378*4882a593Smuzhiyun
el3_init_module(void)1379*4882a593Smuzhiyun static int __init el3_init_module(void)
1380*4882a593Smuzhiyun {
1381*4882a593Smuzhiyun int ret = 0;
1382*4882a593Smuzhiyun
1383*4882a593Smuzhiyun if (debug >= 0)
1384*4882a593Smuzhiyun el3_debug = debug;
1385*4882a593Smuzhiyun
1386*4882a593Smuzhiyun #ifdef CONFIG_PNP
1387*4882a593Smuzhiyun if (!nopnp) {
1388*4882a593Smuzhiyun ret = pnp_register_driver(&el3_pnp_driver);
1389*4882a593Smuzhiyun if (!ret)
1390*4882a593Smuzhiyun pnp_registered = 1;
1391*4882a593Smuzhiyun }
1392*4882a593Smuzhiyun #endif
1393*4882a593Smuzhiyun /* Select an open I/O location at 0x1*0 to do ISA contention select. */
1394*4882a593Smuzhiyun /* Start with 0x110 to avoid some sound cards.*/
1395*4882a593Smuzhiyun for (id_port = 0x110 ; id_port < 0x200; id_port += 0x10) {
1396*4882a593Smuzhiyun if (!request_region(id_port, 1, "3c509-control"))
1397*4882a593Smuzhiyun continue;
1398*4882a593Smuzhiyun outb(0x00, id_port);
1399*4882a593Smuzhiyun outb(0xff, id_port);
1400*4882a593Smuzhiyun if (inb(id_port) & 0x01)
1401*4882a593Smuzhiyun break;
1402*4882a593Smuzhiyun else
1403*4882a593Smuzhiyun release_region(id_port, 1);
1404*4882a593Smuzhiyun }
1405*4882a593Smuzhiyun if (id_port >= 0x200) {
1406*4882a593Smuzhiyun id_port = 0;
1407*4882a593Smuzhiyun pr_err("No I/O port available for 3c509 activation.\n");
1408*4882a593Smuzhiyun } else {
1409*4882a593Smuzhiyun ret = isa_register_driver(&el3_isa_driver, EL3_MAX_CARDS);
1410*4882a593Smuzhiyun if (!ret)
1411*4882a593Smuzhiyun isa_registered = 1;
1412*4882a593Smuzhiyun }
1413*4882a593Smuzhiyun #ifdef CONFIG_EISA
1414*4882a593Smuzhiyun ret = eisa_driver_register(&el3_eisa_driver);
1415*4882a593Smuzhiyun if (!ret)
1416*4882a593Smuzhiyun eisa_registered = 1;
1417*4882a593Smuzhiyun #endif
1418*4882a593Smuzhiyun
1419*4882a593Smuzhiyun #ifdef CONFIG_PNP
1420*4882a593Smuzhiyun if (pnp_registered)
1421*4882a593Smuzhiyun ret = 0;
1422*4882a593Smuzhiyun #endif
1423*4882a593Smuzhiyun if (isa_registered)
1424*4882a593Smuzhiyun ret = 0;
1425*4882a593Smuzhiyun #ifdef CONFIG_EISA
1426*4882a593Smuzhiyun if (eisa_registered)
1427*4882a593Smuzhiyun ret = 0;
1428*4882a593Smuzhiyun #endif
1429*4882a593Smuzhiyun return ret;
1430*4882a593Smuzhiyun }
1431*4882a593Smuzhiyun
el3_cleanup_module(void)1432*4882a593Smuzhiyun static void __exit el3_cleanup_module(void)
1433*4882a593Smuzhiyun {
1434*4882a593Smuzhiyun #ifdef CONFIG_PNP
1435*4882a593Smuzhiyun if (pnp_registered)
1436*4882a593Smuzhiyun pnp_unregister_driver(&el3_pnp_driver);
1437*4882a593Smuzhiyun #endif
1438*4882a593Smuzhiyun if (isa_registered)
1439*4882a593Smuzhiyun isa_unregister_driver(&el3_isa_driver);
1440*4882a593Smuzhiyun if (id_port)
1441*4882a593Smuzhiyun release_region(id_port, 1);
1442*4882a593Smuzhiyun #ifdef CONFIG_EISA
1443*4882a593Smuzhiyun if (eisa_registered)
1444*4882a593Smuzhiyun eisa_driver_unregister(&el3_eisa_driver);
1445*4882a593Smuzhiyun #endif
1446*4882a593Smuzhiyun }
1447*4882a593Smuzhiyun
1448*4882a593Smuzhiyun module_init (el3_init_module);
1449*4882a593Smuzhiyun module_exit (el3_cleanup_module);
1450