treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / net / ethernet / dec / tulip / winbond-840.c
blob7f136488e67cf7158418ada67a8b35606c2dfd29
1 /* winbond-840.c: A Linux PCI network adapter device driver. */
2 /*
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
15 Annapolis MD 21403
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
23 as an improvement.
25 Changelog:
26 * ported to 2.4
27 ???
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
35 * further cleanups
36 power management.
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)
42 TODO:
43 * enable pci_power_off
44 * Wake-On-LAN
47 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
49 #define DRV_NAME "winbond-840"
50 #define DRV_VERSION "1.01-e"
51 #define DRV_RELDATE "Sep-11-2006"
54 /* Automatically extracted configuration info:
55 probe-func: winbond840_probe
56 config-in: tristate 'Winbond W89c840 Ethernet support' CONFIG_WINBOND_840
58 c-help-name: Winbond W89c840 PCI Ethernet support
59 c-help-symbol: CONFIG_WINBOND_840
60 c-help: This driver is for the Winbond W89c840 chip. It also works with
61 c-help: the TX9882 chip on the Compex RL100-ATX board.
62 c-help: More specific information and updates are available from
63 c-help: http://www.scyld.com/network/drivers.html
66 /* The user-configurable values.
67 These may be modified when a driver module is loaded.*/
69 static int debug = 1; /* 1 normal messages, 0 quiet .. 7 verbose. */
70 static int max_interrupt_work = 20;
71 /* Maximum number of multicast addresses to filter (vs. Rx-all-multicast).
72 The '840 uses a 64 element hash table based on the Ethernet CRC. */
73 static int multicast_filter_limit = 32;
75 /* Set the copy breakpoint for the copy-only-tiny-frames scheme.
76 Setting to > 1518 effectively disables this feature. */
77 static int rx_copybreak;
79 /* Used to pass the media type, etc.
80 Both 'options[]' and 'full_duplex[]' should exist for driver
81 interoperability.
82 The media type is usually passed in 'options[]'.
84 #define MAX_UNITS 8 /* More are supported, limit only on options */
85 static int options[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
86 static int full_duplex[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
88 /* Operational parameters that are set at compile time. */
90 /* Keep the ring sizes a power of two for compile efficiency.
91 The compiler will convert <unsigned>'%'<2^N> into a bit mask.
92 Making the Tx ring too large decreases the effectiveness of channel
93 bonding and packet priority.
94 There are no ill effects from too-large receive rings. */
95 #define TX_QUEUE_LEN 10 /* Limit ring entries actually used. */
96 #define TX_QUEUE_LEN_RESTART 5
98 #define TX_BUFLIMIT (1024-128)
100 /* The presumed FIFO size for working around the Tx-FIFO-overflow bug.
101 To avoid overflowing we don't queue again until we have room for a
102 full-size packet.
104 #define TX_FIFO_SIZE (2048)
105 #define TX_BUG_FIFO_LIMIT (TX_FIFO_SIZE-1514-16)
108 /* Operational parameters that usually are not changed. */
109 /* Time in jiffies before concluding the transmitter is hung. */
110 #define TX_TIMEOUT (2*HZ)
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/interrupt.h>
120 #include <linux/pci.h>
121 #include <linux/dma-mapping.h>
122 #include <linux/netdevice.h>
123 #include <linux/etherdevice.h>
124 #include <linux/skbuff.h>
125 #include <linux/init.h>
126 #include <linux/delay.h>
127 #include <linux/ethtool.h>
128 #include <linux/mii.h>
129 #include <linux/rtnetlink.h>
130 #include <linux/crc32.h>
131 #include <linux/bitops.h>
132 #include <linux/uaccess.h>
133 #include <asm/processor.h> /* Processor type for cache alignment. */
134 #include <asm/io.h>
135 #include <asm/irq.h>
137 #include "tulip.h"
139 #undef PKT_BUF_SZ /* tulip.h also defines this */
140 #define PKT_BUF_SZ 1536 /* Size of each temporary Rx buffer.*/
142 /* These identify the driver base version and may not be removed. */
143 static const char version[] __initconst =
144 "v" DRV_VERSION " (2.4 port) "
145 DRV_RELDATE " Donald Becker <becker@scyld.com>\n"
146 " http://www.scyld.com/network/drivers.html\n";
148 MODULE_AUTHOR("Donald Becker <becker@scyld.com>");
149 MODULE_DESCRIPTION("Winbond W89c840 Ethernet driver");
150 MODULE_LICENSE("GPL");
151 MODULE_VERSION(DRV_VERSION);
153 module_param(max_interrupt_work, int, 0);
154 module_param(debug, int, 0);
155 module_param(rx_copybreak, int, 0);
156 module_param(multicast_filter_limit, int, 0);
157 module_param_array(options, int, NULL, 0);
158 module_param_array(full_duplex, int, NULL, 0);
159 MODULE_PARM_DESC(max_interrupt_work, "winbond-840 maximum events handled per interrupt");
160 MODULE_PARM_DESC(debug, "winbond-840 debug level (0-6)");
161 MODULE_PARM_DESC(rx_copybreak, "winbond-840 copy breakpoint for copy-only-tiny-frames");
162 MODULE_PARM_DESC(multicast_filter_limit, "winbond-840 maximum number of filtered multicast addresses");
163 MODULE_PARM_DESC(options, "winbond-840: Bits 0-3: media type, bit 17: full duplex");
164 MODULE_PARM_DESC(full_duplex, "winbond-840 full duplex setting(s) (1)");
167 Theory of Operation
169 I. Board Compatibility
171 This driver is for the Winbond w89c840 chip.
173 II. Board-specific settings
175 None.
177 III. Driver operation
179 This chip is very similar to the Digital 21*4* "Tulip" family. The first
180 twelve registers and the descriptor format are nearly identical. Read a
181 Tulip manual for operational details.
183 A significant difference is that the multicast filter and station address are
184 stored in registers rather than loaded through a pseudo-transmit packet.
186 Unlike the Tulip, transmit buffers are limited to 1KB. To transmit a
187 full-sized packet we must use both data buffers in a descriptor. Thus the
188 driver uses ring mode where descriptors are implicitly sequential in memory,
189 rather than using the second descriptor address as a chain pointer to
190 subsequent descriptors.
192 IV. Notes
194 If you are going to almost clone a Tulip, why not go all the way and avoid
195 the need for a new driver?
197 IVb. References
199 http://www.scyld.com/expert/100mbps.html
200 http://www.scyld.com/expert/NWay.html
201 http://www.winbond.com.tw/
203 IVc. Errata
205 A horrible bug exists in the transmit FIFO. Apparently the chip doesn't
206 correctly detect a full FIFO, and queuing more than 2048 bytes may result in
207 silent data corruption.
209 Test with 'ping -s 10000' on a fast computer.
216 PCI probe table.
218 enum chip_capability_flags {
219 CanHaveMII=1, HasBrokenTx=2, AlwaysFDX=4, FDXOnNoMII=8,
222 static const struct pci_device_id w840_pci_tbl[] = {
223 { 0x1050, 0x0840, PCI_ANY_ID, 0x8153, 0, 0, 0 },
224 { 0x1050, 0x0840, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1 },
225 { 0x11f6, 0x2011, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2 },
228 MODULE_DEVICE_TABLE(pci, w840_pci_tbl);
230 enum {
231 netdev_res_size = 128, /* size of PCI BAR resource */
234 struct pci_id_info {
235 const char *name;
236 int drv_flags; /* Driver use, intended as capability flags. */
239 static const struct pci_id_info pci_id_tbl[] = {
240 { /* Sometime a Level-One switch card. */
241 "Winbond W89c840", CanHaveMII | HasBrokenTx | FDXOnNoMII},
242 { "Winbond W89c840", CanHaveMII | HasBrokenTx},
243 { "Compex RL100-ATX", CanHaveMII | HasBrokenTx},
244 { } /* terminate list. */
247 /* This driver was written to use PCI memory space, however some x86 systems
248 work only with I/O space accesses. See CONFIG_TULIP_MMIO in .config
251 /* Offsets to the Command and Status Registers, "CSRs".
252 While similar to the Tulip, these registers are longword aligned.
253 Note: It's not useful to define symbolic names for every register bit in
254 the device. The name can only partially document the semantics and make
255 the driver longer and more difficult to read.
257 enum w840_offsets {
258 PCIBusCfg=0x00, TxStartDemand=0x04, RxStartDemand=0x08,
259 RxRingPtr=0x0C, TxRingPtr=0x10,
260 IntrStatus=0x14, NetworkConfig=0x18, IntrEnable=0x1C,
261 RxMissed=0x20, EECtrl=0x24, MIICtrl=0x24, BootRom=0x28, GPTimer=0x2C,
262 CurRxDescAddr=0x30, CurRxBufAddr=0x34, /* Debug use */
263 MulticastFilter0=0x38, MulticastFilter1=0x3C, StationAddr=0x40,
264 CurTxDescAddr=0x4C, CurTxBufAddr=0x50,
267 /* Bits in the NetworkConfig register. */
268 enum rx_mode_bits {
269 AcceptErr=0x80,
270 RxAcceptBroadcast=0x20, AcceptMulticast=0x10,
271 RxAcceptAllPhys=0x08, AcceptMyPhys=0x02,
274 enum mii_reg_bits {
275 MDIO_ShiftClk=0x10000, MDIO_DataIn=0x80000, MDIO_DataOut=0x20000,
276 MDIO_EnbOutput=0x40000, MDIO_EnbIn = 0x00000,
279 /* The Tulip Rx and Tx buffer descriptors. */
280 struct w840_rx_desc {
281 s32 status;
282 s32 length;
283 u32 buffer1;
284 u32 buffer2;
287 struct w840_tx_desc {
288 s32 status;
289 s32 length;
290 u32 buffer1, buffer2;
293 #define MII_CNT 1 /* winbond only supports one MII */
294 struct netdev_private {
295 struct w840_rx_desc *rx_ring;
296 dma_addr_t rx_addr[RX_RING_SIZE];
297 struct w840_tx_desc *tx_ring;
298 dma_addr_t tx_addr[TX_RING_SIZE];
299 dma_addr_t ring_dma_addr;
300 /* The addresses of receive-in-place skbuffs. */
301 struct sk_buff* rx_skbuff[RX_RING_SIZE];
302 /* The saved address of a sent-in-place packet/buffer, for later free(). */
303 struct sk_buff* tx_skbuff[TX_RING_SIZE];
304 struct net_device_stats stats;
305 struct timer_list timer; /* Media monitoring timer. */
306 /* Frequently used values: keep some adjacent for cache effect. */
307 spinlock_t lock;
308 int chip_id, drv_flags;
309 struct pci_dev *pci_dev;
310 int csr6;
311 struct w840_rx_desc *rx_head_desc;
312 unsigned int cur_rx, dirty_rx; /* Producer/consumer ring indices */
313 unsigned int rx_buf_sz; /* Based on MTU+slack. */
314 unsigned int cur_tx, dirty_tx;
315 unsigned int tx_q_bytes;
316 unsigned int tx_full; /* The Tx queue is full. */
317 /* MII transceiver section. */
318 int mii_cnt; /* MII device addresses. */
319 unsigned char phys[MII_CNT]; /* MII device addresses, but only the first is used */
320 u32 mii;
321 struct mii_if_info mii_if;
322 void __iomem *base_addr;
325 static int eeprom_read(void __iomem *ioaddr, int location);
326 static int mdio_read(struct net_device *dev, int phy_id, int location);
327 static void mdio_write(struct net_device *dev, int phy_id, int location, int value);
328 static int netdev_open(struct net_device *dev);
329 static int update_link(struct net_device *dev);
330 static void netdev_timer(struct timer_list *t);
331 static void init_rxtx_rings(struct net_device *dev);
332 static void free_rxtx_rings(struct netdev_private *np);
333 static void init_registers(struct net_device *dev);
334 static void tx_timeout(struct net_device *dev, unsigned int txqueue);
335 static int alloc_ringdesc(struct net_device *dev);
336 static void free_ringdesc(struct netdev_private *np);
337 static netdev_tx_t start_tx(struct sk_buff *skb, struct net_device *dev);
338 static irqreturn_t intr_handler(int irq, void *dev_instance);
339 static void netdev_error(struct net_device *dev, int intr_status);
340 static int netdev_rx(struct net_device *dev);
341 static u32 __set_rx_mode(struct net_device *dev);
342 static void set_rx_mode(struct net_device *dev);
343 static struct net_device_stats *get_stats(struct net_device *dev);
344 static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
345 static const struct ethtool_ops netdev_ethtool_ops;
346 static int netdev_close(struct net_device *dev);
348 static const struct net_device_ops netdev_ops = {
349 .ndo_open = netdev_open,
350 .ndo_stop = netdev_close,
351 .ndo_start_xmit = start_tx,
352 .ndo_get_stats = get_stats,
353 .ndo_set_rx_mode = set_rx_mode,
354 .ndo_do_ioctl = netdev_ioctl,
355 .ndo_tx_timeout = tx_timeout,
356 .ndo_set_mac_address = eth_mac_addr,
357 .ndo_validate_addr = eth_validate_addr,
360 static int w840_probe1(struct pci_dev *pdev, const struct pci_device_id *ent)
362 struct net_device *dev;
363 struct netdev_private *np;
364 static int find_cnt;
365 int chip_idx = ent->driver_data;
366 int irq;
367 int i, option = find_cnt < MAX_UNITS ? options[find_cnt] : 0;
368 void __iomem *ioaddr;
370 i = pci_enable_device(pdev);
371 if (i) return i;
373 pci_set_master(pdev);
375 irq = pdev->irq;
377 if (pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) {
378 pr_warn("Device %s disabled due to DMA limitations\n",
379 pci_name(pdev));
380 return -EIO;
382 dev = alloc_etherdev(sizeof(*np));
383 if (!dev)
384 return -ENOMEM;
385 SET_NETDEV_DEV(dev, &pdev->dev);
387 if (pci_request_regions(pdev, DRV_NAME))
388 goto err_out_netdev;
390 ioaddr = pci_iomap(pdev, TULIP_BAR, netdev_res_size);
391 if (!ioaddr)
392 goto err_out_free_res;
394 for (i = 0; i < 3; i++)
395 ((__le16 *)dev->dev_addr)[i] = cpu_to_le16(eeprom_read(ioaddr, i));
397 /* Reset the chip to erase previous misconfiguration.
398 No hold time required! */
399 iowrite32(0x00000001, ioaddr + PCIBusCfg);
401 np = netdev_priv(dev);
402 np->pci_dev = pdev;
403 np->chip_id = chip_idx;
404 np->drv_flags = pci_id_tbl[chip_idx].drv_flags;
405 spin_lock_init(&np->lock);
406 np->mii_if.dev = dev;
407 np->mii_if.mdio_read = mdio_read;
408 np->mii_if.mdio_write = mdio_write;
409 np->base_addr = ioaddr;
411 pci_set_drvdata(pdev, dev);
413 if (dev->mem_start)
414 option = dev->mem_start;
416 /* The lower four bits are the media type. */
417 if (option > 0) {
418 if (option & 0x200)
419 np->mii_if.full_duplex = 1;
420 if (option & 15)
421 dev_info(&dev->dev,
422 "ignoring user supplied media type %d",
423 option & 15);
425 if (find_cnt < MAX_UNITS && full_duplex[find_cnt] > 0)
426 np->mii_if.full_duplex = 1;
428 if (np->mii_if.full_duplex)
429 np->mii_if.force_media = 1;
431 /* The chip-specific entries in the device structure. */
432 dev->netdev_ops = &netdev_ops;
433 dev->ethtool_ops = &netdev_ethtool_ops;
434 dev->watchdog_timeo = TX_TIMEOUT;
436 i = register_netdev(dev);
437 if (i)
438 goto err_out_cleardev;
440 dev_info(&dev->dev, "%s at %p, %pM, IRQ %d\n",
441 pci_id_tbl[chip_idx].name, ioaddr, dev->dev_addr, irq);
443 if (np->drv_flags & CanHaveMII) {
444 int phy, phy_idx = 0;
445 for (phy = 1; phy < 32 && phy_idx < MII_CNT; phy++) {
446 int mii_status = mdio_read(dev, phy, MII_BMSR);
447 if (mii_status != 0xffff && mii_status != 0x0000) {
448 np->phys[phy_idx++] = phy;
449 np->mii_if.advertising = mdio_read(dev, phy, MII_ADVERTISE);
450 np->mii = (mdio_read(dev, phy, MII_PHYSID1) << 16)+
451 mdio_read(dev, phy, MII_PHYSID2);
452 dev_info(&dev->dev,
453 "MII PHY %08xh found at address %d, status 0x%04x advertising %04x\n",
454 np->mii, phy, mii_status,
455 np->mii_if.advertising);
458 np->mii_cnt = phy_idx;
459 np->mii_if.phy_id = np->phys[0];
460 if (phy_idx == 0) {
461 dev_warn(&dev->dev,
462 "MII PHY not found -- this device may not operate correctly\n");
466 find_cnt++;
467 return 0;
469 err_out_cleardev:
470 pci_iounmap(pdev, ioaddr);
471 err_out_free_res:
472 pci_release_regions(pdev);
473 err_out_netdev:
474 free_netdev (dev);
475 return -ENODEV;
479 /* Read the EEPROM and MII Management Data I/O (MDIO) interfaces. These are
480 often serial bit streams generated by the host processor.
481 The example below is for the common 93c46 EEPROM, 64 16 bit words. */
483 /* Delay between EEPROM clock transitions.
484 No extra delay is needed with 33Mhz PCI, but future 66Mhz access may need
485 a delay. Note that pre-2.0.34 kernels had a cache-alignment bug that
486 made udelay() unreliable.
487 The old method of using an ISA access as a delay, __SLOW_DOWN_IO__, is
488 deprecated.
490 #define eeprom_delay(ee_addr) ioread32(ee_addr)
492 enum EEPROM_Ctrl_Bits {
493 EE_ShiftClk=0x02, EE_Write0=0x801, EE_Write1=0x805,
494 EE_ChipSelect=0x801, EE_DataIn=0x08,
497 /* The EEPROM commands include the alway-set leading bit. */
498 enum EEPROM_Cmds {
499 EE_WriteCmd=(5 << 6), EE_ReadCmd=(6 << 6), EE_EraseCmd=(7 << 6),
502 static int eeprom_read(void __iomem *addr, int location)
504 int i;
505 int retval = 0;
506 void __iomem *ee_addr = addr + EECtrl;
507 int read_cmd = location | EE_ReadCmd;
508 iowrite32(EE_ChipSelect, ee_addr);
510 /* Shift the read command bits out. */
511 for (i = 10; i >= 0; i--) {
512 short dataval = (read_cmd & (1 << i)) ? EE_Write1 : EE_Write0;
513 iowrite32(dataval, ee_addr);
514 eeprom_delay(ee_addr);
515 iowrite32(dataval | EE_ShiftClk, ee_addr);
516 eeprom_delay(ee_addr);
518 iowrite32(EE_ChipSelect, ee_addr);
519 eeprom_delay(ee_addr);
521 for (i = 16; i > 0; i--) {
522 iowrite32(EE_ChipSelect | EE_ShiftClk, ee_addr);
523 eeprom_delay(ee_addr);
524 retval = (retval << 1) | ((ioread32(ee_addr) & EE_DataIn) ? 1 : 0);
525 iowrite32(EE_ChipSelect, ee_addr);
526 eeprom_delay(ee_addr);
529 /* Terminate the EEPROM access. */
530 iowrite32(0, ee_addr);
531 return retval;
534 /* MII transceiver control section.
535 Read and write the MII registers using software-generated serial
536 MDIO protocol. See the MII specifications or DP83840A data sheet
537 for details.
539 The maximum data clock rate is 2.5 Mhz. The minimum timing is usually
540 met by back-to-back 33Mhz PCI cycles. */
541 #define mdio_delay(mdio_addr) ioread32(mdio_addr)
543 /* Set iff a MII transceiver on any interface requires mdio preamble.
544 This only set with older transceivers, so the extra
545 code size of a per-interface flag is not worthwhile. */
546 static char mii_preamble_required = 1;
548 #define MDIO_WRITE0 (MDIO_EnbOutput)
549 #define MDIO_WRITE1 (MDIO_DataOut | MDIO_EnbOutput)
551 /* Generate the preamble required for initial synchronization and
552 a few older transceivers. */
553 static void mdio_sync(void __iomem *mdio_addr)
555 int bits = 32;
557 /* Establish sync by sending at least 32 logic ones. */
558 while (--bits >= 0) {
559 iowrite32(MDIO_WRITE1, mdio_addr);
560 mdio_delay(mdio_addr);
561 iowrite32(MDIO_WRITE1 | MDIO_ShiftClk, mdio_addr);
562 mdio_delay(mdio_addr);
566 static int mdio_read(struct net_device *dev, int phy_id, int location)
568 struct netdev_private *np = netdev_priv(dev);
569 void __iomem *mdio_addr = np->base_addr + MIICtrl;
570 int mii_cmd = (0xf6 << 10) | (phy_id << 5) | location;
571 int i, retval = 0;
573 if (mii_preamble_required)
574 mdio_sync(mdio_addr);
576 /* Shift the read command bits out. */
577 for (i = 15; i >= 0; i--) {
578 int dataval = (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
580 iowrite32(dataval, mdio_addr);
581 mdio_delay(mdio_addr);
582 iowrite32(dataval | MDIO_ShiftClk, mdio_addr);
583 mdio_delay(mdio_addr);
585 /* Read the two transition, 16 data, and wire-idle bits. */
586 for (i = 20; i > 0; i--) {
587 iowrite32(MDIO_EnbIn, mdio_addr);
588 mdio_delay(mdio_addr);
589 retval = (retval << 1) | ((ioread32(mdio_addr) & MDIO_DataIn) ? 1 : 0);
590 iowrite32(MDIO_EnbIn | MDIO_ShiftClk, mdio_addr);
591 mdio_delay(mdio_addr);
593 return (retval>>1) & 0xffff;
596 static void mdio_write(struct net_device *dev, int phy_id, int location, int value)
598 struct netdev_private *np = netdev_priv(dev);
599 void __iomem *mdio_addr = np->base_addr + MIICtrl;
600 int mii_cmd = (0x5002 << 16) | (phy_id << 23) | (location<<18) | value;
601 int i;
603 if (location == 4 && phy_id == np->phys[0])
604 np->mii_if.advertising = value;
606 if (mii_preamble_required)
607 mdio_sync(mdio_addr);
609 /* Shift the command bits out. */
610 for (i = 31; i >= 0; i--) {
611 int dataval = (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
613 iowrite32(dataval, mdio_addr);
614 mdio_delay(mdio_addr);
615 iowrite32(dataval | MDIO_ShiftClk, mdio_addr);
616 mdio_delay(mdio_addr);
618 /* Clear out extra bits. */
619 for (i = 2; i > 0; i--) {
620 iowrite32(MDIO_EnbIn, mdio_addr);
621 mdio_delay(mdio_addr);
622 iowrite32(MDIO_EnbIn | MDIO_ShiftClk, mdio_addr);
623 mdio_delay(mdio_addr);
628 static int netdev_open(struct net_device *dev)
630 struct netdev_private *np = netdev_priv(dev);
631 void __iomem *ioaddr = np->base_addr;
632 const int irq = np->pci_dev->irq;
633 int i;
635 iowrite32(0x00000001, ioaddr + PCIBusCfg); /* Reset */
637 netif_device_detach(dev);
638 i = request_irq(irq, intr_handler, IRQF_SHARED, dev->name, dev);
639 if (i)
640 goto out_err;
642 if (debug > 1)
643 netdev_dbg(dev, "w89c840_open() irq %d\n", irq);
645 if((i=alloc_ringdesc(dev)))
646 goto out_err;
648 spin_lock_irq(&np->lock);
649 netif_device_attach(dev);
650 init_registers(dev);
651 spin_unlock_irq(&np->lock);
653 netif_start_queue(dev);
654 if (debug > 2)
655 netdev_dbg(dev, "Done netdev_open()\n");
657 /* Set the timer to check for link beat. */
658 timer_setup(&np->timer, netdev_timer, 0);
659 np->timer.expires = jiffies + 1*HZ;
660 add_timer(&np->timer);
661 return 0;
662 out_err:
663 netif_device_attach(dev);
664 return i;
667 #define MII_DAVICOM_DM9101 0x0181b800
669 static int update_link(struct net_device *dev)
671 struct netdev_private *np = netdev_priv(dev);
672 int duplex, fasteth, result, mii_reg;
674 /* BSMR */
675 mii_reg = mdio_read(dev, np->phys[0], MII_BMSR);
677 if (mii_reg == 0xffff)
678 return np->csr6;
679 /* reread: the link status bit is sticky */
680 mii_reg = mdio_read(dev, np->phys[0], MII_BMSR);
681 if (!(mii_reg & 0x4)) {
682 if (netif_carrier_ok(dev)) {
683 if (debug)
684 dev_info(&dev->dev,
685 "MII #%d reports no link. Disabling watchdog\n",
686 np->phys[0]);
687 netif_carrier_off(dev);
689 return np->csr6;
691 if (!netif_carrier_ok(dev)) {
692 if (debug)
693 dev_info(&dev->dev,
694 "MII #%d link is back. Enabling watchdog\n",
695 np->phys[0]);
696 netif_carrier_on(dev);
699 if ((np->mii & ~0xf) == MII_DAVICOM_DM9101) {
700 /* If the link partner doesn't support autonegotiation
701 * the MII detects it's abilities with the "parallel detection".
702 * Some MIIs update the LPA register to the result of the parallel
703 * detection, some don't.
704 * The Davicom PHY [at least 0181b800] doesn't.
705 * Instead bit 9 and 13 of the BMCR are updated to the result
706 * of the negotiation..
708 mii_reg = mdio_read(dev, np->phys[0], MII_BMCR);
709 duplex = mii_reg & BMCR_FULLDPLX;
710 fasteth = mii_reg & BMCR_SPEED100;
711 } else {
712 int negotiated;
713 mii_reg = mdio_read(dev, np->phys[0], MII_LPA);
714 negotiated = mii_reg & np->mii_if.advertising;
716 duplex = (negotiated & LPA_100FULL) || ((negotiated & 0x02C0) == LPA_10FULL);
717 fasteth = negotiated & 0x380;
719 duplex |= np->mii_if.force_media;
720 /* remove fastether and fullduplex */
721 result = np->csr6 & ~0x20000200;
722 if (duplex)
723 result |= 0x200;
724 if (fasteth)
725 result |= 0x20000000;
726 if (result != np->csr6 && debug)
727 dev_info(&dev->dev,
728 "Setting %dMBit-%s-duplex based on MII#%d\n",
729 fasteth ? 100 : 10, duplex ? "full" : "half",
730 np->phys[0]);
731 return result;
734 #define RXTX_TIMEOUT 2000
735 static inline void update_csr6(struct net_device *dev, int new)
737 struct netdev_private *np = netdev_priv(dev);
738 void __iomem *ioaddr = np->base_addr;
739 int limit = RXTX_TIMEOUT;
741 if (!netif_device_present(dev))
742 new = 0;
743 if (new==np->csr6)
744 return;
745 /* stop both Tx and Rx processes */
746 iowrite32(np->csr6 & ~0x2002, ioaddr + NetworkConfig);
747 /* wait until they have really stopped */
748 for (;;) {
749 int csr5 = ioread32(ioaddr + IntrStatus);
750 int t;
752 t = (csr5 >> 17) & 0x07;
753 if (t==0||t==1) {
754 /* rx stopped */
755 t = (csr5 >> 20) & 0x07;
756 if (t==0||t==1)
757 break;
760 limit--;
761 if(!limit) {
762 dev_info(&dev->dev,
763 "couldn't stop rxtx, IntrStatus %xh\n", csr5);
764 break;
766 udelay(1);
768 np->csr6 = new;
769 /* and restart them with the new configuration */
770 iowrite32(np->csr6, ioaddr + NetworkConfig);
771 if (new & 0x200)
772 np->mii_if.full_duplex = 1;
775 static void netdev_timer(struct timer_list *t)
777 struct netdev_private *np = from_timer(np, t, timer);
778 struct net_device *dev = pci_get_drvdata(np->pci_dev);
779 void __iomem *ioaddr = np->base_addr;
781 if (debug > 2)
782 netdev_dbg(dev, "Media selection timer tick, status %08x config %08x\n",
783 ioread32(ioaddr + IntrStatus),
784 ioread32(ioaddr + NetworkConfig));
785 spin_lock_irq(&np->lock);
786 update_csr6(dev, update_link(dev));
787 spin_unlock_irq(&np->lock);
788 np->timer.expires = jiffies + 10*HZ;
789 add_timer(&np->timer);
792 static void init_rxtx_rings(struct net_device *dev)
794 struct netdev_private *np = netdev_priv(dev);
795 int i;
797 np->rx_head_desc = &np->rx_ring[0];
798 np->tx_ring = (struct w840_tx_desc*)&np->rx_ring[RX_RING_SIZE];
800 /* Initial all Rx descriptors. */
801 for (i = 0; i < RX_RING_SIZE; i++) {
802 np->rx_ring[i].length = np->rx_buf_sz;
803 np->rx_ring[i].status = 0;
804 np->rx_skbuff[i] = NULL;
806 /* Mark the last entry as wrapping the ring. */
807 np->rx_ring[i-1].length |= DescEndRing;
809 /* Fill in the Rx buffers. Handle allocation failure gracefully. */
810 for (i = 0; i < RX_RING_SIZE; i++) {
811 struct sk_buff *skb = netdev_alloc_skb(dev, np->rx_buf_sz);
812 np->rx_skbuff[i] = skb;
813 if (skb == NULL)
814 break;
815 np->rx_addr[i] = pci_map_single(np->pci_dev,skb->data,
816 np->rx_buf_sz,PCI_DMA_FROMDEVICE);
818 np->rx_ring[i].buffer1 = np->rx_addr[i];
819 np->rx_ring[i].status = DescOwned;
822 np->cur_rx = 0;
823 np->dirty_rx = (unsigned int)(i - RX_RING_SIZE);
825 /* Initialize the Tx descriptors */
826 for (i = 0; i < TX_RING_SIZE; i++) {
827 np->tx_skbuff[i] = NULL;
828 np->tx_ring[i].status = 0;
830 np->tx_full = 0;
831 np->tx_q_bytes = np->dirty_tx = np->cur_tx = 0;
833 iowrite32(np->ring_dma_addr, np->base_addr + RxRingPtr);
834 iowrite32(np->ring_dma_addr+sizeof(struct w840_rx_desc)*RX_RING_SIZE,
835 np->base_addr + TxRingPtr);
839 static void free_rxtx_rings(struct netdev_private* np)
841 int i;
842 /* Free all the skbuffs in the Rx queue. */
843 for (i = 0; i < RX_RING_SIZE; i++) {
844 np->rx_ring[i].status = 0;
845 if (np->rx_skbuff[i]) {
846 pci_unmap_single(np->pci_dev,
847 np->rx_addr[i],
848 np->rx_skbuff[i]->len,
849 PCI_DMA_FROMDEVICE);
850 dev_kfree_skb(np->rx_skbuff[i]);
852 np->rx_skbuff[i] = NULL;
854 for (i = 0; i < TX_RING_SIZE; i++) {
855 if (np->tx_skbuff[i]) {
856 pci_unmap_single(np->pci_dev,
857 np->tx_addr[i],
858 np->tx_skbuff[i]->len,
859 PCI_DMA_TODEVICE);
860 dev_kfree_skb(np->tx_skbuff[i]);
862 np->tx_skbuff[i] = NULL;
866 static void init_registers(struct net_device *dev)
868 struct netdev_private *np = netdev_priv(dev);
869 void __iomem *ioaddr = np->base_addr;
870 int i;
872 for (i = 0; i < 6; i++)
873 iowrite8(dev->dev_addr[i], ioaddr + StationAddr + i);
875 /* Initialize other registers. */
876 #ifdef __BIG_ENDIAN
877 i = (1<<20); /* Big-endian descriptors */
878 #else
879 i = 0;
880 #endif
881 i |= (0x04<<2); /* skip length 4 u32 */
882 i |= 0x02; /* give Rx priority */
884 /* Configure the PCI bus bursts and FIFO thresholds.
885 486: Set 8 longword cache alignment, 8 longword burst.
886 586: Set 16 longword cache alignment, no burst limit.
887 Cache alignment bits 15:14 Burst length 13:8
888 0000 <not allowed> 0000 align to cache 0800 8 longwords
889 4000 8 longwords 0100 1 longword 1000 16 longwords
890 8000 16 longwords 0200 2 longwords 2000 32 longwords
891 C000 32 longwords 0400 4 longwords */
893 #if defined (__i386__) && !defined(MODULE)
894 /* When not a module we can work around broken '486 PCI boards. */
895 if (boot_cpu_data.x86 <= 4) {
896 i |= 0x4800;
897 dev_info(&dev->dev,
898 "This is a 386/486 PCI system, setting cache alignment to 8 longwords\n");
899 } else {
900 i |= 0xE000;
902 #elif defined(__powerpc__) || defined(__i386__) || defined(__alpha__) || defined(__ia64__) || defined(__x86_64__)
903 i |= 0xE000;
904 #elif defined(CONFIG_SPARC) || defined (CONFIG_PARISC) || defined(CONFIG_ARM)
905 i |= 0x4800;
906 #else
907 dev_warn(&dev->dev, "unknown CPU architecture, using default csr0 setting\n");
908 i |= 0x4800;
909 #endif
910 iowrite32(i, ioaddr + PCIBusCfg);
912 np->csr6 = 0;
913 /* 128 byte Tx threshold;
914 Transmit on; Receive on; */
915 update_csr6(dev, 0x00022002 | update_link(dev) | __set_rx_mode(dev));
917 /* Clear and Enable interrupts by setting the interrupt mask. */
918 iowrite32(0x1A0F5, ioaddr + IntrStatus);
919 iowrite32(0x1A0F5, ioaddr + IntrEnable);
921 iowrite32(0, ioaddr + RxStartDemand);
924 static void tx_timeout(struct net_device *dev, unsigned int txqueue)
926 struct netdev_private *np = netdev_priv(dev);
927 void __iomem *ioaddr = np->base_addr;
928 const int irq = np->pci_dev->irq;
930 dev_warn(&dev->dev, "Transmit timed out, status %08x, resetting...\n",
931 ioread32(ioaddr + IntrStatus));
934 int i;
935 printk(KERN_DEBUG " Rx ring %p: ", np->rx_ring);
936 for (i = 0; i < RX_RING_SIZE; i++)
937 printk(KERN_CONT " %08x", (unsigned int)np->rx_ring[i].status);
938 printk(KERN_CONT "\n");
939 printk(KERN_DEBUG " Tx ring %p: ", np->tx_ring);
940 for (i = 0; i < TX_RING_SIZE; i++)
941 printk(KERN_CONT " %08x", np->tx_ring[i].status);
942 printk(KERN_CONT "\n");
944 printk(KERN_DEBUG "Tx cur %d Tx dirty %d Tx Full %d, q bytes %d\n",
945 np->cur_tx, np->dirty_tx, np->tx_full, np->tx_q_bytes);
946 printk(KERN_DEBUG "Tx Descriptor addr %xh\n", ioread32(ioaddr+0x4C));
948 disable_irq(irq);
949 spin_lock_irq(&np->lock);
951 * Under high load dirty_tx and the internal tx descriptor pointer
952 * come out of sync, thus perform a software reset and reinitialize
953 * everything.
956 iowrite32(1, np->base_addr+PCIBusCfg);
957 udelay(1);
959 free_rxtx_rings(np);
960 init_rxtx_rings(dev);
961 init_registers(dev);
962 spin_unlock_irq(&np->lock);
963 enable_irq(irq);
965 netif_wake_queue(dev);
966 netif_trans_update(dev); /* prevent tx timeout */
967 np->stats.tx_errors++;
970 /* Initialize the Rx and Tx rings, along with various 'dev' bits. */
971 static int alloc_ringdesc(struct net_device *dev)
973 struct netdev_private *np = netdev_priv(dev);
975 np->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32);
977 np->rx_ring = pci_alloc_consistent(np->pci_dev,
978 sizeof(struct w840_rx_desc)*RX_RING_SIZE +
979 sizeof(struct w840_tx_desc)*TX_RING_SIZE,
980 &np->ring_dma_addr);
981 if(!np->rx_ring)
982 return -ENOMEM;
983 init_rxtx_rings(dev);
984 return 0;
987 static void free_ringdesc(struct netdev_private *np)
989 pci_free_consistent(np->pci_dev,
990 sizeof(struct w840_rx_desc)*RX_RING_SIZE +
991 sizeof(struct w840_tx_desc)*TX_RING_SIZE,
992 np->rx_ring, np->ring_dma_addr);
996 static netdev_tx_t start_tx(struct sk_buff *skb, struct net_device *dev)
998 struct netdev_private *np = netdev_priv(dev);
999 unsigned entry;
1001 /* Caution: the write order is important here, set the field
1002 with the "ownership" bits last. */
1004 /* Calculate the next Tx descriptor entry. */
1005 entry = np->cur_tx % TX_RING_SIZE;
1007 np->tx_addr[entry] = pci_map_single(np->pci_dev,
1008 skb->data,skb->len, PCI_DMA_TODEVICE);
1009 np->tx_skbuff[entry] = skb;
1011 np->tx_ring[entry].buffer1 = np->tx_addr[entry];
1012 if (skb->len < TX_BUFLIMIT) {
1013 np->tx_ring[entry].length = DescWholePkt | skb->len;
1014 } else {
1015 int len = skb->len - TX_BUFLIMIT;
1017 np->tx_ring[entry].buffer2 = np->tx_addr[entry]+TX_BUFLIMIT;
1018 np->tx_ring[entry].length = DescWholePkt | (len << 11) | TX_BUFLIMIT;
1020 if(entry == TX_RING_SIZE-1)
1021 np->tx_ring[entry].length |= DescEndRing;
1023 /* Now acquire the irq spinlock.
1024 * The difficult race is the ordering between
1025 * increasing np->cur_tx and setting DescOwned:
1026 * - if np->cur_tx is increased first the interrupt
1027 * handler could consider the packet as transmitted
1028 * since DescOwned is cleared.
1029 * - If DescOwned is set first the NIC could report the
1030 * packet as sent, but the interrupt handler would ignore it
1031 * since the np->cur_tx was not yet increased.
1033 spin_lock_irq(&np->lock);
1034 np->cur_tx++;
1036 wmb(); /* flush length, buffer1, buffer2 */
1037 np->tx_ring[entry].status = DescOwned;
1038 wmb(); /* flush status and kick the hardware */
1039 iowrite32(0, np->base_addr + TxStartDemand);
1040 np->tx_q_bytes += skb->len;
1041 /* Work around horrible bug in the chip by marking the queue as full
1042 when we do not have FIFO room for a maximum sized packet. */
1043 if (np->cur_tx - np->dirty_tx > TX_QUEUE_LEN ||
1044 ((np->drv_flags & HasBrokenTx) && np->tx_q_bytes > TX_BUG_FIFO_LIMIT)) {
1045 netif_stop_queue(dev);
1046 wmb();
1047 np->tx_full = 1;
1049 spin_unlock_irq(&np->lock);
1051 if (debug > 4) {
1052 netdev_dbg(dev, "Transmit frame #%d queued in slot %d\n",
1053 np->cur_tx, entry);
1055 return NETDEV_TX_OK;
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;
1065 if (tx_status < 0)
1066 break;
1067 if (tx_status & 0x8000) { /* There was an error, log it. */
1068 #ifndef final_version
1069 if (debug > 1)
1070 netdev_dbg(dev, "Transmit error, Tx status %08x\n",
1071 tx_status);
1072 #endif
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++;
1080 } else {
1081 #ifndef final_version
1082 if (debug > 3)
1083 netdev_dbg(dev, "Transmit slot %d ok, Tx status %08x\n",
1084 entry, tx_status);
1085 #endif
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,
1093 PCI_DMA_TODEVICE);
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;
1098 if (np->tx_full &&
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. */
1102 np->tx_full = 0;
1103 wmb();
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;
1116 int handled = 0;
1118 if (!netif_device_present(dev))
1119 return IRQ_NONE;
1120 do {
1121 u32 intr_status = ioread32(ioaddr + IntrStatus);
1123 /* Acknowledge all of the current interrupt sources ASAP. */
1124 iowrite32(intr_status & 0x001ffff, ioaddr + IntrStatus);
1126 if (debug > 4)
1127 netdev_dbg(dev, "Interrupt, status %04x\n", intr_status);
1129 if ((intr_status & (NormalIntr|AbnormalIntr)) == 0)
1130 break;
1132 handled = 1;
1134 if (intr_status & (RxIntr | RxNoBuf))
1135 netdev_rx(dev);
1136 if (intr_status & RxNoBuf)
1137 iowrite32(0, ioaddr + RxStartDemand);
1139 if (intr_status & (TxNoBuf | TxIntr) &&
1140 np->cur_tx != np->dirty_tx) {
1141 spin_lock(&np->lock);
1142 netdev_tx_done(dev);
1143 spin_unlock(&np->lock);
1146 /* Abnormal error summary/uncommon events handlers. */
1147 if (intr_status & (AbnormalIntr | TxFIFOUnderflow | SystemError |
1148 TimerInt | TxDied))
1149 netdev_error(dev, intr_status);
1151 if (--work_limit < 0) {
1152 dev_warn(&dev->dev,
1153 "Too much work at interrupt, status=0x%04x\n",
1154 intr_status);
1155 /* Set the timer to re-enable the other interrupts after
1156 10*82usec ticks. */
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);
1163 break;
1165 } while (1);
1167 if (debug > 3)
1168 netdev_dbg(dev, "exiting interrupt, status=%#4.4x\n",
1169 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;
1181 if (debug > 4) {
1182 netdev_dbg(dev, " In netdev_rx(), entry %d status %04x\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;
1191 if (debug > 4)
1192 netdev_dbg(dev, " netdev_rx() status was %08x\n",
1193 status);
1194 if (status < 0)
1195 break;
1196 if ((status & 0x38008300) != 0x0300) {
1197 if ((status & 0x38000300) != 0x0300) {
1198 /* Ingore earlier buffers. */
1199 if ((status & 0xffff) != 0x7fff) {
1200 dev_warn(&dev->dev,
1201 "Oversized Ethernet frame spanned multiple buffers, entry %#x status %04x!\n",
1202 np->cur_rx, status);
1203 np->stats.rx_length_errors++;
1205 } else if (status & 0x8000) {
1206 /* There was a fatal error. */
1207 if (debug > 2)
1208 netdev_dbg(dev, "Receive error, Rx status %08x\n",
1209 status);
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++;
1215 } else {
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
1221 if (debug > 4)
1222 netdev_dbg(dev, " netdev_rx() normal Rx pkt length %d status %x\n",
1223 pkt_len, status);
1224 #endif
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 = netdev_alloc_skb(dev, 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);
1238 } else {
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. */
1247 if (debug > 5)
1248 netdev_dbg(dev, " Rx data %pM %pM %02x%02x %pI4\n",
1249 &skb->data[0], &skb->data[6],
1250 skb->data[12], skb->data[13],
1251 &skb->data[14]);
1252 #endif
1253 skb->protocol = eth_type_trans(skb, dev);
1254 netif_rx(skb);
1255 np->stats.rx_packets++;
1256 np->stats.rx_bytes += pkt_len;
1258 entry = (++np->cur_rx) % RX_RING_SIZE;
1259 np->rx_head_desc = &np->rx_ring[entry];
1262 /* Refill the Rx ring buffers. */
1263 for (; np->cur_rx - np->dirty_rx > 0; np->dirty_rx++) {
1264 struct sk_buff *skb;
1265 entry = np->dirty_rx % RX_RING_SIZE;
1266 if (np->rx_skbuff[entry] == NULL) {
1267 skb = netdev_alloc_skb(dev, np->rx_buf_sz);
1268 np->rx_skbuff[entry] = skb;
1269 if (skb == NULL)
1270 break; /* Better luck next round. */
1271 np->rx_addr[entry] = pci_map_single(np->pci_dev,
1272 skb->data,
1273 np->rx_buf_sz, PCI_DMA_FROMDEVICE);
1274 np->rx_ring[entry].buffer1 = np->rx_addr[entry];
1276 wmb();
1277 np->rx_ring[entry].status = DescOwned;
1280 return 0;
1283 static void netdev_error(struct net_device *dev, int intr_status)
1285 struct netdev_private *np = netdev_priv(dev);
1286 void __iomem *ioaddr = np->base_addr;
1288 if (debug > 2)
1289 netdev_dbg(dev, "Abnormal event, %08x\n", intr_status);
1290 if (intr_status == 0xffffffff)
1291 return;
1292 spin_lock(&np->lock);
1293 if (intr_status & TxFIFOUnderflow) {
1294 int new;
1295 /* Bump up the Tx threshold */
1296 #if 0
1297 /* This causes lots of dropped packets,
1298 * and under high load even tx_timeouts
1300 new = np->csr6 + 0x4000;
1301 #else
1302 new = (np->csr6 >> 14)&0x7f;
1303 if (new < 64)
1304 new *= 2;
1305 else
1306 new = 127; /* load full packet before starting */
1307 new = (np->csr6 & ~(0x7F << 14)) | (new<<14);
1308 #endif
1309 netdev_dbg(dev, "Tx underflow, new csr6 %08x\n", new);
1310 update_csr6(dev, new);
1312 if (intr_status & RxDied) { /* Missed a Rx frame. */
1313 np->stats.rx_errors++;
1315 if (intr_status & TimerInt) {
1316 /* Re-enable other interrupts. */
1317 if (netif_device_present(dev))
1318 iowrite32(0x1A0F5, ioaddr + IntrEnable);
1320 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1321 iowrite32(0, ioaddr + RxStartDemand);
1322 spin_unlock(&np->lock);
1325 static struct net_device_stats *get_stats(struct net_device *dev)
1327 struct netdev_private *np = netdev_priv(dev);
1328 void __iomem *ioaddr = np->base_addr;
1330 /* The chip only need report frame silently dropped. */
1331 spin_lock_irq(&np->lock);
1332 if (netif_running(dev) && netif_device_present(dev))
1333 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1334 spin_unlock_irq(&np->lock);
1336 return &np->stats;
1340 static u32 __set_rx_mode(struct net_device *dev)
1342 struct netdev_private *np = netdev_priv(dev);
1343 void __iomem *ioaddr = np->base_addr;
1344 u32 mc_filter[2]; /* Multicast hash filter */
1345 u32 rx_mode;
1347 if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */
1348 memset(mc_filter, 0xff, sizeof(mc_filter));
1349 rx_mode = RxAcceptBroadcast | AcceptMulticast | RxAcceptAllPhys
1350 | AcceptMyPhys;
1351 } else if ((netdev_mc_count(dev) > multicast_filter_limit) ||
1352 (dev->flags & IFF_ALLMULTI)) {
1353 /* Too many to match, or accept all multicasts. */
1354 memset(mc_filter, 0xff, sizeof(mc_filter));
1355 rx_mode = RxAcceptBroadcast | AcceptMulticast | AcceptMyPhys;
1356 } else {
1357 struct netdev_hw_addr *ha;
1359 memset(mc_filter, 0, sizeof(mc_filter));
1360 netdev_for_each_mc_addr(ha, dev) {
1361 int filbit;
1363 filbit = (ether_crc(ETH_ALEN, ha->addr) >> 26) ^ 0x3F;
1364 filbit &= 0x3f;
1365 mc_filter[filbit >> 5] |= 1 << (filbit & 31);
1367 rx_mode = RxAcceptBroadcast | AcceptMulticast | AcceptMyPhys;
1369 iowrite32(mc_filter[0], ioaddr + MulticastFilter0);
1370 iowrite32(mc_filter[1], ioaddr + MulticastFilter1);
1371 return rx_mode;
1374 static void set_rx_mode(struct net_device *dev)
1376 struct netdev_private *np = netdev_priv(dev);
1377 u32 rx_mode = __set_rx_mode(dev);
1378 spin_lock_irq(&np->lock);
1379 update_csr6(dev, (np->csr6 & ~0x00F8) | rx_mode);
1380 spin_unlock_irq(&np->lock);
1383 static void netdev_get_drvinfo (struct net_device *dev, struct ethtool_drvinfo *info)
1385 struct netdev_private *np = netdev_priv(dev);
1387 strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
1388 strlcpy(info->version, DRV_VERSION, sizeof(info->version));
1389 strlcpy(info->bus_info, pci_name(np->pci_dev), sizeof(info->bus_info));
1392 static int netdev_get_link_ksettings(struct net_device *dev,
1393 struct ethtool_link_ksettings *cmd)
1395 struct netdev_private *np = netdev_priv(dev);
1397 spin_lock_irq(&np->lock);
1398 mii_ethtool_get_link_ksettings(&np->mii_if, cmd);
1399 spin_unlock_irq(&np->lock);
1401 return 0;
1404 static int netdev_set_link_ksettings(struct net_device *dev,
1405 const struct ethtool_link_ksettings *cmd)
1407 struct netdev_private *np = netdev_priv(dev);
1408 int rc;
1410 spin_lock_irq(&np->lock);
1411 rc = mii_ethtool_set_link_ksettings(&np->mii_if, cmd);
1412 spin_unlock_irq(&np->lock);
1414 return rc;
1417 static int netdev_nway_reset(struct net_device *dev)
1419 struct netdev_private *np = netdev_priv(dev);
1420 return mii_nway_restart(&np->mii_if);
1423 static u32 netdev_get_link(struct net_device *dev)
1425 struct netdev_private *np = netdev_priv(dev);
1426 return mii_link_ok(&np->mii_if);
1429 static u32 netdev_get_msglevel(struct net_device *dev)
1431 return debug;
1434 static void netdev_set_msglevel(struct net_device *dev, u32 value)
1436 debug = value;
1439 static const struct ethtool_ops netdev_ethtool_ops = {
1440 .get_drvinfo = netdev_get_drvinfo,
1441 .nway_reset = netdev_nway_reset,
1442 .get_link = netdev_get_link,
1443 .get_msglevel = netdev_get_msglevel,
1444 .set_msglevel = netdev_set_msglevel,
1445 .get_link_ksettings = netdev_get_link_ksettings,
1446 .set_link_ksettings = netdev_set_link_ksettings,
1449 static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1451 struct mii_ioctl_data *data = if_mii(rq);
1452 struct netdev_private *np = netdev_priv(dev);
1454 switch(cmd) {
1455 case SIOCGMIIPHY: /* Get address of MII PHY in use. */
1456 data->phy_id = ((struct netdev_private *)netdev_priv(dev))->phys[0] & 0x1f;
1457 /* Fall Through */
1459 case SIOCGMIIREG: /* Read MII PHY register. */
1460 spin_lock_irq(&np->lock);
1461 data->val_out = mdio_read(dev, data->phy_id & 0x1f, data->reg_num & 0x1f);
1462 spin_unlock_irq(&np->lock);
1463 return 0;
1465 case SIOCSMIIREG: /* Write MII PHY register. */
1466 spin_lock_irq(&np->lock);
1467 mdio_write(dev, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
1468 spin_unlock_irq(&np->lock);
1469 return 0;
1470 default:
1471 return -EOPNOTSUPP;
1475 static int netdev_close(struct net_device *dev)
1477 struct netdev_private *np = netdev_priv(dev);
1478 void __iomem *ioaddr = np->base_addr;
1480 netif_stop_queue(dev);
1482 if (debug > 1) {
1483 netdev_dbg(dev, "Shutting down ethercard, status was %08x Config %08x\n",
1484 ioread32(ioaddr + IntrStatus),
1485 ioread32(ioaddr + NetworkConfig));
1486 netdev_dbg(dev, "Queue pointers were Tx %d / %d, Rx %d / %d\n",
1487 np->cur_tx, np->dirty_tx,
1488 np->cur_rx, np->dirty_rx);
1491 /* Stop the chip's Tx and Rx processes. */
1492 spin_lock_irq(&np->lock);
1493 netif_device_detach(dev);
1494 update_csr6(dev, 0);
1495 iowrite32(0x0000, ioaddr + IntrEnable);
1496 spin_unlock_irq(&np->lock);
1498 free_irq(np->pci_dev->irq, dev);
1499 wmb();
1500 netif_device_attach(dev);
1502 if (ioread32(ioaddr + NetworkConfig) != 0xffffffff)
1503 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1505 #ifdef __i386__
1506 if (debug > 2) {
1507 int i;
1509 printk(KERN_DEBUG" Tx ring at %p:\n", np->tx_ring);
1510 for (i = 0; i < TX_RING_SIZE; i++)
1511 printk(KERN_DEBUG " #%d desc. %04x %04x %08x\n",
1512 i, np->tx_ring[i].length,
1513 np->tx_ring[i].status, np->tx_ring[i].buffer1);
1514 printk(KERN_DEBUG " Rx ring %p:\n", np->rx_ring);
1515 for (i = 0; i < RX_RING_SIZE; i++) {
1516 printk(KERN_DEBUG " #%d desc. %04x %04x %08x\n",
1517 i, np->rx_ring[i].length,
1518 np->rx_ring[i].status, np->rx_ring[i].buffer1);
1521 #endif /* __i386__ debugging only */
1523 del_timer_sync(&np->timer);
1525 free_rxtx_rings(np);
1526 free_ringdesc(np);
1528 return 0;
1531 static void w840_remove1(struct pci_dev *pdev)
1533 struct net_device *dev = pci_get_drvdata(pdev);
1535 if (dev) {
1536 struct netdev_private *np = netdev_priv(dev);
1537 unregister_netdev(dev);
1538 pci_release_regions(pdev);
1539 pci_iounmap(pdev, np->base_addr);
1540 free_netdev(dev);
1544 #ifdef CONFIG_PM
1547 * suspend/resume synchronization:
1548 * - open, close, do_ioctl:
1549 * rtnl_lock, & netif_device_detach after the rtnl_unlock.
1550 * - get_stats:
1551 * spin_lock_irq(np->lock), doesn't touch hw if not present
1552 * - start_xmit:
1553 * synchronize_irq + netif_tx_disable;
1554 * - tx_timeout:
1555 * netif_device_detach + netif_tx_disable;
1556 * - set_multicast_list
1557 * netif_device_detach + netif_tx_disable;
1558 * - interrupt handler
1559 * doesn't touch hw if not present, synchronize_irq waits for
1560 * running instances of the interrupt handler.
1562 * Disabling hw requires clearing csr6 & IntrEnable.
1563 * update_csr6 & all function that write IntrEnable check netif_device_present
1564 * before settings any bits.
1566 * Detach must occur under spin_unlock_irq(), interrupts from a detached
1567 * device would cause an irq storm.
1569 static int w840_suspend (struct pci_dev *pdev, pm_message_t state)
1571 struct net_device *dev = pci_get_drvdata (pdev);
1572 struct netdev_private *np = netdev_priv(dev);
1573 void __iomem *ioaddr = np->base_addr;
1575 rtnl_lock();
1576 if (netif_running (dev)) {
1577 del_timer_sync(&np->timer);
1579 spin_lock_irq(&np->lock);
1580 netif_device_detach(dev);
1581 update_csr6(dev, 0);
1582 iowrite32(0, ioaddr + IntrEnable);
1583 spin_unlock_irq(&np->lock);
1585 synchronize_irq(np->pci_dev->irq);
1586 netif_tx_disable(dev);
1588 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1590 /* no more hardware accesses behind this line. */
1592 BUG_ON(np->csr6 || ioread32(ioaddr + IntrEnable));
1594 /* pci_power_off(pdev, -1); */
1596 free_rxtx_rings(np);
1597 } else {
1598 netif_device_detach(dev);
1600 rtnl_unlock();
1601 return 0;
1604 static int w840_resume (struct pci_dev *pdev)
1606 struct net_device *dev = pci_get_drvdata (pdev);
1607 struct netdev_private *np = netdev_priv(dev);
1608 int retval = 0;
1610 rtnl_lock();
1611 if (netif_device_present(dev))
1612 goto out; /* device not suspended */
1613 if (netif_running(dev)) {
1614 if ((retval = pci_enable_device(pdev))) {
1615 dev_err(&dev->dev,
1616 "pci_enable_device failed in resume\n");
1617 goto out;
1619 spin_lock_irq(&np->lock);
1620 iowrite32(1, np->base_addr+PCIBusCfg);
1621 ioread32(np->base_addr+PCIBusCfg);
1622 udelay(1);
1623 netif_device_attach(dev);
1624 init_rxtx_rings(dev);
1625 init_registers(dev);
1626 spin_unlock_irq(&np->lock);
1628 netif_wake_queue(dev);
1630 mod_timer(&np->timer, jiffies + 1*HZ);
1631 } else {
1632 netif_device_attach(dev);
1634 out:
1635 rtnl_unlock();
1636 return retval;
1638 #endif
1640 static struct pci_driver w840_driver = {
1641 .name = DRV_NAME,
1642 .id_table = w840_pci_tbl,
1643 .probe = w840_probe1,
1644 .remove = w840_remove1,
1645 #ifdef CONFIG_PM
1646 .suspend = w840_suspend,
1647 .resume = w840_resume,
1648 #endif
1651 static int __init w840_init(void)
1653 printk(version);
1654 return pci_register_driver(&w840_driver);
1657 static void __exit w840_exit(void)
1659 pci_unregister_driver(&w840_driver);
1662 module_init(w840_init);
1663 module_exit(w840_exit);