blob: 3c8e3b63be07a74d6d4f807317b9a427f7b27aa0 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/* winbond-840.c: A Linux PCI network adapter device driver. */
2/*
3 Written 1998-2001 by Donald Becker.
4
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.
11
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
16
17 Support and updates available at
18 http://www.scyld.com/network/drivers.html
19
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.
24
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)
Jeff Garzikf3b197a2006-05-26 21:39:03 -040041
Linus Torvalds1da177e2005-04-16 15:20:36 -070042 TODO:
43 * enable pci_power_off
44 * Wake-On-LAN
45*/
Jeff Garzikf3b197a2006-05-26 21:39:03 -040046
Linus Torvalds1da177e2005-04-16 15:20:36 -070047#define DRV_NAME "winbond-840"
Andy Gospodarekd5b20692006-09-11 17:39:18 -040048#define DRV_VERSION "1.01-e"
49#define DRV_RELDATE "Sep-11-2006"
Linus Torvalds1da177e2005-04-16 15:20:36 -070050
51
52/* Automatically extracted configuration info:
53probe-func: winbond840_probe
54config-in: tristate 'Winbond W89c840 Ethernet support' CONFIG_WINBOND_840
55
56c-help-name: Winbond W89c840 PCI Ethernet support
57c-help-symbol: CONFIG_WINBOND_840
58c-help: This driver is for the Winbond W89c840 chip. It also works with
59c-help: the TX9882 chip on the Compex RL100-ATX board.
Jeff Garzikf3b197a2006-05-26 21:39:03 -040060c-help: More specific information and updates are available from
Linus Torvalds1da177e2005-04-16 15:20:36 -070061c-help: http://www.scyld.com/network/drivers.html
62*/
63
64/* The user-configurable values.
65 These may be modified when a driver module is loaded.*/
66
67static int debug = 1; /* 1 normal messages, 0 quiet .. 7 verbose. */
68static 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. */
71static int multicast_filter_limit = 32;
72
73/* Set the copy breakpoint for the copy-only-tiny-frames scheme.
74 Setting to > 1518 effectively disables this feature. */
75static int rx_copybreak;
76
77/* Used to pass the media type, etc.
78 Both 'options[]' and 'full_duplex[]' should exist for driver
79 interoperability.
80 The media type is usually passed in 'options[]'.
81*/
82#define MAX_UNITS 8 /* More are supported, limit only on options */
83static int options[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
84static int full_duplex[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
85
86/* Operational parameters that are set at compile time. */
87
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. */
Linus Torvalds1da177e2005-04-16 15:20:36 -070093#define TX_QUEUE_LEN 10 /* Limit ring entries actually used. */
94#define TX_QUEUE_LEN_RESTART 5
Linus Torvalds1da177e2005-04-16 15:20:36 -070095
96#define TX_BUFLIMIT (1024-128)
97
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
100 full-size packet.
101 */
102#define TX_FIFO_SIZE (2048)
103#define TX_BUG_FIFO_LIMIT (TX_FIFO_SIZE-1514-16)
104
105
106/* Operational parameters that usually are not changed. */
107/* Time in jiffies before concluding the transmitter is hung. */
108#define TX_TIMEOUT (2*HZ)
109
110#define PKT_BUF_SZ 1536 /* Size of each temporary Rx buffer.*/
111
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>
Tobias Klauser10a87fc2005-05-12 22:20:53 -0400122#include <linux/dma-mapping.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -0700123#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. */
135#include <asm/io.h>
136#include <asm/irq.h>
137
Grant Grundler42eab562006-09-08 11:15:40 -0700138#include "tulip.h"
139
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140/* These identify the driver base version and may not be removed. */
Andrew Mortonc9d26c92006-08-14 23:00:08 -0700141static char version[] =
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142KERN_INFO DRV_NAME ".c:v" DRV_VERSION " (2.4 port) " DRV_RELDATE " Donald Becker <becker@scyld.com>\n"
143KERN_INFO " http://www.scyld.com/network/drivers.html\n";
144
145MODULE_AUTHOR("Donald Becker <becker@scyld.com>");
146MODULE_DESCRIPTION("Winbond W89c840 Ethernet driver");
147MODULE_LICENSE("GPL");
148MODULE_VERSION(DRV_VERSION);
149
150module_param(max_interrupt_work, int, 0);
151module_param(debug, int, 0);
152module_param(rx_copybreak, int, 0);
153module_param(multicast_filter_limit, int, 0);
154module_param_array(options, int, NULL, 0);
155module_param_array(full_duplex, int, NULL, 0);
156MODULE_PARM_DESC(max_interrupt_work, "winbond-840 maximum events handled per interrupt");
157MODULE_PARM_DESC(debug, "winbond-840 debug level (0-6)");
158MODULE_PARM_DESC(rx_copybreak, "winbond-840 copy breakpoint for copy-only-tiny-frames");
159MODULE_PARM_DESC(multicast_filter_limit, "winbond-840 maximum number of filtered multicast addresses");
160MODULE_PARM_DESC(options, "winbond-840: Bits 0-3: media type, bit 17: full duplex");
161MODULE_PARM_DESC(full_duplex, "winbond-840 full duplex setting(s) (1)");
162
163/*
164 Theory of Operation
165
166I. Board Compatibility
167
168This driver is for the Winbond w89c840 chip.
169
170II. Board-specific settings
171
172None.
173
174III. Driver operation
175
176This chip is very similar to the Digital 21*4* "Tulip" family. The first
177twelve registers and the descriptor format are nearly identical. Read a
178Tulip manual for operational details.
179
180A significant difference is that the multicast filter and station address are
181stored in registers rather than loaded through a pseudo-transmit packet.
182
183Unlike the Tulip, transmit buffers are limited to 1KB. To transmit a
184full-sized packet we must use both data buffers in a descriptor. Thus the
185driver uses ring mode where descriptors are implicitly sequential in memory,
186rather than using the second descriptor address as a chain pointer to
187subsequent descriptors.
188
189IV. Notes
190
191If you are going to almost clone a Tulip, why not go all the way and avoid
192the need for a new driver?
193
194IVb. References
195
196http://www.scyld.com/expert/100mbps.html
197http://www.scyld.com/expert/NWay.html
198http://www.winbond.com.tw/
199
200IVc. Errata
201
202A horrible bug exists in the transmit FIFO. Apparently the chip doesn't
203correctly detect a full FIFO, and queuing more than 2048 bytes may result in
204silent data corruption.
205
206Test with 'ping -s 10000' on a fast computer.
207
208*/
209
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400210
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211
212/*
213 PCI probe table.
214*/
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215enum chip_capability_flags {
Jeff Garzik1f1bd5f2006-06-26 23:47:50 -0400216 CanHaveMII=1, HasBrokenTx=2, AlwaysFDX=4, FDXOnNoMII=8,
217};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700218
Jeff Garzik1f1bd5f2006-06-26 23:47:50 -0400219static const struct pci_device_id w840_pci_tbl[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700220 { 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 },
Jeff Garzik1f1bd5f2006-06-26 23:47:50 -0400223 { }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700224};
225MODULE_DEVICE_TABLE(pci, w840_pci_tbl);
226
Jeff Garzikc3d8e682006-06-27 08:54:34 -0400227enum {
228 netdev_res_size = 128, /* size of PCI BAR resource */
229};
230
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231struct pci_id_info {
232 const char *name;
Jeff Garzikc3d8e682006-06-27 08:54:34 -0400233 int drv_flags; /* Driver use, intended as capability flags. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234};
Jeff Garzikc3d8e682006-06-27 08:54:34 -0400235
236static 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. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700242};
243
244/* This driver was written to use PCI memory space, however some x86 systems
Grant Grundler42eab562006-09-08 11:15:40 -0700245 work only with I/O space accesses. See CONFIG_TULIP_MMIO in .config
246*/
Linus Torvalds1da177e2005-04-16 15:20:36 -0700247
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.
253*/
254enum w840_offsets {
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,
262};
263
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264/* Bits in the NetworkConfig register. */
265enum rx_mode_bits {
Grant Grundler42eab562006-09-08 11:15:40 -0700266 AcceptErr=0x80,
267 RxAcceptBroadcast=0x20, AcceptMulticast=0x10,
268 RxAcceptAllPhys=0x08, AcceptMyPhys=0x02,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269};
270
271enum mii_reg_bits {
272 MDIO_ShiftClk=0x10000, MDIO_DataIn=0x80000, MDIO_DataOut=0x20000,
273 MDIO_EnbOutput=0x40000, MDIO_EnbIn = 0x00000,
274};
275
276/* The Tulip Rx and Tx buffer descriptors. */
277struct w840_rx_desc {
278 s32 status;
279 s32 length;
280 u32 buffer1;
281 u32 buffer2;
282};
283
284struct w840_tx_desc {
285 s32 status;
286 s32 length;
287 u32 buffer1, buffer2;
288};
289
Linus Torvalds1da177e2005-04-16 15:20:36 -0700290#define MII_CNT 1 /* winbond only supports one MII */
291struct 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. */
304 spinlock_t lock;
305 int chip_id, drv_flags;
306 struct pci_dev *pci_dev;
307 int csr6;
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 */
317 u32 mii;
318 struct mii_if_info mii_if;
319 void __iomem *base_addr;
320};
321
322static int eeprom_read(void __iomem *ioaddr, int location);
323static int mdio_read(struct net_device *dev, int phy_id, int location);
324static void mdio_write(struct net_device *dev, int phy_id, int location, int value);
325static int netdev_open(struct net_device *dev);
326static int update_link(struct net_device *dev);
327static void netdev_timer(unsigned long data);
328static void init_rxtx_rings(struct net_device *dev);
329static void free_rxtx_rings(struct netdev_private *np);
330static void init_registers(struct net_device *dev);
331static void tx_timeout(struct net_device *dev);
332static int alloc_ringdesc(struct net_device *dev);
333static void free_ringdesc(struct netdev_private *np);
334static int start_tx(struct sk_buff *skb, struct net_device *dev);
David Howells7d12e782006-10-05 14:55:46 +0100335static irqreturn_t intr_handler(int irq, void *dev_instance);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700336static void netdev_error(struct net_device *dev, int intr_status);
337static int netdev_rx(struct net_device *dev);
338static u32 __set_rx_mode(struct net_device *dev);
339static void set_rx_mode(struct net_device *dev);
340static struct net_device_stats *get_stats(struct net_device *dev);
341static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
Jeff Garzik7282d492006-09-13 14:30:00 -0400342static const struct ethtool_ops netdev_ethtool_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343static int netdev_close(struct net_device *dev);
344
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400345
Linus Torvalds1da177e2005-04-16 15:20:36 -0700346
347static int __devinit w840_probe1 (struct pci_dev *pdev,
348 const struct pci_device_id *ent)
349{
350 struct net_device *dev;
351 struct netdev_private *np;
352 static int find_cnt;
353 int chip_idx = ent->driver_data;
354 int irq;
355 int i, option = find_cnt < MAX_UNITS ? options[find_cnt] : 0;
356 void __iomem *ioaddr;
Joe Perches0795af52007-10-03 17:59:30 -0700357 DECLARE_MAC_BUF(mac);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358
359 i = pci_enable_device(pdev);
360 if (i) return i;
361
362 pci_set_master(pdev);
363
364 irq = pdev->irq;
365
Tobias Klauser10a87fc2005-05-12 22:20:53 -0400366 if (pci_set_dma_mask(pdev, DMA_32BIT_MASK)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367 printk(KERN_WARNING "Winbond-840: Device %s disabled due to DMA limitations.\n",
368 pci_name(pdev));
369 return -EIO;
370 }
371 dev = alloc_etherdev(sizeof(*np));
372 if (!dev)
373 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374 SET_NETDEV_DEV(dev, &pdev->dev);
375
376 if (pci_request_regions(pdev, DRV_NAME))
377 goto err_out_netdev;
Grant Grundler42eab562006-09-08 11:15:40 -0700378
379 ioaddr = pci_iomap(pdev, TULIP_BAR, netdev_res_size);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380 if (!ioaddr)
381 goto err_out_free_res;
382
383 for (i = 0; i < 3; i++)
Al Viroc559a5b2007-08-23 00:43:22 -0400384 ((__le16 *)dev->dev_addr)[i] = cpu_to_le16(eeprom_read(ioaddr, i));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385
386 /* Reset the chip to erase previous misconfiguration.
387 No hold time required! */
388 iowrite32(0x00000001, ioaddr + PCIBusCfg);
389
390 dev->base_addr = (unsigned long)ioaddr;
391 dev->irq = irq;
392
393 np = netdev_priv(dev);
394 np->pci_dev = pdev;
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;
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400402
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403 pci_set_drvdata(pdev, dev);
404
405 if (dev->mem_start)
406 option = dev->mem_start;
407
408 /* The lower four bits are the media type. */
409 if (option > 0) {
410 if (option & 0x200)
411 np->mii_if.full_duplex = 1;
412 if (option & 15)
413 printk(KERN_INFO "%s: ignoring user supplied media type %d",
414 dev->name, option & 15);
415 }
416 if (find_cnt < MAX_UNITS && full_duplex[find_cnt] > 0)
417 np->mii_if.full_duplex = 1;
418
419 if (np->mii_if.full_duplex)
420 np->mii_if.force_media = 1;
421
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;
432
433 i = register_netdev(dev);
434 if (i)
435 goto err_out_cleardev;
436
Joe Perches0795af52007-10-03 17:59:30 -0700437 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);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440
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);
453 }
454 }
455 np->mii_cnt = phy_idx;
456 np->mii_if.phy_id = np->phys[0];
457 if (phy_idx == 0) {
458 printk(KERN_WARNING "%s: MII PHY not found -- this device may "
459 "not operate correctly.\n", dev->name);
460 }
461 }
462
463 find_cnt++;
464 return 0;
465
466err_out_cleardev:
467 pci_set_drvdata(pdev, NULL);
468 pci_iounmap(pdev, ioaddr);
469err_out_free_res:
470 pci_release_regions(pdev);
471err_out_netdev:
472 free_netdev (dev);
473 return -ENODEV;
474}
475
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400476
Linus Torvalds1da177e2005-04-16 15:20:36 -0700477/* 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. */
480
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
486 depricated.
487*/
488#define eeprom_delay(ee_addr) ioread32(ee_addr)
489
490enum EEPROM_Ctrl_Bits {
491 EE_ShiftClk=0x02, EE_Write0=0x801, EE_Write1=0x805,
492 EE_ChipSelect=0x801, EE_DataIn=0x08,
493};
494
495/* The EEPROM commands include the alway-set leading bit. */
496enum EEPROM_Cmds {
497 EE_WriteCmd=(5 << 6), EE_ReadCmd=(6 << 6), EE_EraseCmd=(7 << 6),
498};
499
500static int eeprom_read(void __iomem *addr, int location)
501{
502 int i;
503 int retval = 0;
504 void __iomem *ee_addr = addr + EECtrl;
505 int read_cmd = location | EE_ReadCmd;
506 iowrite32(EE_ChipSelect, ee_addr);
507
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);
515 }
516 iowrite32(EE_ChipSelect, ee_addr);
517 eeprom_delay(ee_addr);
518
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);
525 }
526
527 /* Terminate the EEPROM access. */
528 iowrite32(0, ee_addr);
529 return retval;
530}
531
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
535 for details.
536
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)
540
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. */
544static char mii_preamble_required = 1;
545
546#define MDIO_WRITE0 (MDIO_EnbOutput)
547#define MDIO_WRITE1 (MDIO_DataOut | MDIO_EnbOutput)
548
549/* Generate the preamble required for initial synchronization and
550 a few older transceivers. */
551static void mdio_sync(void __iomem *mdio_addr)
552{
553 int bits = 32;
554
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);
561 }
562}
563
564static int mdio_read(struct net_device *dev, int phy_id, int location)
565{
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;
569 int i, retval = 0;
570
571 if (mii_preamble_required)
572 mdio_sync(mdio_addr);
573
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;
577
578 iowrite32(dataval, mdio_addr);
579 mdio_delay(mdio_addr);
580 iowrite32(dataval | MDIO_ShiftClk, mdio_addr);
581 mdio_delay(mdio_addr);
582 }
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);
590 }
591 return (retval>>1) & 0xffff;
592}
593
594static void mdio_write(struct net_device *dev, int phy_id, int location, int value)
595{
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;
599 int i;
600
601 if (location == 4 && phy_id == np->phys[0])
602 np->mii_if.advertising = value;
603
604 if (mii_preamble_required)
605 mdio_sync(mdio_addr);
606
607 /* Shift the command bits out. */
608 for (i = 31; i >= 0; i--) {
609 int dataval = (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
610
611 iowrite32(dataval, mdio_addr);
612 mdio_delay(mdio_addr);
613 iowrite32(dataval | MDIO_ShiftClk, mdio_addr);
614 mdio_delay(mdio_addr);
615 }
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);
622 }
623 return;
624}
625
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400626
Linus Torvalds1da177e2005-04-16 15:20:36 -0700627static int netdev_open(struct net_device *dev)
628{
629 struct netdev_private *np = netdev_priv(dev);
630 void __iomem *ioaddr = np->base_addr;
631 int i;
632
633 iowrite32(0x00000001, ioaddr + PCIBusCfg); /* Reset */
634
635 netif_device_detach(dev);
Thomas Gleixner1fb9df52006-07-01 19:29:39 -0700636 i = request_irq(dev->irq, &intr_handler, IRQF_SHARED, dev->name, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700637 if (i)
638 goto out_err;
639
640 if (debug > 1)
641 printk(KERN_DEBUG "%s: w89c840_open() irq %d.\n",
642 dev->name, dev->irq);
643
644 if((i=alloc_ringdesc(dev)))
645 goto out_err;
646
647 spin_lock_irq(&np->lock);
648 netif_device_attach(dev);
649 init_registers(dev);
650 spin_unlock_irq(&np->lock);
651
652 netif_start_queue(dev);
653 if (debug > 2)
654 printk(KERN_DEBUG "%s: Done netdev_open().\n", dev->name);
655
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);
662 return 0;
663out_err:
664 netif_device_attach(dev);
665 return i;
666}
667
668#define MII_DAVICOM_DM9101 0x0181b800
669
670static int update_link(struct net_device *dev)
671{
672 struct netdev_private *np = netdev_priv(dev);
673 int duplex, fasteth, result, mii_reg;
674
675 /* BSMR */
676 mii_reg = mdio_read(dev, np->phys[0], MII_BMSR);
677
678 if (mii_reg == 0xffff)
679 return np->csr6;
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)) {
684 if (debug)
685 printk(KERN_INFO "%s: MII #%d reports no link. Disabling watchdog.\n",
686 dev->name, np->phys[0]);
687 netif_carrier_off(dev);
688 }
689 return np->csr6;
690 }
691 if (!netif_carrier_ok(dev)) {
692 if (debug)
693 printk(KERN_INFO "%s: MII #%d link is back. Enabling watchdog.\n",
694 dev->name, np->phys[0]);
695 netif_carrier_on(dev);
696 }
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400697
Linus Torvalds1da177e2005-04-16 15:20:36 -0700698 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..
706 */
707 mii_reg = mdio_read(dev, np->phys[0], MII_BMCR);
708 duplex = mii_reg & BMCR_FULLDPLX;
709 fasteth = mii_reg & BMCR_SPEED100;
710 } else {
711 int negotiated;
712 mii_reg = mdio_read(dev, np->phys[0], MII_LPA);
713 negotiated = mii_reg & np->mii_if.advertising;
714
715 duplex = (negotiated & LPA_100FULL) || ((negotiated & 0x02C0) == LPA_10FULL);
716 fasteth = negotiated & 0x380;
717 }
718 duplex |= np->mii_if.force_media;
719 /* remove fastether and fullduplex */
720 result = np->csr6 & ~0x20000200;
721 if (duplex)
722 result |= 0x200;
723 if (fasteth)
724 result |= 0x20000000;
725 if (result != np->csr6 && debug)
726 printk(KERN_INFO "%s: Setting %dMBit-%s-duplex based on MII#%d\n",
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400727 dev->name, fasteth ? 100 : 10,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700728 duplex ? "full" : "half", np->phys[0]);
729 return result;
730}
731
732#define RXTX_TIMEOUT 2000
733static inline void update_csr6(struct net_device *dev, int new)
734{
735 struct netdev_private *np = netdev_priv(dev);
736 void __iomem *ioaddr = np->base_addr;
737 int limit = RXTX_TIMEOUT;
738
739 if (!netif_device_present(dev))
740 new = 0;
741 if (new==np->csr6)
742 return;
743 /* stop both Tx and Rx processes */
744 iowrite32(np->csr6 & ~0x2002, ioaddr + NetworkConfig);
745 /* wait until they have really stopped */
746 for (;;) {
747 int csr5 = ioread32(ioaddr + IntrStatus);
748 int t;
749
750 t = (csr5 >> 17) & 0x07;
751 if (t==0||t==1) {
752 /* rx stopped */
753 t = (csr5 >> 20) & 0x07;
754 if (t==0||t==1)
755 break;
756 }
757
758 limit--;
759 if(!limit) {
760 printk(KERN_INFO "%s: couldn't stop rxtx, IntrStatus %xh.\n",
761 dev->name, csr5);
762 break;
763 }
764 udelay(1);
765 }
766 np->csr6 = new;
767 /* and restart them with the new configuration */
768 iowrite32(np->csr6, ioaddr + NetworkConfig);
769 if (new & 0x200)
770 np->mii_if.full_duplex = 1;
771}
772
773static void netdev_timer(unsigned long data)
774{
775 struct net_device *dev = (struct net_device *)data;
776 struct netdev_private *np = netdev_priv(dev);
777 void __iomem *ioaddr = np->base_addr;
778
779 if (debug > 2)
780 printk(KERN_DEBUG "%s: Media selection timer tick, status %8.8x "
781 "config %8.8x.\n",
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);
789}
790
791static void init_rxtx_rings(struct net_device *dev)
792{
793 struct netdev_private *np = netdev_priv(dev);
794 int i;
795
796 np->rx_head_desc = &np->rx_ring[0];
797 np->tx_ring = (struct w840_tx_desc*)&np->rx_ring[RX_RING_SIZE];
798
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;
804 }
805 /* Mark the last entry as wrapping the ring. */
806 np->rx_ring[i-1].length |= DescEndRing;
807
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;
812 if (skb == NULL)
813 break;
David S. Miller689be432005-06-28 15:25:31 -0700814 np->rx_addr[i] = pci_map_single(np->pci_dev,skb->data,
Erling A. Jacobsenbb02aac2006-04-30 21:46:56 +0200815 np->rx_buf_sz,PCI_DMA_FROMDEVICE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700816
817 np->rx_ring[i].buffer1 = np->rx_addr[i];
Grant Grundler42eab562006-09-08 11:15:40 -0700818 np->rx_ring[i].status = DescOwned;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700819 }
820
821 np->cur_rx = 0;
822 np->dirty_rx = (unsigned int)(i - RX_RING_SIZE);
823
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;
828 }
829 np->tx_full = 0;
830 np->tx_q_bytes = np->dirty_tx = np->cur_tx = 0;
831
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);
835
836}
837
838static void free_rxtx_rings(struct netdev_private* np)
839{
840 int i;
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,
846 np->rx_addr[i],
847 np->rx_skbuff[i]->len,
848 PCI_DMA_FROMDEVICE);
849 dev_kfree_skb(np->rx_skbuff[i]);
850 }
851 np->rx_skbuff[i] = NULL;
852 }
853 for (i = 0; i < TX_RING_SIZE; i++) {
854 if (np->tx_skbuff[i]) {
855 pci_unmap_single(np->pci_dev,
856 np->tx_addr[i],
857 np->tx_skbuff[i]->len,
858 PCI_DMA_TODEVICE);
859 dev_kfree_skb(np->tx_skbuff[i]);
860 }
861 np->tx_skbuff[i] = NULL;
862 }
863}
864
865static void init_registers(struct net_device *dev)
866{
867 struct netdev_private *np = netdev_priv(dev);
868 void __iomem *ioaddr = np->base_addr;
869 int i;
870
871 for (i = 0; i < 6; i++)
872 iowrite8(dev->dev_addr[i], ioaddr + StationAddr + i);
873
874 /* Initialize other registers. */
875#ifdef __BIG_ENDIAN
876 i = (1<<20); /* Big-endian descriptors */
877#else
878 i = 0;
879#endif
880 i |= (0x04<<2); /* skip length 4 u32 */
881 i |= 0x02; /* give Rx priority */
882
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 */
891
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) {
895 i |= 0x4800;
896 printk(KERN_INFO "%s: This is a 386/486 PCI system, setting cache "
897 "alignment to 8 longwords.\n", dev->name);
898 } else {
899 i |= 0xE000;
900 }
901#elif defined(__powerpc__) || defined(__i386__) || defined(__alpha__) || defined(__ia64__) || defined(__x86_64__)
902 i |= 0xE000;
David S. Miller49345102007-03-29 01:39:44 -0700903#elif defined(CONFIG_SPARC) || defined (CONFIG_PARISC)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700904 i |= 0x4800;
905#else
906#warning Processor architecture undefined
907 i |= 0x4800;
908#endif
909 iowrite32(i, ioaddr + PCIBusCfg);
910
911 np->csr6 = 0;
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400912 /* 128 byte Tx threshold;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700913 Transmit on; Receive on; */
914 update_csr6(dev, 0x00022002 | update_link(dev) | __set_rx_mode(dev));
915
916 /* Clear and Enable interrupts by setting the interrupt mask. */
917 iowrite32(0x1A0F5, ioaddr + IntrStatus);
918 iowrite32(0x1A0F5, ioaddr + IntrEnable);
919
920 iowrite32(0, ioaddr + RxStartDemand);
921}
922
923static void tx_timeout(struct net_device *dev)
924{
925 struct netdev_private *np = netdev_priv(dev);
926 void __iomem *ioaddr = np->base_addr;
927
928 printk(KERN_WARNING "%s: Transmit timed out, status %8.8x,"
929 " resetting...\n", dev->name, ioread32(ioaddr + IntrStatus));
930
931 {
932 int i;
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);
939 printk("\n");
940 }
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));
944
945 disable_irq(dev->irq);
946 spin_lock_irq(&np->lock);
947 /*
948 * Under high load dirty_tx and the internal tx descriptor pointer
949 * come out of sync, thus perform a software reset and reinitialize
950 * everything.
951 */
952
953 iowrite32(1, np->base_addr+PCIBusCfg);
954 udelay(1);
955
956 free_rxtx_rings(np);
957 init_rxtx_rings(dev);
958 init_registers(dev);
959 spin_unlock_irq(&np->lock);
960 enable_irq(dev->irq);
961
962 netif_wake_queue(dev);
963 dev->trans_start = jiffies;
964 np->stats.tx_errors++;
965 return;
966}
967
968/* Initialize the Rx and Tx rings, along with various 'dev' bits. */
969static int alloc_ringdesc(struct net_device *dev)
970{
971 struct netdev_private *np = netdev_priv(dev);
972
973 np->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32);
974
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,
978 &np->ring_dma_addr);
979 if(!np->rx_ring)
980 return -ENOMEM;
981 init_rxtx_rings(dev);
982 return 0;
983}
984
985static void free_ringdesc(struct netdev_private *np)
986{
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);
991
992}
993
994static int start_tx(struct sk_buff *skb, struct net_device *dev)
995{
996 struct netdev_private *np = netdev_priv(dev);
997 unsigned entry;
998
999 /* Caution: the write order is important here, set the field
1000 with the "ownership" bits last. */
1001
1002 /* Calculate the next Tx descriptor entry. */
1003 entry = np->cur_tx % TX_RING_SIZE;
1004
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;
1008
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;
1012 } else {
1013 int len = skb->len - TX_BUFLIMIT;
1014
1015 np->tx_ring[entry].buffer2 = np->tx_addr[entry]+TX_BUFLIMIT;
1016 np->tx_ring[entry].length = DescWholePkt | (len << 11) | TX_BUFLIMIT;
1017 }
1018 if(entry == TX_RING_SIZE-1)
1019 np->tx_ring[entry].length |= DescEndRing;
1020
1021 /* Now acquire the irq spinlock.
Michael Opdenacker59c51592007-05-09 08:57:56 +02001022 * The difficult race is the ordering between
Grant Grundler42eab562006-09-08 11:15:40 -07001023 * increasing np->cur_tx and setting DescOwned:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001024 * - if np->cur_tx is increased first the interrupt
1025 * handler could consider the packet as transmitted
Grant Grundler42eab562006-09-08 11:15:40 -07001026 * since DescOwned is cleared.
1027 * - If DescOwned is set first the NIC could report the
Linus Torvalds1da177e2005-04-16 15:20:36 -07001028 * packet as sent, but the interrupt handler would ignore it
1029 * since the np->cur_tx was not yet increased.
1030 */
1031 spin_lock_irq(&np->lock);
1032 np->cur_tx++;
1033
1034 wmb(); /* flush length, buffer1, buffer2 */
Grant Grundler42eab562006-09-08 11:15:40 -07001035 np->tx_ring[entry].status = DescOwned;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001036 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);
1044 wmb();
1045 np->tx_full = 1;
1046 }
1047 spin_unlock_irq(&np->lock);
1048
1049 dev->trans_start = jiffies;
1050
1051 if (debug > 4) {
1052 printk(KERN_DEBUG "%s: Transmit frame #%d queued in slot %d.\n",
1053 dev->name, np->cur_tx, entry);
1054 }
1055 return 0;
1056}
1057
1058static void netdev_tx_done(struct net_device *dev)
1059{
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;
1064
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 printk(KERN_DEBUG "%s: Transmit error, Tx status %8.8x.\n",
1071 dev->name, 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 printk(KERN_DEBUG "%s: Transmit slot %d ok, Tx status %8.8x.\n",
1084 dev->name, 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++;
1089 }
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;
1097 }
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);
1105 }
1106}
1107
1108/* The interrupt handler does all of the Rx thread work and cleans up
1109 after the Tx thread. */
David Howells7d12e782006-10-05 14:55:46 +01001110static irqreturn_t intr_handler(int irq, void *dev_instance)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001111{
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;
1117
1118 if (!netif_device_present(dev))
1119 return IRQ_NONE;
1120 do {
1121 u32 intr_status = ioread32(ioaddr + IntrStatus);
1122
1123 /* Acknowledge all of the current interrupt sources ASAP. */
1124 iowrite32(intr_status & 0x001ffff, ioaddr + IntrStatus);
1125
1126 if (debug > 4)
1127 printk(KERN_DEBUG "%s: Interrupt, status %4.4x.\n",
1128 dev->name, intr_status);
1129
1130 if ((intr_status & (NormalIntr|AbnormalIntr)) == 0)
1131 break;
1132
1133 handled = 1;
1134
Grant Grundler42eab562006-09-08 11:15:40 -07001135 if (intr_status & (RxIntr | RxNoBuf))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001136 netdev_rx(dev);
1137 if (intr_status & RxNoBuf)
1138 iowrite32(0, ioaddr + RxStartDemand);
1139
Grant Grundler42eab562006-09-08 11:15:40 -07001140 if (intr_status & (TxNoBuf | TxIntr) &&
Linus Torvalds1da177e2005-04-16 15:20:36 -07001141 np->cur_tx != np->dirty_tx) {
1142 spin_lock(&np->lock);
1143 netdev_tx_done(dev);
1144 spin_unlock(&np->lock);
1145 }
1146
1147 /* Abnormal error summary/uncommon events handlers. */
Valerie Henson1ddb9862007-03-12 02:31:33 -07001148 if (intr_status & (AbnormalIntr | TxFIFOUnderflow | SystemError |
Grant Grundler42eab562006-09-08 11:15:40 -07001149 TimerInt | TxDied))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001150 netdev_error(dev, intr_status);
1151
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
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);
1161 }
1162 spin_unlock(&np->lock);
1163 break;
1164 }
1165 } while (1);
1166
1167 if (debug > 3)
1168 printk(KERN_DEBUG "%s: exiting interrupt, status=%#4.4x.\n",
1169 dev->name, ioread32(ioaddr + IntrStatus));
1170 return IRQ_RETVAL(handled);
1171}
1172
1173/* This routine is logically part of the interrupt handler, but separated
1174 for clarity and better register allocation. */
1175static int netdev_rx(struct net_device *dev)
1176{
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;
1180
1181 if (debug > 4) {
1182 printk(KERN_DEBUG " In netdev_rx(), entry %d status %4.4x.\n",
1183 entry, np->rx_ring[entry].status);
1184 }
1185
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;
1190
1191 if (debug > 4)
1192 printk(KERN_DEBUG " netdev_rx() status was %8.8x.\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 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++;
1204 }
1205 } else if (status & 0x8000) {
1206 /* There was a fatal error. */
1207 if (debug > 2)
1208 printk(KERN_DEBUG "%s: Receive error, Rx status %8.8x.\n",
1209 dev->name, 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++;
1214 }
1215 } else {
1216 struct sk_buff *skb;
1217 /* Omit the four octet CRC from the length. */
1218 int pkt_len = ((status >> 16) & 0x7ff) - 4;
1219
1220#ifndef final_version
1221 if (debug > 4)
1222 printk(KERN_DEBUG " netdev_rx() normal Rx pkt length %d"
1223 " status %x.\n", 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 = dev_alloc_skb(pkt_len + 2)) != NULL) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001229 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);
David S. Miller8c7b7fa2007-07-10 22:08:12 -07001233 skb_copy_to_linear_data(skb, np->rx_skbuff[entry]->data, pkt_len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001234 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;
1244 }
1245#ifndef final_version /* Remove after testing. */
1246 /* You will want this info for the initial debug. */
Joe Perches0795af52007-10-03 17:59:30 -07001247 if (debug > 5) {
1248 DECLARE_MAC_BUF(mac);
1249 DECLARE_MAC_BUF(mac2);
1250
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]);
1256 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001257#endif
1258 skb->protocol = eth_type_trans(skb, dev);
1259 netif_rx(skb);
1260 dev->last_rx = jiffies;
1261 np->stats.rx_packets++;
1262 np->stats.rx_bytes += pkt_len;
1263 }
1264 entry = (++np->cur_rx) % RX_RING_SIZE;
1265 np->rx_head_desc = &np->rx_ring[entry];
1266 }
1267
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;
1275 if (skb == NULL)
1276 break; /* Better luck next round. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001277 np->rx_addr[entry] = pci_map_single(np->pci_dev,
David S. Miller689be432005-06-28 15:25:31 -07001278 skb->data,
Erling A. Jacobsenbb02aac2006-04-30 21:46:56 +02001279 np->rx_buf_sz, PCI_DMA_FROMDEVICE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001280 np->rx_ring[entry].buffer1 = np->rx_addr[entry];
1281 }
1282 wmb();
Grant Grundler42eab562006-09-08 11:15:40 -07001283 np->rx_ring[entry].status = DescOwned;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001284 }
1285
1286 return 0;
1287}
1288
1289static void netdev_error(struct net_device *dev, int intr_status)
1290{
1291 struct netdev_private *np = netdev_priv(dev);
1292 void __iomem *ioaddr = np->base_addr;
1293
1294 if (debug > 2)
1295 printk(KERN_DEBUG "%s: Abnormal event, %8.8x.\n",
1296 dev->name, intr_status);
1297 if (intr_status == 0xffffffff)
1298 return;
1299 spin_lock(&np->lock);
1300 if (intr_status & TxFIFOUnderflow) {
1301 int new;
1302 /* Bump up the Tx threshold */
1303#if 0
1304 /* This causes lots of dropped packets,
1305 * and under high load even tx_timeouts
1306 */
1307 new = np->csr6 + 0x4000;
1308#else
1309 new = (np->csr6 >> 14)&0x7f;
1310 if (new < 64)
1311 new *= 2;
1312 else
1313 new = 127; /* load full packet before starting */
1314 new = (np->csr6 & ~(0x7F << 14)) | (new<<14);
1315#endif
1316 printk(KERN_DEBUG "%s: Tx underflow, new csr6 %8.8x.\n",
1317 dev->name, new);
1318 update_csr6(dev, new);
1319 }
Grant Grundler42eab562006-09-08 11:15:40 -07001320 if (intr_status & RxDied) { /* Missed a Rx frame. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001321 np->stats.rx_errors++;
1322 }
1323 if (intr_status & TimerInt) {
1324 /* Re-enable other interrupts. */
1325 if (netif_device_present(dev))
1326 iowrite32(0x1A0F5, ioaddr + IntrEnable);
1327 }
1328 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1329 iowrite32(0, ioaddr + RxStartDemand);
1330 spin_unlock(&np->lock);
1331}
1332
1333static struct net_device_stats *get_stats(struct net_device *dev)
1334{
1335 struct netdev_private *np = netdev_priv(dev);
1336 void __iomem *ioaddr = np->base_addr;
1337
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);
1343
1344 return &np->stats;
1345}
1346
1347
1348static u32 __set_rx_mode(struct net_device *dev)
1349{
1350 struct netdev_private *np = netdev_priv(dev);
1351 void __iomem *ioaddr = np->base_addr;
1352 u32 mc_filter[2]; /* Multicast hash filter */
1353 u32 rx_mode;
1354
1355 if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001356 memset(mc_filter, 0xff, sizeof(mc_filter));
Grant Grundler42eab562006-09-08 11:15:40 -07001357 rx_mode = RxAcceptBroadcast | AcceptMulticast | RxAcceptAllPhys
Linus Torvalds1da177e2005-04-16 15:20:36 -07001358 | AcceptMyPhys;
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));
Grant Grundler42eab562006-09-08 11:15:40 -07001363 rx_mode = RxAcceptBroadcast | AcceptMulticast | AcceptMyPhys;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001364 } else {
1365 struct dev_mc_list *mclist;
1366 int i;
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;
1371 filterbit &= 0x3f;
1372 mc_filter[filterbit >> 5] |= 1 << (filterbit & 31);
1373 }
Grant Grundler42eab562006-09-08 11:15:40 -07001374 rx_mode = RxAcceptBroadcast | AcceptMulticast | AcceptMyPhys;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001375 }
1376 iowrite32(mc_filter[0], ioaddr + MulticastFilter0);
1377 iowrite32(mc_filter[1], ioaddr + MulticastFilter1);
1378 return rx_mode;
1379}
1380
1381static void set_rx_mode(struct net_device *dev)
1382{
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);
1388}
1389
1390static void netdev_get_drvinfo (struct net_device *dev, struct ethtool_drvinfo *info)
1391{
1392 struct netdev_private *np = netdev_priv(dev);
1393
1394 strcpy (info->driver, DRV_NAME);
1395 strcpy (info->version, DRV_VERSION);
1396 strcpy (info->bus_info, pci_name(np->pci_dev));
1397}
1398
1399static int netdev_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1400{
1401 struct netdev_private *np = netdev_priv(dev);
1402 int rc;
1403
1404 spin_lock_irq(&np->lock);
1405 rc = mii_ethtool_gset(&np->mii_if, cmd);
1406 spin_unlock_irq(&np->lock);
1407
1408 return rc;
1409}
1410
1411static int netdev_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1412{
1413 struct netdev_private *np = netdev_priv(dev);
1414 int rc;
1415
1416 spin_lock_irq(&np->lock);
1417 rc = mii_ethtool_sset(&np->mii_if, cmd);
1418 spin_unlock_irq(&np->lock);
1419
1420 return rc;
1421}
1422
1423static int netdev_nway_reset(struct net_device *dev)
1424{
1425 struct netdev_private *np = netdev_priv(dev);
1426 return mii_nway_restart(&np->mii_if);
1427}
1428
1429static u32 netdev_get_link(struct net_device *dev)
1430{
1431 struct netdev_private *np = netdev_priv(dev);
1432 return mii_link_ok(&np->mii_if);
1433}
1434
1435static u32 netdev_get_msglevel(struct net_device *dev)
1436{
1437 return debug;
1438}
1439
1440static void netdev_set_msglevel(struct net_device *dev, u32 value)
1441{
1442 debug = value;
1443}
1444
Jeff Garzik7282d492006-09-13 14:30:00 -04001445static const struct ethtool_ops netdev_ethtool_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001446 .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,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001453};
1454
1455static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1456{
1457 struct mii_ioctl_data *data = if_mii(rq);
1458 struct netdev_private *np = netdev_priv(dev);
1459
1460 switch(cmd) {
1461 case SIOCGMIIPHY: /* Get address of MII PHY in use. */
1462 data->phy_id = ((struct netdev_private *)netdev_priv(dev))->phys[0] & 0x1f;
1463 /* Fall Through */
1464
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);
1469 return 0;
1470
1471 case SIOCSMIIREG: /* Write MII PHY register. */
1472 if (!capable(CAP_NET_ADMIN))
1473 return -EPERM;
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);
1477 return 0;
1478 default:
1479 return -EOPNOTSUPP;
1480 }
1481}
1482
1483static int netdev_close(struct net_device *dev)
1484{
1485 struct netdev_private *np = netdev_priv(dev);
1486 void __iomem *ioaddr = np->base_addr;
1487
1488 netif_stop_queue(dev);
1489
1490 if (debug > 1) {
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);
1496 }
1497
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);
1504
1505 free_irq(dev->irq, dev);
1506 wmb();
1507 netif_device_attach(dev);
1508
1509 if (ioread32(ioaddr + NetworkConfig) != 0xffffffff)
1510 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1511
1512#ifdef __i386__
1513 if (debug > 2) {
1514 int i;
1515
1516 printk(KERN_DEBUG" Tx ring at %8.8x:\n",
1517 (int)np->tx_ring);
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",
1523 (int)np->rx_ring);
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);
1528 }
1529 }
1530#endif /* __i386__ debugging only */
1531
1532 del_timer_sync(&np->timer);
1533
1534 free_rxtx_rings(np);
1535 free_ringdesc(np);
1536
1537 return 0;
1538}
1539
1540static void __devexit w840_remove1 (struct pci_dev *pdev)
1541{
1542 struct net_device *dev = pci_get_drvdata(pdev);
Jeff Garzikf3b197a2006-05-26 21:39:03 -04001543
Linus Torvalds1da177e2005-04-16 15:20:36 -07001544 if (dev) {
1545 struct netdev_private *np = netdev_priv(dev);
1546 unregister_netdev(dev);
1547 pci_release_regions(pdev);
1548 pci_iounmap(pdev, np->base_addr);
1549 free_netdev(dev);
1550 }
1551
1552 pci_set_drvdata(pdev, NULL);
1553}
1554
1555#ifdef CONFIG_PM
1556
1557/*
1558 * suspend/resume synchronization:
1559 * - open, close, do_ioctl:
1560 * rtnl_lock, & netif_device_detach after the rtnl_unlock.
1561 * - get_stats:
1562 * spin_lock_irq(np->lock), doesn't touch hw if not present
1563 * - hard_start_xmit:
Herbert Xu932ff272006-06-09 12:20:56 -07001564 * synchronize_irq + netif_tx_disable;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001565 * - tx_timeout:
Herbert Xu932ff272006-06-09 12:20:56 -07001566 * netif_device_detach + netif_tx_disable;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001567 * - set_multicast_list
Herbert Xu932ff272006-06-09 12:20:56 -07001568 * netif_device_detach + netif_tx_disable;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001569 * - interrupt handler
1570 * doesn't touch hw if not present, synchronize_irq waits for
1571 * running instances of the interrupt handler.
1572 *
1573 * Disabling hw requires clearing csr6 & IntrEnable.
1574 * update_csr6 & all function that write IntrEnable check netif_device_present
1575 * before settings any bits.
1576 *
1577 * Detach must occur under spin_unlock_irq(), interrupts from a detached
1578 * device would cause an irq storm.
1579 */
Pavel Machek05adc3b2005-04-16 15:25:25 -07001580static int w840_suspend (struct pci_dev *pdev, pm_message_t state)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001581{
1582 struct net_device *dev = pci_get_drvdata (pdev);
1583 struct netdev_private *np = netdev_priv(dev);
1584 void __iomem *ioaddr = np->base_addr;
1585
1586 rtnl_lock();
1587 if (netif_running (dev)) {
1588 del_timer_sync(&np->timer);
1589
1590 spin_lock_irq(&np->lock);
1591 netif_device_detach(dev);
1592 update_csr6(dev, 0);
1593 iowrite32(0, ioaddr + IntrEnable);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001594 spin_unlock_irq(&np->lock);
1595
Linus Torvalds1da177e2005-04-16 15:20:36 -07001596 synchronize_irq(dev->irq);
Herbert Xu932ff272006-06-09 12:20:56 -07001597 netif_tx_disable(dev);
Jeff Garzik6aa20a22006-09-13 13:24:59 -04001598
Linus Torvalds1da177e2005-04-16 15:20:36 -07001599 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1600
1601 /* no more hardware accesses behind this line. */
1602
Eric Sesterhenn / snakebytecca4aa82006-01-26 22:02:49 +01001603 BUG_ON(np->csr6);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001604 if (ioread32(ioaddr + IntrEnable)) BUG();
1605
1606 /* pci_power_off(pdev, -1); */
1607
1608 free_rxtx_rings(np);
1609 } else {
1610 netif_device_detach(dev);
1611 }
1612 rtnl_unlock();
1613 return 0;
1614}
1615
1616static int w840_resume (struct pci_dev *pdev)
1617{
1618 struct net_device *dev = pci_get_drvdata (pdev);
1619 struct netdev_private *np = netdev_priv(dev);
Valerie Henson9f486ae2006-09-08 11:15:41 -07001620 int retval = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001621
1622 rtnl_lock();
1623 if (netif_device_present(dev))
1624 goto out; /* device not suspended */
1625 if (netif_running(dev)) {
Valerie Henson9f486ae2006-09-08 11:15:41 -07001626 if ((retval = pci_enable_device(pdev))) {
1627 printk (KERN_ERR
1628 "%s: pci_enable_device failed in resume\n",
1629 dev->name);
1630 goto out;
1631 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001632 spin_lock_irq(&np->lock);
1633 iowrite32(1, np->base_addr+PCIBusCfg);
1634 ioread32(np->base_addr+PCIBusCfg);
1635 udelay(1);
1636 netif_device_attach(dev);
1637 init_rxtx_rings(dev);
1638 init_registers(dev);
1639 spin_unlock_irq(&np->lock);
1640
1641 netif_wake_queue(dev);
1642
1643 mod_timer(&np->timer, jiffies + 1*HZ);
1644 } else {
1645 netif_device_attach(dev);
1646 }
1647out:
1648 rtnl_unlock();
Valerie Henson9f486ae2006-09-08 11:15:41 -07001649 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001650}
1651#endif
1652
1653static struct pci_driver w840_driver = {
1654 .name = DRV_NAME,
1655 .id_table = w840_pci_tbl,
1656 .probe = w840_probe1,
1657 .remove = __devexit_p(w840_remove1),
1658#ifdef CONFIG_PM
1659 .suspend = w840_suspend,
1660 .resume = w840_resume,
1661#endif
1662};
1663
1664static int __init w840_init(void)
1665{
1666 printk(version);
Jeff Garzik29917622006-08-19 17:48:59 -04001667 return pci_register_driver(&w840_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001668}
1669
1670static void __exit w840_exit(void)
1671{
1672 pci_unregister_driver(&w840_driver);
1673}
1674
1675module_init(w840_init);
1676module_exit(w840_exit);