1 /* winbond-840.c: A Linux PCI network adapter device driver. */
3 Written 1998-2001 by Donald Becker.
5 This software may be used and distributed according to the terms of
6 the GNU General Public License (GPL), incorporated herein by reference.
7 Drivers based on or derived from this code fall under the GPL and must
8 retain the authorship, copyright and license notice. This file is not
9 a complete program and may only be used when the entire operating
10 system is licensed under the GPL.
12 The author may be reached as becker@scyld.com, or C/O
13 Scyld Computing Corporation
14 410 Severn Ave., Suite 210
17 Support and updates available at
18 http://www.scyld.com/network/drivers.html
20 Do not remove the copyright information.
21 Do not change the version information unless an improvement has been made.
22 Merely removing my name, as Compex has done in the past, does not count
28 * spin lock update, memory barriers, new style dma mappings
29 limit each tx buffer to < 1024 bytes
30 remove DescIntr from Rx descriptors (that's an Tx flag)
31 remove next pointer from Tx descriptors
32 synchronize tx_q_bytes
33 software reset in tx_timeout
34 Copyright (C) 2000 Manfred Spraul
37 support for big endian descriptors
38 Copyright (C) 2001 Manfred Spraul
39 * ethtool support (jgarzik)
40 * Replace some MII-related magic numbers with constants (jgarzik)
43 * enable pci_power_off
47 #define DRV_NAME "winbond-840"
48 #define DRV_VERSION "1.01-e"
49 #define DRV_RELDATE "Sep-11-2006"
52 /* Automatically extracted configuration info:
53 probe-func: winbond840_probe
54 config-in: tristate 'Winbond W89c840 Ethernet support' CONFIG_WINBOND_840
56 c-help-name: Winbond W89c840 PCI Ethernet support
57 c-help-symbol: CONFIG_WINBOND_840
58 c-help: This driver is for the Winbond W89c840 chip. It also works with
59 c-help: the TX9882 chip on the Compex RL100-ATX board.
60 c-help: More specific information and updates are available from
61 c-help: http://www.scyld.com/network/drivers.html
64 /* The user-configurable values.
65 These may be modified when a driver module is loaded.*/
67 static int debug = 1; /* 1 normal messages, 0 quiet .. 7 verbose. */
68 static int max_interrupt_work = 20;
69 /* Maximum number of multicast addresses to filter (vs. Rx-all-multicast).
70 The '840 uses a 64 element hash table based on the Ethernet CRC. */
71 static int multicast_filter_limit = 32;
73 /* Set the copy breakpoint for the copy-only-tiny-frames scheme.
74 Setting to > 1518 effectively disables this feature. */
75 static int rx_copybreak;
77 /* Used to pass the media type, etc.
78 Both 'options[]' and 'full_duplex[]' should exist for driver
80 The media type is usually passed in 'options[]'.
82 #define MAX_UNITS 8 /* More are supported, limit only on options */
83 static int options[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
84 static int full_duplex[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
86 /* Operational parameters that are set at compile time. */
88 /* Keep the ring sizes a power of two for compile efficiency.
89 The compiler will convert <unsigned>'%'<2^N> into a bit mask.
90 Making the Tx ring too large decreases the effectiveness of channel
91 bonding and packet priority.
92 There are no ill effects from too-large receive rings. */
93 #define TX_QUEUE_LEN 10 /* Limit ring entries actually used. */
94 #define TX_QUEUE_LEN_RESTART 5
96 #define TX_BUFLIMIT (1024-128)
98 /* The presumed FIFO size for working around the Tx-FIFO-overflow bug.
99 To avoid overflowing we don't queue again until we have room for a
102 #define TX_FIFO_SIZE (2048)
103 #define TX_BUG_FIFO_LIMIT (TX_FIFO_SIZE-1514-16)
106 /* Operational parameters that usually are not changed. */
107 /* Time in jiffies before concluding the transmitter is hung. */
108 #define TX_TIMEOUT (2*HZ)
110 #define PKT_BUF_SZ 1536 /* Size of each temporary Rx buffer.*/
112 /* Include files, designed to support most kernel versions 2.0.0 and later. */
113 #include <linux/module.h>
114 #include <linux/kernel.h>
115 #include <linux/string.h>
116 #include <linux/timer.h>
117 #include <linux/errno.h>
118 #include <linux/ioport.h>
119 #include <linux/slab.h>
120 #include <linux/interrupt.h>
121 #include <linux/pci.h>
122 #include <linux/dma-mapping.h>
123 #include <linux/netdevice.h>
124 #include <linux/etherdevice.h>
125 #include <linux/skbuff.h>
126 #include <linux/init.h>
127 #include <linux/delay.h>
128 #include <linux/ethtool.h>
129 #include <linux/mii.h>
130 #include <linux/rtnetlink.h>
131 #include <linux/crc32.h>
132 #include <linux/bitops.h>
133 #include <asm/uaccess.h>
134 #include <asm/processor.h> /* Processor type for cache alignment. */
140 /* These identify the driver base version and may not be removed. */
141 static char version[] =
142 KERN_INFO DRV_NAME ".c:v" DRV_VERSION " (2.4 port) " DRV_RELDATE " Donald Becker <becker@scyld.com>\n"
143 KERN_INFO " http://www.scyld.com/network/drivers.html\n";
145 MODULE_AUTHOR("Donald Becker <becker@scyld.com>");
146 MODULE_DESCRIPTION("Winbond W89c840 Ethernet driver");
147 MODULE_LICENSE("GPL");
148 MODULE_VERSION(DRV_VERSION);
150 module_param(max_interrupt_work, int, 0);
151 module_param(debug, int, 0);
152 module_param(rx_copybreak, int, 0);
153 module_param(multicast_filter_limit, int, 0);
154 module_param_array(options, int, NULL, 0);
155 module_param_array(full_duplex, int, NULL, 0);
156 MODULE_PARM_DESC(max_interrupt_work, "winbond-840 maximum events handled per interrupt");
157 MODULE_PARM_DESC(debug, "winbond-840 debug level (0-6)");
158 MODULE_PARM_DESC(rx_copybreak, "winbond-840 copy breakpoint for copy-only-tiny-frames");
159 MODULE_PARM_DESC(multicast_filter_limit, "winbond-840 maximum number of filtered multicast addresses");
160 MODULE_PARM_DESC(options, "winbond-840: Bits 0-3: media type, bit 17: full duplex");
161 MODULE_PARM_DESC(full_duplex, "winbond-840 full duplex setting(s) (1)");
166 I. Board Compatibility
168 This driver is for the Winbond w89c840 chip.
170 II. Board-specific settings
174 III. Driver operation
176 This chip is very similar to the Digital 21*4* "Tulip" family. The first
177 twelve registers and the descriptor format are nearly identical. Read a
178 Tulip manual for operational details.
180 A significant difference is that the multicast filter and station address are
181 stored in registers rather than loaded through a pseudo-transmit packet.
183 Unlike the Tulip, transmit buffers are limited to 1KB. To transmit a
184 full-sized packet we must use both data buffers in a descriptor. Thus the
185 driver uses ring mode where descriptors are implicitly sequential in memory,
186 rather than using the second descriptor address as a chain pointer to
187 subsequent descriptors.
191 If you are going to almost clone a Tulip, why not go all the way and avoid
192 the need for a new driver?
196 http://www.scyld.com/expert/100mbps.html
197 http://www.scyld.com/expert/NWay.html
198 http://www.winbond.com.tw/
202 A horrible bug exists in the transmit FIFO. Apparently the chip doesn't
203 correctly detect a full FIFO, and queuing more than 2048 bytes may result in
204 silent data corruption.
206 Test with 'ping -s 10000' on a fast computer.
215 enum chip_capability_flags {
216 CanHaveMII=1, HasBrokenTx=2, AlwaysFDX=4, FDXOnNoMII=8,
219 static const struct pci_device_id w840_pci_tbl[] = {
220 { 0x1050, 0x0840, PCI_ANY_ID, 0x8153, 0, 0, 0 },
221 { 0x1050, 0x0840, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1 },
222 { 0x11f6, 0x2011, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2 },
225 MODULE_DEVICE_TABLE(pci, w840_pci_tbl);
228 netdev_res_size = 128, /* size of PCI BAR resource */
233 int drv_flags; /* Driver use, intended as capability flags. */
236 static const struct pci_id_info pci_id_tbl[] __devinitdata = {
237 { /* Sometime a Level-One switch card. */
238 "Winbond W89c840", CanHaveMII | HasBrokenTx | FDXOnNoMII},
239 { "Winbond W89c840", CanHaveMII | HasBrokenTx},
240 { "Compex RL100-ATX", CanHaveMII | HasBrokenTx},
241 { } /* terminate list. */
244 /* This driver was written to use PCI memory space, however some x86 systems
245 work only with I/O space accesses. See CONFIG_TULIP_MMIO in .config
248 /* Offsets to the Command and Status Registers, "CSRs".
249 While similar to the Tulip, these registers are longword aligned.
250 Note: It's not useful to define symbolic names for every register bit in
251 the device. The name can only partially document the semantics and make
252 the driver longer and more difficult to read.
255 PCIBusCfg=0x00, TxStartDemand=0x04, RxStartDemand=0x08,
256 RxRingPtr=0x0C, TxRingPtr=0x10,
257 IntrStatus=0x14, NetworkConfig=0x18, IntrEnable=0x1C,
258 RxMissed=0x20, EECtrl=0x24, MIICtrl=0x24, BootRom=0x28, GPTimer=0x2C,
259 CurRxDescAddr=0x30, CurRxBufAddr=0x34, /* Debug use */
260 MulticastFilter0=0x38, MulticastFilter1=0x3C, StationAddr=0x40,
261 CurTxDescAddr=0x4C, CurTxBufAddr=0x50,
264 /* Bits in the NetworkConfig register. */
267 RxAcceptBroadcast=0x20, AcceptMulticast=0x10,
268 RxAcceptAllPhys=0x08, AcceptMyPhys=0x02,
272 MDIO_ShiftClk=0x10000, MDIO_DataIn=0x80000, MDIO_DataOut=0x20000,
273 MDIO_EnbOutput=0x40000, MDIO_EnbIn = 0x00000,
276 /* The Tulip Rx and Tx buffer descriptors. */
277 struct w840_rx_desc {
284 struct w840_tx_desc {
287 u32 buffer1, buffer2;
290 #define MII_CNT 1 /* winbond only supports one MII */
291 struct netdev_private {
292 struct w840_rx_desc *rx_ring;
293 dma_addr_t rx_addr[RX_RING_SIZE];
294 struct w840_tx_desc *tx_ring;
295 dma_addr_t tx_addr[TX_RING_SIZE];
296 dma_addr_t ring_dma_addr;
297 /* The addresses of receive-in-place skbuffs. */
298 struct sk_buff* rx_skbuff[RX_RING_SIZE];
299 /* The saved address of a sent-in-place packet/buffer, for later free(). */
300 struct sk_buff* tx_skbuff[TX_RING_SIZE];
301 struct net_device_stats stats;
302 struct timer_list timer; /* Media monitoring timer. */
303 /* Frequently used values: keep some adjacent for cache effect. */
305 int chip_id, drv_flags;
306 struct pci_dev *pci_dev;
308 struct w840_rx_desc *rx_head_desc;
309 unsigned int cur_rx, dirty_rx; /* Producer/consumer ring indices */
310 unsigned int rx_buf_sz; /* Based on MTU+slack. */
311 unsigned int cur_tx, dirty_tx;
312 unsigned int tx_q_bytes;
313 unsigned int tx_full; /* The Tx queue is full. */
314 /* MII transceiver section. */
315 int mii_cnt; /* MII device addresses. */
316 unsigned char phys[MII_CNT]; /* MII device addresses, but only the first is used */
318 struct mii_if_info mii_if;
319 void __iomem *base_addr;
322 static int eeprom_read(void __iomem *ioaddr, int location);
323 static int mdio_read(struct net_device *dev, int phy_id, int location);
324 static void mdio_write(struct net_device *dev, int phy_id, int location, int value);
325 static int netdev_open(struct net_device *dev);
326 static int update_link(struct net_device *dev);
327 static void netdev_timer(unsigned long data);
328 static void init_rxtx_rings(struct net_device *dev);
329 static void free_rxtx_rings(struct netdev_private *np);
330 static void init_registers(struct net_device *dev);
331 static void tx_timeout(struct net_device *dev);
332 static int alloc_ringdesc(struct net_device *dev);
333 static void free_ringdesc(struct netdev_private *np);
334 static int start_tx(struct sk_buff *skb, struct net_device *dev);
335 static irqreturn_t intr_handler(int irq, void *dev_instance);
336 static void netdev_error(struct net_device *dev, int intr_status);
337 static int netdev_rx(struct net_device *dev);
338 static u32 __set_rx_mode(struct net_device *dev);
339 static void set_rx_mode(struct net_device *dev);
340 static struct net_device_stats *get_stats(struct net_device *dev);
341 static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
342 static const struct ethtool_ops netdev_ethtool_ops;
343 static int netdev_close(struct net_device *dev);
347 static int __devinit w840_probe1 (struct pci_dev *pdev,
348 const struct pci_device_id *ent)
350 struct net_device *dev;
351 struct netdev_private *np;
353 int chip_idx = ent->driver_data;
355 int i, option = find_cnt < MAX_UNITS ? options[find_cnt] : 0;
356 void __iomem *ioaddr;
357 DECLARE_MAC_BUF(mac);
359 i = pci_enable_device(pdev);
362 pci_set_master(pdev);
366 if (pci_set_dma_mask(pdev, DMA_32BIT_MASK)) {
367 printk(KERN_WARNING "Winbond-840: Device %s disabled due to DMA limitations.\n",
371 dev = alloc_etherdev(sizeof(*np));
374 SET_NETDEV_DEV(dev, &pdev->dev);
376 if (pci_request_regions(pdev, DRV_NAME))
379 ioaddr = pci_iomap(pdev, TULIP_BAR, netdev_res_size);
381 goto err_out_free_res;
383 for (i = 0; i < 3; i++)
384 ((__le16 *)dev->dev_addr)[i] = cpu_to_le16(eeprom_read(ioaddr, i));
386 /* Reset the chip to erase previous misconfiguration.
387 No hold time required! */
388 iowrite32(0x00000001, ioaddr + PCIBusCfg);
390 dev->base_addr = (unsigned long)ioaddr;
393 np = netdev_priv(dev);
395 np->chip_id = chip_idx;
396 np->drv_flags = pci_id_tbl[chip_idx].drv_flags;
397 spin_lock_init(&np->lock);
398 np->mii_if.dev = dev;
399 np->mii_if.mdio_read = mdio_read;
400 np->mii_if.mdio_write = mdio_write;
401 np->base_addr = ioaddr;
403 pci_set_drvdata(pdev, dev);
406 option = dev->mem_start;
408 /* The lower four bits are the media type. */
411 np->mii_if.full_duplex = 1;
413 printk(KERN_INFO "%s: ignoring user supplied media type %d",
414 dev->name, option & 15);
416 if (find_cnt < MAX_UNITS && full_duplex[find_cnt] > 0)
417 np->mii_if.full_duplex = 1;
419 if (np->mii_if.full_duplex)
420 np->mii_if.force_media = 1;
422 /* The chip-specific entries in the device structure. */
423 dev->open = &netdev_open;
424 dev->hard_start_xmit = &start_tx;
425 dev->stop = &netdev_close;
426 dev->get_stats = &get_stats;
427 dev->set_multicast_list = &set_rx_mode;
428 dev->do_ioctl = &netdev_ioctl;
429 dev->ethtool_ops = &netdev_ethtool_ops;
430 dev->tx_timeout = &tx_timeout;
431 dev->watchdog_timeo = TX_TIMEOUT;
433 i = register_netdev(dev);
435 goto err_out_cleardev;
437 printk(KERN_INFO "%s: %s at %p, %s, IRQ %d.\n",
438 dev->name, pci_id_tbl[chip_idx].name, ioaddr,
439 print_mac(mac, dev->dev_addr), irq);
441 if (np->drv_flags & CanHaveMII) {
442 int phy, phy_idx = 0;
443 for (phy = 1; phy < 32 && phy_idx < MII_CNT; phy++) {
444 int mii_status = mdio_read(dev, phy, MII_BMSR);
445 if (mii_status != 0xffff && mii_status != 0x0000) {
446 np->phys[phy_idx++] = phy;
447 np->mii_if.advertising = mdio_read(dev, phy, MII_ADVERTISE);
448 np->mii = (mdio_read(dev, phy, MII_PHYSID1) << 16)+
449 mdio_read(dev, phy, MII_PHYSID2);
450 printk(KERN_INFO "%s: MII PHY %8.8xh found at address %d, status "
451 "0x%4.4x advertising %4.4x.\n",
452 dev->name, np->mii, phy, mii_status, np->mii_if.advertising);
455 np->mii_cnt = phy_idx;
456 np->mii_if.phy_id = np->phys[0];
458 printk(KERN_WARNING "%s: MII PHY not found -- this device may "
459 "not operate correctly.\n", dev->name);
467 pci_set_drvdata(pdev, NULL);
468 pci_iounmap(pdev, ioaddr);
470 pci_release_regions(pdev);
477 /* Read the EEPROM and MII Management Data I/O (MDIO) interfaces. These are
478 often serial bit streams generated by the host processor.
479 The example below is for the common 93c46 EEPROM, 64 16 bit words. */
481 /* Delay between EEPROM clock transitions.
482 No extra delay is needed with 33Mhz PCI, but future 66Mhz access may need
483 a delay. Note that pre-2.0.34 kernels had a cache-alignment bug that
484 made udelay() unreliable.
485 The old method of using an ISA access as a delay, __SLOW_DOWN_IO__, is
488 #define eeprom_delay(ee_addr) ioread32(ee_addr)
490 enum EEPROM_Ctrl_Bits {
491 EE_ShiftClk=0x02, EE_Write0=0x801, EE_Write1=0x805,
492 EE_ChipSelect=0x801, EE_DataIn=0x08,
495 /* The EEPROM commands include the alway-set leading bit. */
497 EE_WriteCmd=(5 << 6), EE_ReadCmd=(6 << 6), EE_EraseCmd=(7 << 6),
500 static int eeprom_read(void __iomem *addr, int location)
504 void __iomem *ee_addr = addr + EECtrl;
505 int read_cmd = location | EE_ReadCmd;
506 iowrite32(EE_ChipSelect, ee_addr);
508 /* Shift the read command bits out. */
509 for (i = 10; i >= 0; i--) {
510 short dataval = (read_cmd & (1 << i)) ? EE_Write1 : EE_Write0;
511 iowrite32(dataval, ee_addr);
512 eeprom_delay(ee_addr);
513 iowrite32(dataval | EE_ShiftClk, ee_addr);
514 eeprom_delay(ee_addr);
516 iowrite32(EE_ChipSelect, ee_addr);
517 eeprom_delay(ee_addr);
519 for (i = 16; i > 0; i--) {
520 iowrite32(EE_ChipSelect | EE_ShiftClk, ee_addr);
521 eeprom_delay(ee_addr);
522 retval = (retval << 1) | ((ioread32(ee_addr) & EE_DataIn) ? 1 : 0);
523 iowrite32(EE_ChipSelect, ee_addr);
524 eeprom_delay(ee_addr);
527 /* Terminate the EEPROM access. */
528 iowrite32(0, ee_addr);
532 /* MII transceiver control section.
533 Read and write the MII registers using software-generated serial
534 MDIO protocol. See the MII specifications or DP83840A data sheet
537 The maximum data clock rate is 2.5 Mhz. The minimum timing is usually
538 met by back-to-back 33Mhz PCI cycles. */
539 #define mdio_delay(mdio_addr) ioread32(mdio_addr)
541 /* Set iff a MII transceiver on any interface requires mdio preamble.
542 This only set with older transceivers, so the extra
543 code size of a per-interface flag is not worthwhile. */
544 static char mii_preamble_required = 1;
546 #define MDIO_WRITE0 (MDIO_EnbOutput)
547 #define MDIO_WRITE1 (MDIO_DataOut | MDIO_EnbOutput)
549 /* Generate the preamble required for initial synchronization and
550 a few older transceivers. */
551 static void mdio_sync(void __iomem *mdio_addr)
555 /* Establish sync by sending at least 32 logic ones. */
556 while (--bits >= 0) {
557 iowrite32(MDIO_WRITE1, mdio_addr);
558 mdio_delay(mdio_addr);
559 iowrite32(MDIO_WRITE1 | MDIO_ShiftClk, mdio_addr);
560 mdio_delay(mdio_addr);
564 static int mdio_read(struct net_device *dev, int phy_id, int location)
566 struct netdev_private *np = netdev_priv(dev);
567 void __iomem *mdio_addr = np->base_addr + MIICtrl;
568 int mii_cmd = (0xf6 << 10) | (phy_id << 5) | location;
571 if (mii_preamble_required)
572 mdio_sync(mdio_addr);
574 /* Shift the read command bits out. */
575 for (i = 15; i >= 0; i--) {
576 int dataval = (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
578 iowrite32(dataval, mdio_addr);
579 mdio_delay(mdio_addr);
580 iowrite32(dataval | MDIO_ShiftClk, mdio_addr);
581 mdio_delay(mdio_addr);
583 /* Read the two transition, 16 data, and wire-idle bits. */
584 for (i = 20; i > 0; i--) {
585 iowrite32(MDIO_EnbIn, mdio_addr);
586 mdio_delay(mdio_addr);
587 retval = (retval << 1) | ((ioread32(mdio_addr) & MDIO_DataIn) ? 1 : 0);
588 iowrite32(MDIO_EnbIn | MDIO_ShiftClk, mdio_addr);
589 mdio_delay(mdio_addr);
591 return (retval>>1) & 0xffff;
594 static void mdio_write(struct net_device *dev, int phy_id, int location, int value)
596 struct netdev_private *np = netdev_priv(dev);
597 void __iomem *mdio_addr = np->base_addr + MIICtrl;
598 int mii_cmd = (0x5002 << 16) | (phy_id << 23) | (location<<18) | value;
601 if (location == 4 && phy_id == np->phys[0])
602 np->mii_if.advertising = value;
604 if (mii_preamble_required)
605 mdio_sync(mdio_addr);
607 /* Shift the command bits out. */
608 for (i = 31; i >= 0; i--) {
609 int dataval = (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
611 iowrite32(dataval, mdio_addr);
612 mdio_delay(mdio_addr);
613 iowrite32(dataval | MDIO_ShiftClk, mdio_addr);
614 mdio_delay(mdio_addr);
616 /* Clear out extra bits. */
617 for (i = 2; i > 0; i--) {
618 iowrite32(MDIO_EnbIn, mdio_addr);
619 mdio_delay(mdio_addr);
620 iowrite32(MDIO_EnbIn | MDIO_ShiftClk, mdio_addr);
621 mdio_delay(mdio_addr);
627 static int netdev_open(struct net_device *dev)
629 struct netdev_private *np = netdev_priv(dev);
630 void __iomem *ioaddr = np->base_addr;
633 iowrite32(0x00000001, ioaddr + PCIBusCfg); /* Reset */
635 netif_device_detach(dev);
636 i = request_irq(dev->irq, &intr_handler, IRQF_SHARED, dev->name, dev);
641 printk(KERN_DEBUG "%s: w89c840_open() irq %d.\n",
642 dev->name, dev->irq);
644 if((i=alloc_ringdesc(dev)))
647 spin_lock_irq(&np->lock);
648 netif_device_attach(dev);
650 spin_unlock_irq(&np->lock);
652 netif_start_queue(dev);
654 printk(KERN_DEBUG "%s: Done netdev_open().\n", dev->name);
656 /* Set the timer to check for link beat. */
657 init_timer(&np->timer);
658 np->timer.expires = jiffies + 1*HZ;
659 np->timer.data = (unsigned long)dev;
660 np->timer.function = &netdev_timer; /* timer handler */
661 add_timer(&np->timer);
664 netif_device_attach(dev);
668 #define MII_DAVICOM_DM9101 0x0181b800
670 static int update_link(struct net_device *dev)
672 struct netdev_private *np = netdev_priv(dev);
673 int duplex, fasteth, result, mii_reg;
676 mii_reg = mdio_read(dev, np->phys[0], MII_BMSR);
678 if (mii_reg == 0xffff)
680 /* reread: the link status bit is sticky */
681 mii_reg = mdio_read(dev, np->phys[0], MII_BMSR);
682 if (!(mii_reg & 0x4)) {
683 if (netif_carrier_ok(dev)) {
685 printk(KERN_INFO "%s: MII #%d reports no link. Disabling watchdog.\n",
686 dev->name, np->phys[0]);
687 netif_carrier_off(dev);
691 if (!netif_carrier_ok(dev)) {
693 printk(KERN_INFO "%s: MII #%d link is back. Enabling watchdog.\n",
694 dev->name, np->phys[0]);
695 netif_carrier_on(dev);
698 if ((np->mii & ~0xf) == MII_DAVICOM_DM9101) {
699 /* If the link partner doesn't support autonegotiation
700 * the MII detects it's abilities with the "parallel detection".
701 * Some MIIs update the LPA register to the result of the parallel
702 * detection, some don't.
703 * The Davicom PHY [at least 0181b800] doesn't.
704 * Instead bit 9 and 13 of the BMCR are updated to the result
705 * of the negotiation..
707 mii_reg = mdio_read(dev, np->phys[0], MII_BMCR);
708 duplex = mii_reg & BMCR_FULLDPLX;
709 fasteth = mii_reg & BMCR_SPEED100;
712 mii_reg = mdio_read(dev, np->phys[0], MII_LPA);
713 negotiated = mii_reg & np->mii_if.advertising;
715 duplex = (negotiated & LPA_100FULL) || ((negotiated & 0x02C0) == LPA_10FULL);
716 fasteth = negotiated & 0x380;
718 duplex |= np->mii_if.force_media;
719 /* remove fastether and fullduplex */
720 result = np->csr6 & ~0x20000200;
724 result |= 0x20000000;
725 if (result != np->csr6 && debug)
726 printk(KERN_INFO "%s: Setting %dMBit-%s-duplex based on MII#%d\n",
727 dev->name, fasteth ? 100 : 10,
728 duplex ? "full" : "half", np->phys[0]);
732 #define RXTX_TIMEOUT 2000
733 static inline void update_csr6(struct net_device *dev, int new)
735 struct netdev_private *np = netdev_priv(dev);
736 void __iomem *ioaddr = np->base_addr;
737 int limit = RXTX_TIMEOUT;
739 if (!netif_device_present(dev))
743 /* stop both Tx and Rx processes */
744 iowrite32(np->csr6 & ~0x2002, ioaddr + NetworkConfig);
745 /* wait until they have really stopped */
747 int csr5 = ioread32(ioaddr + IntrStatus);
750 t = (csr5 >> 17) & 0x07;
753 t = (csr5 >> 20) & 0x07;
760 printk(KERN_INFO "%s: couldn't stop rxtx, IntrStatus %xh.\n",
767 /* and restart them with the new configuration */
768 iowrite32(np->csr6, ioaddr + NetworkConfig);
770 np->mii_if.full_duplex = 1;
773 static void netdev_timer(unsigned long data)
775 struct net_device *dev = (struct net_device *)data;
776 struct netdev_private *np = netdev_priv(dev);
777 void __iomem *ioaddr = np->base_addr;
780 printk(KERN_DEBUG "%s: Media selection timer tick, status %8.8x "
782 dev->name, ioread32(ioaddr + IntrStatus),
783 ioread32(ioaddr + NetworkConfig));
784 spin_lock_irq(&np->lock);
785 update_csr6(dev, update_link(dev));
786 spin_unlock_irq(&np->lock);
787 np->timer.expires = jiffies + 10*HZ;
788 add_timer(&np->timer);
791 static void init_rxtx_rings(struct net_device *dev)
793 struct netdev_private *np = netdev_priv(dev);
796 np->rx_head_desc = &np->rx_ring[0];
797 np->tx_ring = (struct w840_tx_desc*)&np->rx_ring[RX_RING_SIZE];
799 /* Initial all Rx descriptors. */
800 for (i = 0; i < RX_RING_SIZE; i++) {
801 np->rx_ring[i].length = np->rx_buf_sz;
802 np->rx_ring[i].status = 0;
803 np->rx_skbuff[i] = NULL;
805 /* Mark the last entry as wrapping the ring. */
806 np->rx_ring[i-1].length |= DescEndRing;
808 /* Fill in the Rx buffers. Handle allocation failure gracefully. */
809 for (i = 0; i < RX_RING_SIZE; i++) {
810 struct sk_buff *skb = dev_alloc_skb(np->rx_buf_sz);
811 np->rx_skbuff[i] = skb;
814 np->rx_addr[i] = pci_map_single(np->pci_dev,skb->data,
815 np->rx_buf_sz,PCI_DMA_FROMDEVICE);
817 np->rx_ring[i].buffer1 = np->rx_addr[i];
818 np->rx_ring[i].status = DescOwned;
822 np->dirty_rx = (unsigned int)(i - RX_RING_SIZE);
824 /* Initialize the Tx descriptors */
825 for (i = 0; i < TX_RING_SIZE; i++) {
826 np->tx_skbuff[i] = NULL;
827 np->tx_ring[i].status = 0;
830 np->tx_q_bytes = np->dirty_tx = np->cur_tx = 0;
832 iowrite32(np->ring_dma_addr, np->base_addr + RxRingPtr);
833 iowrite32(np->ring_dma_addr+sizeof(struct w840_rx_desc)*RX_RING_SIZE,
834 np->base_addr + TxRingPtr);
838 static void free_rxtx_rings(struct netdev_private* np)
841 /* Free all the skbuffs in the Rx queue. */
842 for (i = 0; i < RX_RING_SIZE; i++) {
843 np->rx_ring[i].status = 0;
844 if (np->rx_skbuff[i]) {
845 pci_unmap_single(np->pci_dev,
847 np->rx_skbuff[i]->len,
849 dev_kfree_skb(np->rx_skbuff[i]);
851 np->rx_skbuff[i] = NULL;
853 for (i = 0; i < TX_RING_SIZE; i++) {
854 if (np->tx_skbuff[i]) {
855 pci_unmap_single(np->pci_dev,
857 np->tx_skbuff[i]->len,
859 dev_kfree_skb(np->tx_skbuff[i]);
861 np->tx_skbuff[i] = NULL;
865 static void init_registers(struct net_device *dev)
867 struct netdev_private *np = netdev_priv(dev);
868 void __iomem *ioaddr = np->base_addr;
871 for (i = 0; i < 6; i++)
872 iowrite8(dev->dev_addr[i], ioaddr + StationAddr + i);
874 /* Initialize other registers. */
876 i = (1<<20); /* Big-endian descriptors */
880 i |= (0x04<<2); /* skip length 4 u32 */
881 i |= 0x02; /* give Rx priority */
883 /* Configure the PCI bus bursts and FIFO thresholds.
884 486: Set 8 longword cache alignment, 8 longword burst.
885 586: Set 16 longword cache alignment, no burst limit.
886 Cache alignment bits 15:14 Burst length 13:8
887 0000 <not allowed> 0000 align to cache 0800 8 longwords
888 4000 8 longwords 0100 1 longword 1000 16 longwords
889 8000 16 longwords 0200 2 longwords 2000 32 longwords
890 C000 32 longwords 0400 4 longwords */
892 #if defined (__i386__) && !defined(MODULE)
893 /* When not a module we can work around broken '486 PCI boards. */
894 if (boot_cpu_data.x86 <= 4) {
896 printk(KERN_INFO "%s: This is a 386/486 PCI system, setting cache "
897 "alignment to 8 longwords.\n", dev->name);
901 #elif defined(__powerpc__) || defined(__i386__) || defined(__alpha__) || defined(__ia64__) || defined(__x86_64__)
903 #elif defined(CONFIG_SPARC) || defined (CONFIG_PARISC)
906 #warning Processor architecture undefined
909 iowrite32(i, ioaddr + PCIBusCfg);
912 /* 128 byte Tx threshold;
913 Transmit on; Receive on; */
914 update_csr6(dev, 0x00022002 | update_link(dev) | __set_rx_mode(dev));
916 /* Clear and Enable interrupts by setting the interrupt mask. */
917 iowrite32(0x1A0F5, ioaddr + IntrStatus);
918 iowrite32(0x1A0F5, ioaddr + IntrEnable);
920 iowrite32(0, ioaddr + RxStartDemand);
923 static void tx_timeout(struct net_device *dev)
925 struct netdev_private *np = netdev_priv(dev);
926 void __iomem *ioaddr = np->base_addr;
928 printk(KERN_WARNING "%s: Transmit timed out, status %8.8x,"
929 " resetting...\n", dev->name, ioread32(ioaddr + IntrStatus));
933 printk(KERN_DEBUG " Rx ring %p: ", np->rx_ring);
934 for (i = 0; i < RX_RING_SIZE; i++)
935 printk(" %8.8x", (unsigned int)np->rx_ring[i].status);
936 printk("\n"KERN_DEBUG" Tx ring %p: ", np->tx_ring);
937 for (i = 0; i < TX_RING_SIZE; i++)
938 printk(" %8.8x", np->tx_ring[i].status);
941 printk(KERN_DEBUG "Tx cur %d Tx dirty %d Tx Full %d, q bytes %d.\n",
942 np->cur_tx, np->dirty_tx, np->tx_full, np->tx_q_bytes);
943 printk(KERN_DEBUG "Tx Descriptor addr %xh.\n",ioread32(ioaddr+0x4C));
945 disable_irq(dev->irq);
946 spin_lock_irq(&np->lock);
948 * Under high load dirty_tx and the internal tx descriptor pointer
949 * come out of sync, thus perform a software reset and reinitialize
953 iowrite32(1, np->base_addr+PCIBusCfg);
957 init_rxtx_rings(dev);
959 spin_unlock_irq(&np->lock);
960 enable_irq(dev->irq);
962 netif_wake_queue(dev);
963 dev->trans_start = jiffies;
964 np->stats.tx_errors++;
968 /* Initialize the Rx and Tx rings, along with various 'dev' bits. */
969 static int alloc_ringdesc(struct net_device *dev)
971 struct netdev_private *np = netdev_priv(dev);
973 np->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32);
975 np->rx_ring = pci_alloc_consistent(np->pci_dev,
976 sizeof(struct w840_rx_desc)*RX_RING_SIZE +
977 sizeof(struct w840_tx_desc)*TX_RING_SIZE,
981 init_rxtx_rings(dev);
985 static void free_ringdesc(struct netdev_private *np)
987 pci_free_consistent(np->pci_dev,
988 sizeof(struct w840_rx_desc)*RX_RING_SIZE +
989 sizeof(struct w840_tx_desc)*TX_RING_SIZE,
990 np->rx_ring, np->ring_dma_addr);
994 static int start_tx(struct sk_buff *skb, struct net_device *dev)
996 struct netdev_private *np = netdev_priv(dev);
999 /* Caution: the write order is important here, set the field
1000 with the "ownership" bits last. */
1002 /* Calculate the next Tx descriptor entry. */
1003 entry = np->cur_tx % TX_RING_SIZE;
1005 np->tx_addr[entry] = pci_map_single(np->pci_dev,
1006 skb->data,skb->len, PCI_DMA_TODEVICE);
1007 np->tx_skbuff[entry] = skb;
1009 np->tx_ring[entry].buffer1 = np->tx_addr[entry];
1010 if (skb->len < TX_BUFLIMIT) {
1011 np->tx_ring[entry].length = DescWholePkt | skb->len;
1013 int len = skb->len - TX_BUFLIMIT;
1015 np->tx_ring[entry].buffer2 = np->tx_addr[entry]+TX_BUFLIMIT;
1016 np->tx_ring[entry].length = DescWholePkt | (len << 11) | TX_BUFLIMIT;
1018 if(entry == TX_RING_SIZE-1)
1019 np->tx_ring[entry].length |= DescEndRing;
1021 /* Now acquire the irq spinlock.
1022 * The difficult race is the ordering between
1023 * increasing np->cur_tx and setting DescOwned:
1024 * - if np->cur_tx is increased first the interrupt
1025 * handler could consider the packet as transmitted
1026 * since DescOwned is cleared.
1027 * - If DescOwned is set first the NIC could report the
1028 * packet as sent, but the interrupt handler would ignore it
1029 * since the np->cur_tx was not yet increased.
1031 spin_lock_irq(&np->lock);
1034 wmb(); /* flush length, buffer1, buffer2 */
1035 np->tx_ring[entry].status = DescOwned;
1036 wmb(); /* flush status and kick the hardware */
1037 iowrite32(0, np->base_addr + TxStartDemand);
1038 np->tx_q_bytes += skb->len;
1039 /* Work around horrible bug in the chip by marking the queue as full
1040 when we do not have FIFO room for a maximum sized packet. */
1041 if (np->cur_tx - np->dirty_tx > TX_QUEUE_LEN ||
1042 ((np->drv_flags & HasBrokenTx) && np->tx_q_bytes > TX_BUG_FIFO_LIMIT)) {
1043 netif_stop_queue(dev);
1047 spin_unlock_irq(&np->lock);
1049 dev->trans_start = jiffies;
1052 printk(KERN_DEBUG "%s: Transmit frame #%d queued in slot %d.\n",
1053 dev->name, np->cur_tx, entry);
1058 static void netdev_tx_done(struct net_device *dev)
1060 struct netdev_private *np = netdev_priv(dev);
1061 for (; np->cur_tx - np->dirty_tx > 0; np->dirty_tx++) {
1062 int entry = np->dirty_tx % TX_RING_SIZE;
1063 int tx_status = np->tx_ring[entry].status;
1067 if (tx_status & 0x8000) { /* There was an error, log it. */
1068 #ifndef final_version
1070 printk(KERN_DEBUG "%s: Transmit error, Tx status %8.8x.\n",
1071 dev->name, tx_status);
1073 np->stats.tx_errors++;
1074 if (tx_status & 0x0104) np->stats.tx_aborted_errors++;
1075 if (tx_status & 0x0C80) np->stats.tx_carrier_errors++;
1076 if (tx_status & 0x0200) np->stats.tx_window_errors++;
1077 if (tx_status & 0x0002) np->stats.tx_fifo_errors++;
1078 if ((tx_status & 0x0080) && np->mii_if.full_duplex == 0)
1079 np->stats.tx_heartbeat_errors++;
1081 #ifndef final_version
1083 printk(KERN_DEBUG "%s: Transmit slot %d ok, Tx status %8.8x.\n",
1084 dev->name, entry, tx_status);
1086 np->stats.tx_bytes += np->tx_skbuff[entry]->len;
1087 np->stats.collisions += (tx_status >> 3) & 15;
1088 np->stats.tx_packets++;
1090 /* Free the original skb. */
1091 pci_unmap_single(np->pci_dev,np->tx_addr[entry],
1092 np->tx_skbuff[entry]->len,
1094 np->tx_q_bytes -= np->tx_skbuff[entry]->len;
1095 dev_kfree_skb_irq(np->tx_skbuff[entry]);
1096 np->tx_skbuff[entry] = NULL;
1099 np->cur_tx - np->dirty_tx < TX_QUEUE_LEN_RESTART &&
1100 np->tx_q_bytes < TX_BUG_FIFO_LIMIT) {
1101 /* The ring is no longer full, clear tbusy. */
1104 netif_wake_queue(dev);
1108 /* The interrupt handler does all of the Rx thread work and cleans up
1109 after the Tx thread. */
1110 static irqreturn_t intr_handler(int irq, void *dev_instance)
1112 struct net_device *dev = (struct net_device *)dev_instance;
1113 struct netdev_private *np = netdev_priv(dev);
1114 void __iomem *ioaddr = np->base_addr;
1115 int work_limit = max_interrupt_work;
1118 if (!netif_device_present(dev))
1121 u32 intr_status = ioread32(ioaddr + IntrStatus);
1123 /* Acknowledge all of the current interrupt sources ASAP. */
1124 iowrite32(intr_status & 0x001ffff, ioaddr + IntrStatus);
1127 printk(KERN_DEBUG "%s: Interrupt, status %4.4x.\n",
1128 dev->name, intr_status);
1130 if ((intr_status & (NormalIntr|AbnormalIntr)) == 0)
1135 if (intr_status & (RxIntr | RxNoBuf))
1137 if (intr_status & RxNoBuf)
1138 iowrite32(0, ioaddr + RxStartDemand);
1140 if (intr_status & (TxNoBuf | TxIntr) &&
1141 np->cur_tx != np->dirty_tx) {
1142 spin_lock(&np->lock);
1143 netdev_tx_done(dev);
1144 spin_unlock(&np->lock);
1147 /* Abnormal error summary/uncommon events handlers. */
1148 if (intr_status & (AbnormalIntr | TxFIFOUnderflow | SystemError |
1150 netdev_error(dev, intr_status);
1152 if (--work_limit < 0) {
1153 printk(KERN_WARNING "%s: Too much work at interrupt, "
1154 "status=0x%4.4x.\n", dev->name, intr_status);
1155 /* Set the timer to re-enable the other interrupts after
1157 spin_lock(&np->lock);
1158 if (netif_device_present(dev)) {
1159 iowrite32(AbnormalIntr | TimerInt, ioaddr + IntrEnable);
1160 iowrite32(10, ioaddr + GPTimer);
1162 spin_unlock(&np->lock);
1168 printk(KERN_DEBUG "%s: exiting interrupt, status=%#4.4x.\n",
1169 dev->name, ioread32(ioaddr + IntrStatus));
1170 return IRQ_RETVAL(handled);
1173 /* This routine is logically part of the interrupt handler, but separated
1174 for clarity and better register allocation. */
1175 static int netdev_rx(struct net_device *dev)
1177 struct netdev_private *np = netdev_priv(dev);
1178 int entry = np->cur_rx % RX_RING_SIZE;
1179 int work_limit = np->dirty_rx + RX_RING_SIZE - np->cur_rx;
1182 printk(KERN_DEBUG " In netdev_rx(), entry %d status %4.4x.\n",
1183 entry, np->rx_ring[entry].status);
1186 /* If EOP is set on the next entry, it's a new packet. Send it up. */
1187 while (--work_limit >= 0) {
1188 struct w840_rx_desc *desc = np->rx_head_desc;
1189 s32 status = desc->status;
1192 printk(KERN_DEBUG " netdev_rx() status was %8.8x.\n",
1196 if ((status & 0x38008300) != 0x0300) {
1197 if ((status & 0x38000300) != 0x0300) {
1198 /* Ingore earlier buffers. */
1199 if ((status & 0xffff) != 0x7fff) {
1200 printk(KERN_WARNING "%s: Oversized Ethernet frame spanned "
1201 "multiple buffers, entry %#x status %4.4x!\n",
1202 dev->name, np->cur_rx, status);
1203 np->stats.rx_length_errors++;
1205 } else if (status & 0x8000) {
1206 /* There was a fatal error. */
1208 printk(KERN_DEBUG "%s: Receive error, Rx status %8.8x.\n",
1210 np->stats.rx_errors++; /* end of a packet.*/
1211 if (status & 0x0890) np->stats.rx_length_errors++;
1212 if (status & 0x004C) np->stats.rx_frame_errors++;
1213 if (status & 0x0002) np->stats.rx_crc_errors++;
1216 struct sk_buff *skb;
1217 /* Omit the four octet CRC from the length. */
1218 int pkt_len = ((status >> 16) & 0x7ff) - 4;
1220 #ifndef final_version
1222 printk(KERN_DEBUG " netdev_rx() normal Rx pkt length %d"
1223 " status %x.\n", pkt_len, status);
1225 /* Check if the packet is long enough to accept without copying
1226 to a minimally-sized skbuff. */
1227 if (pkt_len < rx_copybreak
1228 && (skb = dev_alloc_skb(pkt_len + 2)) != NULL) {
1229 skb_reserve(skb, 2); /* 16 byte align the IP header */
1230 pci_dma_sync_single_for_cpu(np->pci_dev,np->rx_addr[entry],
1231 np->rx_skbuff[entry]->len,
1232 PCI_DMA_FROMDEVICE);
1233 skb_copy_to_linear_data(skb, np->rx_skbuff[entry]->data, pkt_len);
1234 skb_put(skb, pkt_len);
1235 pci_dma_sync_single_for_device(np->pci_dev,np->rx_addr[entry],
1236 np->rx_skbuff[entry]->len,
1237 PCI_DMA_FROMDEVICE);
1239 pci_unmap_single(np->pci_dev,np->rx_addr[entry],
1240 np->rx_skbuff[entry]->len,
1241 PCI_DMA_FROMDEVICE);
1242 skb_put(skb = np->rx_skbuff[entry], pkt_len);
1243 np->rx_skbuff[entry] = NULL;
1245 #ifndef final_version /* Remove after testing. */
1246 /* You will want this info for the initial debug. */
1248 DECLARE_MAC_BUF(mac);
1249 DECLARE_MAC_BUF(mac2);
1251 printk(KERN_DEBUG " Rx data %s %s"
1252 " %2.2x%2.2x %d.%d.%d.%d.\n",
1253 print_mac(mac, &skb->data[0]), print_mac(mac2, &skb->data[6]),
1254 skb->data[12], skb->data[13],
1255 skb->data[14], skb->data[15], skb->data[16], skb->data[17]);
1258 skb->protocol = eth_type_trans(skb, dev);
1260 dev->last_rx = jiffies;
1261 np->stats.rx_packets++;
1262 np->stats.rx_bytes += pkt_len;
1264 entry = (++np->cur_rx) % RX_RING_SIZE;
1265 np->rx_head_desc = &np->rx_ring[entry];
1268 /* Refill the Rx ring buffers. */
1269 for (; np->cur_rx - np->dirty_rx > 0; np->dirty_rx++) {
1270 struct sk_buff *skb;
1271 entry = np->dirty_rx % RX_RING_SIZE;
1272 if (np->rx_skbuff[entry] == NULL) {
1273 skb = dev_alloc_skb(np->rx_buf_sz);
1274 np->rx_skbuff[entry] = skb;
1276 break; /* Better luck next round. */
1277 np->rx_addr[entry] = pci_map_single(np->pci_dev,
1279 np->rx_buf_sz, PCI_DMA_FROMDEVICE);
1280 np->rx_ring[entry].buffer1 = np->rx_addr[entry];
1283 np->rx_ring[entry].status = DescOwned;
1289 static void netdev_error(struct net_device *dev, int intr_status)
1291 struct netdev_private *np = netdev_priv(dev);
1292 void __iomem *ioaddr = np->base_addr;
1295 printk(KERN_DEBUG "%s: Abnormal event, %8.8x.\n",
1296 dev->name, intr_status);
1297 if (intr_status == 0xffffffff)
1299 spin_lock(&np->lock);
1300 if (intr_status & TxFIFOUnderflow) {
1302 /* Bump up the Tx threshold */
1304 /* This causes lots of dropped packets,
1305 * and under high load even tx_timeouts
1307 new = np->csr6 + 0x4000;
1309 new = (np->csr6 >> 14)&0x7f;
1313 new = 127; /* load full packet before starting */
1314 new = (np->csr6 & ~(0x7F << 14)) | (new<<14);
1316 printk(KERN_DEBUG "%s: Tx underflow, new csr6 %8.8x.\n",
1318 update_csr6(dev, new);
1320 if (intr_status & RxDied) { /* Missed a Rx frame. */
1321 np->stats.rx_errors++;
1323 if (intr_status & TimerInt) {
1324 /* Re-enable other interrupts. */
1325 if (netif_device_present(dev))
1326 iowrite32(0x1A0F5, ioaddr + IntrEnable);
1328 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1329 iowrite32(0, ioaddr + RxStartDemand);
1330 spin_unlock(&np->lock);
1333 static struct net_device_stats *get_stats(struct net_device *dev)
1335 struct netdev_private *np = netdev_priv(dev);
1336 void __iomem *ioaddr = np->base_addr;
1338 /* The chip only need report frame silently dropped. */
1339 spin_lock_irq(&np->lock);
1340 if (netif_running(dev) && netif_device_present(dev))
1341 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1342 spin_unlock_irq(&np->lock);
1348 static u32 __set_rx_mode(struct net_device *dev)
1350 struct netdev_private *np = netdev_priv(dev);
1351 void __iomem *ioaddr = np->base_addr;
1352 u32 mc_filter[2]; /* Multicast hash filter */
1355 if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */
1356 memset(mc_filter, 0xff, sizeof(mc_filter));
1357 rx_mode = RxAcceptBroadcast | AcceptMulticast | RxAcceptAllPhys
1359 } else if ((dev->mc_count > multicast_filter_limit)
1360 || (dev->flags & IFF_ALLMULTI)) {
1361 /* Too many to match, or accept all multicasts. */
1362 memset(mc_filter, 0xff, sizeof(mc_filter));
1363 rx_mode = RxAcceptBroadcast | AcceptMulticast | AcceptMyPhys;
1365 struct dev_mc_list *mclist;
1367 memset(mc_filter, 0, sizeof(mc_filter));
1368 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
1369 i++, mclist = mclist->next) {
1370 int filterbit = (ether_crc(ETH_ALEN, mclist->dmi_addr) >> 26) ^ 0x3F;
1372 mc_filter[filterbit >> 5] |= 1 << (filterbit & 31);
1374 rx_mode = RxAcceptBroadcast | AcceptMulticast | AcceptMyPhys;
1376 iowrite32(mc_filter[0], ioaddr + MulticastFilter0);
1377 iowrite32(mc_filter[1], ioaddr + MulticastFilter1);
1381 static void set_rx_mode(struct net_device *dev)
1383 struct netdev_private *np = netdev_priv(dev);
1384 u32 rx_mode = __set_rx_mode(dev);
1385 spin_lock_irq(&np->lock);
1386 update_csr6(dev, (np->csr6 & ~0x00F8) | rx_mode);
1387 spin_unlock_irq(&np->lock);
1390 static void netdev_get_drvinfo (struct net_device *dev, struct ethtool_drvinfo *info)
1392 struct netdev_private *np = netdev_priv(dev);
1394 strcpy (info->driver, DRV_NAME);
1395 strcpy (info->version, DRV_VERSION);
1396 strcpy (info->bus_info, pci_name(np->pci_dev));
1399 static int netdev_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1401 struct netdev_private *np = netdev_priv(dev);
1404 spin_lock_irq(&np->lock);
1405 rc = mii_ethtool_gset(&np->mii_if, cmd);
1406 spin_unlock_irq(&np->lock);
1411 static int netdev_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1413 struct netdev_private *np = netdev_priv(dev);
1416 spin_lock_irq(&np->lock);
1417 rc = mii_ethtool_sset(&np->mii_if, cmd);
1418 spin_unlock_irq(&np->lock);
1423 static int netdev_nway_reset(struct net_device *dev)
1425 struct netdev_private *np = netdev_priv(dev);
1426 return mii_nway_restart(&np->mii_if);
1429 static u32 netdev_get_link(struct net_device *dev)
1431 struct netdev_private *np = netdev_priv(dev);
1432 return mii_link_ok(&np->mii_if);
1435 static u32 netdev_get_msglevel(struct net_device *dev)
1440 static void netdev_set_msglevel(struct net_device *dev, u32 value)
1445 static const struct ethtool_ops netdev_ethtool_ops = {
1446 .get_drvinfo = netdev_get_drvinfo,
1447 .get_settings = netdev_get_settings,
1448 .set_settings = netdev_set_settings,
1449 .nway_reset = netdev_nway_reset,
1450 .get_link = netdev_get_link,
1451 .get_msglevel = netdev_get_msglevel,
1452 .set_msglevel = netdev_set_msglevel,
1455 static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1457 struct mii_ioctl_data *data = if_mii(rq);
1458 struct netdev_private *np = netdev_priv(dev);
1461 case SIOCGMIIPHY: /* Get address of MII PHY in use. */
1462 data->phy_id = ((struct netdev_private *)netdev_priv(dev))->phys[0] & 0x1f;
1465 case SIOCGMIIREG: /* Read MII PHY register. */
1466 spin_lock_irq(&np->lock);
1467 data->val_out = mdio_read(dev, data->phy_id & 0x1f, data->reg_num & 0x1f);
1468 spin_unlock_irq(&np->lock);
1471 case SIOCSMIIREG: /* Write MII PHY register. */
1472 if (!capable(CAP_NET_ADMIN))
1474 spin_lock_irq(&np->lock);
1475 mdio_write(dev, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
1476 spin_unlock_irq(&np->lock);
1483 static int netdev_close(struct net_device *dev)
1485 struct netdev_private *np = netdev_priv(dev);
1486 void __iomem *ioaddr = np->base_addr;
1488 netif_stop_queue(dev);
1491 printk(KERN_DEBUG "%s: Shutting down ethercard, status was %8.8x "
1492 "Config %8.8x.\n", dev->name, ioread32(ioaddr + IntrStatus),
1493 ioread32(ioaddr + NetworkConfig));
1494 printk(KERN_DEBUG "%s: Queue pointers were Tx %d / %d, Rx %d / %d.\n",
1495 dev->name, np->cur_tx, np->dirty_tx, np->cur_rx, np->dirty_rx);
1498 /* Stop the chip's Tx and Rx processes. */
1499 spin_lock_irq(&np->lock);
1500 netif_device_detach(dev);
1501 update_csr6(dev, 0);
1502 iowrite32(0x0000, ioaddr + IntrEnable);
1503 spin_unlock_irq(&np->lock);
1505 free_irq(dev->irq, dev);
1507 netif_device_attach(dev);
1509 if (ioread32(ioaddr + NetworkConfig) != 0xffffffff)
1510 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1516 printk(KERN_DEBUG" Tx ring at %8.8x:\n",
1518 for (i = 0; i < TX_RING_SIZE; i++)
1519 printk(KERN_DEBUG " #%d desc. %4.4x %4.4x %8.8x.\n",
1520 i, np->tx_ring[i].length,
1521 np->tx_ring[i].status, np->tx_ring[i].buffer1);
1522 printk("\n"KERN_DEBUG " Rx ring %8.8x:\n",
1524 for (i = 0; i < RX_RING_SIZE; i++) {
1525 printk(KERN_DEBUG " #%d desc. %4.4x %4.4x %8.8x\n",
1526 i, np->rx_ring[i].length,
1527 np->rx_ring[i].status, np->rx_ring[i].buffer1);
1530 #endif /* __i386__ debugging only */
1532 del_timer_sync(&np->timer);
1534 free_rxtx_rings(np);
1540 static void __devexit w840_remove1 (struct pci_dev *pdev)
1542 struct net_device *dev = pci_get_drvdata(pdev);
1545 struct netdev_private *np = netdev_priv(dev);
1546 unregister_netdev(dev);
1547 pci_release_regions(pdev);
1548 pci_iounmap(pdev, np->base_addr);
1552 pci_set_drvdata(pdev, NULL);
1558 * suspend/resume synchronization:
1559 * - open, close, do_ioctl:
1560 * rtnl_lock, & netif_device_detach after the rtnl_unlock.
1562 * spin_lock_irq(np->lock), doesn't touch hw if not present
1563 * - hard_start_xmit:
1564 * synchronize_irq + netif_tx_disable;
1566 * netif_device_detach + netif_tx_disable;
1567 * - set_multicast_list
1568 * netif_device_detach + netif_tx_disable;
1569 * - interrupt handler
1570 * doesn't touch hw if not present, synchronize_irq waits for
1571 * running instances of the interrupt handler.
1573 * Disabling hw requires clearing csr6 & IntrEnable.
1574 * update_csr6 & all function that write IntrEnable check netif_device_present
1575 * before settings any bits.
1577 * Detach must occur under spin_unlock_irq(), interrupts from a detached
1578 * device would cause an irq storm.
1580 static int w840_suspend (struct pci_dev *pdev, pm_message_t state)
1582 struct net_device *dev = pci_get_drvdata (pdev);
1583 struct netdev_private *np = netdev_priv(dev);
1584 void __iomem *ioaddr = np->base_addr;
1587 if (netif_running (dev)) {
1588 del_timer_sync(&np->timer);
1590 spin_lock_irq(&np->lock);
1591 netif_device_detach(dev);
1592 update_csr6(dev, 0);
1593 iowrite32(0, ioaddr + IntrEnable);
1594 spin_unlock_irq(&np->lock);
1596 synchronize_irq(dev->irq);
1597 netif_tx_disable(dev);
1599 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1601 /* no more hardware accesses behind this line. */
1604 if (ioread32(ioaddr + IntrEnable)) BUG();
1606 /* pci_power_off(pdev, -1); */
1608 free_rxtx_rings(np);
1610 netif_device_detach(dev);
1616 static int w840_resume (struct pci_dev *pdev)
1618 struct net_device *dev = pci_get_drvdata (pdev);
1619 struct netdev_private *np = netdev_priv(dev);
1623 if (netif_device_present(dev))
1624 goto out; /* device not suspended */
1625 if (netif_running(dev)) {
1626 if ((retval = pci_enable_device(pdev))) {
1628 "%s: pci_enable_device failed in resume\n",
1632 spin_lock_irq(&np->lock);
1633 iowrite32(1, np->base_addr+PCIBusCfg);
1634 ioread32(np->base_addr+PCIBusCfg);
1636 netif_device_attach(dev);
1637 init_rxtx_rings(dev);
1638 init_registers(dev);
1639 spin_unlock_irq(&np->lock);
1641 netif_wake_queue(dev);
1643 mod_timer(&np->timer, jiffies + 1*HZ);
1645 netif_device_attach(dev);
1653 static struct pci_driver w840_driver = {
1655 .id_table = w840_pci_tbl,
1656 .probe = w840_probe1,
1657 .remove = __devexit_p(w840_remove1),
1659 .suspend = w840_suspend,
1660 .resume = w840_resume,
1664 static int __init w840_init(void)
1667 return pci_register_driver(&w840_driver);
1670 static void __exit w840_exit(void)
1672 pci_unregister_driver(&w840_driver);
1675 module_init(w840_init);
1676 module_exit(w840_exit);