Merge branch 'release' of master.kernel.org:/home/ftp/pub/scm/linux/kernel/git/aegl...
[linux-2.6] / drivers / net / 8139too.c
1 /*
2
3         8139too.c: A RealTek RTL-8139 Fast Ethernet driver for Linux.
4
5         Maintained by Jeff Garzik <jgarzik@pobox.com>
6         Copyright 2000-2002 Jeff Garzik
7
8         Much code comes from Donald Becker's rtl8139.c driver,
9         versions 1.13 and older.  This driver was originally based
10         on rtl8139.c version 1.07.  Header of rtl8139.c version 1.13:
11
12         -----<snip>-----
13
14                 Written 1997-2001 by Donald Becker.
15                 This software may be used and distributed according to the
16                 terms of the GNU General Public License (GPL), incorporated
17                 herein by reference.  Drivers based on or derived from this
18                 code fall under the GPL and must retain the authorship,
19                 copyright and license notice.  This file is not a complete
20                 program and may only be used when the entire operating
21                 system is licensed under the GPL.
22
23                 This driver is for boards based on the RTL8129 and RTL8139
24                 PCI ethernet chips.
25
26                 The author may be reached as becker@scyld.com, or C/O Scyld
27                 Computing Corporation 410 Severn Ave., Suite 210 Annapolis
28                 MD 21403
29
30                 Support and updates available at
31                 http://www.scyld.com/network/rtl8139.html
32
33                 Twister-tuning table provided by Kinston
34                 <shangh@realtek.com.tw>.
35
36         -----<snip>-----
37
38         This software may be used and distributed according to the terms
39         of the GNU General Public License, incorporated herein by reference.
40
41         Contributors:
42
43                 Donald Becker - he wrote the original driver, kudos to him!
44                 (but please don't e-mail him for support, this isn't his driver)
45
46                 Tigran Aivazian - bug fixes, skbuff free cleanup
47
48                 Martin Mares - suggestions for PCI cleanup
49
50                 David S. Miller - PCI DMA and softnet updates
51
52                 Ernst Gill - fixes ported from BSD driver
53
54                 Daniel Kobras - identified specific locations of
55                         posted MMIO write bugginess
56
57                 Gerard Sharp - bug fix, testing and feedback
58
59                 David Ford - Rx ring wrap fix
60
61                 Dan DeMaggio - swapped RTL8139 cards with me, and allowed me
62                 to find and fix a crucial bug on older chipsets.
63
64                 Donald Becker/Chris Butterworth/Marcus Westergren -
65                 Noticed various Rx packet size-related buglets.
66
67                 Santiago Garcia Mantinan - testing and feedback
68
69                 Jens David - 2.2.x kernel backports
70
71                 Martin Dennett - incredibly helpful insight on undocumented
72                 features of the 8139 chips
73
74                 Jean-Jacques Michel - bug fix
75
76                 Tobias Ringström - Rx interrupt status checking suggestion
77
78                 Andrew Morton - Clear blocked signals, avoid
79                 buffer overrun setting current->comm.
80
81                 Kalle Olavi Niemitalo - Wake-on-LAN ioctls
82
83                 Robert Kuebel - Save kernel thread from dying on any signal.
84
85         Submitting bug reports:
86
87                 "rtl8139-diag -mmmaaavvveefN" output
88                 enable RTL8139_DEBUG below, and look at 'dmesg' or kernel log
89
90 */
91
92 #define DRV_NAME        "8139too"
93 #define DRV_VERSION     "0.9.28"
94
95
96 #include <linux/module.h>
97 #include <linux/kernel.h>
98 #include <linux/compiler.h>
99 #include <linux/pci.h>
100 #include <linux/init.h>
101 #include <linux/ioport.h>
102 #include <linux/netdevice.h>
103 #include <linux/etherdevice.h>
104 #include <linux/rtnetlink.h>
105 #include <linux/delay.h>
106 #include <linux/ethtool.h>
107 #include <linux/mii.h>
108 #include <linux/completion.h>
109 #include <linux/crc32.h>
110 #include <asm/io.h>
111 #include <asm/uaccess.h>
112 #include <asm/irq.h>
113
114 #define RTL8139_DRIVER_NAME   DRV_NAME " Fast Ethernet driver " DRV_VERSION
115 #define PFX DRV_NAME ": "
116
117 /* Default Message level */
118 #define RTL8139_DEF_MSG_ENABLE   (NETIF_MSG_DRV   | \
119                                  NETIF_MSG_PROBE  | \
120                                  NETIF_MSG_LINK)
121
122
123 /* enable PIO instead of MMIO, if CONFIG_8139TOO_PIO is selected */
124 #ifdef CONFIG_8139TOO_PIO
125 #define USE_IO_OPS 1
126 #endif
127
128 /* define to 1, 2 or 3 to enable copious debugging info */
129 #define RTL8139_DEBUG 0
130
131 /* define to 1 to disable lightweight runtime debugging checks */
132 #undef RTL8139_NDEBUG
133
134
135 #if RTL8139_DEBUG
136 /* note: prints function name for you */
137 #  define DPRINTK(fmt, args...) printk(KERN_DEBUG "%s: " fmt, __FUNCTION__ , ## args)
138 #else
139 #  define DPRINTK(fmt, args...)
140 #endif
141
142 #ifdef RTL8139_NDEBUG
143 #  define assert(expr) do {} while (0)
144 #else
145 #  define assert(expr) \
146         if(unlikely(!(expr))) {                                 \
147         printk(KERN_ERR "Assertion failed! %s,%s,%s,line=%d\n", \
148         #expr,__FILE__,__FUNCTION__,__LINE__);                  \
149         }
150 #endif
151
152
153 /* A few user-configurable values. */
154 /* media options */
155 #define MAX_UNITS 8
156 static int media[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
157 static int full_duplex[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1};
158
159 /* Maximum number of multicast addresses to filter (vs. Rx-all-multicast).
160    The RTL chips use a 64 element hash table based on the Ethernet CRC.  */
161 static int multicast_filter_limit = 32;
162
163 /* bitmapped message enable number */
164 static int debug = -1;
165
166 /*
167  * Receive ring size
168  * Warning: 64K ring has hardware issues and may lock up.
169  */
170 #if defined(CONFIG_SH_DREAMCAST)
171 #define RX_BUF_IDX      1       /* 16K ring */
172 #else
173 #define RX_BUF_IDX      2       /* 32K ring */
174 #endif
175 #define RX_BUF_LEN      (8192 << RX_BUF_IDX)
176 #define RX_BUF_PAD      16
177 #define RX_BUF_WRAP_PAD 2048 /* spare padding to handle lack of packet wrap */
178
179 #if RX_BUF_LEN == 65536
180 #define RX_BUF_TOT_LEN  RX_BUF_LEN
181 #else
182 #define RX_BUF_TOT_LEN  (RX_BUF_LEN + RX_BUF_PAD + RX_BUF_WRAP_PAD)
183 #endif
184
185 /* Number of Tx descriptor registers. */
186 #define NUM_TX_DESC     4
187
188 /* max supported ethernet frame size -- must be at least (dev->mtu+14+4).*/
189 #define MAX_ETH_FRAME_SIZE      1536
190
191 /* Size of the Tx bounce buffers -- must be at least (dev->mtu+14+4). */
192 #define TX_BUF_SIZE     MAX_ETH_FRAME_SIZE
193 #define TX_BUF_TOT_LEN  (TX_BUF_SIZE * NUM_TX_DESC)
194
195 /* PCI Tuning Parameters
196    Threshold is bytes transferred to chip before transmission starts. */
197 #define TX_FIFO_THRESH 256      /* In bytes, rounded down to 32 byte units. */
198
199 /* The following settings are log_2(bytes)-4:  0 == 16 bytes .. 6==1024, 7==end of packet. */
200 #define RX_FIFO_THRESH  7       /* Rx buffer level before first PCI xfer.  */
201 #define RX_DMA_BURST    7       /* Maximum PCI burst, '6' is 1024 */
202 #define TX_DMA_BURST    6       /* Maximum PCI burst, '6' is 1024 */
203 #define TX_RETRY        8       /* 0-15.  retries = 16 + (TX_RETRY * 16) */
204
205 /* Operational parameters that usually are not changed. */
206 /* Time in jiffies before concluding the transmitter is hung. */
207 #define TX_TIMEOUT  (6*HZ)
208
209
210 enum {
211         HAS_MII_XCVR = 0x010000,
212         HAS_CHIP_XCVR = 0x020000,
213         HAS_LNK_CHNG = 0x040000,
214 };
215
216 #define RTL_NUM_STATS 4         /* number of ETHTOOL_GSTATS u64's */
217 #define RTL_REGS_VER 1          /* version of reg. data in ETHTOOL_GREGS */
218 #define RTL_MIN_IO_SIZE 0x80
219 #define RTL8139B_IO_SIZE 256
220
221 #define RTL8129_CAPS    HAS_MII_XCVR
222 #define RTL8139_CAPS    HAS_CHIP_XCVR|HAS_LNK_CHNG
223
224 typedef enum {
225         RTL8139 = 0,
226         RTL8129,
227 } board_t;
228
229
230 /* indexed by board_t, above */
231 static const struct {
232         const char *name;
233         u32 hw_flags;
234 } board_info[] __devinitdata = {
235         { "RealTek RTL8139", RTL8139_CAPS },
236         { "RealTek RTL8129", RTL8129_CAPS },
237 };
238
239
240 static struct pci_device_id rtl8139_pci_tbl[] = {
241         {0x10ec, 0x8139, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
242         {0x10ec, 0x8138, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
243         {0x1113, 0x1211, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
244         {0x1500, 0x1360, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
245         {0x4033, 0x1360, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
246         {0x1186, 0x1300, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
247         {0x1186, 0x1340, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
248         {0x13d1, 0xab06, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
249         {0x1259, 0xa117, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
250         {0x1259, 0xa11e, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
251         {0x14ea, 0xab06, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
252         {0x14ea, 0xab07, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
253         {0x11db, 0x1234, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
254         {0x1432, 0x9130, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
255         {0x02ac, 0x1012, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
256         {0x018a, 0x0106, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
257         {0x126c, 0x1211, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
258         {0x1743, 0x8139, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
259         {0x021b, 0x8139, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
260
261 #ifdef CONFIG_SH_SECUREEDGE5410
262         /* Bogus 8139 silicon reports 8129 without external PROM :-( */
263         {0x10ec, 0x8129, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8139 },
264 #endif
265 #ifdef CONFIG_8139TOO_8129
266         {0x10ec, 0x8129, PCI_ANY_ID, PCI_ANY_ID, 0, 0, RTL8129 },
267 #endif
268
269         /* some crazy cards report invalid vendor ids like
270          * 0x0001 here.  The other ids are valid and constant,
271          * so we simply don't match on the main vendor id.
272          */
273         {PCI_ANY_ID, 0x8139, 0x10ec, 0x8139, 0, 0, RTL8139 },
274         {PCI_ANY_ID, 0x8139, 0x1186, 0x1300, 0, 0, RTL8139 },
275         {PCI_ANY_ID, 0x8139, 0x13d1, 0xab06, 0, 0, RTL8139 },
276
277         {0,}
278 };
279 MODULE_DEVICE_TABLE (pci, rtl8139_pci_tbl);
280
281 static struct {
282         const char str[ETH_GSTRING_LEN];
283 } ethtool_stats_keys[] = {
284         { "early_rx" },
285         { "tx_buf_mapped" },
286         { "tx_timeouts" },
287         { "rx_lost_in_ring" },
288 };
289
290 /* The rest of these values should never change. */
291
292 /* Symbolic offsets to registers. */
293 enum RTL8139_registers {
294         MAC0 = 0,               /* Ethernet hardware address. */
295         MAR0 = 8,               /* Multicast filter. */
296         TxStatus0 = 0x10,       /* Transmit status (Four 32bit registers). */
297         TxAddr0 = 0x20,         /* Tx descriptors (also four 32bit). */
298         RxBuf = 0x30,
299         ChipCmd = 0x37,
300         RxBufPtr = 0x38,
301         RxBufAddr = 0x3A,
302         IntrMask = 0x3C,
303         IntrStatus = 0x3E,
304         TxConfig = 0x40,
305         RxConfig = 0x44,
306         Timer = 0x48,           /* A general-purpose counter. */
307         RxMissed = 0x4C,        /* 24 bits valid, write clears. */
308         Cfg9346 = 0x50,
309         Config0 = 0x51,
310         Config1 = 0x52,
311         FlashReg = 0x54,
312         MediaStatus = 0x58,
313         Config3 = 0x59,
314         Config4 = 0x5A,         /* absent on RTL-8139A */
315         HltClk = 0x5B,
316         MultiIntr = 0x5C,
317         TxSummary = 0x60,
318         BasicModeCtrl = 0x62,
319         BasicModeStatus = 0x64,
320         NWayAdvert = 0x66,
321         NWayLPAR = 0x68,
322         NWayExpansion = 0x6A,
323         /* Undocumented registers, but required for proper operation. */
324         FIFOTMS = 0x70,         /* FIFO Control and test. */
325         CSCR = 0x74,            /* Chip Status and Configuration Register. */
326         PARA78 = 0x78,
327         PARA7c = 0x7c,          /* Magic transceiver parameter register. */
328         Config5 = 0xD8,         /* absent on RTL-8139A */
329 };
330
331 enum ClearBitMasks {
332         MultiIntrClear = 0xF000,
333         ChipCmdClear = 0xE2,
334         Config1Clear = (1<<7)|(1<<6)|(1<<3)|(1<<2)|(1<<1),
335 };
336
337 enum ChipCmdBits {
338         CmdReset = 0x10,
339         CmdRxEnb = 0x08,
340         CmdTxEnb = 0x04,
341         RxBufEmpty = 0x01,
342 };
343
344 /* Interrupt register bits, using my own meaningful names. */
345 enum IntrStatusBits {
346         PCIErr = 0x8000,
347         PCSTimeout = 0x4000,
348         RxFIFOOver = 0x40,
349         RxUnderrun = 0x20,
350         RxOverflow = 0x10,
351         TxErr = 0x08,
352         TxOK = 0x04,
353         RxErr = 0x02,
354         RxOK = 0x01,
355
356         RxAckBits = RxFIFOOver | RxOverflow | RxOK,
357 };
358
359 enum TxStatusBits {
360         TxHostOwns = 0x2000,
361         TxUnderrun = 0x4000,
362         TxStatOK = 0x8000,
363         TxOutOfWindow = 0x20000000,
364         TxAborted = 0x40000000,
365         TxCarrierLost = 0x80000000,
366 };
367 enum RxStatusBits {
368         RxMulticast = 0x8000,
369         RxPhysical = 0x4000,
370         RxBroadcast = 0x2000,
371         RxBadSymbol = 0x0020,
372         RxRunt = 0x0010,
373         RxTooLong = 0x0008,
374         RxCRCErr = 0x0004,
375         RxBadAlign = 0x0002,
376         RxStatusOK = 0x0001,
377 };
378
379 /* Bits in RxConfig. */
380 enum rx_mode_bits {
381         AcceptErr = 0x20,
382         AcceptRunt = 0x10,
383         AcceptBroadcast = 0x08,
384         AcceptMulticast = 0x04,
385         AcceptMyPhys = 0x02,
386         AcceptAllPhys = 0x01,
387 };
388
389 /* Bits in TxConfig. */
390 enum tx_config_bits {
391
392         /* Interframe Gap Time. Only TxIFG96 doesn't violate IEEE 802.3 */
393         TxIFGShift = 24,
394         TxIFG84 = (0 << TxIFGShift),    /* 8.4us / 840ns (10 / 100Mbps) */
395         TxIFG88 = (1 << TxIFGShift),    /* 8.8us / 880ns (10 / 100Mbps) */
396         TxIFG92 = (2 << TxIFGShift),    /* 9.2us / 920ns (10 / 100Mbps) */
397         TxIFG96 = (3 << TxIFGShift),    /* 9.6us / 960ns (10 / 100Mbps) */
398
399         TxLoopBack = (1 << 18) | (1 << 17), /* enable loopback test mode */
400         TxCRC = (1 << 16),      /* DISABLE appending CRC to end of Tx packets */
401         TxClearAbt = (1 << 0),  /* Clear abort (WO) */
402         TxDMAShift = 8,         /* DMA burst value (0-7) is shifted this many bits */
403         TxRetryShift = 4,       /* TXRR value (0-15) is shifted this many bits */
404
405         TxVersionMask = 0x7C800000, /* mask out version bits 30-26, 23 */
406 };
407
408 /* Bits in Config1 */
409 enum Config1Bits {
410         Cfg1_PM_Enable = 0x01,
411         Cfg1_VPD_Enable = 0x02,
412         Cfg1_PIO = 0x04,
413         Cfg1_MMIO = 0x08,
414         LWAKE = 0x10,           /* not on 8139, 8139A */
415         Cfg1_Driver_Load = 0x20,
416         Cfg1_LED0 = 0x40,
417         Cfg1_LED1 = 0x80,
418         SLEEP = (1 << 1),       /* only on 8139, 8139A */
419         PWRDN = (1 << 0),       /* only on 8139, 8139A */
420 };
421
422 /* Bits in Config3 */
423 enum Config3Bits {
424         Cfg3_FBtBEn    = (1 << 0), /* 1 = Fast Back to Back */
425         Cfg3_FuncRegEn = (1 << 1), /* 1 = enable CardBus Function registers */
426         Cfg3_CLKRUN_En = (1 << 2), /* 1 = enable CLKRUN */
427         Cfg3_CardB_En  = (1 << 3), /* 1 = enable CardBus registers */
428         Cfg3_LinkUp    = (1 << 4), /* 1 = wake up on link up */
429         Cfg3_Magic     = (1 << 5), /* 1 = wake up on Magic Packet (tm) */
430         Cfg3_PARM_En   = (1 << 6), /* 0 = software can set twister parameters */
431         Cfg3_GNTSel    = (1 << 7), /* 1 = delay 1 clock from PCI GNT signal */
432 };
433
434 /* Bits in Config4 */
435 enum Config4Bits {
436         LWPTN = (1 << 2),       /* not on 8139, 8139A */
437 };
438
439 /* Bits in Config5 */
440 enum Config5Bits {
441         Cfg5_PME_STS     = (1 << 0), /* 1 = PCI reset resets PME_Status */
442         Cfg5_LANWake     = (1 << 1), /* 1 = enable LANWake signal */
443         Cfg5_LDPS        = (1 << 2), /* 0 = save power when link is down */
444         Cfg5_FIFOAddrPtr = (1 << 3), /* Realtek internal SRAM testing */
445         Cfg5_UWF         = (1 << 4), /* 1 = accept unicast wakeup frame */
446         Cfg5_MWF         = (1 << 5), /* 1 = accept multicast wakeup frame */
447         Cfg5_BWF         = (1 << 6), /* 1 = accept broadcast wakeup frame */
448 };
449
450 enum RxConfigBits {
451         /* rx fifo threshold */
452         RxCfgFIFOShift = 13,
453         RxCfgFIFONone = (7 << RxCfgFIFOShift),
454
455         /* Max DMA burst */
456         RxCfgDMAShift = 8,
457         RxCfgDMAUnlimited = (7 << RxCfgDMAShift),
458
459         /* rx ring buffer length */
460         RxCfgRcv8K = 0,
461         RxCfgRcv16K = (1 << 11),
462         RxCfgRcv32K = (1 << 12),
463         RxCfgRcv64K = (1 << 11) | (1 << 12),
464
465         /* Disable packet wrap at end of Rx buffer. (not possible with 64k) */
466         RxNoWrap = (1 << 7),
467 };
468
469 /* Twister tuning parameters from RealTek.
470    Completely undocumented, but required to tune bad links on some boards. */
471 enum CSCRBits {
472         CSCR_LinkOKBit = 0x0400,
473         CSCR_LinkChangeBit = 0x0800,
474         CSCR_LinkStatusBits = 0x0f000,
475         CSCR_LinkDownOffCmd = 0x003c0,
476         CSCR_LinkDownCmd = 0x0f3c0,
477 };
478
479 enum Cfg9346Bits {
480         Cfg9346_Lock = 0x00,
481         Cfg9346_Unlock = 0xC0,
482 };
483
484 typedef enum {
485         CH_8139 = 0,
486         CH_8139_K,
487         CH_8139A,
488         CH_8139A_G,
489         CH_8139B,
490         CH_8130,
491         CH_8139C,
492         CH_8100,
493         CH_8100B_8139D,
494         CH_8101,
495 } chip_t;
496
497 enum chip_flags {
498         HasHltClk = (1 << 0),
499         HasLWake = (1 << 1),
500 };
501
502 #define HW_REVID(b30, b29, b28, b27, b26, b23, b22) \
503         (b30<<30 | b29<<29 | b28<<28 | b27<<27 | b26<<26 | b23<<23 | b22<<22)
504 #define HW_REVID_MASK   HW_REVID(1, 1, 1, 1, 1, 1, 1)
505
506 /* directly indexed by chip_t, above */
507 static const struct {
508         const char *name;
509         u32 version; /* from RTL8139C/RTL8139D docs */
510         u32 flags;
511 } rtl_chip_info[] = {
512         { "RTL-8139",
513           HW_REVID(1, 0, 0, 0, 0, 0, 0),
514           HasHltClk,
515         },
516
517         { "RTL-8139 rev K",
518           HW_REVID(1, 1, 0, 0, 0, 0, 0),
519           HasHltClk,
520         },
521
522         { "RTL-8139A",
523           HW_REVID(1, 1, 1, 0, 0, 0, 0),
524           HasHltClk, /* XXX undocumented? */
525         },
526
527         { "RTL-8139A rev G",
528           HW_REVID(1, 1, 1, 0, 0, 1, 0),
529           HasHltClk, /* XXX undocumented? */
530         },
531
532         { "RTL-8139B",
533           HW_REVID(1, 1, 1, 1, 0, 0, 0),
534           HasLWake,
535         },
536
537         { "RTL-8130",
538           HW_REVID(1, 1, 1, 1, 1, 0, 0),
539           HasLWake,
540         },
541
542         { "RTL-8139C",
543           HW_REVID(1, 1, 1, 0, 1, 0, 0),
544           HasLWake,
545         },
546
547         { "RTL-8100",
548           HW_REVID(1, 1, 1, 1, 0, 1, 0),
549           HasLWake,
550         },
551
552         { "RTL-8100B/8139D",
553           HW_REVID(1, 1, 1, 0, 1, 0, 1),
554           HasHltClk /* XXX undocumented? */
555         | HasLWake,
556         },
557
558         { "RTL-8101",
559           HW_REVID(1, 1, 1, 0, 1, 1, 1),
560           HasLWake,
561         },
562 };
563
564 struct rtl_extra_stats {
565         unsigned long early_rx;
566         unsigned long tx_buf_mapped;
567         unsigned long tx_timeouts;
568         unsigned long rx_lost_in_ring;
569 };
570
571 struct rtl8139_private {
572         void __iomem *mmio_addr;
573         int drv_flags;
574         struct pci_dev *pci_dev;
575         u32 msg_enable;
576         struct net_device_stats stats;
577         unsigned char *rx_ring;
578         unsigned int cur_rx;    /* Index into the Rx buffer of next Rx pkt. */
579         unsigned int tx_flag;
580         unsigned long cur_tx;
581         unsigned long dirty_tx;
582         unsigned char *tx_buf[NUM_TX_DESC];     /* Tx bounce buffers */
583         unsigned char *tx_bufs; /* Tx bounce buffer region. */
584         dma_addr_t rx_ring_dma;
585         dma_addr_t tx_bufs_dma;
586         signed char phys[4];            /* MII device addresses. */
587         char twistie, twist_row, twist_col;     /* Twister tune state. */
588         unsigned int watchdog_fired : 1;
589         unsigned int default_port : 4;  /* Last dev->if_port value. */
590         unsigned int have_thread : 1;
591         spinlock_t lock;
592         spinlock_t rx_lock;
593         chip_t chipset;
594         u32 rx_config;
595         struct rtl_extra_stats xstats;
596
597         struct delayed_work thread;
598
599         struct mii_if_info mii;
600         unsigned int regs_len;
601         unsigned long fifo_copy_timeout;
602 };
603
604 MODULE_AUTHOR ("Jeff Garzik <jgarzik@pobox.com>");
605 MODULE_DESCRIPTION ("RealTek RTL-8139 Fast Ethernet driver");
606 MODULE_LICENSE("GPL");
607 MODULE_VERSION(DRV_VERSION);
608
609 module_param(multicast_filter_limit, int, 0);
610 module_param_array(media, int, NULL, 0);
611 module_param_array(full_duplex, int, NULL, 0);
612 module_param(debug, int, 0);
613 MODULE_PARM_DESC (debug, "8139too bitmapped message enable number");
614 MODULE_PARM_DESC (multicast_filter_limit, "8139too maximum number of filtered multicast addresses");
615 MODULE_PARM_DESC (media, "8139too: Bits 4+9: force full duplex, bit 5: 100Mbps");
616 MODULE_PARM_DESC (full_duplex, "8139too: Force full duplex for board(s) (1)");
617
618 static int read_eeprom (void __iomem *ioaddr, int location, int addr_len);
619 static int rtl8139_open (struct net_device *dev);
620 static int mdio_read (struct net_device *dev, int phy_id, int location);
621 static void mdio_write (struct net_device *dev, int phy_id, int location,
622                         int val);
623 static void rtl8139_start_thread(struct rtl8139_private *tp);
624 static void rtl8139_tx_timeout (struct net_device *dev);
625 static void rtl8139_init_ring (struct net_device *dev);
626 static int rtl8139_start_xmit (struct sk_buff *skb,
627                                struct net_device *dev);
628 static int rtl8139_poll(struct net_device *dev, int *budget);
629 #ifdef CONFIG_NET_POLL_CONTROLLER
630 static void rtl8139_poll_controller(struct net_device *dev);
631 #endif
632 static irqreturn_t rtl8139_interrupt (int irq, void *dev_instance);
633 static int rtl8139_close (struct net_device *dev);
634 static int netdev_ioctl (struct net_device *dev, struct ifreq *rq, int cmd);
635 static struct net_device_stats *rtl8139_get_stats (struct net_device *dev);
636 static void rtl8139_set_rx_mode (struct net_device *dev);
637 static void __set_rx_mode (struct net_device *dev);
638 static void rtl8139_hw_start (struct net_device *dev);
639 static void rtl8139_thread (struct work_struct *work);
640 static void rtl8139_tx_timeout_task(struct work_struct *work);
641 static const struct ethtool_ops rtl8139_ethtool_ops;
642
643 /* write MMIO register, with flush */
644 /* Flush avoids rtl8139 bug w/ posted MMIO writes */
645 #define RTL_W8_F(reg, val8)     do { iowrite8 ((val8), ioaddr + (reg)); ioread8 (ioaddr + (reg)); } while (0)
646 #define RTL_W16_F(reg, val16)   do { iowrite16 ((val16), ioaddr + (reg)); ioread16 (ioaddr + (reg)); } while (0)
647 #define RTL_W32_F(reg, val32)   do { iowrite32 ((val32), ioaddr + (reg)); ioread32 (ioaddr + (reg)); } while (0)
648
649
650 #define MMIO_FLUSH_AUDIT_COMPLETE 1
651 #if MMIO_FLUSH_AUDIT_COMPLETE
652
653 /* write MMIO register */
654 #define RTL_W8(reg, val8)       iowrite8 ((val8), ioaddr + (reg))
655 #define RTL_W16(reg, val16)     iowrite16 ((val16), ioaddr + (reg))
656 #define RTL_W32(reg, val32)     iowrite32 ((val32), ioaddr + (reg))
657
658 #else
659
660 /* write MMIO register, then flush */
661 #define RTL_W8          RTL_W8_F
662 #define RTL_W16         RTL_W16_F
663 #define RTL_W32         RTL_W32_F
664
665 #endif /* MMIO_FLUSH_AUDIT_COMPLETE */
666
667 /* read MMIO register */
668 #define RTL_R8(reg)             ioread8 (ioaddr + (reg))
669 #define RTL_R16(reg)            ioread16 (ioaddr + (reg))
670 #define RTL_R32(reg)            ((unsigned long) ioread32 (ioaddr + (reg)))
671
672
673 static const u16 rtl8139_intr_mask =
674         PCIErr | PCSTimeout | RxUnderrun | RxOverflow | RxFIFOOver |
675         TxErr | TxOK | RxErr | RxOK;
676
677 static const u16 rtl8139_norx_intr_mask =
678         PCIErr | PCSTimeout | RxUnderrun |
679         TxErr | TxOK | RxErr ;
680
681 #if RX_BUF_IDX == 0
682 static const unsigned int rtl8139_rx_config =
683         RxCfgRcv8K | RxNoWrap |
684         (RX_FIFO_THRESH << RxCfgFIFOShift) |
685         (RX_DMA_BURST << RxCfgDMAShift);
686 #elif RX_BUF_IDX == 1
687 static const unsigned int rtl8139_rx_config =
688         RxCfgRcv16K | RxNoWrap |
689         (RX_FIFO_THRESH << RxCfgFIFOShift) |
690         (RX_DMA_BURST << RxCfgDMAShift);
691 #elif RX_BUF_IDX == 2
692 static const unsigned int rtl8139_rx_config =
693         RxCfgRcv32K | RxNoWrap |
694         (RX_FIFO_THRESH << RxCfgFIFOShift) |
695         (RX_DMA_BURST << RxCfgDMAShift);
696 #elif RX_BUF_IDX == 3
697 static const unsigned int rtl8139_rx_config =
698         RxCfgRcv64K |
699         (RX_FIFO_THRESH << RxCfgFIFOShift) |
700         (RX_DMA_BURST << RxCfgDMAShift);
701 #else
702 #error "Invalid configuration for 8139_RXBUF_IDX"
703 #endif
704
705 static const unsigned int rtl8139_tx_config =
706         TxIFG96 | (TX_DMA_BURST << TxDMAShift) | (TX_RETRY << TxRetryShift);
707
708 static void __rtl8139_cleanup_dev (struct net_device *dev)
709 {
710         struct rtl8139_private *tp = netdev_priv(dev);
711         struct pci_dev *pdev;
712
713         assert (dev != NULL);
714         assert (tp->pci_dev != NULL);
715         pdev = tp->pci_dev;
716
717 #ifdef USE_IO_OPS
718         if (tp->mmio_addr)
719                 ioport_unmap (tp->mmio_addr);
720 #else
721         if (tp->mmio_addr)
722                 pci_iounmap (pdev, tp->mmio_addr);
723 #endif /* USE_IO_OPS */
724
725         /* it's ok to call this even if we have no regions to free */
726         pci_release_regions (pdev);
727
728         free_netdev(dev);
729         pci_set_drvdata (pdev, NULL);
730 }
731
732
733 static void rtl8139_chip_reset (void __iomem *ioaddr)
734 {
735         int i;
736
737         /* Soft reset the chip. */
738         RTL_W8 (ChipCmd, CmdReset);
739
740         /* Check that the chip has finished the reset. */
741         for (i = 1000; i > 0; i--) {
742                 barrier();
743                 if ((RTL_R8 (ChipCmd) & CmdReset) == 0)
744                         break;
745                 udelay (10);
746         }
747 }
748
749
750 static int __devinit rtl8139_init_board (struct pci_dev *pdev,
751                                          struct net_device **dev_out)
752 {
753         void __iomem *ioaddr;
754         struct net_device *dev;
755         struct rtl8139_private *tp;
756         u8 tmp8;
757         int rc, disable_dev_on_err = 0;
758         unsigned int i;
759         unsigned long pio_start, pio_end, pio_flags, pio_len;
760         unsigned long mmio_start, mmio_end, mmio_flags, mmio_len;
761         u32 version;
762
763         assert (pdev != NULL);
764
765         *dev_out = NULL;
766
767         /* dev and priv zeroed in alloc_etherdev */
768         dev = alloc_etherdev (sizeof (*tp));
769         if (dev == NULL) {
770                 dev_err(&pdev->dev, "Unable to alloc new net device\n");
771                 return -ENOMEM;
772         }
773         SET_MODULE_OWNER(dev);
774         SET_NETDEV_DEV(dev, &pdev->dev);
775
776         tp = netdev_priv(dev);
777         tp->pci_dev = pdev;
778
779         /* enable device (incl. PCI PM wakeup and hotplug setup) */
780         rc = pci_enable_device (pdev);
781         if (rc)
782                 goto err_out;
783
784         pio_start = pci_resource_start (pdev, 0);
785         pio_end = pci_resource_end (pdev, 0);
786         pio_flags = pci_resource_flags (pdev, 0);
787         pio_len = pci_resource_len (pdev, 0);
788
789         mmio_start = pci_resource_start (pdev, 1);
790         mmio_end = pci_resource_end (pdev, 1);
791         mmio_flags = pci_resource_flags (pdev, 1);
792         mmio_len = pci_resource_len (pdev, 1);
793
794         /* set this immediately, we need to know before
795          * we talk to the chip directly */
796         DPRINTK("PIO region size == 0x%02X\n", pio_len);
797         DPRINTK("MMIO region size == 0x%02lX\n", mmio_len);
798
799 #ifdef USE_IO_OPS
800         /* make sure PCI base addr 0 is PIO */
801         if (!(pio_flags & IORESOURCE_IO)) {
802                 dev_err(&pdev->dev, "region #0 not a PIO resource, aborting\n");
803                 rc = -ENODEV;
804                 goto err_out;
805         }
806         /* check for weird/broken PCI region reporting */
807         if (pio_len < RTL_MIN_IO_SIZE) {
808                 dev_err(&pdev->dev, "Invalid PCI I/O region size(s), aborting\n");
809                 rc = -ENODEV;
810                 goto err_out;
811         }
812 #else
813         /* make sure PCI base addr 1 is MMIO */
814         if (!(mmio_flags & IORESOURCE_MEM)) {
815                 dev_err(&pdev->dev, "region #1 not an MMIO resource, aborting\n");
816                 rc = -ENODEV;
817                 goto err_out;
818         }
819         if (mmio_len < RTL_MIN_IO_SIZE) {
820                 dev_err(&pdev->dev, "Invalid PCI mem region size(s), aborting\n");
821                 rc = -ENODEV;
822                 goto err_out;
823         }
824 #endif
825
826         rc = pci_request_regions (pdev, DRV_NAME);
827         if (rc)
828                 goto err_out;
829         disable_dev_on_err = 1;
830
831         /* enable PCI bus-mastering */
832         pci_set_master (pdev);
833
834 #ifdef USE_IO_OPS
835         ioaddr = ioport_map(pio_start, pio_len);
836         if (!ioaddr) {
837                 dev_err(&pdev->dev, "cannot map PIO, aborting\n");
838                 rc = -EIO;
839                 goto err_out;
840         }
841         dev->base_addr = pio_start;
842         tp->mmio_addr = ioaddr;
843         tp->regs_len = pio_len;
844 #else
845         /* ioremap MMIO region */
846         ioaddr = pci_iomap(pdev, 1, 0);
847         if (ioaddr == NULL) {
848                 dev_err(&pdev->dev, "cannot remap MMIO, aborting\n");
849                 rc = -EIO;
850                 goto err_out;
851         }
852         dev->base_addr = (long) ioaddr;
853         tp->mmio_addr = ioaddr;
854         tp->regs_len = mmio_len;
855 #endif /* USE_IO_OPS */
856
857         /* Bring old chips out of low-power mode. */
858         RTL_W8 (HltClk, 'R');
859
860         /* check for missing/broken hardware */
861         if (RTL_R32 (TxConfig) == 0xFFFFFFFF) {
862                 dev_err(&pdev->dev, "Chip not responding, ignoring board\n");
863                 rc = -EIO;
864                 goto err_out;
865         }
866
867         /* identify chip attached to board */
868         version = RTL_R32 (TxConfig) & HW_REVID_MASK;
869         for (i = 0; i < ARRAY_SIZE (rtl_chip_info); i++)
870                 if (version == rtl_chip_info[i].version) {
871                         tp->chipset = i;
872                         goto match;
873                 }
874
875         /* if unknown chip, assume array element #0, original RTL-8139 in this case */
876         dev_printk (KERN_DEBUG, &pdev->dev,
877                     "unknown chip version, assuming RTL-8139\n");
878         dev_printk (KERN_DEBUG, &pdev->dev,
879                     "TxConfig = 0x%lx\n", RTL_R32 (TxConfig));
880         tp->chipset = 0;
881
882 match:
883         DPRINTK ("chipset id (%d) == index %d, '%s'\n",
884                  version, i, rtl_chip_info[i].name);
885
886         if (tp->chipset >= CH_8139B) {
887                 u8 new_tmp8 = tmp8 = RTL_R8 (Config1);
888                 DPRINTK("PCI PM wakeup\n");
889                 if ((rtl_chip_info[tp->chipset].flags & HasLWake) &&
890                     (tmp8 & LWAKE))
891                         new_tmp8 &= ~LWAKE;
892                 new_tmp8 |= Cfg1_PM_Enable;
893                 if (new_tmp8 != tmp8) {
894                         RTL_W8 (Cfg9346, Cfg9346_Unlock);
895                         RTL_W8 (Config1, tmp8);
896                         RTL_W8 (Cfg9346, Cfg9346_Lock);
897                 }
898                 if (rtl_chip_info[tp->chipset].flags & HasLWake) {
899                         tmp8 = RTL_R8 (Config4);
900                         if (tmp8 & LWPTN) {
901                                 RTL_W8 (Cfg9346, Cfg9346_Unlock);
902                                 RTL_W8 (Config4, tmp8 & ~LWPTN);
903                                 RTL_W8 (Cfg9346, Cfg9346_Lock);
904                         }
905                 }
906         } else {
907                 DPRINTK("Old chip wakeup\n");
908                 tmp8 = RTL_R8 (Config1);
909                 tmp8 &= ~(SLEEP | PWRDN);
910                 RTL_W8 (Config1, tmp8);
911         }
912
913         rtl8139_chip_reset (ioaddr);
914
915         *dev_out = dev;
916         return 0;
917
918 err_out:
919         __rtl8139_cleanup_dev (dev);
920         if (disable_dev_on_err)
921                 pci_disable_device (pdev);
922         return rc;
923 }
924
925
926 static int __devinit rtl8139_init_one (struct pci_dev *pdev,
927                                        const struct pci_device_id *ent)
928 {
929         struct net_device *dev = NULL;
930         struct rtl8139_private *tp;
931         int i, addr_len, option;
932         void __iomem *ioaddr;
933         static int board_idx = -1;
934         u8 pci_rev;
935
936         assert (pdev != NULL);
937         assert (ent != NULL);
938
939         board_idx++;
940
941         /* when we're built into the kernel, the driver version message
942          * is only printed if at least one 8139 board has been found
943          */
944 #ifndef MODULE
945         {
946                 static int printed_version;
947                 if (!printed_version++)
948                         printk (KERN_INFO RTL8139_DRIVER_NAME "\n");
949         }
950 #endif
951
952         pci_read_config_byte(pdev, PCI_REVISION_ID, &pci_rev);
953
954         if (pdev->vendor == PCI_VENDOR_ID_REALTEK &&
955             pdev->device == PCI_DEVICE_ID_REALTEK_8139 && pci_rev >= 0x20) {
956                 dev_info(&pdev->dev,
957                            "This (id %04x:%04x rev %02x) is an enhanced 8139C+ chip\n",
958                            pdev->vendor, pdev->device, pci_rev);
959                 dev_info(&pdev->dev,
960                            "Use the \"8139cp\" driver for improved performance and stability.\n");
961         }
962
963         i = rtl8139_init_board (pdev, &dev);
964         if (i < 0)
965                 return i;
966
967         assert (dev != NULL);
968         tp = netdev_priv(dev);
969
970         ioaddr = tp->mmio_addr;
971         assert (ioaddr != NULL);
972
973         addr_len = read_eeprom (ioaddr, 0, 8) == 0x8129 ? 8 : 6;
974         for (i = 0; i < 3; i++)
975                 ((u16 *) (dev->dev_addr))[i] =
976                     le16_to_cpu (read_eeprom (ioaddr, i + 7, addr_len));
977         memcpy(dev->perm_addr, dev->dev_addr, dev->addr_len);
978
979         /* The Rtl8139-specific entries in the device structure. */
980         dev->open = rtl8139_open;
981         dev->hard_start_xmit = rtl8139_start_xmit;
982         dev->poll = rtl8139_poll;
983         dev->weight = 64;
984         dev->stop = rtl8139_close;
985         dev->get_stats = rtl8139_get_stats;
986         dev->set_multicast_list = rtl8139_set_rx_mode;
987         dev->do_ioctl = netdev_ioctl;
988         dev->ethtool_ops = &rtl8139_ethtool_ops;
989         dev->tx_timeout = rtl8139_tx_timeout;
990         dev->watchdog_timeo = TX_TIMEOUT;
991 #ifdef CONFIG_NET_POLL_CONTROLLER
992         dev->poll_controller = rtl8139_poll_controller;
993 #endif
994
995         /* note: the hardware is not capable of sg/csum/highdma, however
996          * through the use of skb_copy_and_csum_dev we enable these
997          * features
998          */
999         dev->features |= NETIF_F_SG | NETIF_F_HW_CSUM | NETIF_F_HIGHDMA;
1000
1001         dev->irq = pdev->irq;
1002
1003         /* tp zeroed and aligned in alloc_etherdev */
1004         tp = netdev_priv(dev);
1005
1006         /* note: tp->chipset set in rtl8139_init_board */
1007         tp->drv_flags = board_info[ent->driver_data].hw_flags;
1008         tp->mmio_addr = ioaddr;
1009         tp->msg_enable =
1010                 (debug < 0 ? RTL8139_DEF_MSG_ENABLE : ((1 << debug) - 1));
1011         spin_lock_init (&tp->lock);
1012         spin_lock_init (&tp->rx_lock);
1013         INIT_DELAYED_WORK(&tp->thread, rtl8139_thread);
1014         tp->mii.dev = dev;
1015         tp->mii.mdio_read = mdio_read;
1016         tp->mii.mdio_write = mdio_write;
1017         tp->mii.phy_id_mask = 0x3f;
1018         tp->mii.reg_num_mask = 0x1f;
1019
1020         /* dev is fully set up and ready to use now */
1021         DPRINTK("about to register device named %s (%p)...\n", dev->name, dev);
1022         i = register_netdev (dev);
1023         if (i) goto err_out;
1024
1025         pci_set_drvdata (pdev, dev);
1026
1027         printk (KERN_INFO "%s: %s at 0x%lx, "
1028                 "%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x, "
1029                 "IRQ %d\n",
1030                 dev->name,
1031                 board_info[ent->driver_data].name,
1032                 dev->base_addr,
1033                 dev->dev_addr[0], dev->dev_addr[1],
1034                 dev->dev_addr[2], dev->dev_addr[3],
1035                 dev->dev_addr[4], dev->dev_addr[5],
1036                 dev->irq);
1037
1038         printk (KERN_DEBUG "%s:  Identified 8139 chip type '%s'\n",
1039                 dev->name, rtl_chip_info[tp->chipset].name);
1040
1041         /* Find the connected MII xcvrs.
1042            Doing this in open() would allow detecting external xcvrs later, but
1043            takes too much time. */
1044 #ifdef CONFIG_8139TOO_8129
1045         if (tp->drv_flags & HAS_MII_XCVR) {
1046                 int phy, phy_idx = 0;
1047                 for (phy = 0; phy < 32 && phy_idx < sizeof(tp->phys); phy++) {
1048                         int mii_status = mdio_read(dev, phy, 1);
1049                         if (mii_status != 0xffff  &&  mii_status != 0x0000) {
1050                                 u16 advertising = mdio_read(dev, phy, 4);
1051                                 tp->phys[phy_idx++] = phy;
1052                                 printk(KERN_INFO "%s: MII transceiver %d status 0x%4.4x "
1053                                            "advertising %4.4x.\n",
1054                                            dev->name, phy, mii_status, advertising);
1055                         }
1056                 }
1057                 if (phy_idx == 0) {
1058                         printk(KERN_INFO "%s: No MII transceivers found!  Assuming SYM "
1059                                    "transceiver.\n",
1060                                    dev->name);
1061                         tp->phys[0] = 32;
1062                 }
1063         } else
1064 #endif
1065                 tp->phys[0] = 32;
1066         tp->mii.phy_id = tp->phys[0];
1067
1068         /* The lower four bits are the media type. */
1069         option = (board_idx >= MAX_UNITS) ? 0 : media[board_idx];
1070         if (option > 0) {
1071                 tp->mii.full_duplex = (option & 0x210) ? 1 : 0;
1072                 tp->default_port = option & 0xFF;
1073                 if (tp->default_port)
1074                         tp->mii.force_media = 1;
1075         }
1076         if (board_idx < MAX_UNITS  &&  full_duplex[board_idx] > 0)
1077                 tp->mii.full_duplex = full_duplex[board_idx];
1078         if (tp->mii.full_duplex) {
1079                 printk(KERN_INFO "%s: Media type forced to Full Duplex.\n", dev->name);
1080                 /* Changing the MII-advertised media because might prevent
1081                    re-connection. */
1082                 tp->mii.force_media = 1;
1083         }
1084         if (tp->default_port) {
1085                 printk(KERN_INFO "  Forcing %dMbps %s-duplex operation.\n",
1086                            (option & 0x20 ? 100 : 10),
1087                            (option & 0x10 ? "full" : "half"));
1088                 mdio_write(dev, tp->phys[0], 0,
1089                                    ((option & 0x20) ? 0x2000 : 0) |     /* 100Mbps? */
1090                                    ((option & 0x10) ? 0x0100 : 0)); /* Full duplex? */
1091         }
1092
1093         /* Put the chip into low-power mode. */
1094         if (rtl_chip_info[tp->chipset].flags & HasHltClk)
1095                 RTL_W8 (HltClk, 'H');   /* 'R' would leave the clock running. */
1096
1097         return 0;
1098
1099 err_out:
1100         __rtl8139_cleanup_dev (dev);
1101         pci_disable_device (pdev);
1102         return i;
1103 }
1104
1105
1106 static void __devexit rtl8139_remove_one (struct pci_dev *pdev)
1107 {
1108         struct net_device *dev = pci_get_drvdata (pdev);
1109
1110         assert (dev != NULL);
1111
1112         unregister_netdev (dev);
1113
1114         __rtl8139_cleanup_dev (dev);
1115         pci_disable_device (pdev);
1116 }
1117
1118
1119 /* Serial EEPROM section. */
1120
1121 /*  EEPROM_Ctrl bits. */
1122 #define EE_SHIFT_CLK    0x04    /* EEPROM shift clock. */
1123 #define EE_CS                   0x08    /* EEPROM chip select. */
1124 #define EE_DATA_WRITE   0x02    /* EEPROM chip data in. */
1125 #define EE_WRITE_0              0x00
1126 #define EE_WRITE_1              0x02
1127 #define EE_DATA_READ    0x01    /* EEPROM chip data out. */
1128 #define EE_ENB                  (0x80 | EE_CS)
1129
1130 /* Delay between EEPROM clock transitions.
1131    No extra delay is needed with 33Mhz PCI, but 66Mhz may change this.
1132  */
1133
1134 #define eeprom_delay()  (void)RTL_R32(Cfg9346)
1135
1136 /* The EEPROM commands include the alway-set leading bit. */
1137 #define EE_WRITE_CMD    (5)
1138 #define EE_READ_CMD             (6)
1139 #define EE_ERASE_CMD    (7)
1140
1141 static int __devinit read_eeprom (void __iomem *ioaddr, int location, int addr_len)
1142 {
1143         int i;
1144         unsigned retval = 0;
1145         int read_cmd = location | (EE_READ_CMD << addr_len);
1146
1147         RTL_W8 (Cfg9346, EE_ENB & ~EE_CS);
1148         RTL_W8 (Cfg9346, EE_ENB);
1149         eeprom_delay ();
1150
1151         /* Shift the read command bits out. */
1152         for (i = 4 + addr_len; i >= 0; i--) {
1153                 int dataval = (read_cmd & (1 << i)) ? EE_DATA_WRITE : 0;
1154                 RTL_W8 (Cfg9346, EE_ENB | dataval);
1155                 eeprom_delay ();
1156                 RTL_W8 (Cfg9346, EE_ENB | dataval | EE_SHIFT_CLK);
1157                 eeprom_delay ();
1158         }
1159         RTL_W8 (Cfg9346, EE_ENB);
1160         eeprom_delay ();
1161
1162         for (i = 16; i > 0; i--) {
1163                 RTL_W8 (Cfg9346, EE_ENB | EE_SHIFT_CLK);
1164                 eeprom_delay ();
1165                 retval =
1166                     (retval << 1) | ((RTL_R8 (Cfg9346) & EE_DATA_READ) ? 1 :
1167                                      0);
1168                 RTL_W8 (Cfg9346, EE_ENB);
1169                 eeprom_delay ();
1170         }
1171
1172         /* Terminate the EEPROM access. */
1173         RTL_W8 (Cfg9346, ~EE_CS);
1174         eeprom_delay ();
1175
1176         return retval;
1177 }
1178
1179 /* MII serial management: mostly bogus for now. */
1180 /* Read and write the MII management registers using software-generated
1181    serial MDIO protocol.
1182    The maximum data clock rate is 2.5 Mhz.  The minimum timing is usually
1183    met by back-to-back PCI I/O cycles, but we insert a delay to avoid
1184    "overclocking" issues. */
1185 #define MDIO_DIR                0x80
1186 #define MDIO_DATA_OUT   0x04
1187 #define MDIO_DATA_IN    0x02
1188 #define MDIO_CLK                0x01
1189 #define MDIO_WRITE0 (MDIO_DIR)
1190 #define MDIO_WRITE1 (MDIO_DIR | MDIO_DATA_OUT)
1191
1192 #define mdio_delay()    RTL_R8(Config4)
1193
1194
1195 static const char mii_2_8139_map[8] = {
1196         BasicModeCtrl,
1197         BasicModeStatus,
1198         0,
1199         0,
1200         NWayAdvert,
1201         NWayLPAR,
1202         NWayExpansion,
1203         0
1204 };
1205
1206
1207 #ifdef CONFIG_8139TOO_8129
1208 /* Syncronize the MII management interface by shifting 32 one bits out. */
1209 static void mdio_sync (void __iomem *ioaddr)
1210 {
1211         int i;
1212
1213         for (i = 32; i >= 0; i--) {
1214                 RTL_W8 (Config4, MDIO_WRITE1);
1215                 mdio_delay ();
1216                 RTL_W8 (Config4, MDIO_WRITE1 | MDIO_CLK);
1217                 mdio_delay ();
1218         }
1219 }
1220 #endif
1221
1222 static int mdio_read (struct net_device *dev, int phy_id, int location)
1223 {
1224         struct rtl8139_private *tp = netdev_priv(dev);
1225         int retval = 0;
1226 #ifdef CONFIG_8139TOO_8129
1227         void __iomem *ioaddr = tp->mmio_addr;
1228         int mii_cmd = (0xf6 << 10) | (phy_id << 5) | location;
1229         int i;
1230 #endif
1231
1232         if (phy_id > 31) {      /* Really a 8139.  Use internal registers. */
1233                 void __iomem *ioaddr = tp->mmio_addr;
1234                 return location < 8 && mii_2_8139_map[location] ?
1235                     RTL_R16 (mii_2_8139_map[location]) : 0;
1236         }
1237
1238 #ifdef CONFIG_8139TOO_8129
1239         mdio_sync (ioaddr);
1240         /* Shift the read command bits out. */
1241         for (i = 15; i >= 0; i--) {
1242                 int dataval = (mii_cmd & (1 << i)) ? MDIO_DATA_OUT : 0;
1243
1244                 RTL_W8 (Config4, MDIO_DIR | dataval);
1245                 mdio_delay ();
1246                 RTL_W8 (Config4, MDIO_DIR | dataval | MDIO_CLK);
1247                 mdio_delay ();
1248         }
1249
1250         /* Read the two transition, 16 data, and wire-idle bits. */
1251         for (i = 19; i > 0; i--) {
1252                 RTL_W8 (Config4, 0);
1253                 mdio_delay ();
1254                 retval = (retval << 1) | ((RTL_R8 (Config4) & MDIO_DATA_IN) ? 1 : 0);
1255                 RTL_W8 (Config4, MDIO_CLK);
1256                 mdio_delay ();
1257         }
1258 #endif
1259
1260         return (retval >> 1) & 0xffff;
1261 }
1262
1263
1264 static void mdio_write (struct net_device *dev, int phy_id, int location,
1265                         int value)
1266 {
1267         struct rtl8139_private *tp = netdev_priv(dev);
1268 #ifdef CONFIG_8139TOO_8129
1269         void __iomem *ioaddr = tp->mmio_addr;
1270         int mii_cmd = (0x5002 << 16) | (phy_id << 23) | (location << 18) | value;
1271         int i;
1272 #endif
1273
1274         if (phy_id > 31) {      /* Really a 8139.  Use internal registers. */
1275                 void __iomem *ioaddr = tp->mmio_addr;
1276                 if (location == 0) {
1277                         RTL_W8 (Cfg9346, Cfg9346_Unlock);
1278                         RTL_W16 (BasicModeCtrl, value);
1279                         RTL_W8 (Cfg9346, Cfg9346_Lock);
1280                 } else if (location < 8 && mii_2_8139_map[location])
1281                         RTL_W16 (mii_2_8139_map[location], value);
1282                 return;
1283         }
1284
1285 #ifdef CONFIG_8139TOO_8129
1286         mdio_sync (ioaddr);
1287
1288         /* Shift the command bits out. */
1289         for (i = 31; i >= 0; i--) {
1290                 int dataval =
1291                     (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
1292                 RTL_W8 (Config4, dataval);
1293                 mdio_delay ();
1294                 RTL_W8 (Config4, dataval | MDIO_CLK);
1295                 mdio_delay ();
1296         }
1297         /* Clear out extra bits. */
1298         for (i = 2; i > 0; i--) {
1299                 RTL_W8 (Config4, 0);
1300                 mdio_delay ();
1301                 RTL_W8 (Config4, MDIO_CLK);
1302                 mdio_delay ();
1303         }
1304 #endif
1305 }
1306
1307
1308 static int rtl8139_open (struct net_device *dev)
1309 {
1310         struct rtl8139_private *tp = netdev_priv(dev);
1311         int retval;
1312         void __iomem *ioaddr = tp->mmio_addr;
1313
1314         retval = request_irq (dev->irq, rtl8139_interrupt, IRQF_SHARED, dev->name, dev);
1315         if (retval)
1316                 return retval;
1317
1318         tp->tx_bufs = pci_alloc_consistent(tp->pci_dev, TX_BUF_TOT_LEN,
1319                                            &tp->tx_bufs_dma);
1320         tp->rx_ring = pci_alloc_consistent(tp->pci_dev, RX_BUF_TOT_LEN,
1321                                            &tp->rx_ring_dma);
1322         if (tp->tx_bufs == NULL || tp->rx_ring == NULL) {
1323                 free_irq(dev->irq, dev);
1324
1325                 if (tp->tx_bufs)
1326                         pci_free_consistent(tp->pci_dev, TX_BUF_TOT_LEN,
1327                                             tp->tx_bufs, tp->tx_bufs_dma);
1328                 if (tp->rx_ring)
1329                         pci_free_consistent(tp->pci_dev, RX_BUF_TOT_LEN,
1330                                             tp->rx_ring, tp->rx_ring_dma);
1331
1332                 return -ENOMEM;
1333
1334         }
1335
1336         tp->mii.full_duplex = tp->mii.force_media;
1337         tp->tx_flag = (TX_FIFO_THRESH << 11) & 0x003f0000;
1338
1339         rtl8139_init_ring (dev);
1340         rtl8139_hw_start (dev);
1341         netif_start_queue (dev);
1342
1343         if (netif_msg_ifup(tp))
1344                 printk(KERN_DEBUG "%s: rtl8139_open() ioaddr %#llx IRQ %d"
1345                         " GP Pins %2.2x %s-duplex.\n", dev->name,
1346                         (unsigned long long)pci_resource_start (tp->pci_dev, 1),
1347                         dev->irq, RTL_R8 (MediaStatus),
1348                         tp->mii.full_duplex ? "full" : "half");
1349
1350         rtl8139_start_thread(tp);
1351
1352         return 0;
1353 }
1354
1355
1356 static void rtl_check_media (struct net_device *dev, unsigned int init_media)
1357 {
1358         struct rtl8139_private *tp = netdev_priv(dev);
1359
1360         if (tp->phys[0] >= 0) {
1361                 mii_check_media(&tp->mii, netif_msg_link(tp), init_media);
1362         }
1363 }
1364
1365 /* Start the hardware at open or resume. */
1366 static void rtl8139_hw_start (struct net_device *dev)
1367 {
1368         struct rtl8139_private *tp = netdev_priv(dev);
1369         void __iomem *ioaddr = tp->mmio_addr;
1370         u32 i;
1371         u8 tmp;
1372
1373         /* Bring old chips out of low-power mode. */
1374         if (rtl_chip_info[tp->chipset].flags & HasHltClk)
1375                 RTL_W8 (HltClk, 'R');
1376
1377         rtl8139_chip_reset (ioaddr);
1378
1379         /* unlock Config[01234] and BMCR register writes */
1380         RTL_W8_F (Cfg9346, Cfg9346_Unlock);
1381         /* Restore our idea of the MAC address. */
1382         RTL_W32_F (MAC0 + 0, cpu_to_le32 (*(u32 *) (dev->dev_addr + 0)));
1383         RTL_W32_F (MAC0 + 4, cpu_to_le32 (*(u32 *) (dev->dev_addr + 4)));
1384
1385         /* Must enable Tx/Rx before setting transfer thresholds! */
1386         RTL_W8 (ChipCmd, CmdRxEnb | CmdTxEnb);
1387
1388         tp->rx_config = rtl8139_rx_config | AcceptBroadcast | AcceptMyPhys;
1389         RTL_W32 (RxConfig, tp->rx_config);
1390         RTL_W32 (TxConfig, rtl8139_tx_config);
1391
1392         tp->cur_rx = 0;
1393
1394         rtl_check_media (dev, 1);
1395
1396         if (tp->chipset >= CH_8139B) {
1397                 /* Disable magic packet scanning, which is enabled
1398                  * when PM is enabled in Config1.  It can be reenabled
1399                  * via ETHTOOL_SWOL if desired.  */
1400                 RTL_W8 (Config3, RTL_R8 (Config3) & ~Cfg3_Magic);
1401         }
1402
1403         DPRINTK("init buffer addresses\n");
1404
1405         /* Lock Config[01234] and BMCR register writes */
1406         RTL_W8 (Cfg9346, Cfg9346_Lock);
1407
1408         /* init Rx ring buffer DMA address */
1409         RTL_W32_F (RxBuf, tp->rx_ring_dma);
1410
1411         /* init Tx buffer DMA addresses */
1412         for (i = 0; i < NUM_TX_DESC; i++)
1413                 RTL_W32_F (TxAddr0 + (i * 4), tp->tx_bufs_dma + (tp->tx_buf[i] - tp->tx_bufs));
1414
1415         RTL_W32 (RxMissed, 0);
1416
1417         rtl8139_set_rx_mode (dev);
1418
1419         /* no early-rx interrupts */
1420         RTL_W16 (MultiIntr, RTL_R16 (MultiIntr) & MultiIntrClear);
1421
1422         /* make sure RxTx has started */
1423         tmp = RTL_R8 (ChipCmd);
1424         if ((!(tmp & CmdRxEnb)) || (!(tmp & CmdTxEnb)))
1425                 RTL_W8 (ChipCmd, CmdRxEnb | CmdTxEnb);
1426
1427         /* Enable all known interrupts by setting the interrupt mask. */
1428         RTL_W16 (IntrMask, rtl8139_intr_mask);
1429 }
1430
1431
1432 /* Initialize the Rx and Tx rings, along with various 'dev' bits. */
1433 static void rtl8139_init_ring (struct net_device *dev)
1434 {
1435         struct rtl8139_private *tp = netdev_priv(dev);
1436         int i;
1437
1438         tp->cur_rx = 0;
1439         tp->cur_tx = 0;
1440         tp->dirty_tx = 0;
1441
1442         for (i = 0; i < NUM_TX_DESC; i++)
1443                 tp->tx_buf[i] = &tp->tx_bufs[i * TX_BUF_SIZE];
1444 }
1445
1446
1447 /* This must be global for CONFIG_8139TOO_TUNE_TWISTER case */
1448 static int next_tick = 3 * HZ;
1449
1450 #ifndef CONFIG_8139TOO_TUNE_TWISTER
1451 static inline void rtl8139_tune_twister (struct net_device *dev,
1452                                   struct rtl8139_private *tp) {}
1453 #else
1454 enum TwisterParamVals {
1455         PARA78_default  = 0x78fa8388,
1456         PARA7c_default  = 0xcb38de43,   /* param[0][3] */
1457         PARA7c_xxx      = 0xcb38de43,
1458 };
1459
1460 static const unsigned long param[4][4] = {
1461         {0xcb39de43, 0xcb39ce43, 0xfb38de03, 0xcb38de43},
1462         {0xcb39de43, 0xcb39ce43, 0xcb39ce83, 0xcb39ce83},
1463         {0xcb39de43, 0xcb39ce43, 0xcb39ce83, 0xcb39ce83},
1464         {0xbb39de43, 0xbb39ce43, 0xbb39ce83, 0xbb39ce83}
1465 };
1466
1467 static void rtl8139_tune_twister (struct net_device *dev,
1468                                   struct rtl8139_private *tp)
1469 {
1470         int linkcase;
1471         void __iomem *ioaddr = tp->mmio_addr;
1472
1473         /* This is a complicated state machine to configure the "twister" for
1474            impedance/echos based on the cable length.
1475            All of this is magic and undocumented.
1476          */
1477         switch (tp->twistie) {
1478         case 1:
1479                 if (RTL_R16 (CSCR) & CSCR_LinkOKBit) {
1480                         /* We have link beat, let us tune the twister. */
1481                         RTL_W16 (CSCR, CSCR_LinkDownOffCmd);
1482                         tp->twistie = 2;        /* Change to state 2. */
1483                         next_tick = HZ / 10;
1484                 } else {
1485                         /* Just put in some reasonable defaults for when beat returns. */
1486                         RTL_W16 (CSCR, CSCR_LinkDownCmd);
1487                         RTL_W32 (FIFOTMS, 0x20);        /* Turn on cable test mode. */
1488                         RTL_W32 (PARA78, PARA78_default);
1489                         RTL_W32 (PARA7c, PARA7c_default);
1490                         tp->twistie = 0;        /* Bail from future actions. */
1491                 }
1492                 break;
1493         case 2:
1494                 /* Read how long it took to hear the echo. */
1495                 linkcase = RTL_R16 (CSCR) & CSCR_LinkStatusBits;
1496                 if (linkcase == 0x7000)
1497                         tp->twist_row = 3;
1498                 else if (linkcase == 0x3000)
1499                         tp->twist_row = 2;
1500                 else if (linkcase == 0x1000)
1501                         tp->twist_row = 1;
1502                 else
1503                         tp->twist_row = 0;
1504                 tp->twist_col = 0;
1505                 tp->twistie = 3;        /* Change to state 2. */
1506                 next_tick = HZ / 10;
1507                 break;
1508         case 3:
1509                 /* Put out four tuning parameters, one per 100msec. */
1510                 if (tp->twist_col == 0)
1511                         RTL_W16 (FIFOTMS, 0);
1512                 RTL_W32 (PARA7c, param[(int) tp->twist_row]
1513                          [(int) tp->twist_col]);
1514                 next_tick = HZ / 10;
1515                 if (++tp->twist_col >= 4) {
1516                         /* For short cables we are done.
1517                            For long cables (row == 3) check for mistune. */
1518                         tp->twistie =
1519                             (tp->twist_row == 3) ? 4 : 0;
1520                 }
1521                 break;
1522         case 4:
1523                 /* Special case for long cables: check for mistune. */
1524                 if ((RTL_R16 (CSCR) &
1525                      CSCR_LinkStatusBits) == 0x7000) {
1526                         tp->twistie = 0;
1527                         break;
1528                 } else {
1529                         RTL_W32 (PARA7c, 0xfb38de03);
1530                         tp->twistie = 5;
1531                         next_tick = HZ / 10;
1532                 }
1533                 break;
1534         case 5:
1535                 /* Retune for shorter cable (column 2). */
1536                 RTL_W32 (FIFOTMS, 0x20);
1537                 RTL_W32 (PARA78, PARA78_default);
1538                 RTL_W32 (PARA7c, PARA7c_default);
1539                 RTL_W32 (FIFOTMS, 0x00);
1540                 tp->twist_row = 2;
1541                 tp->twist_col = 0;
1542                 tp->twistie = 3;
1543                 next_tick = HZ / 10;
1544                 break;
1545
1546         default:
1547                 /* do nothing */
1548                 break;
1549         }
1550 }
1551 #endif /* CONFIG_8139TOO_TUNE_TWISTER */
1552
1553 static inline void rtl8139_thread_iter (struct net_device *dev,
1554                                  struct rtl8139_private *tp,
1555                                  void __iomem *ioaddr)
1556 {
1557         int mii_lpa;
1558
1559         mii_lpa = mdio_read (dev, tp->phys[0], MII_LPA);
1560
1561         if (!tp->mii.force_media && mii_lpa != 0xffff) {
1562                 int duplex = (mii_lpa & LPA_100FULL)
1563                     || (mii_lpa & 0x01C0) == 0x0040;
1564                 if (tp->mii.full_duplex != duplex) {
1565                         tp->mii.full_duplex = duplex;
1566
1567                         if (mii_lpa) {
1568                                 printk (KERN_INFO
1569                                         "%s: Setting %s-duplex based on MII #%d link"
1570                                         " partner ability of %4.4x.\n",
1571                                         dev->name,
1572                                         tp->mii.full_duplex ? "full" : "half",
1573                                         tp->phys[0], mii_lpa);
1574                         } else {
1575                                 printk(KERN_INFO"%s: media is unconnected, link down, or incompatible connection\n",
1576                                        dev->name);
1577                         }
1578 #if 0
1579                         RTL_W8 (Cfg9346, Cfg9346_Unlock);
1580                         RTL_W8 (Config1, tp->mii.full_duplex ? 0x60 : 0x20);
1581                         RTL_W8 (Cfg9346, Cfg9346_Lock);
1582 #endif
1583                 }
1584         }
1585
1586         next_tick = HZ * 60;
1587
1588         rtl8139_tune_twister (dev, tp);
1589
1590         DPRINTK ("%s: Media selection tick, Link partner %4.4x.\n",
1591                  dev->name, RTL_R16 (NWayLPAR));
1592         DPRINTK ("%s:  Other registers are IntMask %4.4x IntStatus %4.4x\n",
1593                  dev->name, RTL_R16 (IntrMask), RTL_R16 (IntrStatus));
1594         DPRINTK ("%s:  Chip config %2.2x %2.2x.\n",
1595                  dev->name, RTL_R8 (Config0),
1596                  RTL_R8 (Config1));
1597 }
1598
1599 static void rtl8139_thread (struct work_struct *work)
1600 {
1601         struct rtl8139_private *tp =
1602                 container_of(work, struct rtl8139_private, thread.work);
1603         struct net_device *dev = tp->mii.dev;
1604         unsigned long thr_delay = next_tick;
1605
1606         if (tp->watchdog_fired) {
1607                 tp->watchdog_fired = 0;
1608                 rtl8139_tx_timeout_task(work);
1609         } else if (rtnl_trylock()) {
1610                 rtl8139_thread_iter (dev, tp, tp->mmio_addr);
1611                 rtnl_unlock ();
1612         } else {
1613                 /* unlikely race.  mitigate with fast poll. */
1614                 thr_delay = HZ / 2;
1615         }
1616
1617         schedule_delayed_work(&tp->thread, thr_delay);
1618 }
1619
1620 static void rtl8139_start_thread(struct rtl8139_private *tp)
1621 {
1622         tp->twistie = 0;
1623         if (tp->chipset == CH_8139_K)
1624                 tp->twistie = 1;
1625         else if (tp->drv_flags & HAS_LNK_CHNG)
1626                 return;
1627
1628         tp->have_thread = 1;
1629
1630         schedule_delayed_work(&tp->thread, next_tick);
1631 }
1632
1633 static void rtl8139_stop_thread(struct rtl8139_private *tp)
1634 {
1635         if (tp->have_thread) {
1636                 cancel_rearming_delayed_work(&tp->thread);
1637                 tp->have_thread = 0;
1638         } else
1639                 flush_scheduled_work();
1640 }
1641
1642 static inline void rtl8139_tx_clear (struct rtl8139_private *tp)
1643 {
1644         tp->cur_tx = 0;
1645         tp->dirty_tx = 0;
1646
1647         /* XXX account for unsent Tx packets in tp->stats.tx_dropped */
1648 }
1649
1650 static void rtl8139_tx_timeout_task (struct work_struct *work)
1651 {
1652         struct rtl8139_private *tp =
1653                 container_of(work, struct rtl8139_private, thread.work);
1654         struct net_device *dev = tp->mii.dev;
1655         void __iomem *ioaddr = tp->mmio_addr;
1656         int i;
1657         u8 tmp8;
1658
1659         printk (KERN_DEBUG "%s: Transmit timeout, status %2.2x %4.4x %4.4x "
1660                 "media %2.2x.\n", dev->name, RTL_R8 (ChipCmd),
1661                 RTL_R16(IntrStatus), RTL_R16(IntrMask), RTL_R8(MediaStatus));
1662         /* Emit info to figure out what went wrong. */
1663         printk (KERN_DEBUG "%s: Tx queue start entry %ld  dirty entry %ld.\n",
1664                 dev->name, tp->cur_tx, tp->dirty_tx);
1665         for (i = 0; i < NUM_TX_DESC; i++)
1666                 printk (KERN_DEBUG "%s:  Tx descriptor %d is %8.8lx.%s\n",
1667                         dev->name, i, RTL_R32 (TxStatus0 + (i * 4)),
1668                         i == tp->dirty_tx % NUM_TX_DESC ?
1669                                 " (queue head)" : "");
1670
1671         tp->xstats.tx_timeouts++;
1672
1673         /* disable Tx ASAP, if not already */
1674         tmp8 = RTL_R8 (ChipCmd);
1675         if (tmp8 & CmdTxEnb)
1676                 RTL_W8 (ChipCmd, CmdRxEnb);
1677
1678         spin_lock_bh(&tp->rx_lock);
1679         /* Disable interrupts by clearing the interrupt mask. */
1680         RTL_W16 (IntrMask, 0x0000);
1681
1682         /* Stop a shared interrupt from scavenging while we are. */
1683         spin_lock_irq(&tp->lock);
1684         rtl8139_tx_clear (tp);
1685         spin_unlock_irq(&tp->lock);
1686
1687         /* ...and finally, reset everything */
1688         if (netif_running(dev)) {
1689                 rtl8139_hw_start (dev);
1690                 netif_wake_queue (dev);
1691         }
1692         spin_unlock_bh(&tp->rx_lock);
1693 }
1694
1695 static void rtl8139_tx_timeout (struct net_device *dev)
1696 {
1697         struct rtl8139_private *tp = netdev_priv(dev);
1698
1699         if (!tp->have_thread) {
1700                 INIT_DELAYED_WORK(&tp->thread, rtl8139_tx_timeout_task);
1701                 schedule_delayed_work(&tp->thread, next_tick);
1702         } else
1703                 tp->watchdog_fired = 1;
1704
1705 }
1706
1707 static int rtl8139_start_xmit (struct sk_buff *skb, struct net_device *dev)
1708 {
1709         struct rtl8139_private *tp = netdev_priv(dev);
1710         void __iomem *ioaddr = tp->mmio_addr;
1711         unsigned int entry;
1712         unsigned int len = skb->len;
1713         unsigned long flags;
1714
1715         /* Calculate the next Tx descriptor entry. */
1716         entry = tp->cur_tx % NUM_TX_DESC;
1717
1718         /* Note: the chip doesn't have auto-pad! */
1719         if (likely(len < TX_BUF_SIZE)) {
1720                 if (len < ETH_ZLEN)
1721                         memset(tp->tx_buf[entry], 0, ETH_ZLEN);
1722                 skb_copy_and_csum_dev(skb, tp->tx_buf[entry]);
1723                 dev_kfree_skb(skb);
1724         } else {
1725                 dev_kfree_skb(skb);
1726                 tp->stats.tx_dropped++;
1727                 return 0;
1728         }
1729
1730         spin_lock_irqsave(&tp->lock, flags);
1731         RTL_W32_F (TxStatus0 + (entry * sizeof (u32)),
1732                    tp->tx_flag | max(len, (unsigned int)ETH_ZLEN));
1733
1734         dev->trans_start = jiffies;
1735
1736         tp->cur_tx++;
1737         wmb();
1738
1739         if ((tp->cur_tx - NUM_TX_DESC) == tp->dirty_tx)
1740                 netif_stop_queue (dev);
1741         spin_unlock_irqrestore(&tp->lock, flags);
1742
1743         if (netif_msg_tx_queued(tp))
1744                 printk (KERN_DEBUG "%s: Queued Tx packet size %u to slot %d.\n",
1745                         dev->name, len, entry);
1746
1747         return 0;
1748 }
1749
1750
1751 static void rtl8139_tx_interrupt (struct net_device *dev,
1752                                   struct rtl8139_private *tp,
1753                                   void __iomem *ioaddr)
1754 {
1755         unsigned long dirty_tx, tx_left;
1756
1757         assert (dev != NULL);
1758         assert (ioaddr != NULL);
1759
1760         dirty_tx = tp->dirty_tx;
1761         tx_left = tp->cur_tx - dirty_tx;
1762         while (tx_left > 0) {
1763                 int entry = dirty_tx % NUM_TX_DESC;
1764                 int txstatus;
1765
1766                 txstatus = RTL_R32 (TxStatus0 + (entry * sizeof (u32)));
1767
1768                 if (!(txstatus & (TxStatOK | TxUnderrun | TxAborted)))
1769                         break;  /* It still hasn't been Txed */
1770
1771                 /* Note: TxCarrierLost is always asserted at 100mbps. */
1772                 if (txstatus & (TxOutOfWindow | TxAborted)) {
1773                         /* There was an major error, log it. */
1774                         if (netif_msg_tx_err(tp))
1775                                 printk(KERN_DEBUG "%s: Transmit error, Tx status %8.8x.\n",
1776                                         dev->name, txstatus);
1777                         tp->stats.tx_errors++;
1778                         if (txstatus & TxAborted) {
1779                                 tp->stats.tx_aborted_errors++;
1780                                 RTL_W32 (TxConfig, TxClearAbt);
1781                                 RTL_W16 (IntrStatus, TxErr);
1782                                 wmb();
1783                         }
1784                         if (txstatus & TxCarrierLost)
1785                                 tp->stats.tx_carrier_errors++;
1786                         if (txstatus & TxOutOfWindow)
1787                                 tp->stats.tx_window_errors++;
1788                 } else {
1789                         if (txstatus & TxUnderrun) {
1790                                 /* Add 64 to the Tx FIFO threshold. */
1791                                 if (tp->tx_flag < 0x00300000)
1792                                         tp->tx_flag += 0x00020000;
1793                                 tp->stats.tx_fifo_errors++;
1794                         }
1795                         tp->stats.collisions += (txstatus >> 24) & 15;
1796                         tp->stats.tx_bytes += txstatus & 0x7ff;
1797                         tp->stats.tx_packets++;
1798                 }
1799
1800                 dirty_tx++;
1801                 tx_left--;
1802         }
1803
1804 #ifndef RTL8139_NDEBUG
1805         if (tp->cur_tx - dirty_tx > NUM_TX_DESC) {
1806                 printk (KERN_ERR "%s: Out-of-sync dirty pointer, %ld vs. %ld.\n",
1807                         dev->name, dirty_tx, tp->cur_tx);
1808                 dirty_tx += NUM_TX_DESC;
1809         }
1810 #endif /* RTL8139_NDEBUG */
1811
1812         /* only wake the queue if we did work, and the queue is stopped */
1813         if (tp->dirty_tx != dirty_tx) {
1814                 tp->dirty_tx = dirty_tx;
1815                 mb();
1816                 netif_wake_queue (dev);
1817         }
1818 }
1819
1820
1821 /* TODO: clean this up!  Rx reset need not be this intensive */
1822 static void rtl8139_rx_err (u32 rx_status, struct net_device *dev,
1823                             struct rtl8139_private *tp, void __iomem *ioaddr)
1824 {
1825         u8 tmp8;
1826 #ifdef CONFIG_8139_OLD_RX_RESET
1827         int tmp_work;
1828 #endif
1829
1830         if (netif_msg_rx_err (tp))
1831                 printk(KERN_DEBUG "%s: Ethernet frame had errors, status %8.8x.\n",
1832                         dev->name, rx_status);
1833         tp->stats.rx_errors++;
1834         if (!(rx_status & RxStatusOK)) {
1835                 if (rx_status & RxTooLong) {
1836                         DPRINTK ("%s: Oversized Ethernet frame, status %4.4x!\n",
1837                                 dev->name, rx_status);
1838                         /* A.C.: The chip hangs here. */
1839                 }
1840                 if (rx_status & (RxBadSymbol | RxBadAlign))
1841                         tp->stats.rx_frame_errors++;
1842                 if (rx_status & (RxRunt | RxTooLong))
1843                         tp->stats.rx_length_errors++;
1844                 if (rx_status & RxCRCErr)
1845                         tp->stats.rx_crc_errors++;
1846         } else {
1847                 tp->xstats.rx_lost_in_ring++;
1848         }
1849
1850 #ifndef CONFIG_8139_OLD_RX_RESET
1851         tmp8 = RTL_R8 (ChipCmd);
1852         RTL_W8 (ChipCmd, tmp8 & ~CmdRxEnb);
1853         RTL_W8 (ChipCmd, tmp8);
1854         RTL_W32 (RxConfig, tp->rx_config);
1855         tp->cur_rx = 0;
1856 #else
1857         /* Reset the receiver, based on RealTek recommendation. (Bug?) */
1858
1859         /* disable receive */
1860         RTL_W8_F (ChipCmd, CmdTxEnb);
1861         tmp_work = 200;
1862         while (--tmp_work > 0) {
1863                 udelay(1);
1864                 tmp8 = RTL_R8 (ChipCmd);
1865                 if (!(tmp8 & CmdRxEnb))
1866                         break;
1867         }
1868         if (tmp_work <= 0)
1869                 printk (KERN_WARNING PFX "rx stop wait too long\n");
1870         /* restart receive */
1871         tmp_work = 200;
1872         while (--tmp_work > 0) {
1873                 RTL_W8_F (ChipCmd, CmdRxEnb | CmdTxEnb);
1874                 udelay(1);
1875                 tmp8 = RTL_R8 (ChipCmd);
1876                 if ((tmp8 & CmdRxEnb) && (tmp8 & CmdTxEnb))
1877                         break;
1878         }
1879         if (tmp_work <= 0)
1880                 printk (KERN_WARNING PFX "tx/rx enable wait too long\n");
1881
1882         /* and reinitialize all rx related registers */
1883         RTL_W8_F (Cfg9346, Cfg9346_Unlock);
1884         /* Must enable Tx/Rx before setting transfer thresholds! */
1885         RTL_W8 (ChipCmd, CmdRxEnb | CmdTxEnb);
1886
1887         tp->rx_config = rtl8139_rx_config | AcceptBroadcast | AcceptMyPhys;
1888         RTL_W32 (RxConfig, tp->rx_config);
1889         tp->cur_rx = 0;
1890
1891         DPRINTK("init buffer addresses\n");
1892
1893         /* Lock Config[01234] and BMCR register writes */
1894         RTL_W8 (Cfg9346, Cfg9346_Lock);
1895
1896         /* init Rx ring buffer DMA address */
1897         RTL_W32_F (RxBuf, tp->rx_ring_dma);
1898
1899         /* A.C.: Reset the multicast list. */
1900         __set_rx_mode (dev);
1901 #endif
1902 }
1903
1904 #if RX_BUF_IDX == 3
1905 static __inline__ void wrap_copy(struct sk_buff *skb, const unsigned char *ring,
1906                                  u32 offset, unsigned int size)
1907 {
1908         u32 left = RX_BUF_LEN - offset;
1909
1910         if (size > left) {
1911                 memcpy(skb->data, ring + offset, left);
1912                 memcpy(skb->data+left, ring, size - left);
1913         } else
1914                 memcpy(skb->data, ring + offset, size);
1915 }
1916 #endif
1917
1918 static void rtl8139_isr_ack(struct rtl8139_private *tp)
1919 {
1920         void __iomem *ioaddr = tp->mmio_addr;
1921         u16 status;
1922
1923         status = RTL_R16 (IntrStatus) & RxAckBits;
1924
1925         /* Clear out errors and receive interrupts */
1926         if (likely(status != 0)) {
1927                 if (unlikely(status & (RxFIFOOver | RxOverflow))) {
1928                         tp->stats.rx_errors++;
1929                         if (status & RxFIFOOver)
1930                                 tp->stats.rx_fifo_errors++;
1931                 }
1932                 RTL_W16_F (IntrStatus, RxAckBits);
1933         }
1934 }
1935
1936 static int rtl8139_rx(struct net_device *dev, struct rtl8139_private *tp,
1937                       int budget)
1938 {
1939         void __iomem *ioaddr = tp->mmio_addr;
1940         int received = 0;
1941         unsigned char *rx_ring = tp->rx_ring;
1942         unsigned int cur_rx = tp->cur_rx;
1943         unsigned int rx_size = 0;
1944
1945         DPRINTK ("%s: In rtl8139_rx(), current %4.4x BufAddr %4.4x,"
1946                  " free to %4.4x, Cmd %2.2x.\n", dev->name, (u16)cur_rx,
1947                  RTL_R16 (RxBufAddr),
1948                  RTL_R16 (RxBufPtr), RTL_R8 (ChipCmd));
1949
1950         while (netif_running(dev) && received < budget
1951                && (RTL_R8 (ChipCmd) & RxBufEmpty) == 0) {
1952                 u32 ring_offset = cur_rx % RX_BUF_LEN;
1953                 u32 rx_status;
1954                 unsigned int pkt_size;
1955                 struct sk_buff *skb;
1956
1957                 rmb();
1958
1959                 /* read size+status of next frame from DMA ring buffer */
1960                 rx_status = le32_to_cpu (*(u32 *) (rx_ring + ring_offset));
1961                 rx_size = rx_status >> 16;
1962                 pkt_size = rx_size - 4;
1963
1964                 if (netif_msg_rx_status(tp))
1965                         printk(KERN_DEBUG "%s:  rtl8139_rx() status %4.4x, size %4.4x,"
1966                                 " cur %4.4x.\n", dev->name, rx_status,
1967                          rx_size, cur_rx);
1968 #if RTL8139_DEBUG > 2
1969                 {
1970                         int i;
1971                         DPRINTK ("%s: Frame contents ", dev->name);
1972                         for (i = 0; i < 70; i++)
1973                                 printk (" %2.2x",
1974                                         rx_ring[ring_offset + i]);
1975                         printk (".\n");
1976                 }
1977 #endif
1978
1979                 /* Packet copy from FIFO still in progress.
1980                  * Theoretically, this should never happen
1981                  * since EarlyRx is disabled.
1982                  */
1983                 if (unlikely(rx_size == 0xfff0)) {
1984                         if (!tp->fifo_copy_timeout)
1985                                 tp->fifo_copy_timeout = jiffies + 2;
1986                         else if (time_after(jiffies, tp->fifo_copy_timeout)) {
1987                                 DPRINTK ("%s: hung FIFO. Reset.", dev->name);
1988                                 rx_size = 0;
1989                                 goto no_early_rx;
1990                         }
1991                         if (netif_msg_intr(tp)) {
1992                                 printk(KERN_DEBUG "%s: fifo copy in progress.",
1993                                        dev->name);
1994                         }
1995                         tp->xstats.early_rx++;
1996                         break;
1997                 }
1998
1999 no_early_rx:
2000                 tp->fifo_copy_timeout = 0;
2001
2002                 /* If Rx err or invalid rx_size/rx_status received
2003                  * (which happens if we get lost in the ring),
2004                  * Rx process gets reset, so we abort any further
2005                  * Rx processing.
2006                  */
2007                 if (unlikely((rx_size > (MAX_ETH_FRAME_SIZE+4)) ||
2008                              (rx_size < 8) ||
2009                              (!(rx_status & RxStatusOK)))) {
2010                         rtl8139_rx_err (rx_status, dev, tp, ioaddr);
2011                         received = -1;
2012                         goto out;
2013                 }
2014
2015                 /* Malloc up new buffer, compatible with net-2e. */
2016                 /* Omit the four octet CRC from the length. */
2017
2018                 skb = dev_alloc_skb (pkt_size + 2);
2019                 if (likely(skb)) {
2020                         skb->dev = dev;
2021                         skb_reserve (skb, 2);   /* 16 byte align the IP fields. */
2022 #if RX_BUF_IDX == 3
2023                         wrap_copy(skb, rx_ring, ring_offset+4, pkt_size);
2024 #else
2025                         eth_copy_and_sum (skb, &rx_ring[ring_offset + 4], pkt_size, 0);
2026 #endif
2027                         skb_put (skb, pkt_size);
2028
2029                         skb->protocol = eth_type_trans (skb, dev);
2030
2031                         dev->last_rx = jiffies;
2032                         tp->stats.rx_bytes += pkt_size;
2033                         tp->stats.rx_packets++;
2034
2035                         netif_receive_skb (skb);
2036                 } else {
2037                         if (net_ratelimit())
2038                                 printk (KERN_WARNING
2039                                         "%s: Memory squeeze, dropping packet.\n",
2040                                         dev->name);
2041                         tp->stats.rx_dropped++;
2042                 }
2043                 received++;
2044
2045                 cur_rx = (cur_rx + rx_size + 4 + 3) & ~3;
2046                 RTL_W16 (RxBufPtr, (u16) (cur_rx - 16));
2047
2048                 rtl8139_isr_ack(tp);
2049         }
2050
2051         if (unlikely(!received || rx_size == 0xfff0))
2052                 rtl8139_isr_ack(tp);
2053
2054 #if RTL8139_DEBUG > 1
2055         DPRINTK ("%s: Done rtl8139_rx(), current %4.4x BufAddr %4.4x,"
2056                  " free to %4.4x, Cmd %2.2x.\n", dev->name, cur_rx,
2057                  RTL_R16 (RxBufAddr),
2058                  RTL_R16 (RxBufPtr), RTL_R8 (ChipCmd));
2059 #endif
2060
2061         tp->cur_rx = cur_rx;
2062
2063         /*
2064          * The receive buffer should be mostly empty.
2065          * Tell NAPI to reenable the Rx irq.
2066          */
2067         if (tp->fifo_copy_timeout)
2068                 received = budget;
2069
2070 out:
2071         return received;
2072 }
2073
2074
2075 static void rtl8139_weird_interrupt (struct net_device *dev,
2076                                      struct rtl8139_private *tp,
2077                                      void __iomem *ioaddr,
2078                                      int status, int link_changed)
2079 {
2080         DPRINTK ("%s: Abnormal interrupt, status %8.8x.\n",
2081                  dev->name, status);
2082
2083         assert (dev != NULL);
2084         assert (tp != NULL);
2085         assert (ioaddr != NULL);
2086
2087         /* Update the error count. */
2088         tp->stats.rx_missed_errors += RTL_R32 (RxMissed);
2089         RTL_W32 (RxMissed, 0);
2090
2091         if ((status & RxUnderrun) && link_changed &&
2092             (tp->drv_flags & HAS_LNK_CHNG)) {
2093                 rtl_check_media(dev, 0);
2094                 status &= ~RxUnderrun;
2095         }
2096
2097         if (status & (RxUnderrun | RxErr))
2098                 tp->stats.rx_errors++;
2099
2100         if (status & PCSTimeout)
2101                 tp->stats.rx_length_errors++;
2102         if (status & RxUnderrun)
2103                 tp->stats.rx_fifo_errors++;
2104         if (status & PCIErr) {
2105                 u16 pci_cmd_status;
2106                 pci_read_config_word (tp->pci_dev, PCI_STATUS, &pci_cmd_status);
2107                 pci_write_config_word (tp->pci_dev, PCI_STATUS, pci_cmd_status);
2108
2109                 printk (KERN_ERR "%s: PCI Bus error %4.4x.\n",
2110                         dev->name, pci_cmd_status);
2111         }
2112 }
2113
2114 static int rtl8139_poll(struct net_device *dev, int *budget)
2115 {
2116         struct rtl8139_private *tp = netdev_priv(dev);
2117         void __iomem *ioaddr = tp->mmio_addr;
2118         int orig_budget = min(*budget, dev->quota);
2119         int done = 1;
2120
2121         spin_lock(&tp->rx_lock);
2122         if (likely(RTL_R16(IntrStatus) & RxAckBits)) {
2123                 int work_done;
2124
2125                 work_done = rtl8139_rx(dev, tp, orig_budget);
2126                 if (likely(work_done > 0)) {
2127                         *budget -= work_done;
2128                         dev->quota -= work_done;
2129                         done = (work_done < orig_budget);
2130                 }
2131         }
2132
2133         if (done) {
2134                 /*
2135                  * Order is important since data can get interrupted
2136                  * again when we think we are done.
2137                  */
2138                 local_irq_disable();
2139                 RTL_W16_F(IntrMask, rtl8139_intr_mask);
2140                 __netif_rx_complete(dev);
2141                 local_irq_enable();
2142         }
2143         spin_unlock(&tp->rx_lock);
2144
2145         return !done;
2146 }
2147
2148 /* The interrupt handler does all of the Rx thread work and cleans up
2149    after the Tx thread. */
2150 static irqreturn_t rtl8139_interrupt (int irq, void *dev_instance)
2151 {
2152         struct net_device *dev = (struct net_device *) dev_instance;
2153         struct rtl8139_private *tp = netdev_priv(dev);
2154         void __iomem *ioaddr = tp->mmio_addr;
2155         u16 status, ackstat;
2156         int link_changed = 0; /* avoid bogus "uninit" warning */
2157         int handled = 0;
2158
2159         spin_lock (&tp->lock);
2160         status = RTL_R16 (IntrStatus);
2161
2162         /* shared irq? */
2163         if (unlikely((status & rtl8139_intr_mask) == 0))
2164                 goto out;
2165
2166         handled = 1;
2167
2168         /* h/w no longer present (hotplug?) or major error, bail */
2169         if (unlikely(status == 0xFFFF))
2170                 goto out;
2171
2172         /* close possible race's with dev_close */
2173         if (unlikely(!netif_running(dev))) {
2174                 RTL_W16 (IntrMask, 0);
2175                 goto out;
2176         }
2177
2178         /* Acknowledge all of the current interrupt sources ASAP, but
2179            an first get an additional status bit from CSCR. */
2180         if (unlikely(status & RxUnderrun))
2181                 link_changed = RTL_R16 (CSCR) & CSCR_LinkChangeBit;
2182
2183         ackstat = status & ~(RxAckBits | TxErr);
2184         if (ackstat)
2185                 RTL_W16 (IntrStatus, ackstat);
2186
2187         /* Receive packets are processed by poll routine.
2188            If not running start it now. */
2189         if (status & RxAckBits){
2190                 if (netif_rx_schedule_prep(dev)) {
2191                         RTL_W16_F (IntrMask, rtl8139_norx_intr_mask);
2192                         __netif_rx_schedule (dev);
2193                 }
2194         }
2195
2196         /* Check uncommon events with one test. */
2197         if (unlikely(status & (PCIErr | PCSTimeout | RxUnderrun | RxErr)))
2198                 rtl8139_weird_interrupt (dev, tp, ioaddr,
2199                                          status, link_changed);
2200
2201         if (status & (TxOK | TxErr)) {
2202                 rtl8139_tx_interrupt (dev, tp, ioaddr);
2203                 if (status & TxErr)
2204                         RTL_W16 (IntrStatus, TxErr);
2205         }
2206  out:
2207         spin_unlock (&tp->lock);
2208
2209         DPRINTK ("%s: exiting interrupt, intr_status=%#4.4x.\n",
2210                  dev->name, RTL_R16 (IntrStatus));
2211         return IRQ_RETVAL(handled);
2212 }
2213
2214 #ifdef CONFIG_NET_POLL_CONTROLLER
2215 /*
2216  * Polling receive - used by netconsole and other diagnostic tools
2217  * to allow network i/o with interrupts disabled.
2218  */
2219 static void rtl8139_poll_controller(struct net_device *dev)
2220 {
2221         disable_irq(dev->irq);
2222         rtl8139_interrupt(dev->irq, dev);
2223         enable_irq(dev->irq);
2224 }
2225 #endif
2226
2227 static int rtl8139_close (struct net_device *dev)
2228 {
2229         struct rtl8139_private *tp = netdev_priv(dev);
2230         void __iomem *ioaddr = tp->mmio_addr;
2231         unsigned long flags;
2232
2233         netif_stop_queue (dev);
2234
2235         rtl8139_stop_thread(tp);
2236
2237         if (netif_msg_ifdown(tp))
2238                 printk(KERN_DEBUG "%s: Shutting down ethercard, status was 0x%4.4x.\n",
2239                         dev->name, RTL_R16 (IntrStatus));
2240
2241         spin_lock_irqsave (&tp->lock, flags);
2242
2243         /* Stop the chip's Tx and Rx DMA processes. */
2244         RTL_W8 (ChipCmd, 0);
2245
2246         /* Disable interrupts by clearing the interrupt mask. */
2247         RTL_W16 (IntrMask, 0);
2248
2249         /* Update the error counts. */
2250         tp->stats.rx_missed_errors += RTL_R32 (RxMissed);
2251         RTL_W32 (RxMissed, 0);
2252
2253         spin_unlock_irqrestore (&tp->lock, flags);
2254
2255         synchronize_irq (dev->irq);     /* racy, but that's ok here */
2256         free_irq (dev->irq, dev);
2257
2258         rtl8139_tx_clear (tp);
2259
2260         pci_free_consistent(tp->pci_dev, RX_BUF_TOT_LEN,
2261                             tp->rx_ring, tp->rx_ring_dma);
2262         pci_free_consistent(tp->pci_dev, TX_BUF_TOT_LEN,
2263                             tp->tx_bufs, tp->tx_bufs_dma);
2264         tp->rx_ring = NULL;
2265         tp->tx_bufs = NULL;
2266
2267         /* Green! Put the chip in low-power mode. */
2268         RTL_W8 (Cfg9346, Cfg9346_Unlock);
2269
2270         if (rtl_chip_info[tp->chipset].flags & HasHltClk)
2271                 RTL_W8 (HltClk, 'H');   /* 'R' would leave the clock running. */
2272
2273         return 0;
2274 }
2275
2276
2277 /* Get the ethtool Wake-on-LAN settings.  Assumes that wol points to
2278    kernel memory, *wol has been initialized as {ETHTOOL_GWOL}, and
2279    other threads or interrupts aren't messing with the 8139.  */
2280 static void rtl8139_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
2281 {
2282         struct rtl8139_private *np = netdev_priv(dev);
2283         void __iomem *ioaddr = np->mmio_addr;
2284
2285         spin_lock_irq(&np->lock);
2286         if (rtl_chip_info[np->chipset].flags & HasLWake) {
2287                 u8 cfg3 = RTL_R8 (Config3);
2288                 u8 cfg5 = RTL_R8 (Config5);
2289
2290                 wol->supported = WAKE_PHY | WAKE_MAGIC
2291                         | WAKE_UCAST | WAKE_MCAST | WAKE_BCAST;
2292
2293                 wol->wolopts = 0;
2294                 if (cfg3 & Cfg3_LinkUp)
2295                         wol->wolopts |= WAKE_PHY;
2296                 if (cfg3 & Cfg3_Magic)
2297                         wol->wolopts |= WAKE_MAGIC;
2298                 /* (KON)FIXME: See how netdev_set_wol() handles the
2299                    following constants.  */
2300                 if (cfg5 & Cfg5_UWF)
2301                         wol->wolopts |= WAKE_UCAST;
2302                 if (cfg5 & Cfg5_MWF)
2303                         wol->wolopts |= WAKE_MCAST;
2304                 if (cfg5 & Cfg5_BWF)
2305                         wol->wolopts |= WAKE_BCAST;
2306         }
2307         spin_unlock_irq(&np->lock);
2308 }
2309
2310
2311 /* Set the ethtool Wake-on-LAN settings.  Return 0 or -errno.  Assumes
2312    that wol points to kernel memory and other threads or interrupts
2313    aren't messing with the 8139.  */
2314 static int rtl8139_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
2315 {
2316         struct rtl8139_private *np = netdev_priv(dev);
2317         void __iomem *ioaddr = np->mmio_addr;
2318         u32 support;
2319         u8 cfg3, cfg5;
2320
2321         support = ((rtl_chip_info[np->chipset].flags & HasLWake)
2322                    ? (WAKE_PHY | WAKE_MAGIC
2323                       | WAKE_UCAST | WAKE_MCAST | WAKE_BCAST)
2324                    : 0);
2325         if (wol->wolopts & ~support)
2326                 return -EINVAL;
2327
2328         spin_lock_irq(&np->lock);
2329         cfg3 = RTL_R8 (Config3) & ~(Cfg3_LinkUp | Cfg3_Magic);
2330         if (wol->wolopts & WAKE_PHY)
2331                 cfg3 |= Cfg3_LinkUp;
2332         if (wol->wolopts & WAKE_MAGIC)
2333                 cfg3 |= Cfg3_Magic;
2334         RTL_W8 (Cfg9346, Cfg9346_Unlock);
2335         RTL_W8 (Config3, cfg3);
2336         RTL_W8 (Cfg9346, Cfg9346_Lock);
2337
2338         cfg5 = RTL_R8 (Config5) & ~(Cfg5_UWF | Cfg5_MWF | Cfg5_BWF);
2339         /* (KON)FIXME: These are untested.  We may have to set the
2340            CRC0, Wakeup0 and LSBCRC0 registers too, but I have no
2341            documentation.  */
2342         if (wol->wolopts & WAKE_UCAST)
2343                 cfg5 |= Cfg5_UWF;
2344         if (wol->wolopts & WAKE_MCAST)
2345                 cfg5 |= Cfg5_MWF;
2346         if (wol->wolopts & WAKE_BCAST)
2347                 cfg5 |= Cfg5_BWF;
2348         RTL_W8 (Config5, cfg5); /* need not unlock via Cfg9346 */
2349         spin_unlock_irq(&np->lock);
2350
2351         return 0;
2352 }
2353
2354 static void rtl8139_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
2355 {
2356         struct rtl8139_private *np = netdev_priv(dev);
2357         strcpy(info->driver, DRV_NAME);
2358         strcpy(info->version, DRV_VERSION);
2359         strcpy(info->bus_info, pci_name(np->pci_dev));
2360         info->regdump_len = np->regs_len;
2361 }
2362
2363 static int rtl8139_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
2364 {
2365         struct rtl8139_private *np = netdev_priv(dev);
2366         spin_lock_irq(&np->lock);
2367         mii_ethtool_gset(&np->mii, cmd);
2368         spin_unlock_irq(&np->lock);
2369         return 0;
2370 }
2371
2372 static int rtl8139_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
2373 {
2374         struct rtl8139_private *np = netdev_priv(dev);
2375         int rc;
2376         spin_lock_irq(&np->lock);
2377         rc = mii_ethtool_sset(&np->mii, cmd);
2378         spin_unlock_irq(&np->lock);
2379         return rc;
2380 }
2381
2382 static int rtl8139_nway_reset(struct net_device *dev)
2383 {
2384         struct rtl8139_private *np = netdev_priv(dev);
2385         return mii_nway_restart(&np->mii);
2386 }
2387
2388 static u32 rtl8139_get_link(struct net_device *dev)
2389 {
2390         struct rtl8139_private *np = netdev_priv(dev);
2391         return mii_link_ok(&np->mii);
2392 }
2393
2394 static u32 rtl8139_get_msglevel(struct net_device *dev)
2395 {
2396         struct rtl8139_private *np = netdev_priv(dev);
2397         return np->msg_enable;
2398 }
2399
2400 static void rtl8139_set_msglevel(struct net_device *dev, u32 datum)
2401 {
2402         struct rtl8139_private *np = netdev_priv(dev);
2403         np->msg_enable = datum;
2404 }
2405
2406 /* TODO: we are too slack to do reg dumping for pio, for now */
2407 #ifdef CONFIG_8139TOO_PIO
2408 #define rtl8139_get_regs_len    NULL
2409 #define rtl8139_get_regs        NULL
2410 #else
2411 static int rtl8139_get_regs_len(struct net_device *dev)
2412 {
2413         struct rtl8139_private *np = netdev_priv(dev);
2414         return np->regs_len;
2415 }
2416
2417 static void rtl8139_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *regbuf)
2418 {
2419         struct rtl8139_private *np = netdev_priv(dev);
2420
2421         regs->version = RTL_REGS_VER;
2422
2423         spin_lock_irq(&np->lock);
2424         memcpy_fromio(regbuf, np->mmio_addr, regs->len);
2425         spin_unlock_irq(&np->lock);
2426 }
2427 #endif /* CONFIG_8139TOO_MMIO */
2428
2429 static int rtl8139_get_stats_count(struct net_device *dev)
2430 {
2431         return RTL_NUM_STATS;
2432 }
2433
2434 static void rtl8139_get_ethtool_stats(struct net_device *dev, struct ethtool_stats *stats, u64 *data)
2435 {
2436         struct rtl8139_private *np = netdev_priv(dev);
2437
2438         data[0] = np->xstats.early_rx;
2439         data[1] = np->xstats.tx_buf_mapped;
2440         data[2] = np->xstats.tx_timeouts;
2441         data[3] = np->xstats.rx_lost_in_ring;
2442 }
2443
2444 static void rtl8139_get_strings(struct net_device *dev, u32 stringset, u8 *data)
2445 {
2446         memcpy(data, ethtool_stats_keys, sizeof(ethtool_stats_keys));
2447 }
2448
2449 static const struct ethtool_ops rtl8139_ethtool_ops = {
2450         .get_drvinfo            = rtl8139_get_drvinfo,
2451         .get_settings           = rtl8139_get_settings,
2452         .set_settings           = rtl8139_set_settings,
2453         .get_regs_len           = rtl8139_get_regs_len,
2454         .get_regs               = rtl8139_get_regs,
2455         .nway_reset             = rtl8139_nway_reset,
2456         .get_link               = rtl8139_get_link,
2457         .get_msglevel           = rtl8139_get_msglevel,
2458         .set_msglevel           = rtl8139_set_msglevel,
2459         .get_wol                = rtl8139_get_wol,
2460         .set_wol                = rtl8139_set_wol,
2461         .get_strings            = rtl8139_get_strings,
2462         .get_stats_count        = rtl8139_get_stats_count,
2463         .get_ethtool_stats      = rtl8139_get_ethtool_stats,
2464         .get_perm_addr          = ethtool_op_get_perm_addr,
2465 };
2466
2467 static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
2468 {
2469         struct rtl8139_private *np = netdev_priv(dev);
2470         int rc;
2471
2472         if (!netif_running(dev))
2473                 return -EINVAL;
2474
2475         spin_lock_irq(&np->lock);
2476         rc = generic_mii_ioctl(&np->mii, if_mii(rq), cmd, NULL);
2477         spin_unlock_irq(&np->lock);
2478
2479         return rc;
2480 }
2481
2482
2483 static struct net_device_stats *rtl8139_get_stats (struct net_device *dev)
2484 {
2485         struct rtl8139_private *tp = netdev_priv(dev);
2486         void __iomem *ioaddr = tp->mmio_addr;
2487         unsigned long flags;
2488
2489         if (netif_running(dev)) {
2490                 spin_lock_irqsave (&tp->lock, flags);
2491                 tp->stats.rx_missed_errors += RTL_R32 (RxMissed);
2492                 RTL_W32 (RxMissed, 0);
2493                 spin_unlock_irqrestore (&tp->lock, flags);
2494         }
2495
2496         return &tp->stats;
2497 }
2498
2499 /* Set or clear the multicast filter for this adaptor.
2500    This routine is not state sensitive and need not be SMP locked. */
2501
2502 static void __set_rx_mode (struct net_device *dev)
2503 {
2504         struct rtl8139_private *tp = netdev_priv(dev);
2505         void __iomem *ioaddr = tp->mmio_addr;
2506         u32 mc_filter[2];       /* Multicast hash filter */
2507         int i, rx_mode;
2508         u32 tmp;
2509
2510         DPRINTK ("%s:   rtl8139_set_rx_mode(%4.4x) done -- Rx config %8.8lx.\n",
2511                         dev->name, dev->flags, RTL_R32 (RxConfig));
2512
2513         /* Note: do not reorder, GCC is clever about common statements. */
2514         if (dev->flags & IFF_PROMISC) {
2515                 rx_mode =
2516                     AcceptBroadcast | AcceptMulticast | AcceptMyPhys |
2517                     AcceptAllPhys;
2518                 mc_filter[1] = mc_filter[0] = 0xffffffff;
2519         } else if ((dev->mc_count > multicast_filter_limit)
2520                    || (dev->flags & IFF_ALLMULTI)) {
2521                 /* Too many to filter perfectly -- accept all multicasts. */
2522                 rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys;
2523                 mc_filter[1] = mc_filter[0] = 0xffffffff;
2524         } else {
2525                 struct dev_mc_list *mclist;
2526                 rx_mode = AcceptBroadcast | AcceptMyPhys;
2527                 mc_filter[1] = mc_filter[0] = 0;
2528                 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
2529                      i++, mclist = mclist->next) {
2530                         int bit_nr = ether_crc(ETH_ALEN, mclist->dmi_addr) >> 26;
2531
2532                         mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
2533                         rx_mode |= AcceptMulticast;
2534                 }
2535         }
2536
2537         /* We can safely update without stopping the chip. */
2538         tmp = rtl8139_rx_config | rx_mode;
2539         if (tp->rx_config != tmp) {
2540                 RTL_W32_F (RxConfig, tmp);
2541                 tp->rx_config = tmp;
2542         }
2543         RTL_W32_F (MAR0 + 0, mc_filter[0]);
2544         RTL_W32_F (MAR0 + 4, mc_filter[1]);
2545 }
2546
2547 static void rtl8139_set_rx_mode (struct net_device *dev)
2548 {
2549         unsigned long flags;
2550         struct rtl8139_private *tp = netdev_priv(dev);
2551
2552         spin_lock_irqsave (&tp->lock, flags);
2553         __set_rx_mode(dev);
2554         spin_unlock_irqrestore (&tp->lock, flags);
2555 }
2556
2557 #ifdef CONFIG_PM
2558
2559 static int rtl8139_suspend (struct pci_dev *pdev, pm_message_t state)
2560 {
2561         struct net_device *dev = pci_get_drvdata (pdev);
2562         struct rtl8139_private *tp = netdev_priv(dev);
2563         void __iomem *ioaddr = tp->mmio_addr;
2564         unsigned long flags;
2565
2566         pci_save_state (pdev);
2567
2568         if (!netif_running (dev))
2569                 return 0;
2570
2571         netif_device_detach (dev);
2572
2573         spin_lock_irqsave (&tp->lock, flags);
2574
2575         /* Disable interrupts, stop Tx and Rx. */
2576         RTL_W16 (IntrMask, 0);
2577         RTL_W8 (ChipCmd, 0);
2578
2579         /* Update the error counts. */
2580         tp->stats.rx_missed_errors += RTL_R32 (RxMissed);
2581         RTL_W32 (RxMissed, 0);
2582
2583         spin_unlock_irqrestore (&tp->lock, flags);
2584
2585         pci_set_power_state (pdev, PCI_D3hot);
2586
2587         return 0;
2588 }
2589
2590
2591 static int rtl8139_resume (struct pci_dev *pdev)
2592 {
2593         struct net_device *dev = pci_get_drvdata (pdev);
2594
2595         pci_restore_state (pdev);
2596         if (!netif_running (dev))
2597                 return 0;
2598         pci_set_power_state (pdev, PCI_D0);
2599         rtl8139_init_ring (dev);
2600         rtl8139_hw_start (dev);
2601         netif_device_attach (dev);
2602         return 0;
2603 }
2604
2605 #endif /* CONFIG_PM */
2606
2607
2608 static struct pci_driver rtl8139_pci_driver = {
2609         .name           = DRV_NAME,
2610         .id_table       = rtl8139_pci_tbl,
2611         .probe          = rtl8139_init_one,
2612         .remove         = __devexit_p(rtl8139_remove_one),
2613 #ifdef CONFIG_PM
2614         .suspend        = rtl8139_suspend,
2615         .resume         = rtl8139_resume,
2616 #endif /* CONFIG_PM */
2617 };
2618
2619
2620 static int __init rtl8139_init_module (void)
2621 {
2622         /* when we're a module, we always print a version message,
2623          * even if no 8139 board is found.
2624          */
2625 #ifdef MODULE
2626         printk (KERN_INFO RTL8139_DRIVER_NAME "\n");
2627 #endif
2628
2629         return pci_register_driver(&rtl8139_pci_driver);
2630 }
2631
2632
2633 static void __exit rtl8139_cleanup_module (void)
2634 {
2635         pci_unregister_driver (&rtl8139_pci_driver);
2636 }
2637
2638
2639 module_init(rtl8139_init_module);
2640 module_exit(rtl8139_cleanup_module);