blob: e4cb408a70feaa19c8ab138f1fb5b48a62968765 [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
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110/* Include files, designed to support most kernel versions 2.0.0 and later. */
111#include <linux/module.h>
112#include <linux/kernel.h>
113#include <linux/string.h>
114#include <linux/timer.h>
115#include <linux/errno.h>
116#include <linux/ioport.h>
117#include <linux/slab.h>
118#include <linux/interrupt.h>
119#include <linux/pci.h>
Tobias Klauser10a87fc2005-05-12 22:20:53 -0400120#include <linux/dma-mapping.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121#include <linux/netdevice.h>
122#include <linux/etherdevice.h>
123#include <linux/skbuff.h>
124#include <linux/init.h>
125#include <linux/delay.h>
126#include <linux/ethtool.h>
127#include <linux/mii.h>
128#include <linux/rtnetlink.h>
129#include <linux/crc32.h>
130#include <linux/bitops.h>
131#include <asm/uaccess.h>
132#include <asm/processor.h> /* Processor type for cache alignment. */
133#include <asm/io.h>
134#include <asm/irq.h>
135
Grant Grundler42eab562006-09-08 11:15:40 -0700136#include "tulip.h"
137
Jeff Garzik48dd59e2008-04-16 20:37:24 -0400138#undef PKT_BUF_SZ /* tulip.h also defines this */
139#define PKT_BUF_SZ 1536 /* Size of each temporary Rx buffer.*/
140
Linus Torvalds1da177e2005-04-16 15:20:36 -0700141/* These identify the driver base version and may not be removed. */
Andrew Mortonc9d26c92006-08-14 23:00:08 -0700142static char version[] =
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143KERN_INFO DRV_NAME ".c:v" DRV_VERSION " (2.4 port) " DRV_RELDATE " Donald Becker <becker@scyld.com>\n"
144KERN_INFO " http://www.scyld.com/network/drivers.html\n";
145
146MODULE_AUTHOR("Donald Becker <becker@scyld.com>");
147MODULE_DESCRIPTION("Winbond W89c840 Ethernet driver");
148MODULE_LICENSE("GPL");
149MODULE_VERSION(DRV_VERSION);
150
151module_param(max_interrupt_work, int, 0);
152module_param(debug, int, 0);
153module_param(rx_copybreak, int, 0);
154module_param(multicast_filter_limit, int, 0);
155module_param_array(options, int, NULL, 0);
156module_param_array(full_duplex, int, NULL, 0);
157MODULE_PARM_DESC(max_interrupt_work, "winbond-840 maximum events handled per interrupt");
158MODULE_PARM_DESC(debug, "winbond-840 debug level (0-6)");
159MODULE_PARM_DESC(rx_copybreak, "winbond-840 copy breakpoint for copy-only-tiny-frames");
160MODULE_PARM_DESC(multicast_filter_limit, "winbond-840 maximum number of filtered multicast addresses");
161MODULE_PARM_DESC(options, "winbond-840: Bits 0-3: media type, bit 17: full duplex");
162MODULE_PARM_DESC(full_duplex, "winbond-840 full duplex setting(s) (1)");
163
164/*
165 Theory of Operation
166
167I. Board Compatibility
168
169This driver is for the Winbond w89c840 chip.
170
171II. Board-specific settings
172
173None.
174
175III. Driver operation
176
177This chip is very similar to the Digital 21*4* "Tulip" family. The first
178twelve registers and the descriptor format are nearly identical. Read a
179Tulip manual for operational details.
180
181A significant difference is that the multicast filter and station address are
182stored in registers rather than loaded through a pseudo-transmit packet.
183
184Unlike the Tulip, transmit buffers are limited to 1KB. To transmit a
185full-sized packet we must use both data buffers in a descriptor. Thus the
186driver uses ring mode where descriptors are implicitly sequential in memory,
187rather than using the second descriptor address as a chain pointer to
188subsequent descriptors.
189
190IV. Notes
191
192If you are going to almost clone a Tulip, why not go all the way and avoid
193the need for a new driver?
194
195IVb. References
196
197http://www.scyld.com/expert/100mbps.html
198http://www.scyld.com/expert/NWay.html
199http://www.winbond.com.tw/
200
201IVc. Errata
202
203A horrible bug exists in the transmit FIFO. Apparently the chip doesn't
204correctly detect a full FIFO, and queuing more than 2048 bytes may result in
205silent data corruption.
206
207Test with 'ping -s 10000' on a fast computer.
208
209*/
210
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400211
Linus Torvalds1da177e2005-04-16 15:20:36 -0700212
213/*
214 PCI probe table.
215*/
Linus Torvalds1da177e2005-04-16 15:20:36 -0700216enum chip_capability_flags {
Jeff Garzik1f1bd5f2006-06-26 23:47:50 -0400217 CanHaveMII=1, HasBrokenTx=2, AlwaysFDX=4, FDXOnNoMII=8,
218};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700219
Jeff Garzik1f1bd5f2006-06-26 23:47:50 -0400220static const struct pci_device_id w840_pci_tbl[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221 { 0x1050, 0x0840, PCI_ANY_ID, 0x8153, 0, 0, 0 },
222 { 0x1050, 0x0840, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1 },
223 { 0x11f6, 0x2011, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2 },
Jeff Garzik1f1bd5f2006-06-26 23:47:50 -0400224 { }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700225};
226MODULE_DEVICE_TABLE(pci, w840_pci_tbl);
227
Jeff Garzikc3d8e682006-06-27 08:54:34 -0400228enum {
229 netdev_res_size = 128, /* size of PCI BAR resource */
230};
231
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232struct pci_id_info {
233 const char *name;
Jeff Garzikc3d8e682006-06-27 08:54:34 -0400234 int drv_flags; /* Driver use, intended as capability flags. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235};
Jeff Garzikc3d8e682006-06-27 08:54:34 -0400236
237static const struct pci_id_info pci_id_tbl[] __devinitdata = {
238 { /* Sometime a Level-One switch card. */
239 "Winbond W89c840", CanHaveMII | HasBrokenTx | FDXOnNoMII},
240 { "Winbond W89c840", CanHaveMII | HasBrokenTx},
241 { "Compex RL100-ATX", CanHaveMII | HasBrokenTx},
242 { } /* terminate list. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700243};
244
245/* This driver was written to use PCI memory space, however some x86 systems
Grant Grundler42eab562006-09-08 11:15:40 -0700246 work only with I/O space accesses. See CONFIG_TULIP_MMIO in .config
247*/
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248
249/* Offsets to the Command and Status Registers, "CSRs".
250 While similar to the Tulip, these registers are longword aligned.
251 Note: It's not useful to define symbolic names for every register bit in
252 the device. The name can only partially document the semantics and make
253 the driver longer and more difficult to read.
254*/
255enum w840_offsets {
256 PCIBusCfg=0x00, TxStartDemand=0x04, RxStartDemand=0x08,
257 RxRingPtr=0x0C, TxRingPtr=0x10,
258 IntrStatus=0x14, NetworkConfig=0x18, IntrEnable=0x1C,
259 RxMissed=0x20, EECtrl=0x24, MIICtrl=0x24, BootRom=0x28, GPTimer=0x2C,
260 CurRxDescAddr=0x30, CurRxBufAddr=0x34, /* Debug use */
261 MulticastFilter0=0x38, MulticastFilter1=0x3C, StationAddr=0x40,
262 CurTxDescAddr=0x4C, CurTxBufAddr=0x50,
263};
264
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265/* Bits in the NetworkConfig register. */
266enum rx_mode_bits {
Grant Grundler42eab562006-09-08 11:15:40 -0700267 AcceptErr=0x80,
268 RxAcceptBroadcast=0x20, AcceptMulticast=0x10,
269 RxAcceptAllPhys=0x08, AcceptMyPhys=0x02,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700270};
271
272enum mii_reg_bits {
273 MDIO_ShiftClk=0x10000, MDIO_DataIn=0x80000, MDIO_DataOut=0x20000,
274 MDIO_EnbOutput=0x40000, MDIO_EnbIn = 0x00000,
275};
276
277/* The Tulip Rx and Tx buffer descriptors. */
278struct w840_rx_desc {
279 s32 status;
280 s32 length;
281 u32 buffer1;
282 u32 buffer2;
283};
284
285struct w840_tx_desc {
286 s32 status;
287 s32 length;
288 u32 buffer1, buffer2;
289};
290
Linus Torvalds1da177e2005-04-16 15:20:36 -0700291#define MII_CNT 1 /* winbond only supports one MII */
292struct netdev_private {
293 struct w840_rx_desc *rx_ring;
294 dma_addr_t rx_addr[RX_RING_SIZE];
295 struct w840_tx_desc *tx_ring;
296 dma_addr_t tx_addr[TX_RING_SIZE];
297 dma_addr_t ring_dma_addr;
298 /* The addresses of receive-in-place skbuffs. */
299 struct sk_buff* rx_skbuff[RX_RING_SIZE];
300 /* The saved address of a sent-in-place packet/buffer, for later free(). */
301 struct sk_buff* tx_skbuff[TX_RING_SIZE];
302 struct net_device_stats stats;
303 struct timer_list timer; /* Media monitoring timer. */
304 /* Frequently used values: keep some adjacent for cache effect. */
305 spinlock_t lock;
306 int chip_id, drv_flags;
307 struct pci_dev *pci_dev;
308 int csr6;
309 struct w840_rx_desc *rx_head_desc;
310 unsigned int cur_rx, dirty_rx; /* Producer/consumer ring indices */
311 unsigned int rx_buf_sz; /* Based on MTU+slack. */
312 unsigned int cur_tx, dirty_tx;
313 unsigned int tx_q_bytes;
314 unsigned int tx_full; /* The Tx queue is full. */
315 /* MII transceiver section. */
316 int mii_cnt; /* MII device addresses. */
317 unsigned char phys[MII_CNT]; /* MII device addresses, but only the first is used */
318 u32 mii;
319 struct mii_if_info mii_if;
320 void __iomem *base_addr;
321};
322
323static int eeprom_read(void __iomem *ioaddr, int location);
324static int mdio_read(struct net_device *dev, int phy_id, int location);
325static void mdio_write(struct net_device *dev, int phy_id, int location, int value);
326static int netdev_open(struct net_device *dev);
327static int update_link(struct net_device *dev);
328static void netdev_timer(unsigned long data);
329static void init_rxtx_rings(struct net_device *dev);
330static void free_rxtx_rings(struct netdev_private *np);
331static void init_registers(struct net_device *dev);
332static void tx_timeout(struct net_device *dev);
333static int alloc_ringdesc(struct net_device *dev);
334static void free_ringdesc(struct netdev_private *np);
335static int start_tx(struct sk_buff *skb, struct net_device *dev);
David Howells7d12e782006-10-05 14:55:46 +0100336static irqreturn_t intr_handler(int irq, void *dev_instance);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700337static void netdev_error(struct net_device *dev, int intr_status);
338static int netdev_rx(struct net_device *dev);
339static u32 __set_rx_mode(struct net_device *dev);
340static void set_rx_mode(struct net_device *dev);
341static struct net_device_stats *get_stats(struct net_device *dev);
342static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
Jeff Garzik7282d492006-09-13 14:30:00 -0400343static const struct ethtool_ops netdev_ethtool_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344static int netdev_close(struct net_device *dev);
345
Jeff Garzikf3b197a2006-05-26 21:39:03 -0400346
Linus Torvalds1da177e2005-04-16 15:20:36 -0700347
348static int __devinit w840_probe1 (struct pci_dev *pdev,
349 const struct pci_device_id *ent)
350{
351 struct net_device *dev;
352 struct netdev_private *np;
353 static int find_cnt;
354 int chip_idx = ent->driver_data;
355 int irq;
356 int i, option = find_cnt < MAX_UNITS ? options[find_cnt] : 0;
357 void __iomem *ioaddr;
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
Johannes Berge1749612008-10-27 15:59:26 -0700437 printk(KERN_INFO "%s: %s at %p, %pM, IRQ %d.\n",
Joe Perches0795af52007-10-03 17:59:30 -0700438 dev->name, pci_id_tbl[chip_idx].name, ioaddr,
Johannes Berge1749612008-10-27 15:59:26 -0700439 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
Rolf Eike Beer405bbe9f2007-10-20 03:10:57 +0200486 deprecated.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700487*/
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. */
Johannes Berge1749612008-10-27 15:59:26 -07001247 if (debug > 5)
1248 printk(KERN_DEBUG " Rx data %pM %pM"
Joe Perches0795af52007-10-03 17:59:30 -07001249 " %2.2x%2.2x %d.%d.%d.%d.\n",
Johannes Berge1749612008-10-27 15:59:26 -07001250 &skb->data[0], &skb->data[6],
Joe Perches0795af52007-10-03 17:59:30 -07001251 skb->data[12], skb->data[13],
1252 skb->data[14], skb->data[15], skb->data[16], skb->data[17]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001253#endif
1254 skb->protocol = eth_type_trans(skb, dev);
1255 netif_rx(skb);
1256 dev->last_rx = jiffies;
1257 np->stats.rx_packets++;
1258 np->stats.rx_bytes += pkt_len;
1259 }
1260 entry = (++np->cur_rx) % RX_RING_SIZE;
1261 np->rx_head_desc = &np->rx_ring[entry];
1262 }
1263
1264 /* Refill the Rx ring buffers. */
1265 for (; np->cur_rx - np->dirty_rx > 0; np->dirty_rx++) {
1266 struct sk_buff *skb;
1267 entry = np->dirty_rx % RX_RING_SIZE;
1268 if (np->rx_skbuff[entry] == NULL) {
1269 skb = dev_alloc_skb(np->rx_buf_sz);
1270 np->rx_skbuff[entry] = skb;
1271 if (skb == NULL)
1272 break; /* Better luck next round. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001273 np->rx_addr[entry] = pci_map_single(np->pci_dev,
David S. Miller689be432005-06-28 15:25:31 -07001274 skb->data,
Erling A. Jacobsenbb02aac2006-04-30 21:46:56 +02001275 np->rx_buf_sz, PCI_DMA_FROMDEVICE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001276 np->rx_ring[entry].buffer1 = np->rx_addr[entry];
1277 }
1278 wmb();
Grant Grundler42eab562006-09-08 11:15:40 -07001279 np->rx_ring[entry].status = DescOwned;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001280 }
1281
1282 return 0;
1283}
1284
1285static void netdev_error(struct net_device *dev, int intr_status)
1286{
1287 struct netdev_private *np = netdev_priv(dev);
1288 void __iomem *ioaddr = np->base_addr;
1289
1290 if (debug > 2)
1291 printk(KERN_DEBUG "%s: Abnormal event, %8.8x.\n",
1292 dev->name, intr_status);
1293 if (intr_status == 0xffffffff)
1294 return;
1295 spin_lock(&np->lock);
1296 if (intr_status & TxFIFOUnderflow) {
1297 int new;
1298 /* Bump up the Tx threshold */
1299#if 0
1300 /* This causes lots of dropped packets,
1301 * and under high load even tx_timeouts
1302 */
1303 new = np->csr6 + 0x4000;
1304#else
1305 new = (np->csr6 >> 14)&0x7f;
1306 if (new < 64)
1307 new *= 2;
1308 else
1309 new = 127; /* load full packet before starting */
1310 new = (np->csr6 & ~(0x7F << 14)) | (new<<14);
1311#endif
1312 printk(KERN_DEBUG "%s: Tx underflow, new csr6 %8.8x.\n",
1313 dev->name, new);
1314 update_csr6(dev, new);
1315 }
Grant Grundler42eab562006-09-08 11:15:40 -07001316 if (intr_status & RxDied) { /* Missed a Rx frame. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001317 np->stats.rx_errors++;
1318 }
1319 if (intr_status & TimerInt) {
1320 /* Re-enable other interrupts. */
1321 if (netif_device_present(dev))
1322 iowrite32(0x1A0F5, ioaddr + IntrEnable);
1323 }
1324 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1325 iowrite32(0, ioaddr + RxStartDemand);
1326 spin_unlock(&np->lock);
1327}
1328
1329static struct net_device_stats *get_stats(struct net_device *dev)
1330{
1331 struct netdev_private *np = netdev_priv(dev);
1332 void __iomem *ioaddr = np->base_addr;
1333
1334 /* The chip only need report frame silently dropped. */
1335 spin_lock_irq(&np->lock);
1336 if (netif_running(dev) && netif_device_present(dev))
1337 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1338 spin_unlock_irq(&np->lock);
1339
1340 return &np->stats;
1341}
1342
1343
1344static u32 __set_rx_mode(struct net_device *dev)
1345{
1346 struct netdev_private *np = netdev_priv(dev);
1347 void __iomem *ioaddr = np->base_addr;
1348 u32 mc_filter[2]; /* Multicast hash filter */
1349 u32 rx_mode;
1350
1351 if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001352 memset(mc_filter, 0xff, sizeof(mc_filter));
Grant Grundler42eab562006-09-08 11:15:40 -07001353 rx_mode = RxAcceptBroadcast | AcceptMulticast | RxAcceptAllPhys
Linus Torvalds1da177e2005-04-16 15:20:36 -07001354 | AcceptMyPhys;
1355 } else if ((dev->mc_count > multicast_filter_limit)
1356 || (dev->flags & IFF_ALLMULTI)) {
1357 /* Too many to match, or accept all multicasts. */
1358 memset(mc_filter, 0xff, sizeof(mc_filter));
Grant Grundler42eab562006-09-08 11:15:40 -07001359 rx_mode = RxAcceptBroadcast | AcceptMulticast | AcceptMyPhys;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001360 } else {
1361 struct dev_mc_list *mclist;
1362 int i;
1363 memset(mc_filter, 0, sizeof(mc_filter));
1364 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
1365 i++, mclist = mclist->next) {
1366 int filterbit = (ether_crc(ETH_ALEN, mclist->dmi_addr) >> 26) ^ 0x3F;
1367 filterbit &= 0x3f;
1368 mc_filter[filterbit >> 5] |= 1 << (filterbit & 31);
1369 }
Grant Grundler42eab562006-09-08 11:15:40 -07001370 rx_mode = RxAcceptBroadcast | AcceptMulticast | AcceptMyPhys;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001371 }
1372 iowrite32(mc_filter[0], ioaddr + MulticastFilter0);
1373 iowrite32(mc_filter[1], ioaddr + MulticastFilter1);
1374 return rx_mode;
1375}
1376
1377static void set_rx_mode(struct net_device *dev)
1378{
1379 struct netdev_private *np = netdev_priv(dev);
1380 u32 rx_mode = __set_rx_mode(dev);
1381 spin_lock_irq(&np->lock);
1382 update_csr6(dev, (np->csr6 & ~0x00F8) | rx_mode);
1383 spin_unlock_irq(&np->lock);
1384}
1385
1386static void netdev_get_drvinfo (struct net_device *dev, struct ethtool_drvinfo *info)
1387{
1388 struct netdev_private *np = netdev_priv(dev);
1389
1390 strcpy (info->driver, DRV_NAME);
1391 strcpy (info->version, DRV_VERSION);
1392 strcpy (info->bus_info, pci_name(np->pci_dev));
1393}
1394
1395static int netdev_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1396{
1397 struct netdev_private *np = netdev_priv(dev);
1398 int rc;
1399
1400 spin_lock_irq(&np->lock);
1401 rc = mii_ethtool_gset(&np->mii_if, cmd);
1402 spin_unlock_irq(&np->lock);
1403
1404 return rc;
1405}
1406
1407static int netdev_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
1408{
1409 struct netdev_private *np = netdev_priv(dev);
1410 int rc;
1411
1412 spin_lock_irq(&np->lock);
1413 rc = mii_ethtool_sset(&np->mii_if, cmd);
1414 spin_unlock_irq(&np->lock);
1415
1416 return rc;
1417}
1418
1419static int netdev_nway_reset(struct net_device *dev)
1420{
1421 struct netdev_private *np = netdev_priv(dev);
1422 return mii_nway_restart(&np->mii_if);
1423}
1424
1425static u32 netdev_get_link(struct net_device *dev)
1426{
1427 struct netdev_private *np = netdev_priv(dev);
1428 return mii_link_ok(&np->mii_if);
1429}
1430
1431static u32 netdev_get_msglevel(struct net_device *dev)
1432{
1433 return debug;
1434}
1435
1436static void netdev_set_msglevel(struct net_device *dev, u32 value)
1437{
1438 debug = value;
1439}
1440
Jeff Garzik7282d492006-09-13 14:30:00 -04001441static const struct ethtool_ops netdev_ethtool_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001442 .get_drvinfo = netdev_get_drvinfo,
1443 .get_settings = netdev_get_settings,
1444 .set_settings = netdev_set_settings,
1445 .nway_reset = netdev_nway_reset,
1446 .get_link = netdev_get_link,
1447 .get_msglevel = netdev_get_msglevel,
1448 .set_msglevel = netdev_set_msglevel,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001449};
1450
1451static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1452{
1453 struct mii_ioctl_data *data = if_mii(rq);
1454 struct netdev_private *np = netdev_priv(dev);
1455
1456 switch(cmd) {
1457 case SIOCGMIIPHY: /* Get address of MII PHY in use. */
1458 data->phy_id = ((struct netdev_private *)netdev_priv(dev))->phys[0] & 0x1f;
1459 /* Fall Through */
1460
1461 case SIOCGMIIREG: /* Read MII PHY register. */
1462 spin_lock_irq(&np->lock);
1463 data->val_out = mdio_read(dev, data->phy_id & 0x1f, data->reg_num & 0x1f);
1464 spin_unlock_irq(&np->lock);
1465 return 0;
1466
1467 case SIOCSMIIREG: /* Write MII PHY register. */
1468 if (!capable(CAP_NET_ADMIN))
1469 return -EPERM;
1470 spin_lock_irq(&np->lock);
1471 mdio_write(dev, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in);
1472 spin_unlock_irq(&np->lock);
1473 return 0;
1474 default:
1475 return -EOPNOTSUPP;
1476 }
1477}
1478
1479static int netdev_close(struct net_device *dev)
1480{
1481 struct netdev_private *np = netdev_priv(dev);
1482 void __iomem *ioaddr = np->base_addr;
1483
1484 netif_stop_queue(dev);
1485
1486 if (debug > 1) {
1487 printk(KERN_DEBUG "%s: Shutting down ethercard, status was %8.8x "
1488 "Config %8.8x.\n", dev->name, ioread32(ioaddr + IntrStatus),
1489 ioread32(ioaddr + NetworkConfig));
1490 printk(KERN_DEBUG "%s: Queue pointers were Tx %d / %d, Rx %d / %d.\n",
1491 dev->name, np->cur_tx, np->dirty_tx, np->cur_rx, np->dirty_rx);
1492 }
1493
1494 /* Stop the chip's Tx and Rx processes. */
1495 spin_lock_irq(&np->lock);
1496 netif_device_detach(dev);
1497 update_csr6(dev, 0);
1498 iowrite32(0x0000, ioaddr + IntrEnable);
1499 spin_unlock_irq(&np->lock);
1500
1501 free_irq(dev->irq, dev);
1502 wmb();
1503 netif_device_attach(dev);
1504
1505 if (ioread32(ioaddr + NetworkConfig) != 0xffffffff)
1506 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1507
1508#ifdef __i386__
1509 if (debug > 2) {
1510 int i;
1511
1512 printk(KERN_DEBUG" Tx ring at %8.8x:\n",
1513 (int)np->tx_ring);
1514 for (i = 0; i < TX_RING_SIZE; i++)
1515 printk(KERN_DEBUG " #%d desc. %4.4x %4.4x %8.8x.\n",
1516 i, np->tx_ring[i].length,
1517 np->tx_ring[i].status, np->tx_ring[i].buffer1);
1518 printk("\n"KERN_DEBUG " Rx ring %8.8x:\n",
1519 (int)np->rx_ring);
1520 for (i = 0; i < RX_RING_SIZE; i++) {
1521 printk(KERN_DEBUG " #%d desc. %4.4x %4.4x %8.8x\n",
1522 i, np->rx_ring[i].length,
1523 np->rx_ring[i].status, np->rx_ring[i].buffer1);
1524 }
1525 }
1526#endif /* __i386__ debugging only */
1527
1528 del_timer_sync(&np->timer);
1529
1530 free_rxtx_rings(np);
1531 free_ringdesc(np);
1532
1533 return 0;
1534}
1535
1536static void __devexit w840_remove1 (struct pci_dev *pdev)
1537{
1538 struct net_device *dev = pci_get_drvdata(pdev);
Jeff Garzikf3b197a2006-05-26 21:39:03 -04001539
Linus Torvalds1da177e2005-04-16 15:20:36 -07001540 if (dev) {
1541 struct netdev_private *np = netdev_priv(dev);
1542 unregister_netdev(dev);
1543 pci_release_regions(pdev);
1544 pci_iounmap(pdev, np->base_addr);
1545 free_netdev(dev);
1546 }
1547
1548 pci_set_drvdata(pdev, NULL);
1549}
1550
1551#ifdef CONFIG_PM
1552
1553/*
1554 * suspend/resume synchronization:
1555 * - open, close, do_ioctl:
1556 * rtnl_lock, & netif_device_detach after the rtnl_unlock.
1557 * - get_stats:
1558 * spin_lock_irq(np->lock), doesn't touch hw if not present
1559 * - hard_start_xmit:
Herbert Xu932ff272006-06-09 12:20:56 -07001560 * synchronize_irq + netif_tx_disable;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001561 * - tx_timeout:
Herbert Xu932ff272006-06-09 12:20:56 -07001562 * netif_device_detach + netif_tx_disable;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001563 * - set_multicast_list
Herbert Xu932ff272006-06-09 12:20:56 -07001564 * netif_device_detach + netif_tx_disable;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001565 * - interrupt handler
1566 * doesn't touch hw if not present, synchronize_irq waits for
1567 * running instances of the interrupt handler.
1568 *
1569 * Disabling hw requires clearing csr6 & IntrEnable.
1570 * update_csr6 & all function that write IntrEnable check netif_device_present
1571 * before settings any bits.
1572 *
1573 * Detach must occur under spin_unlock_irq(), interrupts from a detached
1574 * device would cause an irq storm.
1575 */
Pavel Machek05adc3b2005-04-16 15:25:25 -07001576static int w840_suspend (struct pci_dev *pdev, pm_message_t state)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001577{
1578 struct net_device *dev = pci_get_drvdata (pdev);
1579 struct netdev_private *np = netdev_priv(dev);
1580 void __iomem *ioaddr = np->base_addr;
1581
1582 rtnl_lock();
1583 if (netif_running (dev)) {
1584 del_timer_sync(&np->timer);
1585
1586 spin_lock_irq(&np->lock);
1587 netif_device_detach(dev);
1588 update_csr6(dev, 0);
1589 iowrite32(0, ioaddr + IntrEnable);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001590 spin_unlock_irq(&np->lock);
1591
Linus Torvalds1da177e2005-04-16 15:20:36 -07001592 synchronize_irq(dev->irq);
Herbert Xu932ff272006-06-09 12:20:56 -07001593 netif_tx_disable(dev);
Jeff Garzik6aa20a22006-09-13 13:24:59 -04001594
Linus Torvalds1da177e2005-04-16 15:20:36 -07001595 np->stats.rx_missed_errors += ioread32(ioaddr + RxMissed) & 0xffff;
1596
1597 /* no more hardware accesses behind this line. */
1598
Eric Sesterhenn / snakebytecca4aa82006-01-26 22:02:49 +01001599 BUG_ON(np->csr6);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001600 if (ioread32(ioaddr + IntrEnable)) BUG();
1601
1602 /* pci_power_off(pdev, -1); */
1603
1604 free_rxtx_rings(np);
1605 } else {
1606 netif_device_detach(dev);
1607 }
1608 rtnl_unlock();
1609 return 0;
1610}
1611
1612static int w840_resume (struct pci_dev *pdev)
1613{
1614 struct net_device *dev = pci_get_drvdata (pdev);
1615 struct netdev_private *np = netdev_priv(dev);
Valerie Henson9f486ae2006-09-08 11:15:41 -07001616 int retval = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001617
1618 rtnl_lock();
1619 if (netif_device_present(dev))
1620 goto out; /* device not suspended */
1621 if (netif_running(dev)) {
Valerie Henson9f486ae2006-09-08 11:15:41 -07001622 if ((retval = pci_enable_device(pdev))) {
1623 printk (KERN_ERR
1624 "%s: pci_enable_device failed in resume\n",
1625 dev->name);
1626 goto out;
1627 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001628 spin_lock_irq(&np->lock);
1629 iowrite32(1, np->base_addr+PCIBusCfg);
1630 ioread32(np->base_addr+PCIBusCfg);
1631 udelay(1);
1632 netif_device_attach(dev);
1633 init_rxtx_rings(dev);
1634 init_registers(dev);
1635 spin_unlock_irq(&np->lock);
1636
1637 netif_wake_queue(dev);
1638
1639 mod_timer(&np->timer, jiffies + 1*HZ);
1640 } else {
1641 netif_device_attach(dev);
1642 }
1643out:
1644 rtnl_unlock();
Valerie Henson9f486ae2006-09-08 11:15:41 -07001645 return retval;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001646}
1647#endif
1648
1649static struct pci_driver w840_driver = {
1650 .name = DRV_NAME,
1651 .id_table = w840_pci_tbl,
1652 .probe = w840_probe1,
1653 .remove = __devexit_p(w840_remove1),
1654#ifdef CONFIG_PM
1655 .suspend = w840_suspend,
1656 .resume = w840_resume,
1657#endif
1658};
1659
1660static int __init w840_init(void)
1661{
1662 printk(version);
Jeff Garzik29917622006-08-19 17:48:59 -04001663 return pci_register_driver(&w840_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001664}
1665
1666static void __exit w840_exit(void)
1667{
1668 pci_unregister_driver(&w840_driver);
1669}
1670
1671module_init(w840_init);
1672module_exit(w840_exit);