]> bbs.cooldavid.org Git - net-next-2.6.git/blob - drivers/net/8139too.c
Pull thermal into release branch
[net-next-2.6.git] / 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é—£ - 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         flush_scheduled_work();
1113
1114         unregister_netdev (dev);
1115
1116         __rtl8139_cleanup_dev (dev);
1117         pci_disable_device (pdev);
1118 }
1119
1120
1121 /* Serial EEPROM section. */
1122
1123 /*  EEPROM_Ctrl bits. */
1124 #define EE_SHIFT_CLK    0x04    /* EEPROM shift clock. */
1125 #define EE_CS                   0x08    /* EEPROM chip select. */
1126 #define EE_DATA_WRITE   0x02    /* EEPROM chip data in. */
1127 #define EE_WRITE_0              0x00
1128 #define EE_WRITE_1              0x02
1129 #define EE_DATA_READ    0x01    /* EEPROM chip data out. */
1130 #define EE_ENB                  (0x80 | EE_CS)
1131
1132 /* Delay between EEPROM clock transitions.
1133    No extra delay is needed with 33Mhz PCI, but 66Mhz may change this.
1134  */
1135
1136 #define eeprom_delay()  (void)RTL_R32(Cfg9346)
1137
1138 /* The EEPROM commands include the alway-set leading bit. */
1139 #define EE_WRITE_CMD    (5)
1140 #define EE_READ_CMD             (6)
1141 #define EE_ERASE_CMD    (7)
1142
1143 static int __devinit read_eeprom (void __iomem *ioaddr, int location, int addr_len)
1144 {
1145         int i;
1146         unsigned retval = 0;
1147         int read_cmd = location | (EE_READ_CMD << addr_len);
1148
1149         RTL_W8 (Cfg9346, EE_ENB & ~EE_CS);
1150         RTL_W8 (Cfg9346, EE_ENB);
1151         eeprom_delay ();
1152
1153         /* Shift the read command bits out. */
1154         for (i = 4 + addr_len; i >= 0; i--) {
1155                 int dataval = (read_cmd & (1 << i)) ? EE_DATA_WRITE : 0;
1156                 RTL_W8 (Cfg9346, EE_ENB | dataval);
1157                 eeprom_delay ();
1158                 RTL_W8 (Cfg9346, EE_ENB | dataval | EE_SHIFT_CLK);
1159                 eeprom_delay ();
1160         }
1161         RTL_W8 (Cfg9346, EE_ENB);
1162         eeprom_delay ();
1163
1164         for (i = 16; i > 0; i--) {
1165                 RTL_W8 (Cfg9346, EE_ENB | EE_SHIFT_CLK);
1166                 eeprom_delay ();
1167                 retval =
1168                     (retval << 1) | ((RTL_R8 (Cfg9346) & EE_DATA_READ) ? 1 :
1169                                      0);
1170                 RTL_W8 (Cfg9346, EE_ENB);
1171                 eeprom_delay ();
1172         }
1173
1174         /* Terminate the EEPROM access. */
1175         RTL_W8 (Cfg9346, ~EE_CS);
1176         eeprom_delay ();
1177
1178         return retval;
1179 }
1180
1181 /* MII serial management: mostly bogus for now. */
1182 /* Read and write the MII management registers using software-generated
1183    serial MDIO protocol.
1184    The maximum data clock rate is 2.5 Mhz.  The minimum timing is usually
1185    met by back-to-back PCI I/O cycles, but we insert a delay to avoid
1186    "overclocking" issues. */
1187 #define MDIO_DIR                0x80
1188 #define MDIO_DATA_OUT   0x04
1189 #define MDIO_DATA_IN    0x02
1190 #define MDIO_CLK                0x01
1191 #define MDIO_WRITE0 (MDIO_DIR)
1192 #define MDIO_WRITE1 (MDIO_DIR | MDIO_DATA_OUT)
1193
1194 #define mdio_delay()    RTL_R8(Config4)
1195
1196
1197 static const char mii_2_8139_map[8] = {
1198         BasicModeCtrl,
1199         BasicModeStatus,
1200         0,
1201         0,
1202         NWayAdvert,
1203         NWayLPAR,
1204         NWayExpansion,
1205         0
1206 };
1207
1208
1209 #ifdef CONFIG_8139TOO_8129
1210 /* Syncronize the MII management interface by shifting 32 one bits out. */
1211 static void mdio_sync (void __iomem *ioaddr)
1212 {
1213         int i;
1214
1215         for (i = 32; i >= 0; i--) {
1216                 RTL_W8 (Config4, MDIO_WRITE1);
1217                 mdio_delay ();
1218                 RTL_W8 (Config4, MDIO_WRITE1 | MDIO_CLK);
1219                 mdio_delay ();
1220         }
1221 }
1222 #endif
1223
1224 static int mdio_read (struct net_device *dev, int phy_id, int location)
1225 {
1226         struct rtl8139_private *tp = netdev_priv(dev);
1227         int retval = 0;
1228 #ifdef CONFIG_8139TOO_8129
1229         void __iomem *ioaddr = tp->mmio_addr;
1230         int mii_cmd = (0xf6 << 10) | (phy_id << 5) | location;
1231         int i;
1232 #endif
1233
1234         if (phy_id > 31) {      /* Really a 8139.  Use internal registers. */
1235                 void __iomem *ioaddr = tp->mmio_addr;
1236                 return location < 8 && mii_2_8139_map[location] ?
1237                     RTL_R16 (mii_2_8139_map[location]) : 0;
1238         }
1239
1240 #ifdef CONFIG_8139TOO_8129
1241         mdio_sync (ioaddr);
1242         /* Shift the read command bits out. */
1243         for (i = 15; i >= 0; i--) {
1244                 int dataval = (mii_cmd & (1 << i)) ? MDIO_DATA_OUT : 0;
1245
1246                 RTL_W8 (Config4, MDIO_DIR | dataval);
1247                 mdio_delay ();
1248                 RTL_W8 (Config4, MDIO_DIR | dataval | MDIO_CLK);
1249                 mdio_delay ();
1250         }
1251
1252         /* Read the two transition, 16 data, and wire-idle bits. */
1253         for (i = 19; i > 0; i--) {
1254                 RTL_W8 (Config4, 0);
1255                 mdio_delay ();
1256                 retval = (retval << 1) | ((RTL_R8 (Config4) & MDIO_DATA_IN) ? 1 : 0);
1257                 RTL_W8 (Config4, MDIO_CLK);
1258                 mdio_delay ();
1259         }
1260 #endif
1261
1262         return (retval >> 1) & 0xffff;
1263 }
1264
1265
1266 static void mdio_write (struct net_device *dev, int phy_id, int location,
1267                         int value)
1268 {
1269         struct rtl8139_private *tp = netdev_priv(dev);
1270 #ifdef CONFIG_8139TOO_8129
1271         void __iomem *ioaddr = tp->mmio_addr;
1272         int mii_cmd = (0x5002 << 16) | (phy_id << 23) | (location << 18) | value;
1273         int i;
1274 #endif
1275
1276         if (phy_id > 31) {      /* Really a 8139.  Use internal registers. */
1277                 void __iomem *ioaddr = tp->mmio_addr;
1278                 if (location == 0) {
1279                         RTL_W8 (Cfg9346, Cfg9346_Unlock);
1280                         RTL_W16 (BasicModeCtrl, value);
1281                         RTL_W8 (Cfg9346, Cfg9346_Lock);
1282                 } else if (location < 8 && mii_2_8139_map[location])
1283                         RTL_W16 (mii_2_8139_map[location], value);
1284                 return;
1285         }
1286
1287 #ifdef CONFIG_8139TOO_8129
1288         mdio_sync (ioaddr);
1289
1290         /* Shift the command bits out. */
1291         for (i = 31; i >= 0; i--) {
1292                 int dataval =
1293                     (mii_cmd & (1 << i)) ? MDIO_WRITE1 : MDIO_WRITE0;
1294                 RTL_W8 (Config4, dataval);
1295                 mdio_delay ();
1296                 RTL_W8 (Config4, dataval | MDIO_CLK);
1297                 mdio_delay ();
1298         }
1299         /* Clear out extra bits. */
1300         for (i = 2; i > 0; i--) {
1301                 RTL_W8 (Config4, 0);
1302                 mdio_delay ();
1303                 RTL_W8 (Config4, MDIO_CLK);
1304                 mdio_delay ();
1305         }
1306 #endif
1307 }
1308
1309
1310 static int rtl8139_open (struct net_device *dev)
1311 {
1312         struct rtl8139_private *tp = netdev_priv(dev);
1313         int retval;
1314         void __iomem *ioaddr = tp->mmio_addr;
1315
1316         retval = request_irq (dev->irq, rtl8139_interrupt, IRQF_SHARED, dev->name, dev);
1317         if (retval)
1318                 return retval;
1319
1320         tp->tx_bufs = pci_alloc_consistent(tp->pci_dev, TX_BUF_TOT_LEN,
1321                                            &tp->tx_bufs_dma);
1322         tp->rx_ring = pci_alloc_consistent(tp->pci_dev, RX_BUF_TOT_LEN,
1323                                            &tp->rx_ring_dma);
1324         if (tp->tx_bufs == NULL || tp->rx_ring == NULL) {
1325                 free_irq(dev->irq, dev);
1326
1327                 if (tp->tx_bufs)
1328                         pci_free_consistent(tp->pci_dev, TX_BUF_TOT_LEN,
1329                                             tp->tx_bufs, tp->tx_bufs_dma);
1330                 if (tp->rx_ring)
1331                         pci_free_consistent(tp->pci_dev, RX_BUF_TOT_LEN,
1332                                             tp->rx_ring, tp->rx_ring_dma);
1333
1334                 return -ENOMEM;
1335
1336         }
1337
1338         tp->mii.full_duplex = tp->mii.force_media;
1339         tp->tx_flag = (TX_FIFO_THRESH << 11) & 0x003f0000;
1340
1341         rtl8139_init_ring (dev);
1342         rtl8139_hw_start (dev);
1343         netif_start_queue (dev);
1344
1345         if (netif_msg_ifup(tp))
1346                 printk(KERN_DEBUG "%s: rtl8139_open() ioaddr %#llx IRQ %d"
1347                         " GP Pins %2.2x %s-duplex.\n", dev->name,
1348                         (unsigned long long)pci_resource_start (tp->pci_dev, 1),
1349                         dev->irq, RTL_R8 (MediaStatus),
1350                         tp->mii.full_duplex ? "full" : "half");
1351
1352         rtl8139_start_thread(tp);
1353
1354         return 0;
1355 }
1356
1357
1358 static void rtl_check_media (struct net_device *dev, unsigned int init_media)
1359 {
1360         struct rtl8139_private *tp = netdev_priv(dev);
1361
1362         if (tp->phys[0] >= 0) {
1363                 mii_check_media(&tp->mii, netif_msg_link(tp), init_media);
1364         }
1365 }
1366
1367 /* Start the hardware at open or resume. */
1368 static void rtl8139_hw_start (struct net_device *dev)
1369 {
1370         struct rtl8139_private *tp = netdev_priv(dev);
1371         void __iomem *ioaddr = tp->mmio_addr;
1372         u32 i;
1373         u8 tmp;
1374
1375         /* Bring old chips out of low-power mode. */
1376         if (rtl_chip_info[tp->chipset].flags & HasHltClk)
1377                 RTL_W8 (HltClk, 'R');
1378
1379         rtl8139_chip_reset (ioaddr);
1380
1381         /* unlock Config[01234] and BMCR register writes */
1382         RTL_W8_F (Cfg9346, Cfg9346_Unlock);
1383         /* Restore our idea of the MAC address. */
1384         RTL_W32_F (MAC0 + 0, cpu_to_le32 (*(u32 *) (dev->dev_addr + 0)));
1385         RTL_W32_F (MAC0 + 4, cpu_to_le32 (*(u32 *) (dev->dev_addr + 4)));
1386
1387         /* Must enable Tx/Rx before setting transfer thresholds! */
1388         RTL_W8 (ChipCmd, CmdRxEnb | CmdTxEnb);
1389
1390         tp->rx_config = rtl8139_rx_config | AcceptBroadcast | AcceptMyPhys;
1391         RTL_W32 (RxConfig, tp->rx_config);
1392         RTL_W32 (TxConfig, rtl8139_tx_config);
1393
1394         tp->cur_rx = 0;
1395
1396         rtl_check_media (dev, 1);
1397
1398         if (tp->chipset >= CH_8139B) {
1399                 /* Disable magic packet scanning, which is enabled
1400                  * when PM is enabled in Config1.  It can be reenabled
1401                  * via ETHTOOL_SWOL if desired.  */
1402                 RTL_W8 (Config3, RTL_R8 (Config3) & ~Cfg3_Magic);
1403         }
1404
1405         DPRINTK("init buffer addresses\n");
1406
1407         /* Lock Config[01234] and BMCR register writes */
1408         RTL_W8 (Cfg9346, Cfg9346_Lock);
1409
1410         /* init Rx ring buffer DMA address */
1411         RTL_W32_F (RxBuf, tp->rx_ring_dma);
1412
1413         /* init Tx buffer DMA addresses */
1414         for (i = 0; i < NUM_TX_DESC; i++)
1415                 RTL_W32_F (TxAddr0 + (i * 4), tp->tx_bufs_dma + (tp->tx_buf[i] - tp->tx_bufs));
1416
1417         RTL_W32 (RxMissed, 0);
1418
1419         rtl8139_set_rx_mode (dev);
1420
1421         /* no early-rx interrupts */
1422         RTL_W16 (MultiIntr, RTL_R16 (MultiIntr) & MultiIntrClear);
1423
1424         /* make sure RxTx has started */
1425         tmp = RTL_R8 (ChipCmd);
1426         if ((!(tmp & CmdRxEnb)) || (!(tmp & CmdTxEnb)))
1427                 RTL_W8 (ChipCmd, CmdRxEnb | CmdTxEnb);
1428
1429         /* Enable all known interrupts by setting the interrupt mask. */
1430         RTL_W16 (IntrMask, rtl8139_intr_mask);
1431 }
1432
1433
1434 /* Initialize the Rx and Tx rings, along with various 'dev' bits. */
1435 static void rtl8139_init_ring (struct net_device *dev)
1436 {
1437         struct rtl8139_private *tp = netdev_priv(dev);
1438         int i;
1439
1440         tp->cur_rx = 0;
1441         tp->cur_tx = 0;
1442         tp->dirty_tx = 0;
1443
1444         for (i = 0; i < NUM_TX_DESC; i++)
1445                 tp->tx_buf[i] = &tp->tx_bufs[i * TX_BUF_SIZE];
1446 }
1447
1448
1449 /* This must be global for CONFIG_8139TOO_TUNE_TWISTER case */
1450 static int next_tick = 3 * HZ;
1451
1452 #ifndef CONFIG_8139TOO_TUNE_TWISTER
1453 static inline void rtl8139_tune_twister (struct net_device *dev,
1454                                   struct rtl8139_private *tp) {}
1455 #else
1456 enum TwisterParamVals {
1457         PARA78_default  = 0x78fa8388,
1458         PARA7c_default  = 0xcb38de43,   /* param[0][3] */
1459         PARA7c_xxx      = 0xcb38de43,
1460 };
1461
1462 static const unsigned long param[4][4] = {
1463         {0xcb39de43, 0xcb39ce43, 0xfb38de03, 0xcb38de43},
1464         {0xcb39de43, 0xcb39ce43, 0xcb39ce83, 0xcb39ce83},
1465         {0xcb39de43, 0xcb39ce43, 0xcb39ce83, 0xcb39ce83},
1466         {0xbb39de43, 0xbb39ce43, 0xbb39ce83, 0xbb39ce83}
1467 };
1468
1469 static void rtl8139_tune_twister (struct net_device *dev,
1470                                   struct rtl8139_private *tp)
1471 {
1472         int linkcase;
1473         void __iomem *ioaddr = tp->mmio_addr;
1474
1475         /* This is a complicated state machine to configure the "twister" for
1476            impedance/echos based on the cable length.
1477            All of this is magic and undocumented.
1478          */
1479         switch (tp->twistie) {
1480         case 1:
1481                 if (RTL_R16 (CSCR) & CSCR_LinkOKBit) {
1482                         /* We have link beat, let us tune the twister. */
1483                         RTL_W16 (CSCR, CSCR_LinkDownOffCmd);
1484                         tp->twistie = 2;        /* Change to state 2. */
1485                         next_tick = HZ / 10;
1486                 } else {
1487                         /* Just put in some reasonable defaults for when beat returns. */
1488                         RTL_W16 (CSCR, CSCR_LinkDownCmd);
1489                         RTL_W32 (FIFOTMS, 0x20);        /* Turn on cable test mode. */
1490                         RTL_W32 (PARA78, PARA78_default);
1491                         RTL_W32 (PARA7c, PARA7c_default);
1492                         tp->twistie = 0;        /* Bail from future actions. */
1493                 }
1494                 break;
1495         case 2:
1496                 /* Read how long it took to hear the echo. */
1497                 linkcase = RTL_R16 (CSCR) & CSCR_LinkStatusBits;
1498                 if (linkcase == 0x7000)
1499                         tp->twist_row = 3;
1500                 else if (linkcase == 0x3000)
1501                         tp->twist_row = 2;
1502                 else if (linkcase == 0x1000)
1503                         tp->twist_row = 1;
1504                 else
1505                         tp->twist_row = 0;
1506                 tp->twist_col = 0;
1507                 tp->twistie = 3;        /* Change to state 2. */
1508                 next_tick = HZ / 10;
1509                 break;
1510         case 3:
1511                 /* Put out four tuning parameters, one per 100msec. */
1512                 if (tp->twist_col == 0)
1513                         RTL_W16 (FIFOTMS, 0);
1514                 RTL_W32 (PARA7c, param[(int) tp->twist_row]
1515                          [(int) tp->twist_col]);
1516                 next_tick = HZ / 10;
1517                 if (++tp->twist_col >= 4) {
1518                         /* For short cables we are done.
1519                            For long cables (row == 3) check for mistune. */
1520                         tp->twistie =
1521                             (tp->twist_row == 3) ? 4 : 0;
1522                 }
1523                 break;
1524         case 4:
1525                 /* Special case for long cables: check for mistune. */
1526                 if ((RTL_R16 (CSCR) &
1527                      CSCR_LinkStatusBits) == 0x7000) {
1528                         tp->twistie = 0;
1529                         break;
1530                 } else {
1531                         RTL_W32 (PARA7c, 0xfb38de03);
1532                         tp->twistie = 5;
1533                         next_tick = HZ / 10;
1534                 }
1535                 break;
1536         case 5:
1537                 /* Retune for shorter cable (column 2). */
1538                 RTL_W32 (FIFOTMS, 0x20);
1539                 RTL_W32 (PARA78, PARA78_default);
1540                 RTL_W32 (PARA7c, PARA7c_default);
1541                 RTL_W32 (FIFOTMS, 0x00);
1542                 tp->twist_row = 2;
1543                 tp->twist_col = 0;
1544                 tp->twistie = 3;
1545                 next_tick = HZ / 10;
1546                 break;
1547
1548         default:
1549                 /* do nothing */
1550                 break;
1551         }
1552 }
1553 #endif /* CONFIG_8139TOO_TUNE_TWISTER */
1554
1555 static inline void rtl8139_thread_iter (struct net_device *dev,
1556                                  struct rtl8139_private *tp,
1557                                  void __iomem *ioaddr)
1558 {
1559         int mii_lpa;
1560
1561         mii_lpa = mdio_read (dev, tp->phys[0], MII_LPA);
1562
1563         if (!tp->mii.force_media && mii_lpa != 0xffff) {
1564                 int duplex = (mii_lpa & LPA_100FULL)
1565                     || (mii_lpa & 0x01C0) == 0x0040;
1566                 if (tp->mii.full_duplex != duplex) {
1567                         tp->mii.full_duplex = duplex;
1568
1569                         if (mii_lpa) {
1570                                 printk (KERN_INFO
1571                                         "%s: Setting %s-duplex based on MII #%d link"
1572                                         " partner ability of %4.4x.\n",
1573                                         dev->name,
1574                                         tp->mii.full_duplex ? "full" : "half",
1575                                         tp->phys[0], mii_lpa);
1576                         } else {
1577                                 printk(KERN_INFO"%s: media is unconnected, link down, or incompatible connection\n",
1578                                        dev->name);
1579                         }
1580 #if 0
1581                         RTL_W8 (Cfg9346, Cfg9346_Unlock);
1582                         RTL_W8 (Config1, tp->mii.full_duplex ? 0x60 : 0x20);
1583                         RTL_W8 (Cfg9346, Cfg9346_Lock);
1584 #endif
1585                 }
1586         }
1587
1588         next_tick = HZ * 60;
1589
1590         rtl8139_tune_twister (dev, tp);
1591
1592         DPRINTK ("%s: Media selection tick, Link partner %4.4x.\n",
1593                  dev->name, RTL_R16 (NWayLPAR));
1594         DPRINTK ("%s:  Other registers are IntMask %4.4x IntStatus %4.4x\n",
1595                  dev->name, RTL_R16 (IntrMask), RTL_R16 (IntrStatus));
1596         DPRINTK ("%s:  Chip config %2.2x %2.2x.\n",
1597                  dev->name, RTL_R8 (Config0),
1598                  RTL_R8 (Config1));
1599 }
1600
1601 static void rtl8139_thread (struct work_struct *work)
1602 {
1603         struct rtl8139_private *tp =
1604                 container_of(work, struct rtl8139_private, thread.work);
1605         struct net_device *dev = tp->mii.dev;
1606         unsigned long thr_delay = next_tick;
1607
1608         rtnl_lock();
1609
1610         if (!netif_running(dev))
1611                 goto out_unlock;
1612
1613         if (tp->watchdog_fired) {
1614                 tp->watchdog_fired = 0;
1615                 rtl8139_tx_timeout_task(work);
1616         } else
1617                 rtl8139_thread_iter(dev, tp, tp->mmio_addr);
1618
1619         if (tp->have_thread)
1620                 schedule_delayed_work(&tp->thread, thr_delay);
1621 out_unlock:
1622         rtnl_unlock ();
1623 }
1624
1625 static void rtl8139_start_thread(struct rtl8139_private *tp)
1626 {
1627         tp->twistie = 0;
1628         if (tp->chipset == CH_8139_K)
1629                 tp->twistie = 1;
1630         else if (tp->drv_flags & HAS_LNK_CHNG)
1631                 return;
1632
1633         tp->have_thread = 1;
1634         tp->watchdog_fired = 0;
1635
1636         schedule_delayed_work(&tp->thread, next_tick);
1637 }
1638
1639 static inline void rtl8139_tx_clear (struct rtl8139_private *tp)
1640 {
1641         tp->cur_tx = 0;
1642         tp->dirty_tx = 0;
1643
1644         /* XXX account for unsent Tx packets in tp->stats.tx_dropped */
1645 }
1646
1647 static void rtl8139_tx_timeout_task (struct work_struct *work)
1648 {
1649         struct rtl8139_private *tp =
1650                 container_of(work, struct rtl8139_private, thread.work);
1651         struct net_device *dev = tp->mii.dev;
1652         void __iomem *ioaddr = tp->mmio_addr;
1653         int i;
1654         u8 tmp8;
1655
1656         printk (KERN_DEBUG "%s: Transmit timeout, status %2.2x %4.4x %4.4x "
1657                 "media %2.2x.\n", dev->name, RTL_R8 (ChipCmd),
1658                 RTL_R16(IntrStatus), RTL_R16(IntrMask), RTL_R8(MediaStatus));
1659         /* Emit info to figure out what went wrong. */
1660         printk (KERN_DEBUG "%s: Tx queue start entry %ld  dirty entry %ld.\n",
1661                 dev->name, tp->cur_tx, tp->dirty_tx);
1662         for (i = 0; i < NUM_TX_DESC; i++)
1663                 printk (KERN_DEBUG "%s:  Tx descriptor %d is %8.8lx.%s\n",
1664                         dev->name, i, RTL_R32 (TxStatus0 + (i * 4)),
1665                         i == tp->dirty_tx % NUM_TX_DESC ?
1666                                 " (queue head)" : "");
1667
1668         tp->xstats.tx_timeouts++;
1669
1670         /* disable Tx ASAP, if not already */
1671         tmp8 = RTL_R8 (ChipCmd);
1672         if (tmp8 & CmdTxEnb)
1673                 RTL_W8 (ChipCmd, CmdRxEnb);
1674
1675         spin_lock_bh(&tp->rx_lock);
1676         /* Disable interrupts by clearing the interrupt mask. */
1677         RTL_W16 (IntrMask, 0x0000);
1678
1679         /* Stop a shared interrupt from scavenging while we are. */
1680         spin_lock_irq(&tp->lock);
1681         rtl8139_tx_clear (tp);
1682         spin_unlock_irq(&tp->lock);
1683
1684         /* ...and finally, reset everything */
1685         if (netif_running(dev)) {
1686                 rtl8139_hw_start (dev);
1687                 netif_wake_queue (dev);
1688         }
1689         spin_unlock_bh(&tp->rx_lock);
1690 }
1691
1692 static void rtl8139_tx_timeout (struct net_device *dev)
1693 {
1694         struct rtl8139_private *tp = netdev_priv(dev);
1695
1696         tp->watchdog_fired = 1;
1697         if (!tp->have_thread) {
1698                 INIT_DELAYED_WORK(&tp->thread, rtl8139_thread);
1699                 schedule_delayed_work(&tp->thread, next_tick);
1700         }
1701 }
1702
1703 static int rtl8139_start_xmit (struct sk_buff *skb, struct net_device *dev)
1704 {
1705         struct rtl8139_private *tp = netdev_priv(dev);
1706         void __iomem *ioaddr = tp->mmio_addr;
1707         unsigned int entry;
1708         unsigned int len = skb->len;
1709         unsigned long flags;
1710
1711         /* Calculate the next Tx descriptor entry. */
1712         entry = tp->cur_tx % NUM_TX_DESC;
1713
1714         /* Note: the chip doesn't have auto-pad! */
1715         if (likely(len < TX_BUF_SIZE)) {
1716                 if (len < ETH_ZLEN)
1717                         memset(tp->tx_buf[entry], 0, ETH_ZLEN);
1718                 skb_copy_and_csum_dev(skb, tp->tx_buf[entry]);
1719                 dev_kfree_skb(skb);
1720         } else {
1721                 dev_kfree_skb(skb);
1722                 tp->stats.tx_dropped++;
1723                 return 0;
1724         }
1725
1726         spin_lock_irqsave(&tp->lock, flags);
1727         RTL_W32_F (TxStatus0 + (entry * sizeof (u32)),
1728                    tp->tx_flag | max(len, (unsigned int)ETH_ZLEN));
1729
1730         dev->trans_start = jiffies;
1731
1732         tp->cur_tx++;
1733         wmb();
1734
1735         if ((tp->cur_tx - NUM_TX_DESC) == tp->dirty_tx)
1736                 netif_stop_queue (dev);
1737         spin_unlock_irqrestore(&tp->lock, flags);
1738
1739         if (netif_msg_tx_queued(tp))
1740                 printk (KERN_DEBUG "%s: Queued Tx packet size %u to slot %d.\n",
1741                         dev->name, len, entry);
1742
1743         return 0;
1744 }
1745
1746
1747 static void rtl8139_tx_interrupt (struct net_device *dev,
1748                                   struct rtl8139_private *tp,
1749                                   void __iomem *ioaddr)
1750 {
1751         unsigned long dirty_tx, tx_left;
1752
1753         assert (dev != NULL);
1754         assert (ioaddr != NULL);
1755
1756         dirty_tx = tp->dirty_tx;
1757         tx_left = tp->cur_tx - dirty_tx;
1758         while (tx_left > 0) {
1759                 int entry = dirty_tx % NUM_TX_DESC;
1760                 int txstatus;
1761
1762                 txstatus = RTL_R32 (TxStatus0 + (entry * sizeof (u32)));
1763
1764                 if (!(txstatus & (TxStatOK | TxUnderrun | TxAborted)))
1765                         break;  /* It still hasn't been Txed */
1766
1767                 /* Note: TxCarrierLost is always asserted at 100mbps. */
1768                 if (txstatus & (TxOutOfWindow | TxAborted)) {
1769                         /* There was an major error, log it. */
1770                         if (netif_msg_tx_err(tp))
1771                                 printk(KERN_DEBUG "%s: Transmit error, Tx status %8.8x.\n",
1772                                         dev->name, txstatus);
1773                         tp->stats.tx_errors++;
1774                         if (txstatus & TxAborted) {
1775                                 tp->stats.tx_aborted_errors++;
1776                                 RTL_W32 (TxConfig, TxClearAbt);
1777                                 RTL_W16 (IntrStatus, TxErr);
1778                                 wmb();
1779                         }
1780                         if (txstatus & TxCarrierLost)
1781                                 tp->stats.tx_carrier_errors++;
1782                         if (txstatus & TxOutOfWindow)
1783                                 tp->stats.tx_window_errors++;
1784                 } else {
1785                         if (txstatus & TxUnderrun) {
1786                                 /* Add 64 to the Tx FIFO threshold. */
1787                                 if (tp->tx_flag < 0x00300000)
1788                                         tp->tx_flag += 0x00020000;
1789                                 tp->stats.tx_fifo_errors++;
1790                         }
1791                         tp->stats.collisions += (txstatus >> 24) & 15;
1792                         tp->stats.tx_bytes += txstatus & 0x7ff;
1793                         tp->stats.tx_packets++;
1794                 }
1795
1796                 dirty_tx++;
1797                 tx_left--;
1798         }
1799
1800 #ifndef RTL8139_NDEBUG
1801         if (tp->cur_tx - dirty_tx > NUM_TX_DESC) {
1802                 printk (KERN_ERR "%s: Out-of-sync dirty pointer, %ld vs. %ld.\n",
1803                         dev->name, dirty_tx, tp->cur_tx);
1804                 dirty_tx += NUM_TX_DESC;
1805         }
1806 #endif /* RTL8139_NDEBUG */
1807
1808         /* only wake the queue if we did work, and the queue is stopped */
1809         if (tp->dirty_tx != dirty_tx) {
1810                 tp->dirty_tx = dirty_tx;
1811                 mb();
1812                 netif_wake_queue (dev);
1813         }
1814 }
1815
1816
1817 /* TODO: clean this up!  Rx reset need not be this intensive */
1818 static void rtl8139_rx_err (u32 rx_status, struct net_device *dev,
1819                             struct rtl8139_private *tp, void __iomem *ioaddr)
1820 {
1821         u8 tmp8;
1822 #ifdef CONFIG_8139_OLD_RX_RESET
1823         int tmp_work;
1824 #endif
1825
1826         if (netif_msg_rx_err (tp))
1827                 printk(KERN_DEBUG "%s: Ethernet frame had errors, status %8.8x.\n",
1828                         dev->name, rx_status);
1829         tp->stats.rx_errors++;
1830         if (!(rx_status & RxStatusOK)) {
1831                 if (rx_status & RxTooLong) {
1832                         DPRINTK ("%s: Oversized Ethernet frame, status %4.4x!\n",
1833                                 dev->name, rx_status);
1834                         /* A.C.: The chip hangs here. */
1835                 }
1836                 if (rx_status & (RxBadSymbol | RxBadAlign))
1837                         tp->stats.rx_frame_errors++;
1838                 if (rx_status & (RxRunt | RxTooLong))
1839                         tp->stats.rx_length_errors++;
1840                 if (rx_status & RxCRCErr)
1841                         tp->stats.rx_crc_errors++;
1842         } else {
1843                 tp->xstats.rx_lost_in_ring++;
1844         }
1845
1846 #ifndef CONFIG_8139_OLD_RX_RESET
1847         tmp8 = RTL_R8 (ChipCmd);
1848         RTL_W8 (ChipCmd, tmp8 & ~CmdRxEnb);
1849         RTL_W8 (ChipCmd, tmp8);
1850         RTL_W32 (RxConfig, tp->rx_config);
1851         tp->cur_rx = 0;
1852 #else
1853         /* Reset the receiver, based on RealTek recommendation. (Bug?) */
1854
1855         /* disable receive */
1856         RTL_W8_F (ChipCmd, CmdTxEnb);
1857         tmp_work = 200;
1858         while (--tmp_work > 0) {
1859                 udelay(1);
1860                 tmp8 = RTL_R8 (ChipCmd);
1861                 if (!(tmp8 & CmdRxEnb))
1862                         break;
1863         }
1864         if (tmp_work <= 0)
1865                 printk (KERN_WARNING PFX "rx stop wait too long\n");
1866         /* restart receive */
1867         tmp_work = 200;
1868         while (--tmp_work > 0) {
1869                 RTL_W8_F (ChipCmd, CmdRxEnb | CmdTxEnb);
1870                 udelay(1);
1871                 tmp8 = RTL_R8 (ChipCmd);
1872                 if ((tmp8 & CmdRxEnb) && (tmp8 & CmdTxEnb))
1873                         break;
1874         }
1875         if (tmp_work <= 0)
1876                 printk (KERN_WARNING PFX "tx/rx enable wait too long\n");
1877
1878         /* and reinitialize all rx related registers */
1879         RTL_W8_F (Cfg9346, Cfg9346_Unlock);
1880         /* Must enable Tx/Rx before setting transfer thresholds! */
1881         RTL_W8 (ChipCmd, CmdRxEnb | CmdTxEnb);
1882
1883         tp->rx_config = rtl8139_rx_config | AcceptBroadcast | AcceptMyPhys;
1884         RTL_W32 (RxConfig, tp->rx_config);
1885         tp->cur_rx = 0;
1886
1887         DPRINTK("init buffer addresses\n");
1888
1889         /* Lock Config[01234] and BMCR register writes */
1890         RTL_W8 (Cfg9346, Cfg9346_Lock);
1891
1892         /* init Rx ring buffer DMA address */
1893         RTL_W32_F (RxBuf, tp->rx_ring_dma);
1894
1895         /* A.C.: Reset the multicast list. */
1896         __set_rx_mode (dev);
1897 #endif
1898 }
1899
1900 #if RX_BUF_IDX == 3
1901 static __inline__ void wrap_copy(struct sk_buff *skb, const unsigned char *ring,
1902                                  u32 offset, unsigned int size)
1903 {
1904         u32 left = RX_BUF_LEN - offset;
1905
1906         if (size > left) {
1907                 skb_copy_to_linear_data(skb, ring + offset, left);
1908                 skb_copy_to_linear_data_offset(skb, left, ring, size - left);
1909         } else
1910                 skb_copy_to_linear_data(skb, ring + offset, size);
1911 }
1912 #endif
1913
1914 static void rtl8139_isr_ack(struct rtl8139_private *tp)
1915 {
1916         void __iomem *ioaddr = tp->mmio_addr;
1917         u16 status;
1918
1919         status = RTL_R16 (IntrStatus) & RxAckBits;
1920
1921         /* Clear out errors and receive interrupts */
1922         if (likely(status != 0)) {
1923                 if (unlikely(status & (RxFIFOOver | RxOverflow))) {
1924                         tp->stats.rx_errors++;
1925                         if (status & RxFIFOOver)
1926                                 tp->stats.rx_fifo_errors++;
1927                 }
1928                 RTL_W16_F (IntrStatus, RxAckBits);
1929         }
1930 }
1931
1932 static int rtl8139_rx(struct net_device *dev, struct rtl8139_private *tp,
1933                       int budget)
1934 {
1935         void __iomem *ioaddr = tp->mmio_addr;
1936         int received = 0;
1937         unsigned char *rx_ring = tp->rx_ring;
1938         unsigned int cur_rx = tp->cur_rx;
1939         unsigned int rx_size = 0;
1940
1941         DPRINTK ("%s: In rtl8139_rx(), current %4.4x BufAddr %4.4x,"
1942                  " free to %4.4x, Cmd %2.2x.\n", dev->name, (u16)cur_rx,
1943                  RTL_R16 (RxBufAddr),
1944                  RTL_R16 (RxBufPtr), RTL_R8 (ChipCmd));
1945
1946         while (netif_running(dev) && received < budget
1947                && (RTL_R8 (ChipCmd) & RxBufEmpty) == 0) {
1948                 u32 ring_offset = cur_rx % RX_BUF_LEN;
1949                 u32 rx_status;
1950                 unsigned int pkt_size;
1951                 struct sk_buff *skb;
1952
1953                 rmb();
1954
1955                 /* read size+status of next frame from DMA ring buffer */
1956                 rx_status = le32_to_cpu (*(u32 *) (rx_ring + ring_offset));
1957                 rx_size = rx_status >> 16;
1958                 pkt_size = rx_size - 4;
1959
1960                 if (netif_msg_rx_status(tp))
1961                         printk(KERN_DEBUG "%s:  rtl8139_rx() status %4.4x, size %4.4x,"
1962                                 " cur %4.4x.\n", dev->name, rx_status,
1963                          rx_size, cur_rx);
1964 #if RTL8139_DEBUG > 2
1965                 {
1966                         int i;
1967                         DPRINTK ("%s: Frame contents ", dev->name);
1968                         for (i = 0; i < 70; i++)
1969                                 printk (" %2.2x",
1970                                         rx_ring[ring_offset + i]);
1971                         printk (".\n");
1972                 }
1973 #endif
1974
1975                 /* Packet copy from FIFO still in progress.
1976                  * Theoretically, this should never happen
1977                  * since EarlyRx is disabled.
1978                  */
1979                 if (unlikely(rx_size == 0xfff0)) {
1980                         if (!tp->fifo_copy_timeout)
1981                                 tp->fifo_copy_timeout = jiffies + 2;
1982                         else if (time_after(jiffies, tp->fifo_copy_timeout)) {
1983                                 DPRINTK ("%s: hung FIFO. Reset.", dev->name);
1984                                 rx_size = 0;
1985                                 goto no_early_rx;
1986                         }
1987                         if (netif_msg_intr(tp)) {
1988                                 printk(KERN_DEBUG "%s: fifo copy in progress.",
1989                                        dev->name);
1990                         }
1991                         tp->xstats.early_rx++;
1992                         break;
1993                 }
1994
1995 no_early_rx:
1996                 tp->fifo_copy_timeout = 0;
1997
1998                 /* If Rx err or invalid rx_size/rx_status received
1999                  * (which happens if we get lost in the ring),
2000                  * Rx process gets reset, so we abort any further
2001                  * Rx processing.
2002                  */
2003                 if (unlikely((rx_size > (MAX_ETH_FRAME_SIZE+4)) ||
2004                              (rx_size < 8) ||
2005                              (!(rx_status & RxStatusOK)))) {
2006                         rtl8139_rx_err (rx_status, dev, tp, ioaddr);
2007                         received = -1;
2008                         goto out;
2009                 }
2010
2011                 /* Malloc up new buffer, compatible with net-2e. */
2012                 /* Omit the four octet CRC from the length. */
2013
2014                 skb = dev_alloc_skb (pkt_size + 2);
2015                 if (likely(skb)) {
2016                         skb_reserve (skb, 2);   /* 16 byte align the IP fields. */
2017 #if RX_BUF_IDX == 3
2018                         wrap_copy(skb, rx_ring, ring_offset+4, pkt_size);
2019 #else
2020                         eth_copy_and_sum (skb, &rx_ring[ring_offset + 4], pkt_size, 0);
2021 #endif
2022                         skb_put (skb, pkt_size);
2023
2024                         skb->protocol = eth_type_trans (skb, dev);
2025
2026                         dev->last_rx = jiffies;
2027                         tp->stats.rx_bytes += pkt_size;
2028                         tp->stats.rx_packets++;
2029
2030                         netif_receive_skb (skb);
2031                 } else {
2032                         if (net_ratelimit())
2033                                 printk (KERN_WARNING
2034                                         "%s: Memory squeeze, dropping packet.\n",
2035                                         dev->name);
2036                         tp->stats.rx_dropped++;
2037                 }
2038                 received++;
2039
2040                 cur_rx = (cur_rx + rx_size + 4 + 3) & ~3;
2041                 RTL_W16 (RxBufPtr, (u16) (cur_rx - 16));
2042
2043                 rtl8139_isr_ack(tp);
2044         }
2045
2046         if (unlikely(!received || rx_size == 0xfff0))
2047                 rtl8139_isr_ack(tp);
2048
2049 #if RTL8139_DEBUG > 1
2050         DPRINTK ("%s: Done rtl8139_rx(), current %4.4x BufAddr %4.4x,"
2051                  " free to %4.4x, Cmd %2.2x.\n", dev->name, cur_rx,
2052                  RTL_R16 (RxBufAddr),
2053                  RTL_R16 (RxBufPtr), RTL_R8 (ChipCmd));
2054 #endif
2055
2056         tp->cur_rx = cur_rx;
2057
2058         /*
2059          * The receive buffer should be mostly empty.
2060          * Tell NAPI to reenable the Rx irq.
2061          */
2062         if (tp->fifo_copy_timeout)
2063                 received = budget;
2064
2065 out:
2066         return received;
2067 }
2068
2069
2070 static void rtl8139_weird_interrupt (struct net_device *dev,
2071                                      struct rtl8139_private *tp,
2072                                      void __iomem *ioaddr,
2073                                      int status, int link_changed)
2074 {
2075         DPRINTK ("%s: Abnormal interrupt, status %8.8x.\n",
2076                  dev->name, status);
2077
2078         assert (dev != NULL);
2079         assert (tp != NULL);
2080         assert (ioaddr != NULL);
2081
2082         /* Update the error count. */
2083         tp->stats.rx_missed_errors += RTL_R32 (RxMissed);
2084         RTL_W32 (RxMissed, 0);
2085
2086         if ((status & RxUnderrun) && link_changed &&
2087             (tp->drv_flags & HAS_LNK_CHNG)) {
2088                 rtl_check_media(dev, 0);
2089                 status &= ~RxUnderrun;
2090         }
2091
2092         if (status & (RxUnderrun | RxErr))
2093                 tp->stats.rx_errors++;
2094
2095         if (status & PCSTimeout)
2096                 tp->stats.rx_length_errors++;
2097         if (status & RxUnderrun)
2098                 tp->stats.rx_fifo_errors++;
2099         if (status & PCIErr) {
2100                 u16 pci_cmd_status;
2101                 pci_read_config_word (tp->pci_dev, PCI_STATUS, &pci_cmd_status);
2102                 pci_write_config_word (tp->pci_dev, PCI_STATUS, pci_cmd_status);
2103
2104                 printk (KERN_ERR "%s: PCI Bus error %4.4x.\n",
2105                         dev->name, pci_cmd_status);
2106         }
2107 }
2108
2109 static int rtl8139_poll(struct net_device *dev, int *budget)
2110 {
2111         struct rtl8139_private *tp = netdev_priv(dev);
2112         void __iomem *ioaddr = tp->mmio_addr;
2113         int orig_budget = min(*budget, dev->quota);
2114         int done = 1;
2115
2116         spin_lock(&tp->rx_lock);
2117         if (likely(RTL_R16(IntrStatus) & RxAckBits)) {
2118                 int work_done;
2119
2120                 work_done = rtl8139_rx(dev, tp, orig_budget);
2121                 if (likely(work_done > 0)) {
2122                         *budget -= work_done;
2123                         dev->quota -= work_done;
2124                         done = (work_done < orig_budget);
2125                 }
2126         }
2127
2128         if (done) {
2129                 unsigned long flags;
2130                 /*
2131                  * Order is important since data can get interrupted
2132                  * again when we think we are done.
2133                  */
2134                 local_irq_save(flags);
2135                 RTL_W16_F(IntrMask, rtl8139_intr_mask);
2136                 __netif_rx_complete(dev);
2137                 local_irq_restore(flags);
2138         }
2139         spin_unlock(&tp->rx_lock);
2140
2141         return !done;
2142 }
2143
2144 /* The interrupt handler does all of the Rx thread work and cleans up
2145    after the Tx thread. */
2146 static irqreturn_t rtl8139_interrupt (int irq, void *dev_instance)
2147 {
2148         struct net_device *dev = (struct net_device *) dev_instance;
2149         struct rtl8139_private *tp = netdev_priv(dev);
2150         void __iomem *ioaddr = tp->mmio_addr;
2151         u16 status, ackstat;
2152         int link_changed = 0; /* avoid bogus "uninit" warning */
2153         int handled = 0;
2154
2155         spin_lock (&tp->lock);
2156         status = RTL_R16 (IntrStatus);
2157
2158         /* shared irq? */
2159         if (unlikely((status & rtl8139_intr_mask) == 0))
2160                 goto out;
2161
2162         handled = 1;
2163
2164         /* h/w no longer present (hotplug?) or major error, bail */
2165         if (unlikely(status == 0xFFFF))
2166                 goto out;
2167
2168         /* close possible race's with dev_close */
2169         if (unlikely(!netif_running(dev))) {
2170                 RTL_W16 (IntrMask, 0);
2171                 goto out;
2172         }
2173
2174         /* Acknowledge all of the current interrupt sources ASAP, but
2175            an first get an additional status bit from CSCR. */
2176         if (unlikely(status & RxUnderrun))
2177                 link_changed = RTL_R16 (CSCR) & CSCR_LinkChangeBit;
2178
2179         ackstat = status & ~(RxAckBits | TxErr);
2180         if (ackstat)
2181                 RTL_W16 (IntrStatus, ackstat);
2182
2183         /* Receive packets are processed by poll routine.
2184            If not running start it now. */
2185         if (status & RxAckBits){
2186                 if (netif_rx_schedule_prep(dev)) {
2187                         RTL_W16_F (IntrMask, rtl8139_norx_intr_mask);
2188                         __netif_rx_schedule (dev);
2189                 }
2190         }
2191
2192         /* Check uncommon events with one test. */
2193         if (unlikely(status & (PCIErr | PCSTimeout | RxUnderrun | RxErr)))
2194                 rtl8139_weird_interrupt (dev, tp, ioaddr,
2195                                          status, link_changed);
2196
2197         if (status & (TxOK | TxErr)) {
2198                 rtl8139_tx_interrupt (dev, tp, ioaddr);
2199                 if (status & TxErr)
2200                         RTL_W16 (IntrStatus, TxErr);
2201         }
2202  out:
2203         spin_unlock (&tp->lock);
2204
2205         DPRINTK ("%s: exiting interrupt, intr_status=%#4.4x.\n",
2206                  dev->name, RTL_R16 (IntrStatus));
2207         return IRQ_RETVAL(handled);
2208 }
2209
2210 #ifdef CONFIG_NET_POLL_CONTROLLER
2211 /*
2212  * Polling receive - used by netconsole and other diagnostic tools
2213  * to allow network i/o with interrupts disabled.
2214  */
2215 static void rtl8139_poll_controller(struct net_device *dev)
2216 {
2217         disable_irq(dev->irq);
2218         rtl8139_interrupt(dev->irq, dev);
2219         enable_irq(dev->irq);
2220 }
2221 #endif
2222
2223 static int rtl8139_close (struct net_device *dev)
2224 {
2225         struct rtl8139_private *tp = netdev_priv(dev);
2226         void __iomem *ioaddr = tp->mmio_addr;
2227         unsigned long flags;
2228
2229         netif_stop_queue (dev);
2230
2231         if (netif_msg_ifdown(tp))
2232                 printk(KERN_DEBUG "%s: Shutting down ethercard, status was 0x%4.4x.\n",
2233                         dev->name, RTL_R16 (IntrStatus));
2234
2235         spin_lock_irqsave (&tp->lock, flags);
2236
2237         /* Stop the chip's Tx and Rx DMA processes. */
2238         RTL_W8 (ChipCmd, 0);
2239
2240         /* Disable interrupts by clearing the interrupt mask. */
2241         RTL_W16 (IntrMask, 0);
2242
2243         /* Update the error counts. */
2244         tp->stats.rx_missed_errors += RTL_R32 (RxMissed);
2245         RTL_W32 (RxMissed, 0);
2246
2247         spin_unlock_irqrestore (&tp->lock, flags);
2248
2249         synchronize_irq (dev->irq);     /* racy, but that's ok here */
2250         free_irq (dev->irq, dev);
2251
2252         rtl8139_tx_clear (tp);
2253
2254         pci_free_consistent(tp->pci_dev, RX_BUF_TOT_LEN,
2255                             tp->rx_ring, tp->rx_ring_dma);
2256         pci_free_consistent(tp->pci_dev, TX_BUF_TOT_LEN,
2257                             tp->tx_bufs, tp->tx_bufs_dma);
2258         tp->rx_ring = NULL;
2259         tp->tx_bufs = NULL;
2260
2261         /* Green! Put the chip in low-power mode. */
2262         RTL_W8 (Cfg9346, Cfg9346_Unlock);
2263
2264         if (rtl_chip_info[tp->chipset].flags & HasHltClk)
2265                 RTL_W8 (HltClk, 'H');   /* 'R' would leave the clock running. */
2266
2267         return 0;
2268 }
2269
2270
2271 /* Get the ethtool Wake-on-LAN settings.  Assumes that wol points to
2272    kernel memory, *wol has been initialized as {ETHTOOL_GWOL}, and
2273    other threads or interrupts aren't messing with the 8139.  */
2274 static void rtl8139_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
2275 {
2276         struct rtl8139_private *np = netdev_priv(dev);
2277         void __iomem *ioaddr = np->mmio_addr;
2278
2279         spin_lock_irq(&np->lock);
2280         if (rtl_chip_info[np->chipset].flags & HasLWake) {
2281                 u8 cfg3 = RTL_R8 (Config3);
2282                 u8 cfg5 = RTL_R8 (Config5);
2283
2284                 wol->supported = WAKE_PHY | WAKE_MAGIC
2285                         | WAKE_UCAST | WAKE_MCAST | WAKE_BCAST;
2286
2287                 wol->wolopts = 0;
2288                 if (cfg3 & Cfg3_LinkUp)
2289                         wol->wolopts |= WAKE_PHY;
2290                 if (cfg3 & Cfg3_Magic)
2291                         wol->wolopts |= WAKE_MAGIC;
2292                 /* (KON)FIXME: See how netdev_set_wol() handles the
2293                    following constants.  */
2294                 if (cfg5 & Cfg5_UWF)
2295                         wol->wolopts |= WAKE_UCAST;
2296                 if (cfg5 & Cfg5_MWF)
2297                         wol->wolopts |= WAKE_MCAST;
2298                 if (cfg5 & Cfg5_BWF)
2299                         wol->wolopts |= WAKE_BCAST;
2300         }
2301         spin_unlock_irq(&np->lock);
2302 }
2303
2304
2305 /* Set the ethtool Wake-on-LAN settings.  Return 0 or -errno.  Assumes
2306    that wol points to kernel memory and other threads or interrupts
2307    aren't messing with the 8139.  */
2308 static int rtl8139_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
2309 {
2310         struct rtl8139_private *np = netdev_priv(dev);
2311         void __iomem *ioaddr = np->mmio_addr;
2312         u32 support;
2313         u8 cfg3, cfg5;
2314
2315         support = ((rtl_chip_info[np->chipset].flags & HasLWake)
2316                    ? (WAKE_PHY | WAKE_MAGIC
2317                       | WAKE_UCAST | WAKE_MCAST | WAKE_BCAST)
2318                    : 0);
2319         if (wol->wolopts & ~support)
2320                 return -EINVAL;
2321
2322         spin_lock_irq(&np->lock);
2323         cfg3 = RTL_R8 (Config3) & ~(Cfg3_LinkUp | Cfg3_Magic);
2324         if (wol->wolopts & WAKE_PHY)
2325                 cfg3 |= Cfg3_LinkUp;
2326         if (wol->wolopts & WAKE_MAGIC)
2327                 cfg3 |= Cfg3_Magic;
2328         RTL_W8 (Cfg9346, Cfg9346_Unlock);
2329         RTL_W8 (Config3, cfg3);
2330         RTL_W8 (Cfg9346, Cfg9346_Lock);
2331
2332         cfg5 = RTL_R8 (Config5) & ~(Cfg5_UWF | Cfg5_MWF | Cfg5_BWF);
2333         /* (KON)FIXME: These are untested.  We may have to set the
2334            CRC0, Wakeup0 and LSBCRC0 registers too, but I have no
2335            documentation.  */
2336         if (wol->wolopts & WAKE_UCAST)
2337                 cfg5 |= Cfg5_UWF;
2338         if (wol->wolopts & WAKE_MCAST)
2339                 cfg5 |= Cfg5_MWF;
2340         if (wol->wolopts & WAKE_BCAST)
2341                 cfg5 |= Cfg5_BWF;
2342         RTL_W8 (Config5, cfg5); /* need not unlock via Cfg9346 */
2343         spin_unlock_irq(&np->lock);
2344
2345         return 0;
2346 }
2347
2348 static void rtl8139_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
2349 {
2350         struct rtl8139_private *np = netdev_priv(dev);
2351         strcpy(info->driver, DRV_NAME);
2352         strcpy(info->version, DRV_VERSION);
2353         strcpy(info->bus_info, pci_name(np->pci_dev));
2354         info->regdump_len = np->regs_len;
2355 }
2356
2357 static int rtl8139_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
2358 {
2359         struct rtl8139_private *np = netdev_priv(dev);
2360         spin_lock_irq(&np->lock);
2361         mii_ethtool_gset(&np->mii, cmd);
2362         spin_unlock_irq(&np->lock);
2363         return 0;
2364 }
2365
2366 static int rtl8139_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
2367 {
2368         struct rtl8139_private *np = netdev_priv(dev);
2369         int rc;
2370         spin_lock_irq(&np->lock);
2371         rc = mii_ethtool_sset(&np->mii, cmd);
2372         spin_unlock_irq(&np->lock);
2373         return rc;
2374 }
2375
2376 static int rtl8139_nway_reset(struct net_device *dev)
2377 {
2378         struct rtl8139_private *np = netdev_priv(dev);
2379         return mii_nway_restart(&np->mii);
2380 }
2381
2382 static u32 rtl8139_get_link(struct net_device *dev)
2383 {
2384         struct rtl8139_private *np = netdev_priv(dev);
2385         return mii_link_ok(&np->mii);
2386 }
2387
2388 static u32 rtl8139_get_msglevel(struct net_device *dev)
2389 {
2390         struct rtl8139_private *np = netdev_priv(dev);
2391         return np->msg_enable;
2392 }
2393
2394 static void rtl8139_set_msglevel(struct net_device *dev, u32 datum)
2395 {
2396         struct rtl8139_private *np = netdev_priv(dev);
2397         np->msg_enable = datum;
2398 }
2399
2400 /* TODO: we are too slack to do reg dumping for pio, for now */
2401 #ifdef CONFIG_8139TOO_PIO
2402 #define rtl8139_get_regs_len    NULL
2403 #define rtl8139_get_regs        NULL
2404 #else
2405 static int rtl8139_get_regs_len(struct net_device *dev)
2406 {
2407         struct rtl8139_private *np = netdev_priv(dev);
2408         return np->regs_len;
2409 }
2410
2411 static void rtl8139_get_regs(struct net_device *dev, struct ethtool_regs *regs, void *regbuf)
2412 {
2413         struct rtl8139_private *np = netdev_priv(dev);
2414
2415         regs->version = RTL_REGS_VER;
2416
2417         spin_lock_irq(&np->lock);
2418         memcpy_fromio(regbuf, np->mmio_addr, regs->len);
2419         spin_unlock_irq(&np->lock);
2420 }
2421 #endif /* CONFIG_8139TOO_MMIO */
2422
2423 static int rtl8139_get_stats_count(struct net_device *dev)
2424 {
2425         return RTL_NUM_STATS;
2426 }
2427
2428 static void rtl8139_get_ethtool_stats(struct net_device *dev, struct ethtool_stats *stats, u64 *data)
2429 {
2430         struct rtl8139_private *np = netdev_priv(dev);
2431
2432         data[0] = np->xstats.early_rx;
2433         data[1] = np->xstats.tx_buf_mapped;
2434         data[2] = np->xstats.tx_timeouts;
2435         data[3] = np->xstats.rx_lost_in_ring;
2436 }
2437
2438 static void rtl8139_get_strings(struct net_device *dev, u32 stringset, u8 *data)
2439 {
2440         memcpy(data, ethtool_stats_keys, sizeof(ethtool_stats_keys));
2441 }
2442
2443 static const struct ethtool_ops rtl8139_ethtool_ops = {
2444         .get_drvinfo            = rtl8139_get_drvinfo,
2445         .get_settings           = rtl8139_get_settings,
2446         .set_settings           = rtl8139_set_settings,
2447         .get_regs_len           = rtl8139_get_regs_len,
2448         .get_regs               = rtl8139_get_regs,
2449         .nway_reset             = rtl8139_nway_reset,
2450         .get_link               = rtl8139_get_link,
2451         .get_msglevel           = rtl8139_get_msglevel,
2452         .set_msglevel           = rtl8139_set_msglevel,
2453         .get_wol                = rtl8139_get_wol,
2454         .set_wol                = rtl8139_set_wol,
2455         .get_strings            = rtl8139_get_strings,
2456         .get_stats_count        = rtl8139_get_stats_count,
2457         .get_ethtool_stats      = rtl8139_get_ethtool_stats,
2458         .get_perm_addr          = ethtool_op_get_perm_addr,
2459 };
2460
2461 static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
2462 {
2463         struct rtl8139_private *np = netdev_priv(dev);
2464         int rc;
2465
2466         if (!netif_running(dev))
2467                 return -EINVAL;
2468
2469         spin_lock_irq(&np->lock);
2470         rc = generic_mii_ioctl(&np->mii, if_mii(rq), cmd, NULL);
2471         spin_unlock_irq(&np->lock);
2472
2473         return rc;
2474 }
2475
2476
2477 static struct net_device_stats *rtl8139_get_stats (struct net_device *dev)
2478 {
2479         struct rtl8139_private *tp = netdev_priv(dev);
2480         void __iomem *ioaddr = tp->mmio_addr;
2481         unsigned long flags;
2482
2483         if (netif_running(dev)) {
2484                 spin_lock_irqsave (&tp->lock, flags);
2485                 tp->stats.rx_missed_errors += RTL_R32 (RxMissed);
2486                 RTL_W32 (RxMissed, 0);
2487                 spin_unlock_irqrestore (&tp->lock, flags);
2488         }
2489
2490         return &tp->stats;
2491 }
2492
2493 /* Set or clear the multicast filter for this adaptor.
2494    This routine is not state sensitive and need not be SMP locked. */
2495
2496 static void __set_rx_mode (struct net_device *dev)
2497 {
2498         struct rtl8139_private *tp = netdev_priv(dev);
2499         void __iomem *ioaddr = tp->mmio_addr;
2500         u32 mc_filter[2];       /* Multicast hash filter */
2501         int i, rx_mode;
2502         u32 tmp;
2503
2504         DPRINTK ("%s:   rtl8139_set_rx_mode(%4.4x) done -- Rx config %8.8lx.\n",
2505                         dev->name, dev->flags, RTL_R32 (RxConfig));
2506
2507         /* Note: do not reorder, GCC is clever about common statements. */
2508         if (dev->flags & IFF_PROMISC) {
2509                 rx_mode =
2510                     AcceptBroadcast | AcceptMulticast | AcceptMyPhys |
2511                     AcceptAllPhys;
2512                 mc_filter[1] = mc_filter[0] = 0xffffffff;
2513         } else if ((dev->mc_count > multicast_filter_limit)
2514                    || (dev->flags & IFF_ALLMULTI)) {
2515                 /* Too many to filter perfectly -- accept all multicasts. */
2516                 rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys;
2517                 mc_filter[1] = mc_filter[0] = 0xffffffff;
2518         } else {
2519                 struct dev_mc_list *mclist;
2520                 rx_mode = AcceptBroadcast | AcceptMyPhys;
2521                 mc_filter[1] = mc_filter[0] = 0;
2522                 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
2523                      i++, mclist = mclist->next) {
2524                         int bit_nr = ether_crc(ETH_ALEN, mclist->dmi_addr) >> 26;
2525
2526                         mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
2527                         rx_mode |= AcceptMulticast;
2528                 }
2529         }
2530
2531         /* We can safely update without stopping the chip. */
2532         tmp = rtl8139_rx_config | rx_mode;
2533         if (tp->rx_config != tmp) {
2534                 RTL_W32_F (RxConfig, tmp);
2535                 tp->rx_config = tmp;
2536         }
2537         RTL_W32_F (MAR0 + 0, mc_filter[0]);
2538         RTL_W32_F (MAR0 + 4, mc_filter[1]);
2539 }
2540
2541 static void rtl8139_set_rx_mode (struct net_device *dev)
2542 {
2543         unsigned long flags;
2544         struct rtl8139_private *tp = netdev_priv(dev);
2545
2546         spin_lock_irqsave (&tp->lock, flags);
2547         __set_rx_mode(dev);
2548         spin_unlock_irqrestore (&tp->lock, flags);
2549 }
2550
2551 #ifdef CONFIG_PM
2552
2553 static int rtl8139_suspend (struct pci_dev *pdev, pm_message_t state)
2554 {
2555         struct net_device *dev = pci_get_drvdata (pdev);
2556         struct rtl8139_private *tp = netdev_priv(dev);
2557         void __iomem *ioaddr = tp->mmio_addr;
2558         unsigned long flags;
2559
2560         pci_save_state (pdev);
2561
2562         if (!netif_running (dev))
2563                 return 0;
2564
2565         netif_device_detach (dev);
2566
2567         spin_lock_irqsave (&tp->lock, flags);
2568
2569         /* Disable interrupts, stop Tx and Rx. */
2570         RTL_W16 (IntrMask, 0);
2571         RTL_W8 (ChipCmd, 0);
2572
2573         /* Update the error counts. */
2574         tp->stats.rx_missed_errors += RTL_R32 (RxMissed);
2575         RTL_W32 (RxMissed, 0);
2576
2577         spin_unlock_irqrestore (&tp->lock, flags);
2578
2579         pci_set_power_state (pdev, PCI_D3hot);
2580
2581         return 0;
2582 }
2583
2584
2585 static int rtl8139_resume (struct pci_dev *pdev)
2586 {
2587         struct net_device *dev = pci_get_drvdata (pdev);
2588
2589         pci_restore_state (pdev);
2590         if (!netif_running (dev))
2591                 return 0;
2592         pci_set_power_state (pdev, PCI_D0);
2593         rtl8139_init_ring (dev);
2594         rtl8139_hw_start (dev);
2595         netif_device_attach (dev);
2596         return 0;
2597 }
2598
2599 #endif /* CONFIG_PM */
2600
2601
2602 static struct pci_driver rtl8139_pci_driver = {
2603         .name           = DRV_NAME,
2604         .id_table       = rtl8139_pci_tbl,
2605         .probe          = rtl8139_init_one,
2606         .remove         = __devexit_p(rtl8139_remove_one),
2607 #ifdef CONFIG_PM
2608         .suspend        = rtl8139_suspend,
2609         .resume         = rtl8139_resume,
2610 #endif /* CONFIG_PM */
2611 };
2612
2613
2614 static int __init rtl8139_init_module (void)
2615 {
2616         /* when we're a module, we always print a version message,
2617          * even if no 8139 board is found.
2618          */
2619 #ifdef MODULE
2620         printk (KERN_INFO RTL8139_DRIVER_NAME "\n");
2621 #endif
2622
2623         return pci_register_driver(&rtl8139_pci_driver);
2624 }
2625
2626
2627 static void __exit rtl8139_cleanup_module (void)
2628 {
2629         pci_unregister_driver (&rtl8139_pci_driver);
2630 }
2631
2632
2633 module_init(rtl8139_init_module);
2634 module_exit(rtl8139_cleanup_module);