git.oblomov.eu Git - linux-2.6/blob - drivers/net/8139too.c

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