via_rhine: Use netdev_<level> and pr_<level>
[linux-block.git] / drivers / net / via-rhine.c
CommitLineData
1da177e4
LT
1/* via-rhine.c: A Linux Ethernet device driver for VIA Rhine family chips. */
2/*
3 Written 1998-2001 by Donald Becker.
4
5 Current Maintainer: Roger Luethi <rl@hellgate.ch>
6
7 This software may be used and distributed according to the terms of
8 the GNU General Public License (GPL), incorporated herein by reference.
9 Drivers based on or derived from this code fall under the GPL and must
10 retain the authorship, copyright and license notice. This file is not
11 a complete program and may only be used when the entire operating
12 system is licensed under the GPL.
13
14 This driver is designed for the VIA VT86C100A Rhine-I.
15 It also works with the Rhine-II (6102) and Rhine-III (6105/6105L/6105LOM
16 and management NIC 6105M).
17
18 The author may be reached as becker@scyld.com, or C/O
19 Scyld Computing Corporation
20 410 Severn Ave., Suite 210
21 Annapolis MD 21403
22
23
24 This driver contains some changes from the original Donald Becker
25 version. He may or may not be interested in bug reports on this
26 code. You can find his versions at:
27 http://www.scyld.com/network/via-rhine.html
03a8c661 28 [link no longer provides useful info -jgarzik]
1da177e4
LT
29
30*/
31
df4511fe
JP
32#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
33
1da177e4 34#define DRV_NAME "via-rhine"
38f49e88
RL
35#define DRV_VERSION "1.5.0"
36#define DRV_RELDATE "2010-10-09"
1da177e4
LT
37
38
39/* A few user-configurable values.
40 These may be modified when a driver module is loaded. */
41
df4511fe 42#define DEBUG
1da177e4
LT
43static int debug = 1; /* 1 normal messages, 0 quiet .. 7 verbose. */
44static int max_interrupt_work = 20;
45
46/* Set the copy breakpoint for the copy-only-tiny-frames scheme.
47 Setting to > 1518 effectively disables this feature. */
8e95a202
JP
48#if defined(__alpha__) || defined(__arm__) || defined(__hppa__) || \
49 defined(CONFIG_SPARC) || defined(__ia64__) || \
50 defined(__sh__) || defined(__mips__)
b47157f0
DM
51static int rx_copybreak = 1518;
52#else
1da177e4 53static int rx_copybreak;
b47157f0 54#endif
1da177e4 55
b933b4d9
RL
56/* Work-around for broken BIOSes: they are unable to get the chip back out of
57 power state D3 so PXE booting fails. bootparam(7): via-rhine.avoid_D3=1 */
58static int avoid_D3;
59
1da177e4
LT
60/*
61 * In case you are looking for 'options[]' or 'full_duplex[]', they
62 * are gone. Use ethtool(8) instead.
63 */
64
65/* Maximum number of multicast addresses to filter (vs. rx-all-multicast).
66 The Rhine has a 64 element 8390-like hash table. */
67static const int multicast_filter_limit = 32;
68
69
70/* Operational parameters that are set at compile time. */
71
72/* Keep the ring sizes a power of two for compile efficiency.
73 The compiler will convert <unsigned>'%'<2^N> into a bit mask.
74 Making the Tx ring too large decreases the effectiveness of channel
75 bonding and packet priority.
76 There are no ill effects from too-large receive rings. */
77#define TX_RING_SIZE 16
78#define TX_QUEUE_LEN 10 /* Limit ring entries actually used. */
633949a1 79#define RX_RING_SIZE 64
1da177e4
LT
80
81/* Operational parameters that usually are not changed. */
82
83/* Time in jiffies before concluding the transmitter is hung. */
84#define TX_TIMEOUT (2*HZ)
85
86#define PKT_BUF_SZ 1536 /* Size of each temporary Rx buffer.*/
87
88#include <linux/module.h>
89#include <linux/moduleparam.h>
90#include <linux/kernel.h>
91#include <linux/string.h>
92#include <linux/timer.h>
93#include <linux/errno.h>
94#include <linux/ioport.h>
1da177e4
LT
95#include <linux/interrupt.h>
96#include <linux/pci.h>
1e7f0bd8 97#include <linux/dma-mapping.h>
1da177e4
LT
98#include <linux/netdevice.h>
99#include <linux/etherdevice.h>
100#include <linux/skbuff.h>
101#include <linux/init.h>
102#include <linux/delay.h>
103#include <linux/mii.h>
104#include <linux/ethtool.h>
105#include <linux/crc32.h>
38f49e88 106#include <linux/if_vlan.h>
1da177e4 107#include <linux/bitops.h>
c0d7a021 108#include <linux/workqueue.h>
1da177e4
LT
109#include <asm/processor.h> /* Processor type for cache alignment. */
110#include <asm/io.h>
111#include <asm/irq.h>
112#include <asm/uaccess.h>
e84df485 113#include <linux/dmi.h>
1da177e4
LT
114
115/* These identify the driver base version and may not be removed. */
c8de1fce 116static const char version[] __devinitconst =
df4511fe 117 "v1.10-LK" DRV_VERSION " " DRV_RELDATE " Written by Donald Becker";
1da177e4
LT
118
119/* This driver was written to use PCI memory space. Some early versions
120 of the Rhine may only work correctly with I/O space accesses. */
121#ifdef CONFIG_VIA_RHINE_MMIO
122#define USE_MMIO
123#else
124#endif
125
126MODULE_AUTHOR("Donald Becker <becker@scyld.com>");
127MODULE_DESCRIPTION("VIA Rhine PCI Fast Ethernet driver");
128MODULE_LICENSE("GPL");
129
130module_param(max_interrupt_work, int, 0);
131module_param(debug, int, 0);
132module_param(rx_copybreak, int, 0);
b933b4d9 133module_param(avoid_D3, bool, 0);
1da177e4
LT
134MODULE_PARM_DESC(max_interrupt_work, "VIA Rhine maximum events handled per interrupt");
135MODULE_PARM_DESC(debug, "VIA Rhine debug level (0-7)");
136MODULE_PARM_DESC(rx_copybreak, "VIA Rhine copy breakpoint for copy-only-tiny-frames");
b933b4d9 137MODULE_PARM_DESC(avoid_D3, "Avoid power state D3 (work-around for broken BIOSes)");
1da177e4 138
38f49e88
RL
139#define MCAM_SIZE 32
140#define VCAM_SIZE 32
141
1da177e4
LT
142/*
143 Theory of Operation
144
145I. Board Compatibility
146
147This driver is designed for the VIA 86c100A Rhine-II PCI Fast Ethernet
148controller.
149
150II. Board-specific settings
151
152Boards with this chip are functional only in a bus-master PCI slot.
153
154Many operational settings are loaded from the EEPROM to the Config word at
155offset 0x78. For most of these settings, this driver assumes that they are
156correct.
157If this driver is compiled to use PCI memory space operations the EEPROM
158must be configured to enable memory ops.
159
160III. Driver operation
161
162IIIa. Ring buffers
163
164This driver uses two statically allocated fixed-size descriptor lists
165formed into rings by a branch from the final descriptor to the beginning of
166the list. The ring sizes are set at compile time by RX/TX_RING_SIZE.
167
168IIIb/c. Transmit/Receive Structure
169
170This driver attempts to use a zero-copy receive and transmit scheme.
171
172Alas, all data buffers are required to start on a 32 bit boundary, so
173the driver must often copy transmit packets into bounce buffers.
174
175The driver allocates full frame size skbuffs for the Rx ring buffers at
176open() time and passes the skb->data field to the chip as receive data
177buffers. When an incoming frame is less than RX_COPYBREAK bytes long,
178a fresh skbuff is allocated and the frame is copied to the new skbuff.
179When the incoming frame is larger, the skbuff is passed directly up the
180protocol stack. Buffers consumed this way are replaced by newly allocated
181skbuffs in the last phase of rhine_rx().
182
183The RX_COPYBREAK value is chosen to trade-off the memory wasted by
184using a full-sized skbuff for small frames vs. the copying costs of larger
185frames. New boards are typically used in generously configured machines
186and the underfilled buffers have negligible impact compared to the benefit of
187a single allocation size, so the default value of zero results in never
188copying packets. When copying is done, the cost is usually mitigated by using
189a combined copy/checksum routine. Copying also preloads the cache, which is
190most useful with small frames.
191
192Since the VIA chips are only able to transfer data to buffers on 32 bit
193boundaries, the IP header at offset 14 in an ethernet frame isn't
194longword aligned for further processing. Copying these unaligned buffers
195has the beneficial effect of 16-byte aligning the IP header.
196
197IIId. Synchronization
198
199The driver runs as two independent, single-threaded flows of control. One
200is the send-packet routine, which enforces single-threaded use by the
b74ca3a8
WC
201netdev_priv(dev)->lock spinlock. The other thread is the interrupt handler,
202which is single threaded by the hardware and interrupt handling software.
1da177e4
LT
203
204The send packet thread has partial control over the Tx ring. It locks the
b74ca3a8
WC
205netdev_priv(dev)->lock whenever it's queuing a Tx packet. If the next slot in
206the ring is not available it stops the transmit queue by
207calling netif_stop_queue.
1da177e4
LT
208
209The interrupt handler has exclusive control over the Rx ring and records stats
210from the Tx ring. After reaping the stats, it marks the Tx queue entry as
211empty by incrementing the dirty_tx mark. If at least half of the entries in
212the Rx ring are available the transmit queue is woken up if it was stopped.
213
214IV. Notes
215
216IVb. References
217
218Preliminary VT86C100A manual from http://www.via.com.tw/
219http://www.scyld.com/expert/100mbps.html
220http://www.scyld.com/expert/NWay.html
221ftp://ftp.via.com.tw/public/lan/Products/NIC/VT86C100A/Datasheet/VT86C100A03.pdf
222ftp://ftp.via.com.tw/public/lan/Products/NIC/VT6102/Datasheet/VT6102_021.PDF
223
224
225IVc. Errata
226
227The VT86C100A manual is not reliable information.
228The 3043 chip does not handle unaligned transmit or receive buffers, resulting
229in significant performance degradation for bounce buffer copies on transmit
230and unaligned IP headers on receive.
231The chip does not pad to minimum transmit length.
232
233*/
234
235
236/* This table drives the PCI probe routines. It's mostly boilerplate in all
237 of the drivers, and will likely be provided by some future kernel.
238 Note the matching code -- the first table entry matchs all 56** cards but
239 second only the 1234 card.
240*/
241
242enum rhine_revs {
243 VT86C100A = 0x00,
244 VTunknown0 = 0x20,
245 VT6102 = 0x40,
246 VT8231 = 0x50, /* Integrated MAC */
247 VT8233 = 0x60, /* Integrated MAC */
248 VT8235 = 0x74, /* Integrated MAC */
249 VT8237 = 0x78, /* Integrated MAC */
250 VTunknown1 = 0x7C,
251 VT6105 = 0x80,
252 VT6105_B0 = 0x83,
253 VT6105L = 0x8A,
254 VT6107 = 0x8C,
255 VTunknown2 = 0x8E,
256 VT6105M = 0x90, /* Management adapter */
257};
258
259enum rhine_quirks {
260 rqWOL = 0x0001, /* Wake-On-LAN support */
261 rqForceReset = 0x0002,
262 rq6patterns = 0x0040, /* 6 instead of 4 patterns for WOL */
263 rqStatusWBRace = 0x0080, /* Tx Status Writeback Error possible */
264 rqRhineI = 0x0100, /* See comment below */
265};
266/*
267 * rqRhineI: VT86C100A (aka Rhine-I) uses different bits to enable
268 * MMIO as well as for the collision counter and the Tx FIFO underflow
269 * indicator. In addition, Tx and Rx buffers need to 4 byte aligned.
270 */
271
272/* Beware of PCI posted writes */
273#define IOSYNC do { ioread8(ioaddr + StationAddr); } while (0)
274
a3aa1884 275static DEFINE_PCI_DEVICE_TABLE(rhine_pci_tbl) = {
46009c8b
JG
276 { 0x1106, 0x3043, PCI_ANY_ID, PCI_ANY_ID, }, /* VT86C100A */
277 { 0x1106, 0x3065, PCI_ANY_ID, PCI_ANY_ID, }, /* VT6102 */
278 { 0x1106, 0x3106, PCI_ANY_ID, PCI_ANY_ID, }, /* 6105{,L,LOM} */
279 { 0x1106, 0x3053, PCI_ANY_ID, PCI_ANY_ID, }, /* VT6105M */
1da177e4
LT
280 { } /* terminate list */
281};
282MODULE_DEVICE_TABLE(pci, rhine_pci_tbl);
283
284
285/* Offsets to the device registers. */
286enum register_offsets {
287 StationAddr=0x00, RxConfig=0x06, TxConfig=0x07, ChipCmd=0x08,
38f49e88 288 ChipCmd1=0x09, TQWake=0x0A,
1da177e4
LT
289 IntrStatus=0x0C, IntrEnable=0x0E,
290 MulticastFilter0=0x10, MulticastFilter1=0x14,
291 RxRingPtr=0x18, TxRingPtr=0x1C, GFIFOTest=0x54,
38f49e88 292 MIIPhyAddr=0x6C, MIIStatus=0x6D, PCIBusConfig=0x6E, PCIBusConfig1=0x6F,
1da177e4
LT
293 MIICmd=0x70, MIIRegAddr=0x71, MIIData=0x72, MACRegEEcsr=0x74,
294 ConfigA=0x78, ConfigB=0x79, ConfigC=0x7A, ConfigD=0x7B,
295 RxMissed=0x7C, RxCRCErrs=0x7E, MiscCmd=0x81,
296 StickyHW=0x83, IntrStatus2=0x84,
38f49e88 297 CamMask=0x88, CamCon=0x92, CamAddr=0x93,
1da177e4
LT
298 WOLcrSet=0xA0, PwcfgSet=0xA1, WOLcgSet=0xA3, WOLcrClr=0xA4,
299 WOLcrClr1=0xA6, WOLcgClr=0xA7,
300 PwrcsrSet=0xA8, PwrcsrSet1=0xA9, PwrcsrClr=0xAC, PwrcsrClr1=0xAD,
301};
302
303/* Bits in ConfigD */
304enum backoff_bits {
305 BackOptional=0x01, BackModify=0x02,
306 BackCaptureEffect=0x04, BackRandom=0x08
307};
308
38f49e88
RL
309/* Bits in the TxConfig (TCR) register */
310enum tcr_bits {
311 TCR_PQEN=0x01,
312 TCR_LB0=0x02, /* loopback[0] */
313 TCR_LB1=0x04, /* loopback[1] */
314 TCR_OFSET=0x08,
315 TCR_RTGOPT=0x10,
316 TCR_RTFT0=0x20,
317 TCR_RTFT1=0x40,
318 TCR_RTSF=0x80,
319};
320
321/* Bits in the CamCon (CAMC) register */
322enum camcon_bits {
323 CAMC_CAMEN=0x01,
324 CAMC_VCAMSL=0x02,
325 CAMC_CAMWR=0x04,
326 CAMC_CAMRD=0x08,
327};
328
329/* Bits in the PCIBusConfig1 (BCR1) register */
330enum bcr1_bits {
331 BCR1_POT0=0x01,
332 BCR1_POT1=0x02,
333 BCR1_POT2=0x04,
334 BCR1_CTFT0=0x08,
335 BCR1_CTFT1=0x10,
336 BCR1_CTSF=0x20,
337 BCR1_TXQNOBK=0x40, /* for VT6105 */
338 BCR1_VIDFR=0x80, /* for VT6105 */
339 BCR1_MED0=0x40, /* for VT6102 */
340 BCR1_MED1=0x80, /* for VT6102 */
341};
342
1da177e4
LT
343#ifdef USE_MMIO
344/* Registers we check that mmio and reg are the same. */
345static const int mmio_verify_registers[] = {
346 RxConfig, TxConfig, IntrEnable, ConfigA, ConfigB, ConfigC, ConfigD,
347 0
348};
349#endif
350
351/* Bits in the interrupt status/mask registers. */
352enum intr_status_bits {
353 IntrRxDone=0x0001, IntrRxErr=0x0004, IntrRxEmpty=0x0020,
354 IntrTxDone=0x0002, IntrTxError=0x0008, IntrTxUnderrun=0x0210,
355 IntrPCIErr=0x0040,
356 IntrStatsMax=0x0080, IntrRxEarly=0x0100,
357 IntrRxOverflow=0x0400, IntrRxDropped=0x0800, IntrRxNoBuf=0x1000,
358 IntrTxAborted=0x2000, IntrLinkChange=0x4000,
359 IntrRxWakeUp=0x8000,
360 IntrNormalSummary=0x0003, IntrAbnormalSummary=0xC260,
361 IntrTxDescRace=0x080000, /* mapped from IntrStatus2 */
362 IntrTxErrSummary=0x082218,
363};
364
365/* Bits in WOLcrSet/WOLcrClr and PwrcsrSet/PwrcsrClr */
366enum wol_bits {
367 WOLucast = 0x10,
368 WOLmagic = 0x20,
369 WOLbmcast = 0x30,
370 WOLlnkon = 0x40,
371 WOLlnkoff = 0x80,
372};
373
374/* The Rx and Tx buffer descriptors. */
375struct rx_desc {
53c03f5c
AV
376 __le32 rx_status;
377 __le32 desc_length; /* Chain flag, Buffer/frame length */
378 __le32 addr;
379 __le32 next_desc;
1da177e4
LT
380};
381struct tx_desc {
53c03f5c
AV
382 __le32 tx_status;
383 __le32 desc_length; /* Chain flag, Tx Config, Frame length */
384 __le32 addr;
385 __le32 next_desc;
1da177e4
LT
386};
387
388/* Initial value for tx_desc.desc_length, Buffer size goes to bits 0-10 */
389#define TXDESC 0x00e08000
390
391enum rx_status_bits {
392 RxOK=0x8000, RxWholePkt=0x0300, RxErr=0x008F
393};
394
395/* Bits in *_desc.*_status */
396enum desc_status_bits {
397 DescOwn=0x80000000
398};
399
38f49e88
RL
400/* Bits in *_desc.*_length */
401enum desc_length_bits {
402 DescTag=0x00010000
403};
404
1da177e4
LT
405/* Bits in ChipCmd. */
406enum chip_cmd_bits {
407 CmdInit=0x01, CmdStart=0x02, CmdStop=0x04, CmdRxOn=0x08,
408 CmdTxOn=0x10, Cmd1TxDemand=0x20, CmdRxDemand=0x40,
409 Cmd1EarlyRx=0x01, Cmd1EarlyTx=0x02, Cmd1FDuplex=0x04,
410 Cmd1NoTxPoll=0x08, Cmd1Reset=0x80,
411};
412
413struct rhine_private {
38f49e88
RL
414 /* Bit mask for configured VLAN ids */
415 unsigned long active_vlans[BITS_TO_LONGS(VLAN_N_VID)];
416
1da177e4
LT
417 /* Descriptor rings */
418 struct rx_desc *rx_ring;
419 struct tx_desc *tx_ring;
420 dma_addr_t rx_ring_dma;
421 dma_addr_t tx_ring_dma;
422
423 /* The addresses of receive-in-place skbuffs. */
424 struct sk_buff *rx_skbuff[RX_RING_SIZE];
425 dma_addr_t rx_skbuff_dma[RX_RING_SIZE];
426
427 /* The saved address of a sent-in-place packet/buffer, for later free(). */
428 struct sk_buff *tx_skbuff[TX_RING_SIZE];
429 dma_addr_t tx_skbuff_dma[TX_RING_SIZE];
430
4be5de25 431 /* Tx bounce buffers (Rhine-I only) */
1da177e4
LT
432 unsigned char *tx_buf[TX_RING_SIZE];
433 unsigned char *tx_bufs;
434 dma_addr_t tx_bufs_dma;
435
436 struct pci_dev *pdev;
437 long pioaddr;
bea3348e
SH
438 struct net_device *dev;
439 struct napi_struct napi;
1da177e4 440 spinlock_t lock;
c0d7a021 441 struct work_struct reset_task;
1da177e4
LT
442
443 /* Frequently used values: keep some adjacent for cache effect. */
444 u32 quirks;
445 struct rx_desc *rx_head_desc;
446 unsigned int cur_rx, dirty_rx; /* Producer/consumer ring indices */
447 unsigned int cur_tx, dirty_tx;
448 unsigned int rx_buf_sz; /* Based on MTU+slack. */
449 u8 wolopts;
450
451 u8 tx_thresh, rx_thresh;
452
453 struct mii_if_info mii_if;
454 void __iomem *base;
455};
456
38f49e88
RL
457#define BYTE_REG_BITS_ON(x, p) do { iowrite8((ioread8((p))|(x)), (p)); } while (0)
458#define WORD_REG_BITS_ON(x, p) do { iowrite16((ioread16((p))|(x)), (p)); } while (0)
459#define DWORD_REG_BITS_ON(x, p) do { iowrite32((ioread32((p))|(x)), (p)); } while (0)
460
461#define BYTE_REG_BITS_IS_ON(x, p) (ioread8((p)) & (x))
462#define WORD_REG_BITS_IS_ON(x, p) (ioread16((p)) & (x))
463#define DWORD_REG_BITS_IS_ON(x, p) (ioread32((p)) & (x))
464
465#define BYTE_REG_BITS_OFF(x, p) do { iowrite8(ioread8((p)) & (~(x)), (p)); } while (0)
466#define WORD_REG_BITS_OFF(x, p) do { iowrite16(ioread16((p)) & (~(x)), (p)); } while (0)
467#define DWORD_REG_BITS_OFF(x, p) do { iowrite32(ioread32((p)) & (~(x)), (p)); } while (0)
468
469#define BYTE_REG_BITS_SET(x, m, p) do { iowrite8((ioread8((p)) & (~(m)))|(x), (p)); } while (0)
470#define WORD_REG_BITS_SET(x, m, p) do { iowrite16((ioread16((p)) & (~(m)))|(x), (p)); } while (0)
471#define DWORD_REG_BITS_SET(x, m, p) do { iowrite32((ioread32((p)) & (~(m)))|(x), (p)); } while (0)
472
473
1da177e4
LT
474static int mdio_read(struct net_device *dev, int phy_id, int location);
475static void mdio_write(struct net_device *dev, int phy_id, int location, int value);
476static int rhine_open(struct net_device *dev);
c0d7a021 477static void rhine_reset_task(struct work_struct *work);
1da177e4 478static void rhine_tx_timeout(struct net_device *dev);
61357325
SH
479static netdev_tx_t rhine_start_tx(struct sk_buff *skb,
480 struct net_device *dev);
7d12e780 481static irqreturn_t rhine_interrupt(int irq, void *dev_instance);
1da177e4 482static void rhine_tx(struct net_device *dev);
633949a1 483static int rhine_rx(struct net_device *dev, int limit);
1da177e4
LT
484static void rhine_error(struct net_device *dev, int intr_status);
485static void rhine_set_rx_mode(struct net_device *dev);
486static struct net_device_stats *rhine_get_stats(struct net_device *dev);
487static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
7282d491 488static const struct ethtool_ops netdev_ethtool_ops;
1da177e4 489static int rhine_close(struct net_device *dev);
d18c3db5 490static void rhine_shutdown (struct pci_dev *pdev);
38f49e88
RL
491static void rhine_vlan_rx_add_vid(struct net_device *dev, unsigned short vid);
492static void rhine_vlan_rx_kill_vid(struct net_device *dev, unsigned short vid);
493static void rhine_set_cam(void __iomem *ioaddr, int idx, u8 *addr);
494static void rhine_set_vlan_cam(void __iomem *ioaddr, int idx, u8 *addr);
495static void rhine_set_cam_mask(void __iomem *ioaddr, u32 mask);
496static void rhine_set_vlan_cam_mask(void __iomem *ioaddr, u32 mask);
497static void rhine_init_cam_filter(struct net_device *dev);
498static void rhine_update_vcam(struct net_device *dev);
1da177e4 499
df4511fe
JP
500#define RHINE_WAIT_FOR(condition) \
501do { \
502 int i = 1024; \
503 while (!(condition) && --i) \
504 ; \
505 if (debug > 1 && i < 512) \
506 pr_info("%4d cycles used @ %s:%d\n", \
507 1024 - i, __func__, __LINE__); \
508} while (0)
1da177e4
LT
509
510static inline u32 get_intr_status(struct net_device *dev)
511{
512 struct rhine_private *rp = netdev_priv(dev);
513 void __iomem *ioaddr = rp->base;
514 u32 intr_status;
515
516 intr_status = ioread16(ioaddr + IntrStatus);
517 /* On Rhine-II, Bit 3 indicates Tx descriptor write-back race. */
518 if (rp->quirks & rqStatusWBRace)
519 intr_status |= ioread8(ioaddr + IntrStatus2) << 16;
520 return intr_status;
521}
522
523/*
524 * Get power related registers into sane state.
525 * Notify user about past WOL event.
526 */
527static void rhine_power_init(struct net_device *dev)
528{
529 struct rhine_private *rp = netdev_priv(dev);
530 void __iomem *ioaddr = rp->base;
531 u16 wolstat;
532
533 if (rp->quirks & rqWOL) {
534 /* Make sure chip is in power state D0 */
535 iowrite8(ioread8(ioaddr + StickyHW) & 0xFC, ioaddr + StickyHW);
536
537 /* Disable "force PME-enable" */
538 iowrite8(0x80, ioaddr + WOLcgClr);
539
540 /* Clear power-event config bits (WOL) */
541 iowrite8(0xFF, ioaddr + WOLcrClr);
542 /* More recent cards can manage two additional patterns */
543 if (rp->quirks & rq6patterns)
544 iowrite8(0x03, ioaddr + WOLcrClr1);
545
546 /* Save power-event status bits */
547 wolstat = ioread8(ioaddr + PwrcsrSet);
548 if (rp->quirks & rq6patterns)
549 wolstat |= (ioread8(ioaddr + PwrcsrSet1) & 0x03) << 8;
550
551 /* Clear power-event status bits */
552 iowrite8(0xFF, ioaddr + PwrcsrClr);
553 if (rp->quirks & rq6patterns)
554 iowrite8(0x03, ioaddr + PwrcsrClr1);
555
556 if (wolstat) {
557 char *reason;
558 switch (wolstat) {
559 case WOLmagic:
560 reason = "Magic packet";
561 break;
562 case WOLlnkon:
563 reason = "Link went up";
564 break;
565 case WOLlnkoff:
566 reason = "Link went down";
567 break;
568 case WOLucast:
569 reason = "Unicast packet";
570 break;
571 case WOLbmcast:
572 reason = "Multicast/broadcast packet";
573 break;
574 default:
575 reason = "Unknown";
576 }
df4511fe
JP
577 netdev_info(dev, "Woke system up. Reason: %s\n",
578 reason);
1da177e4
LT
579 }
580 }
581}
582
583static void rhine_chip_reset(struct net_device *dev)
584{
585 struct rhine_private *rp = netdev_priv(dev);
586 void __iomem *ioaddr = rp->base;
587
588 iowrite8(Cmd1Reset, ioaddr + ChipCmd1);
589 IOSYNC;
590
591 if (ioread8(ioaddr + ChipCmd1) & Cmd1Reset) {
df4511fe 592 netdev_info(dev, "Reset not complete yet. Trying harder.\n");
1da177e4
LT
593
594 /* Force reset */
595 if (rp->quirks & rqForceReset)
596 iowrite8(0x40, ioaddr + MiscCmd);
597
598 /* Reset can take somewhat longer (rare) */
599 RHINE_WAIT_FOR(!(ioread8(ioaddr + ChipCmd1) & Cmd1Reset));
600 }
601
602 if (debug > 1)
df4511fe
JP
603 netdev_info(dev, "Reset %s\n",
604 (ioread8(ioaddr + ChipCmd1) & Cmd1Reset) ?
605 "failed" : "succeeded");
1da177e4
LT
606}
607
608#ifdef USE_MMIO
609static void enable_mmio(long pioaddr, u32 quirks)
610{
611 int n;
612 if (quirks & rqRhineI) {
613 /* More recent docs say that this bit is reserved ... */
614 n = inb(pioaddr + ConfigA) | 0x20;
615 outb(n, pioaddr + ConfigA);
616 } else {
617 n = inb(pioaddr + ConfigD) | 0x80;
618 outb(n, pioaddr + ConfigD);
619 }
620}
621#endif
622
623/*
624 * Loads bytes 0x00-0x05, 0x6E-0x6F, 0x78-0x7B from EEPROM
625 * (plus 0x6C for Rhine-I/II)
626 */
627static void __devinit rhine_reload_eeprom(long pioaddr, struct net_device *dev)
628{
629 struct rhine_private *rp = netdev_priv(dev);
630 void __iomem *ioaddr = rp->base;
631
632 outb(0x20, pioaddr + MACRegEEcsr);
633 RHINE_WAIT_FOR(!(inb(pioaddr + MACRegEEcsr) & 0x20));
634
635#ifdef USE_MMIO
636 /*
637 * Reloading from EEPROM overwrites ConfigA-D, so we must re-enable
638 * MMIO. If reloading EEPROM was done first this could be avoided, but
639 * it is not known if that still works with the "win98-reboot" problem.
640 */
641 enable_mmio(pioaddr, rp->quirks);
642#endif
643
644 /* Turn off EEPROM-controlled wake-up (magic packet) */
645 if (rp->quirks & rqWOL)
646 iowrite8(ioread8(ioaddr + ConfigA) & 0xFC, ioaddr + ConfigA);
647
648}
649
650#ifdef CONFIG_NET_POLL_CONTROLLER
651static void rhine_poll(struct net_device *dev)
652{
653 disable_irq(dev->irq);
7d12e780 654 rhine_interrupt(dev->irq, (void *)dev);
1da177e4
LT
655 enable_irq(dev->irq);
656}
657#endif
658
bea3348e 659static int rhine_napipoll(struct napi_struct *napi, int budget)
633949a1 660{
bea3348e
SH
661 struct rhine_private *rp = container_of(napi, struct rhine_private, napi);
662 struct net_device *dev = rp->dev;
633949a1 663 void __iomem *ioaddr = rp->base;
bea3348e 664 int work_done;
633949a1 665
bea3348e 666 work_done = rhine_rx(dev, budget);
633949a1 667
bea3348e 668 if (work_done < budget) {
288379f0 669 napi_complete(napi);
633949a1
RL
670
671 iowrite16(IntrRxDone | IntrRxErr | IntrRxEmpty| IntrRxOverflow |
672 IntrRxDropped | IntrRxNoBuf | IntrTxAborted |
673 IntrTxDone | IntrTxError | IntrTxUnderrun |
674 IntrPCIErr | IntrStatsMax | IntrLinkChange,
675 ioaddr + IntrEnable);
633949a1 676 }
bea3348e 677 return work_done;
633949a1 678}
633949a1 679
de4e7c88 680static void __devinit rhine_hw_init(struct net_device *dev, long pioaddr)
1da177e4
LT
681{
682 struct rhine_private *rp = netdev_priv(dev);
683
684 /* Reset the chip to erase previous misconfiguration. */
685 rhine_chip_reset(dev);
686
687 /* Rhine-I needs extra time to recuperate before EEPROM reload */
688 if (rp->quirks & rqRhineI)
689 msleep(5);
690
691 /* Reload EEPROM controlled bytes cleared by soft reset */
692 rhine_reload_eeprom(pioaddr, dev);
693}
694
5d1d07d8
SH
695static const struct net_device_ops rhine_netdev_ops = {
696 .ndo_open = rhine_open,
697 .ndo_stop = rhine_close,
698 .ndo_start_xmit = rhine_start_tx,
699 .ndo_get_stats = rhine_get_stats,
700 .ndo_set_multicast_list = rhine_set_rx_mode,
635ecaa7 701 .ndo_change_mtu = eth_change_mtu,
5d1d07d8 702 .ndo_validate_addr = eth_validate_addr,
fe96aaa1 703 .ndo_set_mac_address = eth_mac_addr,
5d1d07d8
SH
704 .ndo_do_ioctl = netdev_ioctl,
705 .ndo_tx_timeout = rhine_tx_timeout,
38f49e88
RL
706 .ndo_vlan_rx_add_vid = rhine_vlan_rx_add_vid,
707 .ndo_vlan_rx_kill_vid = rhine_vlan_rx_kill_vid,
5d1d07d8
SH
708#ifdef CONFIG_NET_POLL_CONTROLLER
709 .ndo_poll_controller = rhine_poll,
710#endif
711};
712
1da177e4
LT
713static int __devinit rhine_init_one(struct pci_dev *pdev,
714 const struct pci_device_id *ent)
715{
716 struct net_device *dev;
717 struct rhine_private *rp;
718 int i, rc;
1da177e4
LT
719 u32 quirks;
720 long pioaddr;
721 long memaddr;
722 void __iomem *ioaddr;
723 int io_size, phy_id;
724 const char *name;
725#ifdef USE_MMIO
726 int bar = 1;
727#else
728 int bar = 0;
729#endif
730
731/* when built into the kernel, we only print version if device is found */
732#ifndef MODULE
df4511fe 733 pr_info_once("%s\n", version);
1da177e4
LT
734#endif
735
1da177e4
LT
736 io_size = 256;
737 phy_id = 0;
738 quirks = 0;
739 name = "Rhine";
44c10138 740 if (pdev->revision < VTunknown0) {
1da177e4
LT
741 quirks = rqRhineI;
742 io_size = 128;
743 }
44c10138 744 else if (pdev->revision >= VT6102) {
1da177e4 745 quirks = rqWOL | rqForceReset;
44c10138 746 if (pdev->revision < VT6105) {
1da177e4
LT
747 name = "Rhine II";
748 quirks |= rqStatusWBRace; /* Rhine-II exclusive */
749 }
750 else {
751 phy_id = 1; /* Integrated PHY, phy_id fixed to 1 */
44c10138 752 if (pdev->revision >= VT6105_B0)
1da177e4 753 quirks |= rq6patterns;
44c10138 754 if (pdev->revision < VT6105M)
1da177e4
LT
755 name = "Rhine III";
756 else
757 name = "Rhine III (Management Adapter)";
758 }
759 }
760
761 rc = pci_enable_device(pdev);
762 if (rc)
763 goto err_out;
764
765 /* this should always be supported */
284901a9 766 rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
1da177e4 767 if (rc) {
df4511fe
JP
768 dev_err(&pdev->dev,
769 "32-bit PCI DMA addresses not supported by the card!?\n");
1da177e4
LT
770 goto err_out;
771 }
772
773 /* sanity check */
774 if ((pci_resource_len(pdev, 0) < io_size) ||
775 (pci_resource_len(pdev, 1) < io_size)) {
776 rc = -EIO;
df4511fe 777 dev_err(&pdev->dev, "Insufficient PCI resources, aborting\n");
1da177e4
LT
778 goto err_out;
779 }
780
781 pioaddr = pci_resource_start(pdev, 0);
782 memaddr = pci_resource_start(pdev, 1);
783
784 pci_set_master(pdev);
785
786 dev = alloc_etherdev(sizeof(struct rhine_private));
787 if (!dev) {
788 rc = -ENOMEM;
df4511fe 789 dev_err(&pdev->dev, "alloc_etherdev failed\n");
1da177e4
LT
790 goto err_out;
791 }
1da177e4
LT
792 SET_NETDEV_DEV(dev, &pdev->dev);
793
794 rp = netdev_priv(dev);
bea3348e 795 rp->dev = dev;
1da177e4
LT
796 rp->quirks = quirks;
797 rp->pioaddr = pioaddr;
798 rp->pdev = pdev;
799
800 rc = pci_request_regions(pdev, DRV_NAME);
801 if (rc)
802 goto err_out_free_netdev;
803
804 ioaddr = pci_iomap(pdev, bar, io_size);
805 if (!ioaddr) {
806 rc = -EIO;
df4511fe
JP
807 dev_err(&pdev->dev,
808 "ioremap failed for device %s, region 0x%X @ 0x%lX\n",
809 pci_name(pdev), io_size, memaddr);
1da177e4
LT
810 goto err_out_free_res;
811 }
812
813#ifdef USE_MMIO
814 enable_mmio(pioaddr, quirks);
815
816 /* Check that selected MMIO registers match the PIO ones */
817 i = 0;
818 while (mmio_verify_registers[i]) {
819 int reg = mmio_verify_registers[i++];
820 unsigned char a = inb(pioaddr+reg);
821 unsigned char b = readb(ioaddr+reg);
822 if (a != b) {
823 rc = -EIO;
df4511fe
JP
824 dev_err(&pdev->dev,
825 "MMIO do not match PIO [%02x] (%02x != %02x)\n",
826 reg, a, b);
1da177e4
LT
827 goto err_out_unmap;
828 }
829 }
830#endif /* USE_MMIO */
831
832 dev->base_addr = (unsigned long)ioaddr;
833 rp->base = ioaddr;
834
835 /* Get chip registers into a sane state */
836 rhine_power_init(dev);
837 rhine_hw_init(dev, pioaddr);
838
839 for (i = 0; i < 6; i++)
840 dev->dev_addr[i] = ioread8(ioaddr + StationAddr + i);
b81e8e1f 841 memcpy(dev->perm_addr, dev->dev_addr, dev->addr_len);
1da177e4 842
b81e8e1f 843 if (!is_valid_ether_addr(dev->perm_addr)) {
1da177e4 844 rc = -EIO;
df4511fe 845 dev_err(&pdev->dev, "Invalid MAC address\n");
1da177e4
LT
846 goto err_out_unmap;
847 }
848
849 /* For Rhine-I/II, phy_id is loaded from EEPROM */
850 if (!phy_id)
851 phy_id = ioread8(ioaddr + 0x6C);
852
853 dev->irq = pdev->irq;
854
855 spin_lock_init(&rp->lock);
c0d7a021
JP
856 INIT_WORK(&rp->reset_task, rhine_reset_task);
857
1da177e4
LT
858 rp->mii_if.dev = dev;
859 rp->mii_if.mdio_read = mdio_read;
860 rp->mii_if.mdio_write = mdio_write;
861 rp->mii_if.phy_id_mask = 0x1f;
862 rp->mii_if.reg_num_mask = 0x1f;
863
864 /* The chip-specific entries in the device structure. */
5d1d07d8
SH
865 dev->netdev_ops = &rhine_netdev_ops;
866 dev->ethtool_ops = &netdev_ethtool_ops,
1da177e4 867 dev->watchdog_timeo = TX_TIMEOUT;
5d1d07d8 868
bea3348e 869 netif_napi_add(dev, &rp->napi, rhine_napipoll, 64);
32b0f53e 870
1da177e4
LT
871 if (rp->quirks & rqRhineI)
872 dev->features |= NETIF_F_SG|NETIF_F_HW_CSUM;
873
38f49e88
RL
874 if (pdev->revision >= VT6105M)
875 dev->features |= NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX |
876 NETIF_F_HW_VLAN_FILTER;
877
1da177e4
LT
878 /* dev->name not defined before register_netdev()! */
879 rc = register_netdev(dev);
880 if (rc)
881 goto err_out_unmap;
882
df4511fe
JP
883 netdev_info(dev, "VIA %s at 0x%lx, %pM, IRQ %d\n",
884 name,
1da177e4 885#ifdef USE_MMIO
df4511fe 886 memaddr,
1da177e4 887#else
df4511fe 888 (long)ioaddr,
1da177e4 889#endif
df4511fe 890 dev->dev_addr, pdev->irq);
1da177e4
LT
891
892 pci_set_drvdata(pdev, dev);
893
894 {
895 u16 mii_cmd;
896 int mii_status = mdio_read(dev, phy_id, 1);
897 mii_cmd = mdio_read(dev, phy_id, MII_BMCR) & ~BMCR_ISOLATE;
898 mdio_write(dev, phy_id, MII_BMCR, mii_cmd);
899 if (mii_status != 0xffff && mii_status != 0x0000) {
900 rp->mii_if.advertising = mdio_read(dev, phy_id, 4);
df4511fe
JP
901 netdev_info(dev,
902 "MII PHY found at address %d, status 0x%04x advertising %04x Link %04x\n",
903 phy_id,
904 mii_status, rp->mii_if.advertising,
905 mdio_read(dev, phy_id, 5));
1da177e4
LT
906
907 /* set IFF_RUNNING */
908 if (mii_status & BMSR_LSTATUS)
909 netif_carrier_on(dev);
910 else
911 netif_carrier_off(dev);
912
913 }
914 }
915 rp->mii_if.phy_id = phy_id;
b933b4d9 916 if (debug > 1 && avoid_D3)
df4511fe 917 netdev_info(dev, "No D3 power state at shutdown\n");
1da177e4
LT
918
919 return 0;
920
921err_out_unmap:
922 pci_iounmap(pdev, ioaddr);
923err_out_free_res:
924 pci_release_regions(pdev);
925err_out_free_netdev:
926 free_netdev(dev);
927err_out:
928 return rc;
929}
930
931static int alloc_ring(struct net_device* dev)
932{
933 struct rhine_private *rp = netdev_priv(dev);
934 void *ring;
935 dma_addr_t ring_dma;
936
937 ring = pci_alloc_consistent(rp->pdev,
938 RX_RING_SIZE * sizeof(struct rx_desc) +
939 TX_RING_SIZE * sizeof(struct tx_desc),
940 &ring_dma);
941 if (!ring) {
df4511fe 942 netdev_err(dev, "Could not allocate DMA memory\n");
1da177e4
LT
943 return -ENOMEM;
944 }
945 if (rp->quirks & rqRhineI) {
946 rp->tx_bufs = pci_alloc_consistent(rp->pdev,
947 PKT_BUF_SZ * TX_RING_SIZE,
948 &rp->tx_bufs_dma);
949 if (rp->tx_bufs == NULL) {
950 pci_free_consistent(rp->pdev,
951 RX_RING_SIZE * sizeof(struct rx_desc) +
952 TX_RING_SIZE * sizeof(struct tx_desc),
953 ring, ring_dma);
954 return -ENOMEM;
955 }
956 }
957
958 rp->rx_ring = ring;
959 rp->tx_ring = ring + RX_RING_SIZE * sizeof(struct rx_desc);
960 rp->rx_ring_dma = ring_dma;
961 rp->tx_ring_dma = ring_dma + RX_RING_SIZE * sizeof(struct rx_desc);
962
963 return 0;
964}
965
966static void free_ring(struct net_device* dev)
967{
968 struct rhine_private *rp = netdev_priv(dev);
969
970 pci_free_consistent(rp->pdev,
971 RX_RING_SIZE * sizeof(struct rx_desc) +
972 TX_RING_SIZE * sizeof(struct tx_desc),
973 rp->rx_ring, rp->rx_ring_dma);
974 rp->tx_ring = NULL;
975
976 if (rp->tx_bufs)
977 pci_free_consistent(rp->pdev, PKT_BUF_SZ * TX_RING_SIZE,
978 rp->tx_bufs, rp->tx_bufs_dma);
979
980 rp->tx_bufs = NULL;
981
982}
983
984static void alloc_rbufs(struct net_device *dev)
985{
986 struct rhine_private *rp = netdev_priv(dev);
987 dma_addr_t next;
988 int i;
989
990 rp->dirty_rx = rp->cur_rx = 0;
991
992 rp->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32);
993 rp->rx_head_desc = &rp->rx_ring[0];
994 next = rp->rx_ring_dma;
995
996 /* Init the ring entries */
997 for (i = 0; i < RX_RING_SIZE; i++) {
998 rp->rx_ring[i].rx_status = 0;
999 rp->rx_ring[i].desc_length = cpu_to_le32(rp->rx_buf_sz);
1000 next += sizeof(struct rx_desc);
1001 rp->rx_ring[i].next_desc = cpu_to_le32(next);
1002 rp->rx_skbuff[i] = NULL;
1003 }
1004 /* Mark the last entry as wrapping the ring. */
1005 rp->rx_ring[i-1].next_desc = cpu_to_le32(rp->rx_ring_dma);
1006
1007 /* Fill in the Rx buffers. Handle allocation failure gracefully. */
1008 for (i = 0; i < RX_RING_SIZE; i++) {
b26b555a 1009 struct sk_buff *skb = netdev_alloc_skb(dev, rp->rx_buf_sz);
1da177e4
LT
1010 rp->rx_skbuff[i] = skb;
1011 if (skb == NULL)
1012 break;
1013 skb->dev = dev; /* Mark as being used by this device. */
1014
1015 rp->rx_skbuff_dma[i] =
689be439 1016 pci_map_single(rp->pdev, skb->data, rp->rx_buf_sz,
1da177e4
LT
1017 PCI_DMA_FROMDEVICE);
1018
1019 rp->rx_ring[i].addr = cpu_to_le32(rp->rx_skbuff_dma[i]);
1020 rp->rx_ring[i].rx_status = cpu_to_le32(DescOwn);
1021 }
1022 rp->dirty_rx = (unsigned int)(i - RX_RING_SIZE);
1023}
1024
1025static void free_rbufs(struct net_device* dev)
1026{
1027 struct rhine_private *rp = netdev_priv(dev);
1028 int i;
1029
1030 /* Free all the skbuffs in the Rx queue. */
1031 for (i = 0; i < RX_RING_SIZE; i++) {
1032 rp->rx_ring[i].rx_status = 0;
1033 rp->rx_ring[i].addr = cpu_to_le32(0xBADF00D0); /* An invalid address. */
1034 if (rp->rx_skbuff[i]) {
1035 pci_unmap_single(rp->pdev,
1036 rp->rx_skbuff_dma[i],
1037 rp->rx_buf_sz, PCI_DMA_FROMDEVICE);
1038 dev_kfree_skb(rp->rx_skbuff[i]);
1039 }
1040 rp->rx_skbuff[i] = NULL;
1041 }
1042}
1043
1044static void alloc_tbufs(struct net_device* dev)
1045{
1046 struct rhine_private *rp = netdev_priv(dev);
1047 dma_addr_t next;
1048 int i;
1049
1050 rp->dirty_tx = rp->cur_tx = 0;
1051 next = rp->tx_ring_dma;
1052 for (i = 0; i < TX_RING_SIZE; i++) {
1053 rp->tx_skbuff[i] = NULL;
1054 rp->tx_ring[i].tx_status = 0;
1055 rp->tx_ring[i].desc_length = cpu_to_le32(TXDESC);
1056 next += sizeof(struct tx_desc);
1057 rp->tx_ring[i].next_desc = cpu_to_le32(next);
4be5de25
RL
1058 if (rp->quirks & rqRhineI)
1059 rp->tx_buf[i] = &rp->tx_bufs[i * PKT_BUF_SZ];
1da177e4
LT
1060 }
1061 rp->tx_ring[i-1].next_desc = cpu_to_le32(rp->tx_ring_dma);
1062
1063}
1064
1065static void free_tbufs(struct net_device* dev)
1066{
1067 struct rhine_private *rp = netdev_priv(dev);
1068 int i;
1069
1070 for (i = 0; i < TX_RING_SIZE; i++) {
1071 rp->tx_ring[i].tx_status = 0;
1072 rp->tx_ring[i].desc_length = cpu_to_le32(TXDESC);
1073 rp->tx_ring[i].addr = cpu_to_le32(0xBADF00D0); /* An invalid address. */
1074 if (rp->tx_skbuff[i]) {
1075 if (rp->tx_skbuff_dma[i]) {
1076 pci_unmap_single(rp->pdev,
1077 rp->tx_skbuff_dma[i],
1078 rp->tx_skbuff[i]->len,
1079 PCI_DMA_TODEVICE);
1080 }
1081 dev_kfree_skb(rp->tx_skbuff[i]);
1082 }
1083 rp->tx_skbuff[i] = NULL;
1084 rp->tx_buf[i] = NULL;
1085 }
1086}
1087
1088static void rhine_check_media(struct net_device *dev, unsigned int init_media)
1089{
1090 struct rhine_private *rp = netdev_priv(dev);
1091 void __iomem *ioaddr = rp->base;
1092
1093 mii_check_media(&rp->mii_if, debug, init_media);
1094
1095 if (rp->mii_if.full_duplex)
1096 iowrite8(ioread8(ioaddr + ChipCmd1) | Cmd1FDuplex,
1097 ioaddr + ChipCmd1);
1098 else
1099 iowrite8(ioread8(ioaddr + ChipCmd1) & ~Cmd1FDuplex,
1100 ioaddr + ChipCmd1);
00b428c2 1101 if (debug > 1)
df4511fe
JP
1102 netdev_info(dev, "force_media %d, carrier %d\n",
1103 rp->mii_if.force_media, netif_carrier_ok(dev));
00b428c2
RL
1104}
1105
1106/* Called after status of force_media possibly changed */
0761be4f 1107static void rhine_set_carrier(struct mii_if_info *mii)
00b428c2
RL
1108{
1109 if (mii->force_media) {
1110 /* autoneg is off: Link is always assumed to be up */
1111 if (!netif_carrier_ok(mii->dev))
1112 netif_carrier_on(mii->dev);
1113 }
1114 else /* Let MMI library update carrier status */
1115 rhine_check_media(mii->dev, 0);
1116 if (debug > 1)
df4511fe
JP
1117 netdev_info(mii->dev, "force_media %d, carrier %d\n",
1118 mii->force_media, netif_carrier_ok(mii->dev));
1da177e4
LT
1119}
1120
38f49e88
RL
1121/**
1122 * rhine_set_cam - set CAM multicast filters
1123 * @ioaddr: register block of this Rhine
1124 * @idx: multicast CAM index [0..MCAM_SIZE-1]
1125 * @addr: multicast address (6 bytes)
1126 *
1127 * Load addresses into multicast filters.
1128 */
1129static void rhine_set_cam(void __iomem *ioaddr, int idx, u8 *addr)
1130{
1131 int i;
1132
1133 iowrite8(CAMC_CAMEN, ioaddr + CamCon);
1134 wmb();
1135
1136 /* Paranoid -- idx out of range should never happen */
1137 idx &= (MCAM_SIZE - 1);
1138
1139 iowrite8((u8) idx, ioaddr + CamAddr);
1140
1141 for (i = 0; i < 6; i++, addr++)
1142 iowrite8(*addr, ioaddr + MulticastFilter0 + i);
1143 udelay(10);
1144 wmb();
1145
1146 iowrite8(CAMC_CAMWR | CAMC_CAMEN, ioaddr + CamCon);
1147 udelay(10);
1148
1149 iowrite8(0, ioaddr + CamCon);
1150}
1151
1152/**
1153 * rhine_set_vlan_cam - set CAM VLAN filters
1154 * @ioaddr: register block of this Rhine
1155 * @idx: VLAN CAM index [0..VCAM_SIZE-1]
1156 * @addr: VLAN ID (2 bytes)
1157 *
1158 * Load addresses into VLAN filters.
1159 */
1160static void rhine_set_vlan_cam(void __iomem *ioaddr, int idx, u8 *addr)
1161{
1162 iowrite8(CAMC_CAMEN | CAMC_VCAMSL, ioaddr + CamCon);
1163 wmb();
1164
1165 /* Paranoid -- idx out of range should never happen */
1166 idx &= (VCAM_SIZE - 1);
1167
1168 iowrite8((u8) idx, ioaddr + CamAddr);
1169
1170 iowrite16(*((u16 *) addr), ioaddr + MulticastFilter0 + 6);
1171 udelay(10);
1172 wmb();
1173
1174 iowrite8(CAMC_CAMWR | CAMC_CAMEN, ioaddr + CamCon);
1175 udelay(10);
1176
1177 iowrite8(0, ioaddr + CamCon);
1178}
1179
1180/**
1181 * rhine_set_cam_mask - set multicast CAM mask
1182 * @ioaddr: register block of this Rhine
1183 * @mask: multicast CAM mask
1184 *
1185 * Mask sets multicast filters active/inactive.
1186 */
1187static void rhine_set_cam_mask(void __iomem *ioaddr, u32 mask)
1188{
1189 iowrite8(CAMC_CAMEN, ioaddr + CamCon);
1190 wmb();
1191
1192 /* write mask */
1193 iowrite32(mask, ioaddr + CamMask);
1194
1195 /* disable CAMEN */
1196 iowrite8(0, ioaddr + CamCon);
1197}
1198
1199/**
1200 * rhine_set_vlan_cam_mask - set VLAN CAM mask
1201 * @ioaddr: register block of this Rhine
1202 * @mask: VLAN CAM mask
1203 *
1204 * Mask sets VLAN filters active/inactive.
1205 */
1206static void rhine_set_vlan_cam_mask(void __iomem *ioaddr, u32 mask)
1207{
1208 iowrite8(CAMC_CAMEN | CAMC_VCAMSL, ioaddr + CamCon);
1209 wmb();
1210
1211 /* write mask */
1212 iowrite32(mask, ioaddr + CamMask);
1213
1214 /* disable CAMEN */
1215 iowrite8(0, ioaddr + CamCon);
1216}
1217
1218/**
1219 * rhine_init_cam_filter - initialize CAM filters
1220 * @dev: network device
1221 *
1222 * Initialize (disable) hardware VLAN and multicast support on this
1223 * Rhine.
1224 */
1225static void rhine_init_cam_filter(struct net_device *dev)
1226{
1227 struct rhine_private *rp = netdev_priv(dev);
1228 void __iomem *ioaddr = rp->base;
1229
1230 /* Disable all CAMs */
1231 rhine_set_vlan_cam_mask(ioaddr, 0);
1232 rhine_set_cam_mask(ioaddr, 0);
1233
1234 /* disable hardware VLAN support */
1235 BYTE_REG_BITS_ON(TCR_PQEN, ioaddr + TxConfig);
1236 BYTE_REG_BITS_OFF(BCR1_VIDFR, ioaddr + PCIBusConfig1);
1237}
1238
1239/**
1240 * rhine_update_vcam - update VLAN CAM filters
1241 * @rp: rhine_private data of this Rhine
1242 *
1243 * Update VLAN CAM filters to match configuration change.
1244 */
1245static void rhine_update_vcam(struct net_device *dev)
1246{
1247 struct rhine_private *rp = netdev_priv(dev);
1248 void __iomem *ioaddr = rp->base;
1249 u16 vid;
1250 u32 vCAMmask = 0; /* 32 vCAMs (6105M and better) */
1251 unsigned int i = 0;
1252
1253 for_each_set_bit(vid, rp->active_vlans, VLAN_N_VID) {
1254 rhine_set_vlan_cam(ioaddr, i, (u8 *)&vid);
1255 vCAMmask |= 1 << i;
1256 if (++i >= VCAM_SIZE)
1257 break;
1258 }
1259 rhine_set_vlan_cam_mask(ioaddr, vCAMmask);
1260}
1261
1262static void rhine_vlan_rx_add_vid(struct net_device *dev, unsigned short vid)
1263{
1264 struct rhine_private *rp = netdev_priv(dev);
1265
1266 spin_lock_irq(&rp->lock);
1267 set_bit(vid, rp->active_vlans);
1268 rhine_update_vcam(dev);
1269 spin_unlock_irq(&rp->lock);
1270}
1271
1272static void rhine_vlan_rx_kill_vid(struct net_device *dev, unsigned short vid)
1273{
1274 struct rhine_private *rp = netdev_priv(dev);
1275
1276 spin_lock_irq(&rp->lock);
1277 clear_bit(vid, rp->active_vlans);
1278 rhine_update_vcam(dev);
1279 spin_unlock_irq(&rp->lock);
1280}
1281
1da177e4
LT
1282static void init_registers(struct net_device *dev)
1283{
1284 struct rhine_private *rp = netdev_priv(dev);
1285 void __iomem *ioaddr = rp->base;
1286 int i;
1287
1288 for (i = 0; i < 6; i++)
1289 iowrite8(dev->dev_addr[i], ioaddr + StationAddr + i);
1290
1291 /* Initialize other registers. */
1292 iowrite16(0x0006, ioaddr + PCIBusConfig); /* Tune configuration??? */
1293 /* Configure initial FIFO thresholds. */
1294 iowrite8(0x20, ioaddr + TxConfig);
1295 rp->tx_thresh = 0x20;
1296 rp->rx_thresh = 0x60; /* Written in rhine_set_rx_mode(). */
1297
1298 iowrite32(rp->rx_ring_dma, ioaddr + RxRingPtr);
1299 iowrite32(rp->tx_ring_dma, ioaddr + TxRingPtr);
1300
1301 rhine_set_rx_mode(dev);
1302
38f49e88
RL
1303 if (rp->pdev->revision >= VT6105M)
1304 rhine_init_cam_filter(dev);
1305
bea3348e 1306 napi_enable(&rp->napi);
ab197668 1307
1da177e4
LT
1308 /* Enable interrupts by setting the interrupt mask. */
1309 iowrite16(IntrRxDone | IntrRxErr | IntrRxEmpty| IntrRxOverflow |
1310 IntrRxDropped | IntrRxNoBuf | IntrTxAborted |
1311 IntrTxDone | IntrTxError | IntrTxUnderrun |
1312 IntrPCIErr | IntrStatsMax | IntrLinkChange,
1313 ioaddr + IntrEnable);
1314
1315 iowrite16(CmdStart | CmdTxOn | CmdRxOn | (Cmd1NoTxPoll << 8),
1316 ioaddr + ChipCmd);
1317 rhine_check_media(dev, 1);
1318}
1319
1320/* Enable MII link status auto-polling (required for IntrLinkChange) */
1321static void rhine_enable_linkmon(void __iomem *ioaddr)
1322{
1323 iowrite8(0, ioaddr + MIICmd);
1324 iowrite8(MII_BMSR, ioaddr + MIIRegAddr);
1325 iowrite8(0x80, ioaddr + MIICmd);
1326
1327 RHINE_WAIT_FOR((ioread8(ioaddr + MIIRegAddr) & 0x20));
1328
1329 iowrite8(MII_BMSR | 0x40, ioaddr + MIIRegAddr);
1330}
1331
1332/* Disable MII link status auto-polling (required for MDIO access) */
1333static void rhine_disable_linkmon(void __iomem *ioaddr, u32 quirks)
1334{
1335 iowrite8(0, ioaddr + MIICmd);
1336
1337 if (quirks & rqRhineI) {
1338 iowrite8(0x01, ioaddr + MIIRegAddr); // MII_BMSR
1339
38bb6b28
JL
1340 /* Can be called from ISR. Evil. */
1341 mdelay(1);
1da177e4
LT
1342
1343 /* 0x80 must be set immediately before turning it off */
1344 iowrite8(0x80, ioaddr + MIICmd);
1345
1346 RHINE_WAIT_FOR(ioread8(ioaddr + MIIRegAddr) & 0x20);
1347
1348 /* Heh. Now clear 0x80 again. */
1349 iowrite8(0, ioaddr + MIICmd);
1350 }
1351 else
1352 RHINE_WAIT_FOR(ioread8(ioaddr + MIIRegAddr) & 0x80);
1353}
1354
1355/* Read and write over the MII Management Data I/O (MDIO) interface. */
1356
1357static int mdio_read(struct net_device *dev, int phy_id, int regnum)
1358{
1359 struct rhine_private *rp = netdev_priv(dev);
1360 void __iomem *ioaddr = rp->base;
1361 int result;
1362
1363 rhine_disable_linkmon(ioaddr, rp->quirks);
1364
1365 /* rhine_disable_linkmon already cleared MIICmd */
1366 iowrite8(phy_id, ioaddr + MIIPhyAddr);
1367 iowrite8(regnum, ioaddr + MIIRegAddr);
1368 iowrite8(0x40, ioaddr + MIICmd); /* Trigger read */
1369 RHINE_WAIT_FOR(!(ioread8(ioaddr + MIICmd) & 0x40));
1370 result = ioread16(ioaddr + MIIData);
1371
1372 rhine_enable_linkmon(ioaddr);
1373 return result;
1374}
1375
1376static void mdio_write(struct net_device *dev, int phy_id, int regnum, int value)
1377{
1378 struct rhine_private *rp = netdev_priv(dev);
1379 void __iomem *ioaddr = rp->base;
1380
1381 rhine_disable_linkmon(ioaddr, rp->quirks);
1382
1383 /* rhine_disable_linkmon already cleared MIICmd */
1384 iowrite8(phy_id, ioaddr + MIIPhyAddr);
1385 iowrite8(regnum, ioaddr + MIIRegAddr);
1386 iowrite16(value, ioaddr + MIIData);
1387 iowrite8(0x20, ioaddr + MIICmd); /* Trigger write */
1388 RHINE_WAIT_FOR(!(ioread8(ioaddr + MIICmd) & 0x20));
1389
1390 rhine_enable_linkmon(ioaddr);
1391}
1392
1393static int rhine_open(struct net_device *dev)
1394{
1395 struct rhine_private *rp = netdev_priv(dev);
1396 void __iomem *ioaddr = rp->base;
1397 int rc;
1398
76781382 1399 rc = request_irq(rp->pdev->irq, rhine_interrupt, IRQF_SHARED, dev->name,
1da177e4
LT
1400 dev);
1401 if (rc)
1402 return rc;
1403
1404 if (debug > 1)
df4511fe 1405 netdev_dbg(dev, "%s() irq %d\n", __func__, rp->pdev->irq);
1da177e4
LT
1406
1407 rc = alloc_ring(dev);
1408 if (rc) {
1409 free_irq(rp->pdev->irq, dev);
1410 return rc;
1411 }
1412 alloc_rbufs(dev);
1413 alloc_tbufs(dev);
1414 rhine_chip_reset(dev);
1415 init_registers(dev);
1416 if (debug > 2)
df4511fe
JP
1417 netdev_dbg(dev, "%s() Done - status %04x MII status: %04x\n",
1418 __func__, ioread16(ioaddr + ChipCmd),
1419 mdio_read(dev, rp->mii_if.phy_id, MII_BMSR));
1da177e4
LT
1420
1421 netif_start_queue(dev);
1422
1423 return 0;
1424}
1425
c0d7a021 1426static void rhine_reset_task(struct work_struct *work)
1da177e4 1427{
c0d7a021
JP
1428 struct rhine_private *rp = container_of(work, struct rhine_private,
1429 reset_task);
1430 struct net_device *dev = rp->dev;
1da177e4
LT
1431
1432 /* protect against concurrent rx interrupts */
1433 disable_irq(rp->pdev->irq);
1434
bea3348e 1435 napi_disable(&rp->napi);
bea3348e 1436
c0d7a021 1437 spin_lock_bh(&rp->lock);
1da177e4
LT
1438
1439 /* clear all descriptors */
1440 free_tbufs(dev);
1441 free_rbufs(dev);
1442 alloc_tbufs(dev);
1443 alloc_rbufs(dev);
1444
1445 /* Reinitialize the hardware. */
1446 rhine_chip_reset(dev);
1447 init_registers(dev);
1448
c0d7a021 1449 spin_unlock_bh(&rp->lock);
1da177e4
LT
1450 enable_irq(rp->pdev->irq);
1451
1ae5dc34 1452 dev->trans_start = jiffies; /* prevent tx timeout */
553e2335 1453 dev->stats.tx_errors++;
1da177e4
LT
1454 netif_wake_queue(dev);
1455}
1456
c0d7a021
JP
1457static void rhine_tx_timeout(struct net_device *dev)
1458{
1459 struct rhine_private *rp = netdev_priv(dev);
1460 void __iomem *ioaddr = rp->base;
1461
df4511fe
JP
1462 netdev_warn(dev, "Transmit timed out, status %04x, PHY status %04x, resetting...\n",
1463 ioread16(ioaddr + IntrStatus),
1464 mdio_read(dev, rp->mii_if.phy_id, MII_BMSR));
c0d7a021
JP
1465
1466 schedule_work(&rp->reset_task);
1467}
1468
61357325
SH
1469static netdev_tx_t rhine_start_tx(struct sk_buff *skb,
1470 struct net_device *dev)
1da177e4
LT
1471{
1472 struct rhine_private *rp = netdev_priv(dev);
1473 void __iomem *ioaddr = rp->base;
1474 unsigned entry;
22580f89 1475 unsigned long flags;
1da177e4
LT
1476
1477 /* Caution: the write order is important here, set the field
1478 with the "ownership" bits last. */
1479
1480 /* Calculate the next Tx descriptor entry. */
1481 entry = rp->cur_tx % TX_RING_SIZE;
1482
5b057c6b 1483 if (skb_padto(skb, ETH_ZLEN))
6ed10654 1484 return NETDEV_TX_OK;
1da177e4
LT
1485
1486 rp->tx_skbuff[entry] = skb;
1487
1488 if ((rp->quirks & rqRhineI) &&
84fa7933 1489 (((unsigned long)skb->data & 3) || skb_shinfo(skb)->nr_frags != 0 || skb->ip_summed == CHECKSUM_PARTIAL)) {
1da177e4
LT
1490 /* Must use alignment buffer. */
1491 if (skb->len > PKT_BUF_SZ) {
1492 /* packet too long, drop it */
1493 dev_kfree_skb(skb);
1494 rp->tx_skbuff[entry] = NULL;
553e2335 1495 dev->stats.tx_dropped++;
6ed10654 1496 return NETDEV_TX_OK;
1da177e4 1497 }
3e0d167a
CB
1498
1499 /* Padding is not copied and so must be redone. */
1da177e4 1500 skb_copy_and_csum_dev(skb, rp->tx_buf[entry]);
3e0d167a
CB
1501 if (skb->len < ETH_ZLEN)
1502 memset(rp->tx_buf[entry] + skb->len, 0,
1503 ETH_ZLEN - skb->len);
1da177e4
LT
1504 rp->tx_skbuff_dma[entry] = 0;
1505 rp->tx_ring[entry].addr = cpu_to_le32(rp->tx_bufs_dma +
1506 (rp->tx_buf[entry] -
1507 rp->tx_bufs));
1508 } else {
1509 rp->tx_skbuff_dma[entry] =
1510 pci_map_single(rp->pdev, skb->data, skb->len,
1511 PCI_DMA_TODEVICE);
1512 rp->tx_ring[entry].addr = cpu_to_le32(rp->tx_skbuff_dma[entry]);
1513 }
1514
1515 rp->tx_ring[entry].desc_length =
1516 cpu_to_le32(TXDESC | (skb->len >= ETH_ZLEN ? skb->len : ETH_ZLEN));
1517
38f49e88
RL
1518 if (unlikely(vlan_tx_tag_present(skb))) {
1519 rp->tx_ring[entry].tx_status = cpu_to_le32((vlan_tx_tag_get(skb)) << 16);
1520 /* request tagging */
1521 rp->tx_ring[entry].desc_length |= cpu_to_le32(0x020000);
1522 }
1523 else
1524 rp->tx_ring[entry].tx_status = 0;
1525
1da177e4 1526 /* lock eth irq */
22580f89 1527 spin_lock_irqsave(&rp->lock, flags);
1da177e4 1528 wmb();
38f49e88 1529 rp->tx_ring[entry].tx_status |= cpu_to_le32(DescOwn);
1da177e4
LT
1530 wmb();
1531
1532 rp->cur_tx++;
1533
1534 /* Non-x86 Todo: explicitly flush cache lines here. */
1535
38f49e88
RL
1536 if (vlan_tx_tag_present(skb))
1537 /* Tx queues are bits 7-0 (first Tx queue: bit 7) */
1538 BYTE_REG_BITS_ON(1 << 7, ioaddr + TQWake);
1539
1da177e4
LT
1540 /* Wake the potentially-idle transmit channel */
1541 iowrite8(ioread8(ioaddr + ChipCmd1) | Cmd1TxDemand,
1542 ioaddr + ChipCmd1);
1543 IOSYNC;
1544
1545 if (rp->cur_tx == rp->dirty_tx + TX_QUEUE_LEN)
1546 netif_stop_queue(dev);
1547
22580f89 1548 spin_unlock_irqrestore(&rp->lock, flags);
1da177e4
LT
1549
1550 if (debug > 4) {
df4511fe
JP
1551 netdev_dbg(dev, "Transmit frame #%d queued in slot %d\n",
1552 rp->cur_tx-1, entry);
1da177e4 1553 }
6ed10654 1554 return NETDEV_TX_OK;
1da177e4
LT
1555}
1556
1557/* The interrupt handler does all of the Rx thread work and cleans up
1558 after the Tx thread. */
7d12e780 1559static irqreturn_t rhine_interrupt(int irq, void *dev_instance)
1da177e4
LT
1560{
1561 struct net_device *dev = dev_instance;
1562 struct rhine_private *rp = netdev_priv(dev);
1563 void __iomem *ioaddr = rp->base;
1564 u32 intr_status;
1565 int boguscnt = max_interrupt_work;
1566 int handled = 0;
1567
1568 while ((intr_status = get_intr_status(dev))) {
1569 handled = 1;
1570
1571 /* Acknowledge all of the current interrupt sources ASAP. */
1572 if (intr_status & IntrTxDescRace)
1573 iowrite8(0x08, ioaddr + IntrStatus2);
1574 iowrite16(intr_status & 0xffff, ioaddr + IntrStatus);
1575 IOSYNC;
1576
1577 if (debug > 4)
df4511fe
JP
1578 netdev_dbg(dev, "Interrupt, status %08x\n",
1579 intr_status);
1da177e4
LT
1580
1581 if (intr_status & (IntrRxDone | IntrRxErr | IntrRxDropped |
633949a1 1582 IntrRxWakeUp | IntrRxEmpty | IntrRxNoBuf)) {
633949a1
RL
1583 iowrite16(IntrTxAborted |
1584 IntrTxDone | IntrTxError | IntrTxUnderrun |
1585 IntrPCIErr | IntrStatsMax | IntrLinkChange,
1586 ioaddr + IntrEnable);
1587
288379f0 1588 napi_schedule(&rp->napi);
633949a1 1589 }
1da177e4
LT
1590
1591 if (intr_status & (IntrTxErrSummary | IntrTxDone)) {
1592 if (intr_status & IntrTxErrSummary) {
1593 /* Avoid scavenging before Tx engine turned off */
1594 RHINE_WAIT_FOR(!(ioread8(ioaddr+ChipCmd) & CmdTxOn));
1595 if (debug > 2 &&
1596 ioread8(ioaddr+ChipCmd) & CmdTxOn)
df4511fe
JP
1597 netdev_warn(dev,
1598 "%s: Tx engine still on\n",
1599 __func__);
1da177e4
LT
1600 }
1601 rhine_tx(dev);
1602 }
1603
1604 /* Abnormal error summary/uncommon events handlers. */
1605 if (intr_status & (IntrPCIErr | IntrLinkChange |
1606 IntrStatsMax | IntrTxError | IntrTxAborted |
1607 IntrTxUnderrun | IntrTxDescRace))
1608 rhine_error(dev, intr_status);
1609
1610 if (--boguscnt < 0) {
df4511fe
JP
1611 netdev_warn(dev, "Too much work at interrupt, status=%#08x\n",
1612 intr_status);
1da177e4
LT
1613 break;
1614 }
1615 }
1616
1617 if (debug > 3)
df4511fe
JP
1618 netdev_dbg(dev, "exiting interrupt, status=%08x\n",
1619 ioread16(ioaddr + IntrStatus));
1da177e4
LT
1620 return IRQ_RETVAL(handled);
1621}
1622
1623/* This routine is logically part of the interrupt handler, but isolated
1624 for clarity. */
1625static void rhine_tx(struct net_device *dev)
1626{
1627 struct rhine_private *rp = netdev_priv(dev);
1628 int txstatus = 0, entry = rp->dirty_tx % TX_RING_SIZE;
1629
1630 spin_lock(&rp->lock);
1631
1632 /* find and cleanup dirty tx descriptors */
1633 while (rp->dirty_tx != rp->cur_tx) {
1634 txstatus = le32_to_cpu(rp->tx_ring[entry].tx_status);
1635 if (debug > 6)
df4511fe
JP
1636 netdev_dbg(dev, "Tx scavenge %d status %08x\n",
1637 entry, txstatus);
1da177e4
LT
1638 if (txstatus & DescOwn)
1639 break;
1640 if (txstatus & 0x8000) {
1641 if (debug > 1)
df4511fe
JP
1642 netdev_dbg(dev, "Transmit error, Tx status %08x\n",
1643 txstatus);
553e2335
ED
1644 dev->stats.tx_errors++;
1645 if (txstatus & 0x0400)
1646 dev->stats.tx_carrier_errors++;
1647 if (txstatus & 0x0200)
1648 dev->stats.tx_window_errors++;
1649 if (txstatus & 0x0100)
1650 dev->stats.tx_aborted_errors++;
1651 if (txstatus & 0x0080)
1652 dev->stats.tx_heartbeat_errors++;
1da177e4
LT
1653 if (((rp->quirks & rqRhineI) && txstatus & 0x0002) ||
1654 (txstatus & 0x0800) || (txstatus & 0x1000)) {
553e2335 1655 dev->stats.tx_fifo_errors++;
1da177e4
LT
1656 rp->tx_ring[entry].tx_status = cpu_to_le32(DescOwn);
1657 break; /* Keep the skb - we try again */
1658 }
1659 /* Transmitter restarted in 'abnormal' handler. */
1660 } else {
1661 if (rp->quirks & rqRhineI)
553e2335 1662 dev->stats.collisions += (txstatus >> 3) & 0x0F;
1da177e4 1663 else
553e2335 1664 dev->stats.collisions += txstatus & 0x0F;
1da177e4 1665 if (debug > 6)
df4511fe
JP
1666 netdev_dbg(dev, "collisions: %1.1x:%1.1x\n",
1667 (txstatus >> 3) & 0xF,
1668 txstatus & 0xF);
553e2335
ED
1669 dev->stats.tx_bytes += rp->tx_skbuff[entry]->len;
1670 dev->stats.tx_packets++;
1da177e4
LT
1671 }
1672 /* Free the original skb. */
1673 if (rp->tx_skbuff_dma[entry]) {
1674 pci_unmap_single(rp->pdev,
1675 rp->tx_skbuff_dma[entry],
1676 rp->tx_skbuff[entry]->len,
1677 PCI_DMA_TODEVICE);
1678 }
1679 dev_kfree_skb_irq(rp->tx_skbuff[entry]);
1680 rp->tx_skbuff[entry] = NULL;
1681 entry = (++rp->dirty_tx) % TX_RING_SIZE;
1682 }
1683 if ((rp->cur_tx - rp->dirty_tx) < TX_QUEUE_LEN - 4)
1684 netif_wake_queue(dev);
1685
1686 spin_unlock(&rp->lock);
1687}
1688
38f49e88
RL
1689/**
1690 * rhine_get_vlan_tci - extract TCI from Rx data buffer
1691 * @skb: pointer to sk_buff
1692 * @data_size: used data area of the buffer including CRC
1693 *
1694 * If hardware VLAN tag extraction is enabled and the chip indicates a 802.1Q
1695 * packet, the extracted 802.1Q header (2 bytes TPID + 2 bytes TCI) is 4-byte
1696 * aligned following the CRC.
1697 */
1698static inline u16 rhine_get_vlan_tci(struct sk_buff *skb, int data_size)
1699{
1700 u8 *trailer = (u8 *)skb->data + ((data_size + 3) & ~3) + 2;
4562b2fe 1701 return be16_to_cpup((__be16 *)trailer);
38f49e88
RL
1702}
1703
633949a1
RL
1704/* Process up to limit frames from receive ring */
1705static int rhine_rx(struct net_device *dev, int limit)
1da177e4
LT
1706{
1707 struct rhine_private *rp = netdev_priv(dev);
633949a1 1708 int count;
1da177e4 1709 int entry = rp->cur_rx % RX_RING_SIZE;
1da177e4
LT
1710
1711 if (debug > 4) {
df4511fe
JP
1712 netdev_dbg(dev, "%s(), entry %d status %08x\n",
1713 __func__, entry,
1714 le32_to_cpu(rp->rx_head_desc->rx_status));
1da177e4
LT
1715 }
1716
1717 /* If EOP is set on the next entry, it's a new packet. Send it up. */
633949a1 1718 for (count = 0; count < limit; ++count) {
1da177e4
LT
1719 struct rx_desc *desc = rp->rx_head_desc;
1720 u32 desc_status = le32_to_cpu(desc->rx_status);
38f49e88 1721 u32 desc_length = le32_to_cpu(desc->desc_length);
1da177e4
LT
1722 int data_size = desc_status >> 16;
1723
633949a1
RL
1724 if (desc_status & DescOwn)
1725 break;
1726
1da177e4 1727 if (debug > 4)
df4511fe
JP
1728 netdev_dbg(dev, "%s() status is %08x\n",
1729 __func__, desc_status);
633949a1 1730
1da177e4
LT
1731 if ((desc_status & (RxWholePkt | RxErr)) != RxWholePkt) {
1732 if ((desc_status & RxWholePkt) != RxWholePkt) {
df4511fe
JP
1733 netdev_warn(dev,
1734 "Oversized Ethernet frame spanned multiple buffers, "
1735 "entry %#x length %d status %08x!\n",
1736 entry, data_size,
1737 desc_status);
1738 netdev_warn(dev,
1739 "Oversized Ethernet frame %p vs %p\n",
1740 rp->rx_head_desc,
1741 &rp->rx_ring[entry]);
553e2335 1742 dev->stats.rx_length_errors++;
1da177e4
LT
1743 } else if (desc_status & RxErr) {
1744 /* There was a error. */
1745 if (debug > 2)
df4511fe
JP
1746 netdev_dbg(dev, "%s() Rx error was %08x\n",
1747 __func__, desc_status);
553e2335
ED
1748 dev->stats.rx_errors++;
1749 if (desc_status & 0x0030)
1750 dev->stats.rx_length_errors++;
1751 if (desc_status & 0x0048)
1752 dev->stats.rx_fifo_errors++;
1753 if (desc_status & 0x0004)
1754 dev->stats.rx_frame_errors++;
1da177e4
LT
1755 if (desc_status & 0x0002) {
1756 /* this can also be updated outside the interrupt handler */
1757 spin_lock(&rp->lock);
553e2335 1758 dev->stats.rx_crc_errors++;
1da177e4
LT
1759 spin_unlock(&rp->lock);
1760 }
1761 }
1762 } else {
89d71a66 1763 struct sk_buff *skb = NULL;
1da177e4
LT
1764 /* Length should omit the CRC */
1765 int pkt_len = data_size - 4;
38f49e88 1766 u16 vlan_tci = 0;
1da177e4
LT
1767
1768 /* Check if the packet is long enough to accept without
1769 copying to a minimally-sized skbuff. */
89d71a66
ED
1770 if (pkt_len < rx_copybreak)
1771 skb = netdev_alloc_skb_ip_align(dev, pkt_len);
1772 if (skb) {
1da177e4
LT
1773 pci_dma_sync_single_for_cpu(rp->pdev,
1774 rp->rx_skbuff_dma[entry],
1775 rp->rx_buf_sz,
1776 PCI_DMA_FROMDEVICE);
1777
8c7b7faa 1778 skb_copy_to_linear_data(skb,
689be439 1779 rp->rx_skbuff[entry]->data,
8c7b7faa 1780 pkt_len);
1da177e4
LT
1781 skb_put(skb, pkt_len);
1782 pci_dma_sync_single_for_device(rp->pdev,
1783 rp->rx_skbuff_dma[entry],
1784 rp->rx_buf_sz,
1785 PCI_DMA_FROMDEVICE);
1786 } else {
1787 skb = rp->rx_skbuff[entry];
1788 if (skb == NULL) {
df4511fe 1789 netdev_err(dev, "Inconsistent Rx descriptor chain\n");
1da177e4
LT
1790 break;
1791 }
1792 rp->rx_skbuff[entry] = NULL;
1793 skb_put(skb, pkt_len);
1794 pci_unmap_single(rp->pdev,
1795 rp->rx_skbuff_dma[entry],
1796 rp->rx_buf_sz,
1797 PCI_DMA_FROMDEVICE);
1798 }
38f49e88
RL
1799
1800 if (unlikely(desc_length & DescTag))
1801 vlan_tci = rhine_get_vlan_tci(skb, data_size);
1802
1da177e4 1803 skb->protocol = eth_type_trans(skb, dev);
38f49e88
RL
1804
1805 if (unlikely(desc_length & DescTag))
1806 __vlan_hwaccel_put_tag(skb, vlan_tci);
633949a1 1807 netif_receive_skb(skb);
553e2335
ED
1808 dev->stats.rx_bytes += pkt_len;
1809 dev->stats.rx_packets++;
1da177e4
LT
1810 }
1811 entry = (++rp->cur_rx) % RX_RING_SIZE;
1812 rp->rx_head_desc = &rp->rx_ring[entry];
1813 }
1814
1815 /* Refill the Rx ring buffers. */
1816 for (; rp->cur_rx - rp->dirty_rx > 0; rp->dirty_rx++) {
1817 struct sk_buff *skb;
1818 entry = rp->dirty_rx % RX_RING_SIZE;
1819 if (rp->rx_skbuff[entry] == NULL) {
b26b555a 1820 skb = netdev_alloc_skb(dev, rp->rx_buf_sz);
1da177e4
LT
1821 rp->rx_skbuff[entry] = skb;
1822 if (skb == NULL)
1823 break; /* Better luck next round. */
1824 skb->dev = dev; /* Mark as being used by this device. */
1825 rp->rx_skbuff_dma[entry] =
689be439 1826 pci_map_single(rp->pdev, skb->data,
1da177e4
LT
1827 rp->rx_buf_sz,
1828 PCI_DMA_FROMDEVICE);
1829 rp->rx_ring[entry].addr = cpu_to_le32(rp->rx_skbuff_dma[entry]);
1830 }
1831 rp->rx_ring[entry].rx_status = cpu_to_le32(DescOwn);
1832 }
633949a1
RL
1833
1834 return count;
1da177e4
LT
1835}
1836
1837/*
1838 * Clears the "tally counters" for CRC errors and missed frames(?).
1839 * It has been reported that some chips need a write of 0 to clear
1840 * these, for others the counters are set to 1 when written to and
1841 * instead cleared when read. So we clear them both ways ...
1842 */
1843static inline void clear_tally_counters(void __iomem *ioaddr)
1844{
1845 iowrite32(0, ioaddr + RxMissed);
1846 ioread16(ioaddr + RxCRCErrs);
1847 ioread16(ioaddr + RxMissed);
1848}
1849
1850static void rhine_restart_tx(struct net_device *dev) {
1851 struct rhine_private *rp = netdev_priv(dev);
1852 void __iomem *ioaddr = rp->base;
1853 int entry = rp->dirty_tx % TX_RING_SIZE;
1854 u32 intr_status;
1855
1856 /*
25985edc 1857 * If new errors occurred, we need to sort them out before doing Tx.
1da177e4
LT
1858 * In that case the ISR will be back here RSN anyway.
1859 */
1860 intr_status = get_intr_status(dev);
1861
1862 if ((intr_status & IntrTxErrSummary) == 0) {
1863
1864 /* We know better than the chip where it should continue. */
1865 iowrite32(rp->tx_ring_dma + entry * sizeof(struct tx_desc),
1866 ioaddr + TxRingPtr);
1867
1868 iowrite8(ioread8(ioaddr + ChipCmd) | CmdTxOn,
1869 ioaddr + ChipCmd);
38f49e88
RL
1870
1871 if (rp->tx_ring[entry].desc_length & cpu_to_le32(0x020000))
1872 /* Tx queues are bits 7-0 (first Tx queue: bit 7) */
1873 BYTE_REG_BITS_ON(1 << 7, ioaddr + TQWake);
1874
1da177e4
LT
1875 iowrite8(ioread8(ioaddr + ChipCmd1) | Cmd1TxDemand,
1876 ioaddr + ChipCmd1);
1877 IOSYNC;
1878 }
1879 else {
1880 /* This should never happen */
1881 if (debug > 1)
df4511fe
JP
1882 netdev_warn(dev, "%s() Another error occurred %08x\n",
1883 __func__, intr_status);
1da177e4
LT
1884 }
1885
1886}
1887
1888static void rhine_error(struct net_device *dev, int intr_status)
1889{
1890 struct rhine_private *rp = netdev_priv(dev);
1891 void __iomem *ioaddr = rp->base;
1892
1893 spin_lock(&rp->lock);
1894
1895 if (intr_status & IntrLinkChange)
38bb6b28 1896 rhine_check_media(dev, 0);
1da177e4 1897 if (intr_status & IntrStatsMax) {
553e2335
ED
1898 dev->stats.rx_crc_errors += ioread16(ioaddr + RxCRCErrs);
1899 dev->stats.rx_missed_errors += ioread16(ioaddr + RxMissed);
1da177e4
LT
1900 clear_tally_counters(ioaddr);
1901 }
1902 if (intr_status & IntrTxAborted) {
1903 if (debug > 1)
df4511fe
JP
1904 netdev_info(dev, "Abort %08x, frame dropped\n",
1905 intr_status);
1da177e4
LT
1906 }
1907 if (intr_status & IntrTxUnderrun) {
1908 if (rp->tx_thresh < 0xE0)
38f49e88 1909 BYTE_REG_BITS_SET((rp->tx_thresh += 0x20), 0x80, ioaddr + TxConfig);
1da177e4 1910 if (debug > 1)
df4511fe
JP
1911 netdev_info(dev, "Transmitter underrun, Tx threshold now %02x\n",
1912 rp->tx_thresh);
1da177e4
LT
1913 }
1914 if (intr_status & IntrTxDescRace) {
1915 if (debug > 2)
df4511fe 1916 netdev_info(dev, "Tx descriptor write-back race\n");
1da177e4
LT
1917 }
1918 if ((intr_status & IntrTxError) &&
1919 (intr_status & (IntrTxAborted |
1920 IntrTxUnderrun | IntrTxDescRace)) == 0) {
1921 if (rp->tx_thresh < 0xE0) {
38f49e88 1922 BYTE_REG_BITS_SET((rp->tx_thresh += 0x20), 0x80, ioaddr + TxConfig);
1da177e4
LT
1923 }
1924 if (debug > 1)
df4511fe
JP
1925 netdev_info(dev, "Unspecified error. Tx threshold now %02x\n",
1926 rp->tx_thresh);
1da177e4
LT
1927 }
1928 if (intr_status & (IntrTxAborted | IntrTxUnderrun | IntrTxDescRace |
1929 IntrTxError))
1930 rhine_restart_tx(dev);
1931
1932 if (intr_status & ~(IntrLinkChange | IntrStatsMax | IntrTxUnderrun |
1933 IntrTxError | IntrTxAborted | IntrNormalSummary |
1934 IntrTxDescRace)) {
1935 if (debug > 1)
df4511fe
JP
1936 netdev_err(dev, "Something Wicked happened! %08x\n",
1937 intr_status);
1da177e4
LT
1938 }
1939
1940 spin_unlock(&rp->lock);
1941}
1942
1943static struct net_device_stats *rhine_get_stats(struct net_device *dev)
1944{
1945 struct rhine_private *rp = netdev_priv(dev);
1946 void __iomem *ioaddr = rp->base;
1947 unsigned long flags;
1948
1949 spin_lock_irqsave(&rp->lock, flags);
553e2335
ED
1950 dev->stats.rx_crc_errors += ioread16(ioaddr + RxCRCErrs);
1951 dev->stats.rx_missed_errors += ioread16(ioaddr + RxMissed);
1da177e4
LT
1952 clear_tally_counters(ioaddr);
1953 spin_unlock_irqrestore(&rp->lock, flags);
1954
553e2335 1955 return &dev->stats;
1da177e4
LT
1956}
1957
1958static void rhine_set_rx_mode(struct net_device *dev)
1959{
1960 struct rhine_private *rp = netdev_priv(dev);
1961 void __iomem *ioaddr = rp->base;
1962 u32 mc_filter[2]; /* Multicast hash filter */
38f49e88
RL
1963 u8 rx_mode = 0x0C; /* Note: 0x02=accept runt, 0x01=accept errs */
1964 struct netdev_hw_addr *ha;
1da177e4
LT
1965
1966 if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */
1da177e4
LT
1967 rx_mode = 0x1C;
1968 iowrite32(0xffffffff, ioaddr + MulticastFilter0);
1969 iowrite32(0xffffffff, ioaddr + MulticastFilter1);
4cd24eaf 1970 } else if ((netdev_mc_count(dev) > multicast_filter_limit) ||
8e95a202 1971 (dev->flags & IFF_ALLMULTI)) {
1da177e4
LT
1972 /* Too many to match, or accept all multicasts. */
1973 iowrite32(0xffffffff, ioaddr + MulticastFilter0);
1974 iowrite32(0xffffffff, ioaddr + MulticastFilter1);
38f49e88
RL
1975 } else if (rp->pdev->revision >= VT6105M) {
1976 int i = 0;
1977 u32 mCAMmask = 0; /* 32 mCAMs (6105M and better) */
1978 netdev_for_each_mc_addr(ha, dev) {
1979 if (i == MCAM_SIZE)
1980 break;
1981 rhine_set_cam(ioaddr, i, ha->addr);
1982 mCAMmask |= 1 << i;
1983 i++;
1984 }
1985 rhine_set_cam_mask(ioaddr, mCAMmask);
1da177e4 1986 } else {
1da177e4 1987 memset(mc_filter, 0, sizeof(mc_filter));
22bedad3
JP
1988 netdev_for_each_mc_addr(ha, dev) {
1989 int bit_nr = ether_crc(ETH_ALEN, ha->addr) >> 26;
1da177e4
LT
1990
1991 mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
1992 }
1993 iowrite32(mc_filter[0], ioaddr + MulticastFilter0);
1994 iowrite32(mc_filter[1], ioaddr + MulticastFilter1);
1da177e4 1995 }
38f49e88
RL
1996 /* enable/disable VLAN receive filtering */
1997 if (rp->pdev->revision >= VT6105M) {
1998 if (dev->flags & IFF_PROMISC)
1999 BYTE_REG_BITS_OFF(BCR1_VIDFR, ioaddr + PCIBusConfig1);
2000 else
2001 BYTE_REG_BITS_ON(BCR1_VIDFR, ioaddr + PCIBusConfig1);
2002 }
2003 BYTE_REG_BITS_ON(rx_mode, ioaddr + RxConfig);
1da177e4
LT
2004}
2005
2006static void netdev_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
2007{
2008 struct rhine_private *rp = netdev_priv(dev);
2009
2010 strcpy(info->driver, DRV_NAME);
2011 strcpy(info->version, DRV_VERSION);
2012 strcpy(info->bus_info, pci_name(rp->pdev));
2013}
2014
2015static int netdev_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
2016{
2017 struct rhine_private *rp = netdev_priv(dev);
2018 int rc;
2019
2020 spin_lock_irq(&rp->lock);
2021 rc = mii_ethtool_gset(&rp->mii_if, cmd);
2022 spin_unlock_irq(&rp->lock);
2023
2024 return rc;
2025}
2026
2027static int netdev_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
2028{
2029 struct rhine_private *rp = netdev_priv(dev);
2030 int rc;
2031
2032 spin_lock_irq(&rp->lock);
2033 rc = mii_ethtool_sset(&rp->mii_if, cmd);
2034 spin_unlock_irq(&rp->lock);
00b428c2 2035 rhine_set_carrier(&rp->mii_if);
1da177e4
LT
2036
2037 return rc;
2038}
2039
2040static int netdev_nway_reset(struct net_device *dev)
2041{
2042 struct rhine_private *rp = netdev_priv(dev);
2043
2044 return mii_nway_restart(&rp->mii_if);
2045}
2046
2047static u32 netdev_get_link(struct net_device *dev)
2048{
2049 struct rhine_private *rp = netdev_priv(dev);
2050
2051 return mii_link_ok(&rp->mii_if);
2052}
2053
2054static u32 netdev_get_msglevel(struct net_device *dev)
2055{
2056 return debug;
2057}
2058
2059static void netdev_set_msglevel(struct net_device *dev, u32 value)
2060{
2061 debug = value;
2062}
2063
2064static void rhine_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
2065{
2066 struct rhine_private *rp = netdev_priv(dev);
2067
2068 if (!(rp->quirks & rqWOL))
2069 return;
2070
2071 spin_lock_irq(&rp->lock);
2072 wol->supported = WAKE_PHY | WAKE_MAGIC |
2073 WAKE_UCAST | WAKE_MCAST | WAKE_BCAST; /* Untested */
2074 wol->wolopts = rp->wolopts;
2075 spin_unlock_irq(&rp->lock);
2076}
2077
2078static int rhine_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
2079{
2080 struct rhine_private *rp = netdev_priv(dev);
2081 u32 support = WAKE_PHY | WAKE_MAGIC |
2082 WAKE_UCAST | WAKE_MCAST | WAKE_BCAST; /* Untested */
2083
2084 if (!(rp->quirks & rqWOL))
2085 return -EINVAL;
2086
2087 if (wol->wolopts & ~support)
2088 return -EINVAL;
2089
2090 spin_lock_irq(&rp->lock);
2091 rp->wolopts = wol->wolopts;
2092 spin_unlock_irq(&rp->lock);
2093
2094 return 0;
2095}
2096
7282d491 2097static const struct ethtool_ops netdev_ethtool_ops = {
1da177e4
LT
2098 .get_drvinfo = netdev_get_drvinfo,
2099 .get_settings = netdev_get_settings,
2100 .set_settings = netdev_set_settings,
2101 .nway_reset = netdev_nway_reset,
2102 .get_link = netdev_get_link,
2103 .get_msglevel = netdev_get_msglevel,
2104 .set_msglevel = netdev_set_msglevel,
2105 .get_wol = rhine_get_wol,
2106 .set_wol = rhine_set_wol,
1da177e4
LT
2107};
2108
2109static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
2110{
2111 struct rhine_private *rp = netdev_priv(dev);
2112 int rc;
2113
2114 if (!netif_running(dev))
2115 return -EINVAL;
2116
2117 spin_lock_irq(&rp->lock);
2118 rc = generic_mii_ioctl(&rp->mii_if, if_mii(rq), cmd, NULL);
2119 spin_unlock_irq(&rp->lock);
00b428c2 2120 rhine_set_carrier(&rp->mii_if);
1da177e4
LT
2121
2122 return rc;
2123}
2124
2125static int rhine_close(struct net_device *dev)
2126{
2127 struct rhine_private *rp = netdev_priv(dev);
2128 void __iomem *ioaddr = rp->base;
2129
bea3348e 2130 napi_disable(&rp->napi);
c0d7a021
JP
2131 cancel_work_sync(&rp->reset_task);
2132 netif_stop_queue(dev);
2133
2134 spin_lock_irq(&rp->lock);
1da177e4
LT
2135
2136 if (debug > 1)
df4511fe
JP
2137 netdev_dbg(dev, "Shutting down ethercard, status was %04x\n",
2138 ioread16(ioaddr + ChipCmd));
1da177e4
LT
2139
2140 /* Switch to loopback mode to avoid hardware races. */
2141 iowrite8(rp->tx_thresh | 0x02, ioaddr + TxConfig);
2142
2143 /* Disable interrupts by clearing the interrupt mask. */
2144 iowrite16(0x0000, ioaddr + IntrEnable);
2145
2146 /* Stop the chip's Tx and Rx processes. */
2147 iowrite16(CmdStop, ioaddr + ChipCmd);
2148
2149 spin_unlock_irq(&rp->lock);
2150
2151 free_irq(rp->pdev->irq, dev);
2152 free_rbufs(dev);
2153 free_tbufs(dev);
2154 free_ring(dev);
2155
2156 return 0;
2157}
2158
2159
2160static void __devexit rhine_remove_one(struct pci_dev *pdev)
2161{
2162 struct net_device *dev = pci_get_drvdata(pdev);
2163 struct rhine_private *rp = netdev_priv(dev);
2164
2165 unregister_netdev(dev);
2166
2167 pci_iounmap(pdev, rp->base);
2168 pci_release_regions(pdev);
2169
2170 free_netdev(dev);
2171 pci_disable_device(pdev);
2172 pci_set_drvdata(pdev, NULL);
2173}
2174
d18c3db5 2175static void rhine_shutdown (struct pci_dev *pdev)
1da177e4 2176{
1da177e4
LT
2177 struct net_device *dev = pci_get_drvdata(pdev);
2178 struct rhine_private *rp = netdev_priv(dev);
2179 void __iomem *ioaddr = rp->base;
2180
2181 if (!(rp->quirks & rqWOL))
2182 return; /* Nothing to do for non-WOL adapters */
2183
2184 rhine_power_init(dev);
2185
2186 /* Make sure we use pattern 0, 1 and not 4, 5 */
2187 if (rp->quirks & rq6patterns)
f11cf25e 2188 iowrite8(0x04, ioaddr + WOLcgClr);
1da177e4
LT
2189
2190 if (rp->wolopts & WAKE_MAGIC) {
2191 iowrite8(WOLmagic, ioaddr + WOLcrSet);
2192 /*
2193 * Turn EEPROM-controlled wake-up back on -- some hardware may
2194 * not cooperate otherwise.
2195 */
2196 iowrite8(ioread8(ioaddr + ConfigA) | 0x03, ioaddr + ConfigA);
2197 }
2198
2199 if (rp->wolopts & (WAKE_BCAST|WAKE_MCAST))
2200 iowrite8(WOLbmcast, ioaddr + WOLcgSet);
2201
2202 if (rp->wolopts & WAKE_PHY)
2203 iowrite8(WOLlnkon | WOLlnkoff, ioaddr + WOLcrSet);
2204
2205 if (rp->wolopts & WAKE_UCAST)
2206 iowrite8(WOLucast, ioaddr + WOLcrSet);
2207
2208 if (rp->wolopts) {
2209 /* Enable legacy WOL (for old motherboards) */
2210 iowrite8(0x01, ioaddr + PwcfgSet);
2211 iowrite8(ioread8(ioaddr + StickyHW) | 0x04, ioaddr + StickyHW);
2212 }
2213
2214 /* Hit power state D3 (sleep) */
b933b4d9
RL
2215 if (!avoid_D3)
2216 iowrite8(ioread8(ioaddr + StickyHW) | 0x03, ioaddr + StickyHW);
1da177e4
LT
2217
2218 /* TODO: Check use of pci_enable_wake() */
2219
2220}
2221
2222#ifdef CONFIG_PM
2223static int rhine_suspend(struct pci_dev *pdev, pm_message_t state)
2224{
2225 struct net_device *dev = pci_get_drvdata(pdev);
2226 struct rhine_private *rp = netdev_priv(dev);
2227 unsigned long flags;
2228
2229 if (!netif_running(dev))
2230 return 0;
2231
bea3348e 2232 napi_disable(&rp->napi);
32b0f53e 2233
1da177e4
LT
2234 netif_device_detach(dev);
2235 pci_save_state(pdev);
2236
2237 spin_lock_irqsave(&rp->lock, flags);
d18c3db5 2238 rhine_shutdown(pdev);
1da177e4
LT
2239 spin_unlock_irqrestore(&rp->lock, flags);
2240
2241 free_irq(dev->irq, dev);
2242 return 0;
2243}
2244
2245static int rhine_resume(struct pci_dev *pdev)
2246{
2247 struct net_device *dev = pci_get_drvdata(pdev);
2248 struct rhine_private *rp = netdev_priv(dev);
2249 unsigned long flags;
2250 int ret;
2251
2252 if (!netif_running(dev))
2253 return 0;
2254
38f49e88 2255 if (request_irq(dev->irq, rhine_interrupt, IRQF_SHARED, dev->name, dev))
df4511fe 2256 netdev_err(dev, "request_irq failed\n");
1da177e4
LT
2257
2258 ret = pci_set_power_state(pdev, PCI_D0);
2259 if (debug > 1)
df4511fe
JP
2260 netdev_info(dev, "Entering power state D0 %s (%d)\n",
2261 ret ? "failed" : "succeeded", ret);
1da177e4
LT
2262
2263 pci_restore_state(pdev);
2264
2265 spin_lock_irqsave(&rp->lock, flags);
2266#ifdef USE_MMIO
2267 enable_mmio(rp->pioaddr, rp->quirks);
2268#endif
2269 rhine_power_init(dev);
2270 free_tbufs(dev);
2271 free_rbufs(dev);
2272 alloc_tbufs(dev);
2273 alloc_rbufs(dev);
2274 init_registers(dev);
2275 spin_unlock_irqrestore(&rp->lock, flags);
2276
2277 netif_device_attach(dev);
2278
2279 return 0;
2280}
2281#endif /* CONFIG_PM */
2282
2283static struct pci_driver rhine_driver = {
2284 .name = DRV_NAME,
2285 .id_table = rhine_pci_tbl,
2286 .probe = rhine_init_one,
2287 .remove = __devexit_p(rhine_remove_one),
2288#ifdef CONFIG_PM
2289 .suspend = rhine_suspend,
2290 .resume = rhine_resume,
2291#endif /* CONFIG_PM */
d18c3db5 2292 .shutdown = rhine_shutdown,
1da177e4
LT
2293};
2294
e84df485
RL
2295static struct dmi_system_id __initdata rhine_dmi_table[] = {
2296 {
2297 .ident = "EPIA-M",
2298 .matches = {
2299 DMI_MATCH(DMI_BIOS_VENDOR, "Award Software International, Inc."),
2300 DMI_MATCH(DMI_BIOS_VERSION, "6.00 PG"),
2301 },
2302 },
2303 {
2304 .ident = "KV7",
2305 .matches = {
2306 DMI_MATCH(DMI_BIOS_VENDOR, "Phoenix Technologies, LTD"),
2307 DMI_MATCH(DMI_BIOS_VERSION, "6.00 PG"),
2308 },
2309 },
2310 { NULL }
2311};
1da177e4
LT
2312
2313static int __init rhine_init(void)
2314{
2315/* when a module, this is printed whether or not devices are found in probe */
2316#ifdef MODULE
df4511fe 2317 pr_info("%s\n", version);
1da177e4 2318#endif
e84df485
RL
2319 if (dmi_check_system(rhine_dmi_table)) {
2320 /* these BIOSes fail at PXE boot if chip is in D3 */
2321 avoid_D3 = 1;
df4511fe 2322 pr_warn("Broken BIOS detected, avoid_D3 enabled\n");
e84df485
RL
2323 }
2324 else if (avoid_D3)
df4511fe 2325 pr_info("avoid_D3 set\n");
e84df485 2326
29917620 2327 return pci_register_driver(&rhine_driver);
1da177e4
LT
2328}
2329
2330
2331static void __exit rhine_cleanup(void)
2332{
2333 pci_unregister_driver(&rhine_driver);
2334}
2335
2336
2337module_init(rhine_init);
2338module_exit(rhine_cleanup);