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