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