tc35815.c 71.2 KB
Newer Older
A
Atsushi Nemoto 已提交
1 2
/*
 * tc35815.c: A TOSHIBA TC35815CF PCI 10/100Mbps ethernet driver for linux.
L
Linus Torvalds 已提交
3 4 5
 *
 * Based on skelton.c by Donald Becker.
 *
A
Atsushi Nemoto 已提交
6 7 8 9 10 11 12 13 14 15
 * This driver is a replacement of older and less maintained version.
 * This is a header of the older version:
 *	-----<snip>-----
 *	Copyright 2001 MontaVista Software Inc.
 *	Author: MontaVista Software, Inc.
 *		ahennessy@mvista.com
 *	Copyright (C) 2000-2001 Toshiba Corporation
 *	static const char *version =
 *		"tc35815.c:v0.00 26/07/2000 by Toshiba Corporation\n";
 *	-----<snip>-----
L
Linus Torvalds 已提交
16
 *
A
Atsushi Nemoto 已提交
17 18 19
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
L
Linus Torvalds 已提交
20
 *
A
Atsushi Nemoto 已提交
21 22
 * (C) Copyright TOSHIBA CORPORATION 2004-2005
 * All Rights Reserved.
L
Linus Torvalds 已提交
23 24
 */

A
Atsushi Nemoto 已提交
25
#ifdef TC35815_NAPI
A
Atsushi Nemoto 已提交
26
#define DRV_VERSION	"1.37-NAPI"
A
Atsushi Nemoto 已提交
27
#else
A
Atsushi Nemoto 已提交
28
#define DRV_VERSION	"1.37"
A
Atsushi Nemoto 已提交
29 30 31
#endif
static const char *version = "tc35815.c:v" DRV_VERSION "\n";
#define MODNAME			"tc35815"
L
Linus Torvalds 已提交
32 33 34 35 36 37 38 39

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/types.h>
#include <linux/fcntl.h>
#include <linux/interrupt.h>
#include <linux/ioport.h>
#include <linux/in.h>
A
Atsushi Nemoto 已提交
40
#include <linux/if_vlan.h>
L
Linus Torvalds 已提交
41 42
#include <linux/slab.h>
#include <linux/string.h>
A
Atsushi Nemoto 已提交
43
#include <linux/spinlock.h>
L
Linus Torvalds 已提交
44 45 46 47 48 49 50
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/skbuff.h>
#include <linux/delay.h>
#include <linux/pci.h>
A
Atsushi Nemoto 已提交
51 52
#include <linux/phy.h>
#include <linux/workqueue.h>
53
#include <linux/platform_device.h>
L
Linus Torvalds 已提交
54 55 56 57 58 59
#include <asm/io.h>
#include <asm/byteorder.h>

/* First, a few definitions that the brave might change. */

#define GATHER_TXINT	/* On-Demand Tx Interrupt */
A
Atsushi Nemoto 已提交
60 61 62 63
#define WORKAROUND_LOSTCAR
#define WORKAROUND_100HALF_PROMISC
/* #define TC35815_USE_PACKEDBUFFER */

A
Atsushi Nemoto 已提交
64
enum tc35815_chiptype {
A
Atsushi Nemoto 已提交
65 66 67
	TC35815CF = 0,
	TC35815_NWU,
	TC35815_TX4939,
A
Atsushi Nemoto 已提交
68
};
A
Atsushi Nemoto 已提交
69

A
Atsushi Nemoto 已提交
70
/* indexed by tc35815_chiptype, above */
A
Atsushi Nemoto 已提交
71 72
static const struct {
	const char *name;
A
Atsushi Nemoto 已提交
73
} chip_info[] __devinitdata = {
A
Atsushi Nemoto 已提交
74 75 76 77 78 79 80 81 82 83 84
	{ "TOSHIBA TC35815CF 10/100BaseTX" },
	{ "TOSHIBA TC35815 with Wake on LAN" },
	{ "TOSHIBA TC35815/TX4939" },
};

static const struct pci_device_id tc35815_pci_tbl[] = {
	{PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_TC35815CF), .driver_data = TC35815CF },
	{PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_TC35815_NWU), .driver_data = TC35815_NWU },
	{PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_TC35815_TX4939), .driver_data = TC35815_TX4939 },
	{0,}
};
A
Atsushi Nemoto 已提交
85
MODULE_DEVICE_TABLE(pci, tc35815_pci_tbl);
L
Linus Torvalds 已提交
86

A
Atsushi Nemoto 已提交
87 88 89 90 91
/* see MODULE_PARM_DESC */
static struct tc35815_options {
	int speed;
	int duplex;
} options;
L
Linus Torvalds 已提交
92 93 94 95 96

/*
 * Registers
 */
struct tc35815_regs {
97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127
	__u32 DMA_Ctl;		/* 0x00 */
	__u32 TxFrmPtr;
	__u32 TxThrsh;
	__u32 TxPollCtr;
	__u32 BLFrmPtr;
	__u32 RxFragSize;
	__u32 Int_En;
	__u32 FDA_Bas;
	__u32 FDA_Lim;		/* 0x20 */
	__u32 Int_Src;
	__u32 unused0[2];
	__u32 PauseCnt;
	__u32 RemPauCnt;
	__u32 TxCtlFrmStat;
	__u32 unused1;
	__u32 MAC_Ctl;		/* 0x40 */
	__u32 CAM_Ctl;
	__u32 Tx_Ctl;
	__u32 Tx_Stat;
	__u32 Rx_Ctl;
	__u32 Rx_Stat;
	__u32 MD_Data;
	__u32 MD_CA;
	__u32 CAM_Adr;		/* 0x60 */
	__u32 CAM_Data;
	__u32 CAM_Ena;
	__u32 PROM_Ctl;
	__u32 PROM_Data;
	__u32 Algn_Cnt;
	__u32 CRC_Cnt;
	__u32 Miss_Cnt;
L
Linus Torvalds 已提交
128 129 130 131 132 133
};

/*
 * Bit assignments
 */
/* DMA_Ctl bit asign ------------------------------------------------------- */
A
Atsushi Nemoto 已提交
134 135 136 137 138 139 140 141 142 143 144 145 146
#define DMA_RxAlign	       0x00c00000 /* 1:Reception Alignment	     */
#define DMA_RxAlign_1	       0x00400000
#define DMA_RxAlign_2	       0x00800000
#define DMA_RxAlign_3	       0x00c00000
#define DMA_M66EnStat	       0x00080000 /* 1:66MHz Enable State	     */
#define DMA_IntMask	       0x00040000 /* 1:Interupt mask		     */
#define DMA_SWIntReq	       0x00020000 /* 1:Software Interrupt request    */
#define DMA_TxWakeUp	       0x00010000 /* 1:Transmit Wake Up		     */
#define DMA_RxBigE	       0x00008000 /* 1:Receive Big Endian	     */
#define DMA_TxBigE	       0x00004000 /* 1:Transmit Big Endian	     */
#define DMA_TestMode	       0x00002000 /* 1:Test Mode		     */
#define DMA_PowrMgmnt	       0x00001000 /* 1:Power Management		     */
#define DMA_DmBurst_Mask       0x000001fc /* DMA Burst size		     */
L
Linus Torvalds 已提交
147 148

/* RxFragSize bit asign ---------------------------------------------------- */
A
Atsushi Nemoto 已提交
149 150
#define RxFrag_EnPack	       0x00008000 /* 1:Enable Packing		     */
#define RxFrag_MinFragMask     0x00000ffc /* Minimum Fragment		     */
L
Linus Torvalds 已提交
151 152

/* MAC_Ctl bit asign ------------------------------------------------------- */
A
Atsushi Nemoto 已提交
153 154 155 156 157 158 159 160 161 162 163 164
#define MAC_Link10	       0x00008000 /* 1:Link Status 10Mbits	     */
#define MAC_EnMissRoll	       0x00002000 /* 1:Enable Missed Roll	     */
#define MAC_MissRoll	       0x00000400 /* 1:Missed Roll		     */
#define MAC_Loop10	       0x00000080 /* 1:Loop 10 Mbps		     */
#define MAC_Conn_Auto	       0x00000000 /*00:Connection mode (Automatic)   */
#define MAC_Conn_10M	       0x00000020 /*01:		       (10Mbps endec)*/
#define MAC_Conn_Mll	       0x00000040 /*10:		       (Mll clock)   */
#define MAC_MacLoop	       0x00000010 /* 1:MAC Loopback		     */
#define MAC_FullDup	       0x00000008 /* 1:Full Duplex 0:Half Duplex     */
#define MAC_Reset	       0x00000004 /* 1:Software Reset		     */
#define MAC_HaltImm	       0x00000002 /* 1:Halt Immediate		     */
#define MAC_HaltReq	       0x00000001 /* 1:Halt request		     */
L
Linus Torvalds 已提交
165 166

/* PROM_Ctl bit asign ------------------------------------------------------ */
A
Atsushi Nemoto 已提交
167 168 169 170 171 172 173 174
#define PROM_Busy	       0x00008000 /* 1:Busy (Start Operation)	     */
#define PROM_Read	       0x00004000 /*10:Read operation		     */
#define PROM_Write	       0x00002000 /*01:Write operation		     */
#define PROM_Erase	       0x00006000 /*11:Erase operation		     */
					  /*00:Enable or Disable Writting,   */
					  /*	  as specified in PROM_Addr. */
#define PROM_Addr_Ena	       0x00000030 /*11xxxx:PROM Write enable	     */
					  /*00xxxx:	      disable	     */
L
Linus Torvalds 已提交
175 176

/* CAM_Ctl bit asign ------------------------------------------------------- */
A
Atsushi Nemoto 已提交
177 178 179 180 181 182
#define CAM_CompEn	       0x00000010 /* 1:CAM Compare Enable	     */
#define CAM_NegCAM	       0x00000008 /* 1:Reject packets CAM recognizes,*/
					  /*			accept other */
#define CAM_BroadAcc	       0x00000004 /* 1:Broadcast assept		     */
#define CAM_GroupAcc	       0x00000002 /* 1:Multicast assept		     */
#define CAM_StationAcc	       0x00000001 /* 1:unicast accept		     */
L
Linus Torvalds 已提交
183 184

/* CAM_Ena bit asign ------------------------------------------------------- */
A
Atsushi Nemoto 已提交
185
#define CAM_ENTRY_MAX		       21   /* CAM Data entry max count	     */
L
Linus Torvalds 已提交
186
#define CAM_Ena_Mask ((1<<CAM_ENTRY_MAX)-1) /* CAM Enable bits (Max 21bits)  */
A
Atsushi Nemoto 已提交
187
#define CAM_Ena_Bit(index)	(1 << (index))
L
Linus Torvalds 已提交
188 189 190 191 192
#define CAM_ENTRY_DESTINATION	0
#define CAM_ENTRY_SOURCE	1
#define CAM_ENTRY_MACCTL	20

/* Tx_Ctl bit asign -------------------------------------------------------- */
A
Atsushi Nemoto 已提交
193 194 195 196 197 198 199 200 201 202 203 204
#define Tx_En		       0x00000001 /* 1:Transmit enable		     */
#define Tx_TxHalt	       0x00000002 /* 1:Transmit Halt Request	     */
#define Tx_NoPad	       0x00000004 /* 1:Suppress Padding		     */
#define Tx_NoCRC	       0x00000008 /* 1:Suppress Padding		     */
#define Tx_FBack	       0x00000010 /* 1:Fast Back-off		     */
#define Tx_EnUnder	       0x00000100 /* 1:Enable Underrun		     */
#define Tx_EnExDefer	       0x00000200 /* 1:Enable Excessive Deferral     */
#define Tx_EnLCarr	       0x00000400 /* 1:Enable Lost Carrier	     */
#define Tx_EnExColl	       0x00000800 /* 1:Enable Excessive Collision    */
#define Tx_EnLateColl	       0x00001000 /* 1:Enable Late Collision	     */
#define Tx_EnTxPar	       0x00002000 /* 1:Enable Transmit Parity	     */
#define Tx_EnComp	       0x00004000 /* 1:Enable Completion	     */
L
Linus Torvalds 已提交
205 206

/* Tx_Stat bit asign ------------------------------------------------------- */
A
Atsushi Nemoto 已提交
207 208 209 210 211 212 213 214 215 216 217 218 219 220
#define Tx_TxColl_MASK	       0x0000000F /* Tx Collision Count		     */
#define Tx_ExColl	       0x00000010 /* Excessive Collision	     */
#define Tx_TXDefer	       0x00000020 /* Transmit Defered		     */
#define Tx_Paused	       0x00000040 /* Transmit Paused		     */
#define Tx_IntTx	       0x00000080 /* Interrupt on Tx		     */
#define Tx_Under	       0x00000100 /* Underrun			     */
#define Tx_Defer	       0x00000200 /* Deferral			     */
#define Tx_NCarr	       0x00000400 /* No Carrier			     */
#define Tx_10Stat	       0x00000800 /* 10Mbps Status		     */
#define Tx_LateColl	       0x00001000 /* Late Collision		     */
#define Tx_TxPar	       0x00002000 /* Tx Parity Error		     */
#define Tx_Comp		       0x00004000 /* Completion			     */
#define Tx_Halted	       0x00008000 /* Tx Halted			     */
#define Tx_SQErr	       0x00010000 /* Signal Quality Error(SQE)	     */
L
Linus Torvalds 已提交
221 222

/* Rx_Ctl bit asign -------------------------------------------------------- */
A
Atsushi Nemoto 已提交
223 224 225 226 227 228 229 230 231 232 233 234
#define Rx_EnGood	       0x00004000 /* 1:Enable Good		     */
#define Rx_EnRxPar	       0x00002000 /* 1:Enable Receive Parity	     */
#define Rx_EnLongErr	       0x00000800 /* 1:Enable Long Error	     */
#define Rx_EnOver	       0x00000400 /* 1:Enable OverFlow		     */
#define Rx_EnCRCErr	       0x00000200 /* 1:Enable CRC Error		     */
#define Rx_EnAlign	       0x00000100 /* 1:Enable Alignment		     */
#define Rx_IgnoreCRC	       0x00000040 /* 1:Ignore CRC Value		     */
#define Rx_StripCRC	       0x00000010 /* 1:Strip CRC Value		     */
#define Rx_ShortEn	       0x00000008 /* 1:Short Enable		     */
#define Rx_LongEn	       0x00000004 /* 1:Long Enable		     */
#define Rx_RxHalt	       0x00000002 /* 1:Receive Halt Request	     */
#define Rx_RxEn		       0x00000001 /* 1:Receive Intrrupt Enable	     */
L
Linus Torvalds 已提交
235 236

/* Rx_Stat bit asign ------------------------------------------------------- */
A
Atsushi Nemoto 已提交
237 238 239
#define Rx_Halted	       0x00008000 /* Rx Halted			     */
#define Rx_Good		       0x00004000 /* Rx Good			     */
#define Rx_RxPar	       0x00002000 /* Rx Parity Error		     */
240
#define Rx_TypePkt	       0x00001000 /* Rx Type Packet		     */
A
Atsushi Nemoto 已提交
241 242 243 244 245 246 247
#define Rx_LongErr	       0x00000800 /* Rx Long Error		     */
#define Rx_Over		       0x00000400 /* Rx Overflow		     */
#define Rx_CRCErr	       0x00000200 /* Rx CRC Error		     */
#define Rx_Align	       0x00000100 /* Rx Alignment Error		     */
#define Rx_10Stat	       0x00000080 /* Rx 10Mbps Status		     */
#define Rx_IntRx	       0x00000040 /* Rx Interrupt		     */
#define Rx_CtlRecd	       0x00000020 /* Rx Control Receive		     */
248
#define Rx_InLenErr	       0x00000010 /* Rx In Range Frame Length Error  */
A
Atsushi Nemoto 已提交
249

250
#define Rx_Stat_Mask	       0x0000FFF0 /* Rx All Status Mask		     */
L
Linus Torvalds 已提交
251 252

/* Int_En bit asign -------------------------------------------------------- */
A
Atsushi Nemoto 已提交
253 254 255 256 257 258 259 260 261 262 263 264 265
#define Int_NRAbtEn	       0x00000800 /* 1:Non-recoverable Abort Enable  */
#define Int_TxCtlCmpEn	       0x00000400 /* 1:Transmit Ctl Complete Enable  */
#define Int_DmParErrEn	       0x00000200 /* 1:DMA Parity Error Enable	     */
#define Int_DParDEn	       0x00000100 /* 1:Data Parity Error Enable	     */
#define Int_EarNotEn	       0x00000080 /* 1:Early Notify Enable	     */
#define Int_DParErrEn	       0x00000040 /* 1:Detected Parity Error Enable  */
#define Int_SSysErrEn	       0x00000020 /* 1:Signalled System Error Enable */
#define Int_RMasAbtEn	       0x00000010 /* 1:Received Master Abort Enable  */
#define Int_RTargAbtEn	       0x00000008 /* 1:Received Target Abort Enable  */
#define Int_STargAbtEn	       0x00000004 /* 1:Signalled Target Abort Enable */
#define Int_BLExEn	       0x00000002 /* 1:Buffer List Exhausted Enable  */
#define Int_FDAExEn	       0x00000001 /* 1:Free Descriptor Area	     */
					  /*		   Exhausted Enable  */
L
Linus Torvalds 已提交
266 267

/* Int_Src bit asign ------------------------------------------------------- */
A
Atsushi Nemoto 已提交
268 269 270 271 272 273 274 275 276 277 278 279 280 281 282
#define Int_NRabt	       0x00004000 /* 1:Non Recoverable error	     */
#define Int_DmParErrStat       0x00002000 /* 1:DMA Parity Error & Clear	     */
#define Int_BLEx	       0x00001000 /* 1:Buffer List Empty & Clear     */
#define Int_FDAEx	       0x00000800 /* 1:FDA Empty & Clear	     */
#define Int_IntNRAbt	       0x00000400 /* 1:Non Recoverable Abort	     */
#define Int_IntCmp	       0x00000200 /* 1:MAC control packet complete   */
#define Int_IntExBD	       0x00000100 /* 1:Interrupt Extra BD & Clear    */
#define Int_DmParErr	       0x00000080 /* 1:DMA Parity Error & Clear	     */
#define Int_IntEarNot	       0x00000040 /* 1:Receive Data write & Clear    */
#define Int_SWInt	       0x00000020 /* 1:Software request & Clear	     */
#define Int_IntBLEx	       0x00000010 /* 1:Buffer List Empty & Clear     */
#define Int_IntFDAEx	       0x00000008 /* 1:FDA Empty & Clear	     */
#define Int_IntPCI	       0x00000004 /* 1:PCI controller & Clear	     */
#define Int_IntMacRx	       0x00000002 /* 1:Rx controller & Clear	     */
#define Int_IntMacTx	       0x00000001 /* 1:Tx controller & Clear	     */
L
Linus Torvalds 已提交
283 284

/* MD_CA bit asign --------------------------------------------------------- */
A
Atsushi Nemoto 已提交
285 286 287
#define MD_CA_PreSup	       0x00001000 /* 1:Preamble Supress		     */
#define MD_CA_Busy	       0x00000800 /* 1:Busy (Start Operation)	     */
#define MD_CA_Wr	       0x00000400 /* 1:Write 0:Read		     */
L
Linus Torvalds 已提交
288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310


/*
 * Descriptors
 */

/* Frame descripter */
struct FDesc {
	volatile __u32 FDNext;
	volatile __u32 FDSystem;
	volatile __u32 FDStat;
	volatile __u32 FDCtl;
};

/* Buffer descripter */
struct BDesc {
	volatile __u32 BuffData;
	volatile __u32 BDCtl;
};

#define FD_ALIGN	16

/* Frame Descripter bit asign ---------------------------------------------- */
A
Atsushi Nemoto 已提交
311 312 313
#define FD_FDLength_MASK       0x0000FFFF /* Length MASK		     */
#define FD_BDCnt_MASK	       0x001F0000 /* BD count MASK in FD	     */
#define FD_FrmOpt_MASK	       0x7C000000 /* Frame option MASK		     */
L
Linus Torvalds 已提交
314
#define FD_FrmOpt_BigEndian    0x40000000 /* Tx/Rx */
A
Atsushi Nemoto 已提交
315 316
#define FD_FrmOpt_IntTx	       0x20000000 /* Tx only */
#define FD_FrmOpt_NoCRC	       0x10000000 /* Tx only */
L
Linus Torvalds 已提交
317 318
#define FD_FrmOpt_NoPadding    0x08000000 /* Tx only */
#define FD_FrmOpt_Packing      0x04000000 /* Rx only */
A
Atsushi Nemoto 已提交
319 320 321
#define FD_CownsFD	       0x80000000 /* FD Controller owner bit	     */
#define FD_Next_EOL	       0x00000001 /* FD EOL indicator		     */
#define FD_BDCnt_SHIFT	       16
L
Linus Torvalds 已提交
322 323

/* Buffer Descripter bit asign --------------------------------------------- */
A
Atsushi Nemoto 已提交
324 325 326 327 328
#define BD_BuffLength_MASK     0x0000FFFF /* Recieve Data Size		     */
#define BD_RxBDID_MASK	       0x00FF0000 /* BD ID Number MASK		     */
#define BD_RxBDSeqN_MASK       0x7F000000 /* Rx BD Sequence Number	     */
#define BD_CownsBD	       0x80000000 /* BD Controller owner bit	     */
#define BD_RxBDID_SHIFT	       16
L
Linus Torvalds 已提交
329 330 331 332 333 334 335 336
#define BD_RxBDSeqN_SHIFT      24


/* Some useful constants. */
#undef NO_CHECK_CARRIER	/* Does not check No-Carrier with TP */

#ifdef NO_CHECK_CARRIER
#define TX_CTL_CMD	(Tx_EnComp | Tx_EnTxPar | Tx_EnLateColl | \
A
Atsushi Nemoto 已提交
337 338
	Tx_EnExColl | Tx_EnExDefer | Tx_EnUnder | \
	Tx_En)	/* maybe  0x7b01 */
L
Linus Torvalds 已提交
339 340
#else
#define TX_CTL_CMD	(Tx_EnComp | Tx_EnTxPar | Tx_EnLateColl | \
A
Atsushi Nemoto 已提交
341 342
	Tx_EnExColl | Tx_EnLCarr | Tx_EnExDefer | Tx_EnUnder | \
	Tx_En)	/* maybe  0x7b01 */
L
Linus Torvalds 已提交
343 344
#endif
#define RX_CTL_CMD	(Rx_EnGood | Rx_EnRxPar | Rx_EnLongErr | Rx_EnOver \
A
Atsushi Nemoto 已提交
345
	| Rx_EnCRCErr | Rx_EnAlign | Rx_StripCRC | Rx_RxEn) /* maybe 0x6f11 */
L
Linus Torvalds 已提交
346
#define INT_EN_CMD  (Int_NRAbtEn | \
A
Atsushi Nemoto 已提交
347
	Int_DmParErrEn | Int_DParDEn | Int_DParErrEn | \
L
Linus Torvalds 已提交
348 349 350
	Int_SSysErrEn  | Int_RMasAbtEn | Int_RTargAbtEn | \
	Int_STargAbtEn | \
	Int_BLExEn  | Int_FDAExEn) /* maybe 0xb7f*/
A
Atsushi Nemoto 已提交
351
#define DMA_CTL_CMD	DMA_BURST_SIZE
A
Atsushi Nemoto 已提交
352
#define HAVE_DMA_RXALIGN(lp)	likely((lp)->chiptype != TC35815CF)
L
Linus Torvalds 已提交
353 354 355 356

/* Tuning parameters */
#define DMA_BURST_SIZE	32
#define TX_THRESHOLD	1024
A
Atsushi Nemoto 已提交
357 358 359 360
/* used threshold with packet max byte for low pci transfer ability.*/
#define TX_THRESHOLD_MAX 1536
/* setting threshold max value when overrun error occured this count. */
#define TX_THRESHOLD_KEEP_LIMIT 10
L
Linus Torvalds 已提交
361

A
Atsushi Nemoto 已提交
362 363
/* 16 + RX_BUF_NUM * 8 + RX_FD_NUM * 16 + TX_FD_NUM * 32 <= PAGE_SIZE*FD_PAGE_NUM */
#ifdef TC35815_USE_PACKEDBUFFER
L
Linus Torvalds 已提交
364
#define FD_PAGE_NUM 2
A
Atsushi Nemoto 已提交
365
#define RX_BUF_NUM	8	/* >= 2 */
L
Linus Torvalds 已提交
366 367
#define RX_FD_NUM	250	/* >= 32 */
#define TX_FD_NUM	128
A
Atsushi Nemoto 已提交
368 369 370 371 372 373 374 375 376
#define RX_BUF_SIZE	PAGE_SIZE
#else /* TC35815_USE_PACKEDBUFFER */
#define FD_PAGE_NUM 4
#define RX_BUF_NUM	128	/* < 256 */
#define RX_FD_NUM	256	/* >= 32 */
#define TX_FD_NUM	128
#if RX_CTL_CMD & Rx_LongEn
#define RX_BUF_SIZE	PAGE_SIZE
#elif RX_CTL_CMD & Rx_StripCRC
A
Atsushi Nemoto 已提交
377 378
#define RX_BUF_SIZE	\
	L1_CACHE_ALIGN(ETH_FRAME_LEN + VLAN_HLEN + NET_IP_ALIGN)
A
Atsushi Nemoto 已提交
379
#else
A
Atsushi Nemoto 已提交
380 381
#define RX_BUF_SIZE	\
	L1_CACHE_ALIGN(ETH_FRAME_LEN + VLAN_HLEN + ETH_FCS_LEN + NET_IP_ALIGN)
A
Atsushi Nemoto 已提交
382 383 384 385
#endif
#endif /* TC35815_USE_PACKEDBUFFER */
#define RX_FD_RESERVE	(2 / 2)	/* max 2 BD per RxFD */
#define NAPI_WEIGHT	16
L
Linus Torvalds 已提交
386 387 388 389 390 391 392 393 394 395 396 397 398 399

struct TxFD {
	struct FDesc fd;
	struct BDesc bd;
	struct BDesc unused;
};

struct RxFD {
	struct FDesc fd;
	struct BDesc bd[0];	/* variable length */
};

struct FrFD {
	struct FDesc fd;
A
Atsushi Nemoto 已提交
400
	struct BDesc bd[RX_BUF_NUM];
L
Linus Torvalds 已提交
401 402 403
};


404 405
#define tc_readl(addr)	ioread32(addr)
#define tc_writel(d, addr)	iowrite32(d, addr)
L
Linus Torvalds 已提交
406

A
Atsushi Nemoto 已提交
407 408
#define TC35815_TX_TIMEOUT  msecs_to_jiffies(400)

A
Atsushi Nemoto 已提交
409
/* Information that need to be kept for each controller. */
L
Linus Torvalds 已提交
410
struct tc35815_local {
A
Atsushi Nemoto 已提交
411
	struct pci_dev *pci_dev;
L
Linus Torvalds 已提交
412

413 414 415
	struct net_device *dev;
	struct napi_struct napi;

L
Linus Torvalds 已提交
416 417 418 419 420
	/* statistics */
	struct {
		int max_tx_qlen;
		int tx_ints;
		int rx_ints;
A
Atsushi Nemoto 已提交
421
		int tx_underrun;
L
Linus Torvalds 已提交
422 423
	} lstats;

A
Atsushi Nemoto 已提交
424 425 426 427 428 429 430
	/* Tx control lock.  This protects the transmit buffer ring
	 * state along with the "tx full" state of the driver.  This
	 * means all netif_queue flow control actions are protected
	 * by this lock as well.
	 */
	spinlock_t lock;

431
	struct mii_bus *mii_bus;
A
Atsushi Nemoto 已提交
432 433 434 435 436
	struct phy_device *phy_dev;
	int duplex;
	int speed;
	int link;
	struct work_struct restart_work;
L
Linus Torvalds 已提交
437 438 439 440

	/*
	 * Transmitting: Batch Mode.
	 *	1 BD in 1 TxFD.
A
Atsushi Nemoto 已提交
441
	 * Receiving: Packing Mode. (TC35815_USE_PACKEDBUFFER)
L
Linus Torvalds 已提交
442
	 *	1 circular FD for Free Buffer List.
A
Atsushi Nemoto 已提交
443
	 *	RX_BUF_NUM BD in Free Buffer FD.
L
Linus Torvalds 已提交
444
	 *	One Free Buffer BD has PAGE_SIZE data buffer.
A
Atsushi Nemoto 已提交
445 446 447 448
	 * Or Non-Packing Mode.
	 *	1 circular FD for Free Buffer List.
	 *	RX_BUF_NUM BD in Free Buffer FD.
	 *	One Free Buffer BD has ETH_FRAME_LEN data buffer.
L
Linus Torvalds 已提交
449
	 */
A
Atsushi Nemoto 已提交
450
	void *fd_buf;	/* for TxFD, RxFD, FrFD */
A
Atsushi Nemoto 已提交
451
	dma_addr_t fd_buf_dma;
L
Linus Torvalds 已提交
452
	struct TxFD *tfd_base;
A
Atsushi Nemoto 已提交
453 454
	unsigned int tfd_start;
	unsigned int tfd_end;
L
Linus Torvalds 已提交
455 456 457 458
	struct RxFD *rfd_base;
	struct RxFD *rfd_limit;
	struct RxFD *rfd_cur;
	struct FrFD *fbl_ptr;
A
Atsushi Nemoto 已提交
459
#ifdef TC35815_USE_PACKEDBUFFER
L
Linus Torvalds 已提交
460
	unsigned char fbl_curid;
A
Atsushi Nemoto 已提交
461
	void *data_buf[RX_BUF_NUM];		/* packing */
A
Atsushi Nemoto 已提交
462 463 464 465 466 467 468 469 470 471 472 473 474
	dma_addr_t data_buf_dma[RX_BUF_NUM];
	struct {
		struct sk_buff *skb;
		dma_addr_t skb_dma;
	} tx_skbs[TX_FD_NUM];
#else
	unsigned int fbl_count;
	struct {
		struct sk_buff *skb;
		dma_addr_t skb_dma;
	} tx_skbs[TX_FD_NUM], rx_skbs[RX_BUF_NUM];
#endif
	u32 msg_enable;
A
Atsushi Nemoto 已提交
475
	enum tc35815_chiptype chiptype;
L
Linus Torvalds 已提交
476 477
};

A
Atsushi Nemoto 已提交
478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501
static inline dma_addr_t fd_virt_to_bus(struct tc35815_local *lp, void *virt)
{
	return lp->fd_buf_dma + ((u8 *)virt - (u8 *)lp->fd_buf);
}
#ifdef DEBUG
static inline void *fd_bus_to_virt(struct tc35815_local *lp, dma_addr_t bus)
{
	return (void *)((u8 *)lp->fd_buf + (bus - lp->fd_buf_dma));
}
#endif
#ifdef TC35815_USE_PACKEDBUFFER
static inline void *rxbuf_bus_to_virt(struct tc35815_local *lp, dma_addr_t bus)
{
	int i;
	for (i = 0; i < RX_BUF_NUM; i++) {
		if (bus >= lp->data_buf_dma[i] &&
		    bus < lp->data_buf_dma[i] + PAGE_SIZE)
			return (void *)((u8 *)lp->data_buf[i] +
					(bus - lp->data_buf_dma[i]));
	}
	return NULL;
}

#define TC35815_DMA_SYNC_ONDEMAND
A
Atsushi Nemoto 已提交
502
static void *alloc_rxbuf_page(struct pci_dev *hwdev, dma_addr_t *dma_handle)
A
Atsushi Nemoto 已提交
503 504 505 506 507
{
#ifdef TC35815_DMA_SYNC_ONDEMAND
	void *buf;
	/* pci_map + pci_dma_sync will be more effective than
	 * pci_alloc_consistent on some archs. */
A
Atsushi Nemoto 已提交
508 509
	buf = (void *)__get_free_page(GFP_ATOMIC);
	if (!buf)
A
Atsushi Nemoto 已提交
510 511 512
		return NULL;
	*dma_handle = pci_map_single(hwdev, buf, PAGE_SIZE,
				     PCI_DMA_FROMDEVICE);
513
	if (pci_dma_mapping_error(hwdev, *dma_handle)) {
A
Atsushi Nemoto 已提交
514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542
		free_page((unsigned long)buf);
		return NULL;
	}
	return buf;
#else
	return pci_alloc_consistent(hwdev, PAGE_SIZE, dma_handle);
#endif
}

static void free_rxbuf_page(struct pci_dev *hwdev, void *buf, dma_addr_t dma_handle)
{
#ifdef TC35815_DMA_SYNC_ONDEMAND
	pci_unmap_single(hwdev, dma_handle, PAGE_SIZE, PCI_DMA_FROMDEVICE);
	free_page((unsigned long)buf);
#else
	pci_free_consistent(hwdev, PAGE_SIZE, buf, dma_handle);
#endif
}
#else /* TC35815_USE_PACKEDBUFFER */
static struct sk_buff *alloc_rxbuf_skb(struct net_device *dev,
				       struct pci_dev *hwdev,
				       dma_addr_t *dma_handle)
{
	struct sk_buff *skb;
	skb = dev_alloc_skb(RX_BUF_SIZE);
	if (!skb)
		return NULL;
	*dma_handle = pci_map_single(hwdev, skb->data, RX_BUF_SIZE,
				     PCI_DMA_FROMDEVICE);
543
	if (pci_dma_mapping_error(hwdev, *dma_handle)) {
A
Atsushi Nemoto 已提交
544 545 546 547 548 549 550 551 552 553 554 555 556 557
		dev_kfree_skb_any(skb);
		return NULL;
	}
	skb_reserve(skb, 2);	/* make IP header 4byte aligned */
	return skb;
}

static void free_rxbuf_skb(struct pci_dev *hwdev, struct sk_buff *skb, dma_addr_t dma_handle)
{
	pci_unmap_single(hwdev, dma_handle, RX_BUF_SIZE,
			 PCI_DMA_FROMDEVICE);
	dev_kfree_skb_any(skb);
}
#endif /* TC35815_USE_PACKEDBUFFER */
L
Linus Torvalds 已提交
558

A
Atsushi Nemoto 已提交
559
/* Index to functions, as function prototypes. */
L
Linus Torvalds 已提交
560 561 562

static int	tc35815_open(struct net_device *dev);
static int	tc35815_send_packet(struct sk_buff *skb, struct net_device *dev);
A
Atsushi Nemoto 已提交
563 564 565
static irqreturn_t	tc35815_interrupt(int irq, void *dev_id);
#ifdef TC35815_NAPI
static int	tc35815_rx(struct net_device *dev, int limit);
566
static int	tc35815_poll(struct napi_struct *napi, int budget);
A
Atsushi Nemoto 已提交
567
#else
L
Linus Torvalds 已提交
568
static void	tc35815_rx(struct net_device *dev);
A
Atsushi Nemoto 已提交
569
#endif
L
Linus Torvalds 已提交
570 571 572 573
static void	tc35815_txdone(struct net_device *dev);
static int	tc35815_close(struct net_device *dev);
static struct	net_device_stats *tc35815_get_stats(struct net_device *dev);
static void	tc35815_set_multicast_list(struct net_device *dev);
A
Atsushi Nemoto 已提交
574
static void	tc35815_tx_timeout(struct net_device *dev);
A
Atsushi Nemoto 已提交
575 576 577 578 579
static int	tc35815_ioctl(struct net_device *dev, struct ifreq *rq, int cmd);
#ifdef CONFIG_NET_POLL_CONTROLLER
static void	tc35815_poll_controller(struct net_device *dev);
#endif
static const struct ethtool_ops tc35815_ethtool_ops;
L
Linus Torvalds 已提交
580

A
Atsushi Nemoto 已提交
581
/* Example routines you must write ;->. */
A
Atsushi Nemoto 已提交
582 583
static void	tc35815_chip_reset(struct net_device *dev);
static void	tc35815_chip_init(struct net_device *dev);
L
Linus Torvalds 已提交
584

A
Atsushi Nemoto 已提交
585 586 587
#ifdef DEBUG
static void	panic_queues(struct net_device *dev);
#endif
L
Linus Torvalds 已提交
588

A
Atsushi Nemoto 已提交
589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690
static void tc35815_restart_work(struct work_struct *work);

static int tc_mdio_read(struct mii_bus *bus, int mii_id, int regnum)
{
	struct net_device *dev = bus->priv;
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;
	unsigned long timeout = jiffies + 10;

	tc_writel(MD_CA_Busy | (mii_id << 5) | (regnum & 0x1f), &tr->MD_CA);
	while (tc_readl(&tr->MD_CA) & MD_CA_Busy) {
		if (time_after(jiffies, timeout))
			return -EIO;
		cpu_relax();
	}
	return tc_readl(&tr->MD_Data) & 0xffff;
}

static int tc_mdio_write(struct mii_bus *bus, int mii_id, int regnum, u16 val)
{
	struct net_device *dev = bus->priv;
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;
	unsigned long timeout = jiffies + 10;

	tc_writel(val, &tr->MD_Data);
	tc_writel(MD_CA_Busy | MD_CA_Wr | (mii_id << 5) | (regnum & 0x1f),
		  &tr->MD_CA);
	while (tc_readl(&tr->MD_CA) & MD_CA_Busy) {
		if (time_after(jiffies, timeout))
			return -EIO;
		cpu_relax();
	}
	return 0;
}

static void tc_handle_link_change(struct net_device *dev)
{
	struct tc35815_local *lp = netdev_priv(dev);
	struct phy_device *phydev = lp->phy_dev;
	unsigned long flags;
	int status_change = 0;

	spin_lock_irqsave(&lp->lock, flags);
	if (phydev->link &&
	    (lp->speed != phydev->speed || lp->duplex != phydev->duplex)) {
		struct tc35815_regs __iomem *tr =
			(struct tc35815_regs __iomem *)dev->base_addr;
		u32 reg;

		reg = tc_readl(&tr->MAC_Ctl);
		reg |= MAC_HaltReq;
		tc_writel(reg, &tr->MAC_Ctl);
		if (phydev->duplex == DUPLEX_FULL)
			reg |= MAC_FullDup;
		else
			reg &= ~MAC_FullDup;
		tc_writel(reg, &tr->MAC_Ctl);
		reg &= ~MAC_HaltReq;
		tc_writel(reg, &tr->MAC_Ctl);

		/*
		 * TX4939 PCFG.SPEEDn bit will be changed on
		 * NETDEV_CHANGE event.
		 */

#if !defined(NO_CHECK_CARRIER) && defined(WORKAROUND_LOSTCAR)
		/*
		 * WORKAROUND: enable LostCrS only if half duplex
		 * operation.
		 * (TX4939 does not have EnLCarr)
		 */
		if (phydev->duplex == DUPLEX_HALF &&
		    lp->chiptype != TC35815_TX4939)
			tc_writel(tc_readl(&tr->Tx_Ctl) | Tx_EnLCarr,
				  &tr->Tx_Ctl);
#endif

		lp->speed = phydev->speed;
		lp->duplex = phydev->duplex;
		status_change = 1;
	}

	if (phydev->link != lp->link) {
		if (phydev->link) {
#ifdef WORKAROUND_100HALF_PROMISC
			/* delayed promiscuous enabling */
			if (dev->flags & IFF_PROMISC)
				tc35815_set_multicast_list(dev);
#endif
		} else {
			lp->speed = 0;
			lp->duplex = -1;
		}
		lp->link = phydev->link;

		status_change = 1;
	}
	spin_unlock_irqrestore(&lp->lock, flags);

	if (status_change && netif_msg_link(lp)) {
		phy_print_status(phydev);
691 692 693 694 695
		pr_debug("%s: MII BMCR %04x BMSR %04x LPA %04x\n",
			 dev->name,
			 phy_read(phydev, MII_BMCR),
			 phy_read(phydev, MII_BMSR),
			 phy_read(phydev, MII_LPA));
A
Atsushi Nemoto 已提交
696 697 698 699 700 701 702 703 704 705 706 707
	}
}

static int tc_mii_probe(struct net_device *dev)
{
	struct tc35815_local *lp = netdev_priv(dev);
	struct phy_device *phydev = NULL;
	int phy_addr;
	u32 dropmask;

	/* find the first phy */
	for (phy_addr = 0; phy_addr < PHY_MAX_ADDR; phy_addr++) {
708
		if (lp->mii_bus->phy_map[phy_addr]) {
A
Atsushi Nemoto 已提交
709 710 711 712 713
			if (phydev) {
				printk(KERN_ERR "%s: multiple PHYs found\n",
				       dev->name);
				return -EINVAL;
			}
714
			phydev = lp->mii_bus->phy_map[phy_addr];
A
Atsushi Nemoto 已提交
715 716 717 718 719 720 721 722 723 724
			break;
		}
	}

	if (!phydev) {
		printk(KERN_ERR "%s: no PHY found\n", dev->name);
		return -ENODEV;
	}

	/* attach the mac to the phy */
725
	phydev = phy_connect(dev, dev_name(&phydev->dev),
A
Atsushi Nemoto 已提交
726 727 728 729 730 731 732 733 734
			     &tc_handle_link_change, 0,
			     lp->chiptype == TC35815_TX4939 ?
			     PHY_INTERFACE_MODE_RMII : PHY_INTERFACE_MODE_MII);
	if (IS_ERR(phydev)) {
		printk(KERN_ERR "%s: Could not attach to PHY\n", dev->name);
		return PTR_ERR(phydev);
	}
	printk(KERN_INFO "%s: attached PHY driver [%s] "
		"(mii_bus:phy_addr=%s, id=%x)\n",
735
		dev->name, phydev->drv->name, dev_name(&phydev->dev),
A
Atsushi Nemoto 已提交
736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765
		phydev->phy_id);

	/* mask with MAC supported features */
	phydev->supported &= PHY_BASIC_FEATURES;
	dropmask = 0;
	if (options.speed == 10)
		dropmask |= SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full;
	else if (options.speed == 100)
		dropmask |= SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full;
	if (options.duplex == 1)
		dropmask |= SUPPORTED_10baseT_Full | SUPPORTED_100baseT_Full;
	else if (options.duplex == 2)
		dropmask |= SUPPORTED_10baseT_Half | SUPPORTED_100baseT_Half;
	phydev->supported &= ~dropmask;
	phydev->advertising = phydev->supported;

	lp->link = 0;
	lp->speed = 0;
	lp->duplex = -1;
	lp->phy_dev = phydev;

	return 0;
}

static int tc_mii_init(struct net_device *dev)
{
	struct tc35815_local *lp = netdev_priv(dev);
	int err;
	int i;

766 767
	lp->mii_bus = mdiobus_alloc();
	if (lp->mii_bus == NULL) {
A
Atsushi Nemoto 已提交
768 769 770 771
		err = -ENOMEM;
		goto err_out;
	}

772 773 774 775 776 777 778 779 780 781 782 783 784
	lp->mii_bus->name = "tc35815_mii_bus";
	lp->mii_bus->read = tc_mdio_read;
	lp->mii_bus->write = tc_mdio_write;
	snprintf(lp->mii_bus->id, MII_BUS_ID_SIZE, "%x",
		 (lp->pci_dev->bus->number << 8) | lp->pci_dev->devfn);
	lp->mii_bus->priv = dev;
	lp->mii_bus->parent = &lp->pci_dev->dev;
	lp->mii_bus->irq = kmalloc(sizeof(int) * PHY_MAX_ADDR, GFP_KERNEL);
	if (!lp->mii_bus->irq) {
		err = -ENOMEM;
		goto err_out_free_mii_bus;
	}

A
Atsushi Nemoto 已提交
785
	for (i = 0; i < PHY_MAX_ADDR; i++)
786
		lp->mii_bus->irq[i] = PHY_POLL;
A
Atsushi Nemoto 已提交
787

788
	err = mdiobus_register(lp->mii_bus);
A
Atsushi Nemoto 已提交
789 790 791 792 793 794 795 796
	if (err)
		goto err_out_free_mdio_irq;
	err = tc_mii_probe(dev);
	if (err)
		goto err_out_unregister_bus;
	return 0;

err_out_unregister_bus:
797
	mdiobus_unregister(lp->mii_bus);
A
Atsushi Nemoto 已提交
798
err_out_free_mdio_irq:
799
	kfree(lp->mii_bus->irq);
A
Adrian Bunk 已提交
800
err_out_free_mii_bus:
801
	mdiobus_free(lp->mii_bus);
A
Atsushi Nemoto 已提交
802 803 804
err_out:
	return err;
}
L
Linus Torvalds 已提交
805

806 807 808 809 810 811 812 813 814 815
#ifdef CONFIG_CPU_TX49XX
/*
 * Find a platform_device providing a MAC address.  The platform code
 * should provide a "tc35815-mac" device with a MAC address in its
 * platform_data.
 */
static int __devinit tc35815_mac_match(struct device *dev, void *data)
{
	struct platform_device *plat_dev = to_platform_device(dev);
	struct pci_dev *pci_dev = data;
816
	unsigned int id = pci_dev->irq;
817 818 819 820 821
	return !strcmp(plat_dev->name, "tc35815-mac") && plat_dev->id == id;
}

static int __devinit tc35815_read_plat_dev_addr(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
822
	struct tc35815_local *lp = netdev_priv(dev);
823 824 825 826 827 828 829 830 831 832 833
	struct device *pd = bus_find_device(&platform_bus_type, NULL,
					    lp->pci_dev, tc35815_mac_match);
	if (pd) {
		if (pd->platform_data)
			memcpy(dev->dev_addr, pd->platform_data, ETH_ALEN);
		put_device(pd);
		return is_valid_ether_addr(dev->dev_addr) ? 0 : -ENODEV;
	}
	return -ENODEV;
}
#else
834
static int __devinit tc35815_read_plat_dev_addr(struct net_device *dev)
835 836 837 838 839
{
	return -ENODEV;
}
#endif

A
Atsushi Nemoto 已提交
840
static int __devinit tc35815_init_dev_addr(struct net_device *dev)
A
Atsushi Nemoto 已提交
841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856
{
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;
	int i;

	while (tc_readl(&tr->PROM_Ctl) & PROM_Busy)
		;
	for (i = 0; i < 6; i += 2) {
		unsigned short data;
		tc_writel(PROM_Busy | PROM_Read | (i / 2 + 2), &tr->PROM_Ctl);
		while (tc_readl(&tr->PROM_Ctl) & PROM_Busy)
			;
		data = tc_readl(&tr->PROM_Data);
		dev->dev_addr[i] = data & 0xff;
		dev->dev_addr[i+1] = data >> 8;
	}
857 858 859
	if (!is_valid_ether_addr(dev->dev_addr))
		return tc35815_read_plat_dev_addr(dev);
	return 0;
A
Atsushi Nemoto 已提交
860
}
L
Linus Torvalds 已提交
861

862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877
static const struct net_device_ops tc35815_netdev_ops = {
	.ndo_open		= tc35815_open,
	.ndo_stop		= tc35815_close,
	.ndo_start_xmit		= tc35815_send_packet,
	.ndo_get_stats		= tc35815_get_stats,
	.ndo_set_multicast_list	= tc35815_set_multicast_list,
	.ndo_tx_timeout		= tc35815_tx_timeout,
	.ndo_do_ioctl		= tc35815_ioctl,
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_change_mtu		= eth_change_mtu,
	.ndo_set_mac_address	= eth_mac_addr,
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= tc35815_poll_controller,
#endif
};

A
Atsushi Nemoto 已提交
878 879
static int __devinit tc35815_init_one(struct pci_dev *pdev,
				      const struct pci_device_id *ent)
L
Linus Torvalds 已提交
880
{
A
Atsushi Nemoto 已提交
881 882 883 884 885 886 887 888 889
	void __iomem *ioaddr = NULL;
	struct net_device *dev;
	struct tc35815_local *lp;
	int rc;

	static int printed_version;
	if (!printed_version++) {
		printk(version);
		dev_printk(KERN_DEBUG, &pdev->dev,
A
Atsushi Nemoto 已提交
890 891
			   "speed:%d duplex:%d\n",
			   options.speed, options.duplex);
A
Atsushi Nemoto 已提交
892 893 894 895 896 897
	}

	if (!pdev->irq) {
		dev_warn(&pdev->dev, "no IRQ assigned.\n");
		return -ENODEV;
	}
L
Linus Torvalds 已提交
898

A
Atsushi Nemoto 已提交
899
	/* dev zeroed in alloc_etherdev */
A
Atsushi Nemoto 已提交
900
	dev = alloc_etherdev(sizeof(*lp));
A
Atsushi Nemoto 已提交
901 902 903 904 905
	if (dev == NULL) {
		dev_err(&pdev->dev, "unable to alloc new ethernet\n");
		return -ENOMEM;
	}
	SET_NETDEV_DEV(dev, &pdev->dev);
A
Atsushi Nemoto 已提交
906
	lp = netdev_priv(dev);
907
	lp->dev = dev;
L
Linus Torvalds 已提交
908

A
Atsushi Nemoto 已提交
909
	/* enable device (incl. PCI PM wakeup), and bus-mastering */
910
	rc = pcim_enable_device(pdev);
A
Atsushi Nemoto 已提交
911 912
	if (rc)
		goto err_out;
913
	rc = pcim_iomap_regions(pdev, 1 << 1, MODNAME);
A
Atsushi Nemoto 已提交
914
	if (rc)
L
Linus Torvalds 已提交
915
		goto err_out;
916 917
	pci_set_master(pdev);
	ioaddr = pcim_iomap_table(pdev)[1];
L
Linus Torvalds 已提交
918

A
Atsushi Nemoto 已提交
919
	/* Initialize the device structure. */
920
	dev->netdev_ops = &tc35815_netdev_ops;
A
Atsushi Nemoto 已提交
921 922 923
	dev->ethtool_ops = &tc35815_ethtool_ops;
	dev->watchdog_timeo = TC35815_TX_TIMEOUT;
#ifdef TC35815_NAPI
924
	netif_napi_add(dev, &lp->napi, tc35815_poll, NAPI_WEIGHT);
A
Atsushi Nemoto 已提交
925
#endif
L
Linus Torvalds 已提交
926

A
Atsushi Nemoto 已提交
927
	dev->irq = pdev->irq;
A
Atsushi Nemoto 已提交
928
	dev->base_addr = (unsigned long)ioaddr;
L
Linus Torvalds 已提交
929

A
Atsushi Nemoto 已提交
930
	INIT_WORK(&lp->restart_work, tc35815_restart_work);
A
Atsushi Nemoto 已提交
931 932
	spin_lock_init(&lp->lock);
	lp->pci_dev = pdev;
A
Atsushi Nemoto 已提交
933
	lp->chiptype = ent->driver_data;
L
Linus Torvalds 已提交
934

A
Atsushi Nemoto 已提交
935 936
	lp->msg_enable = NETIF_MSG_TX_ERR | NETIF_MSG_HW | NETIF_MSG_DRV | NETIF_MSG_LINK;
	pci_set_drvdata(pdev, dev);
L
Linus Torvalds 已提交
937

A
Atsushi Nemoto 已提交
938
	/* Soft reset the chip. */
L
Linus Torvalds 已提交
939 940
	tc35815_chip_reset(dev);

A
Atsushi Nemoto 已提交
941
	/* Retrieve the ethernet address. */
942 943 944 945
	if (tc35815_init_dev_addr(dev)) {
		dev_warn(&pdev->dev, "not valid ether addr\n");
		random_ether_addr(dev->dev_addr);
	}
A
Atsushi Nemoto 已提交
946

A
Atsushi Nemoto 已提交
947
	rc = register_netdev(dev);
A
Atsushi Nemoto 已提交
948
	if (rc)
949
		goto err_out;
A
Atsushi Nemoto 已提交
950 951

	memcpy(dev->perm_addr, dev->dev_addr, dev->addr_len);
J
Johannes Berg 已提交
952
	printk(KERN_INFO "%s: %s at 0x%lx, %pM, IRQ %d\n",
A
Atsushi Nemoto 已提交
953
		dev->name,
A
Atsushi Nemoto 已提交
954
		chip_info[ent->driver_data].name,
A
Atsushi Nemoto 已提交
955
		dev->base_addr,
J
Johannes Berg 已提交
956
		dev->dev_addr,
A
Atsushi Nemoto 已提交
957 958
		dev->irq);

A
Atsushi Nemoto 已提交
959 960 961
	rc = tc_mii_init(dev);
	if (rc)
		goto err_out_unregister;
L
Linus Torvalds 已提交
962

A
Atsushi Nemoto 已提交
963
	return 0;
L
Linus Torvalds 已提交
964

A
Atsushi Nemoto 已提交
965 966
err_out_unregister:
	unregister_netdev(dev);
A
Atsushi Nemoto 已提交
967
err_out:
A
Atsushi Nemoto 已提交
968
	free_netdev(dev);
A
Atsushi Nemoto 已提交
969 970
	return rc;
}
L
Linus Torvalds 已提交
971 972


A
Atsushi Nemoto 已提交
973
static void __devexit tc35815_remove_one(struct pci_dev *pdev)
A
Atsushi Nemoto 已提交
974
{
A
Atsushi Nemoto 已提交
975
	struct net_device *dev = pci_get_drvdata(pdev);
A
Atsushi Nemoto 已提交
976
	struct tc35815_local *lp = netdev_priv(dev);
L
Linus Torvalds 已提交
977

A
Atsushi Nemoto 已提交
978
	phy_disconnect(lp->phy_dev);
979 980 981
	mdiobus_unregister(lp->mii_bus);
	kfree(lp->mii_bus->irq);
	mdiobus_free(lp->mii_bus);
A
Atsushi Nemoto 已提交
982 983 984
	unregister_netdev(dev);
	free_netdev(dev);
	pci_set_drvdata(pdev, NULL);
L
Linus Torvalds 已提交
985 986 987 988 989
}

static int
tc35815_init_queues(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
990
	struct tc35815_local *lp = netdev_priv(dev);
L
Linus Torvalds 已提交
991 992 993 994
	int i;
	unsigned long fd_addr;

	if (!lp->fd_buf) {
A
Atsushi Nemoto 已提交
995 996 997 998 999
		BUG_ON(sizeof(struct FDesc) +
		       sizeof(struct BDesc) * RX_BUF_NUM +
		       sizeof(struct FDesc) * RX_FD_NUM +
		       sizeof(struct TxFD) * TX_FD_NUM >
		       PAGE_SIZE * FD_PAGE_NUM);
L
Linus Torvalds 已提交
1000

A
Atsushi Nemoto 已提交
1001 1002 1003 1004
		lp->fd_buf = pci_alloc_consistent(lp->pci_dev,
						  PAGE_SIZE * FD_PAGE_NUM,
						  &lp->fd_buf_dma);
		if (!lp->fd_buf)
L
Linus Torvalds 已提交
1005
			return -ENOMEM;
A
Atsushi Nemoto 已提交
1006 1007
		for (i = 0; i < RX_BUF_NUM; i++) {
#ifdef TC35815_USE_PACKEDBUFFER
A
Atsushi Nemoto 已提交
1008 1009 1010 1011
			lp->data_buf[i] =
				alloc_rxbuf_page(lp->pci_dev,
						 &lp->data_buf_dma[i]);
			if (!lp->data_buf[i]) {
L
Linus Torvalds 已提交
1012
				while (--i >= 0) {
A
Atsushi Nemoto 已提交
1013 1014 1015 1016
					free_rxbuf_page(lp->pci_dev,
							lp->data_buf[i],
							lp->data_buf_dma[i]);
					lp->data_buf[i] = NULL;
L
Linus Torvalds 已提交
1017
				}
A
Atsushi Nemoto 已提交
1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040
				pci_free_consistent(lp->pci_dev,
						    PAGE_SIZE * FD_PAGE_NUM,
						    lp->fd_buf,
						    lp->fd_buf_dma);
				lp->fd_buf = NULL;
				return -ENOMEM;
			}
#else
			lp->rx_skbs[i].skb =
				alloc_rxbuf_skb(dev, lp->pci_dev,
						&lp->rx_skbs[i].skb_dma);
			if (!lp->rx_skbs[i].skb) {
				while (--i >= 0) {
					free_rxbuf_skb(lp->pci_dev,
						       lp->rx_skbs[i].skb,
						       lp->rx_skbs[i].skb_dma);
					lp->rx_skbs[i].skb = NULL;
				}
				pci_free_consistent(lp->pci_dev,
						    PAGE_SIZE * FD_PAGE_NUM,
						    lp->fd_buf,
						    lp->fd_buf_dma);
				lp->fd_buf = NULL;
L
Linus Torvalds 已提交
1041 1042 1043 1044
				return -ENOMEM;
			}
#endif
		}
A
Atsushi Nemoto 已提交
1045 1046 1047 1048 1049 1050
		printk(KERN_DEBUG "%s: FD buf %p DataBuf",
		       dev->name, lp->fd_buf);
#ifdef TC35815_USE_PACKEDBUFFER
		printk(" DataBuf");
		for (i = 0; i < RX_BUF_NUM; i++)
			printk(" %p", lp->data_buf[i]);
L
Linus Torvalds 已提交
1051
#endif
A
Atsushi Nemoto 已提交
1052
		printk("\n");
L
Linus Torvalds 已提交
1053
	} else {
A
Atsushi Nemoto 已提交
1054 1055 1056
		for (i = 0; i < FD_PAGE_NUM; i++)
			clear_page((void *)((unsigned long)lp->fd_buf +
					    i * PAGE_SIZE));
L
Linus Torvalds 已提交
1057 1058 1059 1060 1061 1062
	}
	fd_addr = (unsigned long)lp->fd_buf;

	/* Free Descriptors (for Receive) */
	lp->rfd_base = (struct RxFD *)fd_addr;
	fd_addr += sizeof(struct RxFD) * RX_FD_NUM;
A
Atsushi Nemoto 已提交
1063
	for (i = 0; i < RX_FD_NUM; i++)
L
Linus Torvalds 已提交
1064 1065
		lp->rfd_base[i].fd.FDCtl = cpu_to_le32(FD_CownsFD);
	lp->rfd_cur = lp->rfd_base;
A
Atsushi Nemoto 已提交
1066
	lp->rfd_limit = (struct RxFD *)fd_addr - (RX_FD_RESERVE + 1);
L
Linus Torvalds 已提交
1067 1068 1069 1070 1071

	/* Transmit Descriptors */
	lp->tfd_base = (struct TxFD *)fd_addr;
	fd_addr += sizeof(struct TxFD) * TX_FD_NUM;
	for (i = 0; i < TX_FD_NUM; i++) {
A
Atsushi Nemoto 已提交
1072 1073
		lp->tfd_base[i].fd.FDNext = cpu_to_le32(fd_virt_to_bus(lp, &lp->tfd_base[i+1]));
		lp->tfd_base[i].fd.FDSystem = cpu_to_le32(0xffffffff);
L
Linus Torvalds 已提交
1074 1075
		lp->tfd_base[i].fd.FDCtl = cpu_to_le32(0);
	}
A
Atsushi Nemoto 已提交
1076
	lp->tfd_base[TX_FD_NUM-1].fd.FDNext = cpu_to_le32(fd_virt_to_bus(lp, &lp->tfd_base[0]));
L
Linus Torvalds 已提交
1077 1078 1079 1080 1081
	lp->tfd_start = 0;
	lp->tfd_end = 0;

	/* Buffer List (for Receive) */
	lp->fbl_ptr = (struct FrFD *)fd_addr;
A
Atsushi Nemoto 已提交
1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114
	lp->fbl_ptr->fd.FDNext = cpu_to_le32(fd_virt_to_bus(lp, lp->fbl_ptr));
	lp->fbl_ptr->fd.FDCtl = cpu_to_le32(RX_BUF_NUM | FD_CownsFD);
#ifndef TC35815_USE_PACKEDBUFFER
	/*
	 * move all allocated skbs to head of rx_skbs[] array.
	 * fbl_count mighe not be RX_BUF_NUM if alloc_rxbuf_skb() in
	 * tc35815_rx() had failed.
	 */
	lp->fbl_count = 0;
	for (i = 0; i < RX_BUF_NUM; i++) {
		if (lp->rx_skbs[i].skb) {
			if (i != lp->fbl_count) {
				lp->rx_skbs[lp->fbl_count].skb =
					lp->rx_skbs[i].skb;
				lp->rx_skbs[lp->fbl_count].skb_dma =
					lp->rx_skbs[i].skb_dma;
			}
			lp->fbl_count++;
		}
	}
#endif
	for (i = 0; i < RX_BUF_NUM; i++) {
#ifdef TC35815_USE_PACKEDBUFFER
		lp->fbl_ptr->bd[i].BuffData = cpu_to_le32(lp->data_buf_dma[i]);
#else
		if (i >= lp->fbl_count) {
			lp->fbl_ptr->bd[i].BuffData = 0;
			lp->fbl_ptr->bd[i].BDCtl = 0;
			continue;
		}
		lp->fbl_ptr->bd[i].BuffData =
			cpu_to_le32(lp->rx_skbs[i].skb_dma);
#endif
L
Linus Torvalds 已提交
1115 1116
		/* BDID is index of FrFD.bd[] */
		lp->fbl_ptr->bd[i].BDCtl =
A
Atsushi Nemoto 已提交
1117 1118
			cpu_to_le32(BD_CownsBD | (i << BD_RxBDID_SHIFT) |
				    RX_BUF_SIZE);
L
Linus Torvalds 已提交
1119
	}
A
Atsushi Nemoto 已提交
1120
#ifdef TC35815_USE_PACKEDBUFFER
L
Linus Torvalds 已提交
1121
	lp->fbl_curid = 0;
A
Atsushi Nemoto 已提交
1122
#endif
L
Linus Torvalds 已提交
1123

A
Atsushi Nemoto 已提交
1124 1125
	printk(KERN_DEBUG "%s: TxFD %p RxFD %p FrFD %p\n",
	       dev->name, lp->tfd_base, lp->rfd_base, lp->fbl_ptr);
L
Linus Torvalds 已提交
1126 1127 1128 1129 1130 1131
	return 0;
}

static void
tc35815_clear_queues(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
1132
	struct tc35815_local *lp = netdev_priv(dev);
L
Linus Torvalds 已提交
1133 1134 1135
	int i;

	for (i = 0; i < TX_FD_NUM; i++) {
A
Atsushi Nemoto 已提交
1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151
		u32 fdsystem = le32_to_cpu(lp->tfd_base[i].fd.FDSystem);
		struct sk_buff *skb =
			fdsystem != 0xffffffff ?
			lp->tx_skbs[fdsystem].skb : NULL;
#ifdef DEBUG
		if (lp->tx_skbs[i].skb != skb) {
			printk("%s: tx_skbs mismatch(%d).\n", dev->name, i);
			panic_queues(dev);
		}
#else
		BUG_ON(lp->tx_skbs[i].skb != skb);
#endif
		if (skb) {
			pci_unmap_single(lp->pci_dev, lp->tx_skbs[i].skb_dma, skb->len, PCI_DMA_TODEVICE);
			lp->tx_skbs[i].skb = NULL;
			lp->tx_skbs[i].skb_dma = 0;
L
Linus Torvalds 已提交
1152
			dev_kfree_skb_any(skb);
A
Atsushi Nemoto 已提交
1153 1154
		}
		lp->tfd_base[i].fd.FDSystem = cpu_to_le32(0xffffffff);
L
Linus Torvalds 已提交
1155 1156 1157 1158 1159 1160 1161 1162
	}

	tc35815_init_queues(dev);
}

static void
tc35815_free_queues(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
1163
	struct tc35815_local *lp = netdev_priv(dev);
L
Linus Torvalds 已提交
1164 1165 1166 1167
	int i;

	if (lp->tfd_base) {
		for (i = 0; i < TX_FD_NUM; i++) {
A
Atsushi Nemoto 已提交
1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186
			u32 fdsystem = le32_to_cpu(lp->tfd_base[i].fd.FDSystem);
			struct sk_buff *skb =
				fdsystem != 0xffffffff ?
				lp->tx_skbs[fdsystem].skb : NULL;
#ifdef DEBUG
			if (lp->tx_skbs[i].skb != skb) {
				printk("%s: tx_skbs mismatch(%d).\n", dev->name, i);
				panic_queues(dev);
			}
#else
			BUG_ON(lp->tx_skbs[i].skb != skb);
#endif
			if (skb) {
				dev_kfree_skb(skb);
				pci_unmap_single(lp->pci_dev, lp->tx_skbs[i].skb_dma, skb->len, PCI_DMA_TODEVICE);
				lp->tx_skbs[i].skb = NULL;
				lp->tx_skbs[i].skb_dma = 0;
			}
			lp->tfd_base[i].fd.FDSystem = cpu_to_le32(0xffffffff);
L
Linus Torvalds 已提交
1187 1188 1189 1190 1191 1192 1193 1194
		}
	}

	lp->rfd_base = NULL;
	lp->rfd_limit = NULL;
	lp->rfd_cur = NULL;
	lp->fbl_ptr = NULL;

A
Atsushi Nemoto 已提交
1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213
	for (i = 0; i < RX_BUF_NUM; i++) {
#ifdef TC35815_USE_PACKEDBUFFER
		if (lp->data_buf[i]) {
			free_rxbuf_page(lp->pci_dev,
					lp->data_buf[i], lp->data_buf_dma[i]);
			lp->data_buf[i] = NULL;
		}
#else
		if (lp->rx_skbs[i].skb) {
			free_rxbuf_skb(lp->pci_dev, lp->rx_skbs[i].skb,
				       lp->rx_skbs[i].skb_dma);
			lp->rx_skbs[i].skb = NULL;
		}
#endif
	}
	if (lp->fd_buf) {
		pci_free_consistent(lp->pci_dev, PAGE_SIZE * FD_PAGE_NUM,
				    lp->fd_buf, lp->fd_buf_dma);
		lp->fd_buf = NULL;
L
Linus Torvalds 已提交
1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243
	}
}

static void
dump_txfd(struct TxFD *fd)
{
	printk("TxFD(%p): %08x %08x %08x %08x\n", fd,
	       le32_to_cpu(fd->fd.FDNext),
	       le32_to_cpu(fd->fd.FDSystem),
	       le32_to_cpu(fd->fd.FDStat),
	       le32_to_cpu(fd->fd.FDCtl));
	printk("BD: ");
	printk(" %08x %08x",
	       le32_to_cpu(fd->bd.BuffData),
	       le32_to_cpu(fd->bd.BDCtl));
	printk("\n");
}

static int
dump_rxfd(struct RxFD *fd)
{
	int i, bd_count = (le32_to_cpu(fd->fd.FDCtl) & FD_BDCnt_MASK) >> FD_BDCnt_SHIFT;
	if (bd_count > 8)
		bd_count = 8;
	printk("RxFD(%p): %08x %08x %08x %08x\n", fd,
	       le32_to_cpu(fd->fd.FDNext),
	       le32_to_cpu(fd->fd.FDSystem),
	       le32_to_cpu(fd->fd.FDStat),
	       le32_to_cpu(fd->fd.FDCtl));
	if (le32_to_cpu(fd->fd.FDCtl) & FD_CownsFD)
A
Atsushi Nemoto 已提交
1244
		return 0;
L
Linus Torvalds 已提交
1245 1246 1247 1248 1249 1250 1251 1252 1253
	printk("BD: ");
	for (i = 0; i < bd_count; i++)
		printk(" %08x %08x",
		       le32_to_cpu(fd->bd[i].BuffData),
		       le32_to_cpu(fd->bd[i].BDCtl));
	printk("\n");
	return bd_count;
}

A
Atsushi Nemoto 已提交
1254
#if defined(DEBUG) || defined(TC35815_USE_PACKEDBUFFER)
L
Linus Torvalds 已提交
1255 1256 1257 1258 1259 1260 1261 1262 1263 1264
static void
dump_frfd(struct FrFD *fd)
{
	int i;
	printk("FrFD(%p): %08x %08x %08x %08x\n", fd,
	       le32_to_cpu(fd->fd.FDNext),
	       le32_to_cpu(fd->fd.FDSystem),
	       le32_to_cpu(fd->fd.FDStat),
	       le32_to_cpu(fd->fd.FDCtl));
	printk("BD: ");
A
Atsushi Nemoto 已提交
1265
	for (i = 0; i < RX_BUF_NUM; i++)
L
Linus Torvalds 已提交
1266 1267 1268 1269 1270
		printk(" %08x %08x",
		       le32_to_cpu(fd->bd[i].BuffData),
		       le32_to_cpu(fd->bd[i].BDCtl));
	printk("\n");
}
A
Atsushi Nemoto 已提交
1271
#endif
L
Linus Torvalds 已提交
1272

A
Atsushi Nemoto 已提交
1273
#ifdef DEBUG
L
Linus Torvalds 已提交
1274 1275 1276
static void
panic_queues(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
1277
	struct tc35815_local *lp = netdev_priv(dev);
L
Linus Torvalds 已提交
1278 1279
	int i;

A
Atsushi Nemoto 已提交
1280
	printk("TxFD base %p, start %u, end %u\n",
L
Linus Torvalds 已提交
1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295
	       lp->tfd_base, lp->tfd_start, lp->tfd_end);
	printk("RxFD base %p limit %p cur %p\n",
	       lp->rfd_base, lp->rfd_limit, lp->rfd_cur);
	printk("FrFD %p\n", lp->fbl_ptr);
	for (i = 0; i < TX_FD_NUM; i++)
		dump_txfd(&lp->tfd_base[i]);
	for (i = 0; i < RX_FD_NUM; i++) {
		int bd_count = dump_rxfd(&lp->rfd_base[i]);
		i += (bd_count + 1) / 2;	/* skip BDs */
	}
	dump_frfd(lp->fbl_ptr);
	panic("%s: Illegal queue state.", dev->name);
}
#endif

A
Atsushi Nemoto 已提交
1296
static void print_eth(const u8 *add)
L
Linus Torvalds 已提交
1297
{
A
Atsushi Nemoto 已提交
1298
	printk(KERN_DEBUG "print_eth(%p)\n", add);
J
Johannes Berg 已提交
1299 1300
	printk(KERN_DEBUG " %pM => %pM : %02x%02x\n",
		add + 6, add, add[12], add[13]);
L
Linus Torvalds 已提交
1301 1302
}

A
Atsushi Nemoto 已提交
1303 1304
static int tc35815_tx_full(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
1305
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
1306 1307 1308 1309 1310
	return ((lp->tfd_start + 1) % TX_FD_NUM == lp->tfd_end);
}

static void tc35815_restart(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
1311
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
1312

A
Atsushi Nemoto 已提交
1313
	if (lp->phy_dev) {
A
Atsushi Nemoto 已提交
1314
		int timeout;
A
Atsushi Nemoto 已提交
1315 1316

		phy_write(lp->phy_dev, MII_BMCR, BMCR_RESET);
A
Atsushi Nemoto 已提交
1317 1318
		timeout = 100;
		while (--timeout) {
A
Atsushi Nemoto 已提交
1319
			if (!(phy_read(lp->phy_dev, MII_BMCR) & BMCR_RESET))
A
Atsushi Nemoto 已提交
1320 1321 1322 1323 1324 1325 1326
				break;
			udelay(1);
		}
		if (!timeout)
			printk(KERN_ERR "%s: BMCR reset failed.\n", dev->name);
	}

A
Atsushi Nemoto 已提交
1327
	spin_lock_irq(&lp->lock);
A
Atsushi Nemoto 已提交
1328 1329 1330 1331 1332
	tc35815_chip_reset(dev);
	tc35815_clear_queues(dev);
	tc35815_chip_init(dev);
	/* Reconfigure CAM again since tc35815_chip_init() initialize it. */
	tc35815_set_multicast_list(dev);
A
Atsushi Nemoto 已提交
1333 1334 1335
	spin_unlock_irq(&lp->lock);

	netif_wake_queue(dev);
A
Atsushi Nemoto 已提交
1336 1337
}

A
Atsushi Nemoto 已提交
1338 1339 1340 1341 1342 1343 1344 1345 1346 1347
static void tc35815_restart_work(struct work_struct *work)
{
	struct tc35815_local *lp =
		container_of(work, struct tc35815_local, restart_work);
	struct net_device *dev = lp->dev;

	tc35815_restart(dev);
}

static void tc35815_schedule_restart(struct net_device *dev)
A
Atsushi Nemoto 已提交
1348
{
A
Atsushi Nemoto 已提交
1349
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
1350 1351 1352
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;

A
Atsushi Nemoto 已提交
1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363
	/* disable interrupts */
	tc_writel(0, &tr->Int_En);
	tc_writel(tc_readl(&tr->DMA_Ctl) | DMA_IntMask, &tr->DMA_Ctl);
	schedule_work(&lp->restart_work);
}

static void tc35815_tx_timeout(struct net_device *dev)
{
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;

A
Atsushi Nemoto 已提交
1364 1365 1366 1367
	printk(KERN_WARNING "%s: transmit timed out, status %#x\n",
	       dev->name, tc_readl(&tr->Tx_Stat));

	/* Try to restart the adaptor. */
A
Atsushi Nemoto 已提交
1368
	tc35815_schedule_restart(dev);
A
Atsushi Nemoto 已提交
1369
	dev->stats.tx_errors++;
A
Atsushi Nemoto 已提交
1370 1371
}

L
Linus Torvalds 已提交
1372
/*
A
Atsushi Nemoto 已提交
1373
 * Open/initialize the controller. This is called (in the current kernel)
L
Linus Torvalds 已提交
1374 1375 1376 1377 1378 1379 1380 1381 1382
 * sometime after booting when the 'ifconfig' program is run.
 *
 * This routine should set everything up anew at each open, even
 * registers that "should" only need to be set once at boot, so that
 * there is non-reboot way to recover if something goes wrong.
 */
static int
tc35815_open(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
1383
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
1384

L
Linus Torvalds 已提交
1385 1386 1387 1388
	/*
	 * This is used if the interrupt line can turned off (shared).
	 * See 3c503.c for an example of selecting the IRQ at config-time.
	 */
A
Atsushi Nemoto 已提交
1389 1390
	if (request_irq(dev->irq, &tc35815_interrupt, IRQF_SHARED,
			dev->name, dev))
L
Linus Torvalds 已提交
1391 1392 1393 1394 1395 1396 1397 1398 1399
		return -EAGAIN;

	tc35815_chip_reset(dev);

	if (tc35815_init_queues(dev) != 0) {
		free_irq(dev->irq, dev);
		return -EAGAIN;
	}

1400 1401 1402 1403
#ifdef TC35815_NAPI
	napi_enable(&lp->napi);
#endif

L
Linus Torvalds 已提交
1404
	/* Reset the hardware here. Don't forget to set the station address. */
A
Atsushi Nemoto 已提交
1405
	spin_lock_irq(&lp->lock);
L
Linus Torvalds 已提交
1406
	tc35815_chip_init(dev);
A
Atsushi Nemoto 已提交
1407
	spin_unlock_irq(&lp->lock);
L
Linus Torvalds 已提交
1408

1409
	netif_carrier_off(dev);
A
Atsushi Nemoto 已提交
1410 1411 1412
	/* schedule a link state check */
	phy_start(lp->phy_dev);

A
Atsushi Nemoto 已提交
1413 1414 1415
	/* We are now ready to accept transmit requeusts from
	 * the queueing layer of the networking.
	 */
L
Linus Torvalds 已提交
1416 1417 1418 1419 1420
	netif_start_queue(dev);

	return 0;
}

A
Atsushi Nemoto 已提交
1421 1422 1423 1424 1425 1426
/* This will only be invoked if your driver is _not_ in XOFF state.
 * What this means is that you need not check it, and that this
 * invariant will hold if you make sure that the netif_*_queue()
 * calls are done at the proper times.
 */
static int tc35815_send_packet(struct sk_buff *skb, struct net_device *dev)
L
Linus Torvalds 已提交
1427
{
A
Atsushi Nemoto 已提交
1428
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
1429
	struct TxFD *txfd;
L
Linus Torvalds 已提交
1430 1431
	unsigned long flags;

A
Atsushi Nemoto 已提交
1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445
	/* If some error occurs while trying to transmit this
	 * packet, you should return '1' from this function.
	 * In such a case you _may not_ do anything to the
	 * SKB, it is still owned by the network queueing
	 * layer when an error is returned.  This means you
	 * may not modify any SKB fields, you may not free
	 * the SKB, etc.
	 */

	/* This is the most common case for modern hardware.
	 * The spinlock protects this code from the TX complete
	 * hardware interrupt handler.  Queue flow control is
	 * thus managed under this lock as well.
	 */
L
Linus Torvalds 已提交
1446 1447
	spin_lock_irqsave(&lp->lock, flags);

A
Atsushi Nemoto 已提交
1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458
	/* failsafe... (handle txdone now if half of FDs are used) */
	if ((lp->tfd_start + TX_FD_NUM - lp->tfd_end) % TX_FD_NUM >
	    TX_FD_NUM / 2)
		tc35815_txdone(dev);

	if (netif_msg_pktdata(lp))
		print_eth(skb->data);
#ifdef DEBUG
	if (lp->tx_skbs[lp->tfd_start].skb) {
		printk("%s: tx_skbs conflict.\n", dev->name);
		panic_queues(dev);
L
Linus Torvalds 已提交
1459
	}
A
Atsushi Nemoto 已提交
1460 1461
#else
	BUG_ON(lp->tx_skbs[lp->tfd_start].skb);
L
Linus Torvalds 已提交
1462
#endif
A
Atsushi Nemoto 已提交
1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477
	lp->tx_skbs[lp->tfd_start].skb = skb;
	lp->tx_skbs[lp->tfd_start].skb_dma = pci_map_single(lp->pci_dev, skb->data, skb->len, PCI_DMA_TODEVICE);

	/*add to ring */
	txfd = &lp->tfd_base[lp->tfd_start];
	txfd->bd.BuffData = cpu_to_le32(lp->tx_skbs[lp->tfd_start].skb_dma);
	txfd->bd.BDCtl = cpu_to_le32(skb->len);
	txfd->fd.FDSystem = cpu_to_le32(lp->tfd_start);
	txfd->fd.FDCtl = cpu_to_le32(FD_CownsFD | (1 << FD_BDCnt_SHIFT));

	if (lp->tfd_start == lp->tfd_end) {
		struct tc35815_regs __iomem *tr =
			(struct tc35815_regs __iomem *)dev->base_addr;
		/* Start DMA Transmitter. */
		txfd->fd.FDNext |= cpu_to_le32(FD_Next_EOL);
L
Linus Torvalds 已提交
1478
#ifdef GATHER_TXINT
A
Atsushi Nemoto 已提交
1479
		txfd->fd.FDCtl |= cpu_to_le32(FD_FrmOpt_IntTx);
L
Linus Torvalds 已提交
1480
#endif
A
Atsushi Nemoto 已提交
1481 1482 1483 1484 1485 1486 1487 1488 1489 1490
		if (netif_msg_tx_queued(lp)) {
			printk("%s: starting TxFD.\n", dev->name);
			dump_txfd(txfd);
		}
		tc_writel(fd_virt_to_bus(lp, txfd), &tr->TxFrmPtr);
	} else {
		txfd->fd.FDNext &= cpu_to_le32(~FD_Next_EOL);
		if (netif_msg_tx_queued(lp)) {
			printk("%s: queueing TxFD.\n", dev->name);
			dump_txfd(txfd);
L
Linus Torvalds 已提交
1491
		}
A
Atsushi Nemoto 已提交
1492 1493
	}
	lp->tfd_start = (lp->tfd_start + 1) % TX_FD_NUM;
L
Linus Torvalds 已提交
1494

A
Atsushi Nemoto 已提交
1495
	dev->trans_start = jiffies;
L
Linus Torvalds 已提交
1496

A
Atsushi Nemoto 已提交
1497 1498 1499 1500 1501 1502 1503 1504
	/* If we just used up the very last entry in the
	 * TX ring on this device, tell the queueing
	 * layer to send no more.
	 */
	if (tc35815_tx_full(dev)) {
		if (netif_msg_tx_queued(lp))
			printk(KERN_WARNING "%s: TxFD Exhausted.\n", dev->name);
		netif_stop_queue(dev);
L
Linus Torvalds 已提交
1505 1506
	}

A
Atsushi Nemoto 已提交
1507 1508 1509 1510 1511
	/* When the TX completion hw interrupt arrives, this
	 * is when the transmit statistics are updated.
	 */

	spin_unlock_irqrestore(&lp->lock, flags);
1512
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
1513 1514 1515 1516
}

#define FATAL_ERROR_INT \
	(Int_IntPCI | Int_DmParErr | Int_IntNRAbt)
A
Atsushi Nemoto 已提交
1517
static void tc35815_fatal_error_interrupt(struct net_device *dev, u32 status)
L
Linus Torvalds 已提交
1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530
{
	static int count;
	printk(KERN_WARNING "%s: Fatal Error Intterrupt (%#x):",
	       dev->name, status);
	if (status & Int_IntPCI)
		printk(" IntPCI");
	if (status & Int_DmParErr)
		printk(" DmParErr");
	if (status & Int_IntNRAbt)
		printk(" IntNRAbt");
	printk("\n");
	if (count++ > 100)
		panic("%s: Too many fatal errors.", dev->name);
A
Atsushi Nemoto 已提交
1531
	printk(KERN_WARNING "%s: Resetting ...\n", dev->name);
L
Linus Torvalds 已提交
1532
	/* Try to restart the adaptor. */
A
Atsushi Nemoto 已提交
1533
	tc35815_schedule_restart(dev);
A
Atsushi Nemoto 已提交
1534 1535 1536 1537 1538 1539 1540 1541
}

#ifdef TC35815_NAPI
static int tc35815_do_interrupt(struct net_device *dev, u32 status, int limit)
#else
static int tc35815_do_interrupt(struct net_device *dev, u32 status)
#endif
{
A
Atsushi Nemoto 已提交
1542
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;
	int ret = -1;

	/* Fatal errors... */
	if (status & FATAL_ERROR_INT) {
		tc35815_fatal_error_interrupt(dev, status);
		return 0;
	}
	/* recoverable errors */
	if (status & Int_IntFDAEx) {
		/* disable FDAEx int. (until we make rooms...) */
		tc_writel(tc_readl(&tr->Int_En) & ~Int_FDAExEn, &tr->Int_En);
		printk(KERN_WARNING
		       "%s: Free Descriptor Area Exhausted (%#x).\n",
		       dev->name, status);
A
Atsushi Nemoto 已提交
1559
		dev->stats.rx_dropped++;
A
Atsushi Nemoto 已提交
1560 1561 1562 1563 1564 1565 1566 1567
		ret = 0;
	}
	if (status & Int_IntBLEx) {
		/* disable BLEx int. (until we make rooms...) */
		tc_writel(tc_readl(&tr->Int_En) & ~Int_BLExEn, &tr->Int_En);
		printk(KERN_WARNING
		       "%s: Buffer List Exhausted (%#x).\n",
		       dev->name, status);
A
Atsushi Nemoto 已提交
1568
		dev->stats.rx_dropped++;
A
Atsushi Nemoto 已提交
1569 1570 1571 1572 1573 1574
		ret = 0;
	}
	if (status & Int_IntExBD) {
		printk(KERN_WARNING
		       "%s: Excessive Buffer Descriptiors (%#x).\n",
		       dev->name, status);
A
Atsushi Nemoto 已提交
1575
		dev->stats.rx_length_errors++;
A
Atsushi Nemoto 已提交
1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597
		ret = 0;
	}

	/* normal notification */
	if (status & Int_IntMacRx) {
		/* Got a packet(s). */
#ifdef TC35815_NAPI
		ret = tc35815_rx(dev, limit);
#else
		tc35815_rx(dev);
		ret = 0;
#endif
		lp->lstats.rx_ints++;
	}
	if (status & Int_IntMacTx) {
		/* Transmit complete. */
		lp->lstats.tx_ints++;
		tc35815_txdone(dev);
		netif_wake_queue(dev);
		ret = 0;
	}
	return ret;
L
Linus Torvalds 已提交
1598 1599 1600 1601
}

/*
 * The typical workload of the driver:
A
Atsushi Nemoto 已提交
1602
 * Handle the network interface interrupts.
L
Linus Torvalds 已提交
1603
 */
1604
static irqreturn_t tc35815_interrupt(int irq, void *dev_id)
L
Linus Torvalds 已提交
1605 1606
{
	struct net_device *dev = dev_id;
1607
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
1608 1609 1610 1611 1612 1613 1614 1615
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;
#ifdef TC35815_NAPI
	u32 dmactl = tc_readl(&tr->DMA_Ctl);

	if (!(dmactl & DMA_IntMask)) {
		/* disable interrupts */
		tc_writel(dmactl | DMA_IntMask, &tr->DMA_Ctl);
1616 1617
		if (napi_schedule_prep(&lp->napi))
			__napi_schedule(&lp->napi);
A
Atsushi Nemoto 已提交
1618 1619 1620 1621
		else {
			printk(KERN_ERR "%s: interrupt taken in poll\n",
			       dev->name);
			BUG();
L
Linus Torvalds 已提交
1622
		}
A
Atsushi Nemoto 已提交
1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639
		(void)tc_readl(&tr->Int_Src);	/* flush */
		return IRQ_HANDLED;
	}
	return IRQ_NONE;
#else
	int handled;
	u32 status;

	spin_lock(&lp->lock);
	status = tc_readl(&tr->Int_Src);
	tc_writel(status, &tr->Int_Src);	/* write to clear */
	handled = tc35815_do_interrupt(dev, status);
	(void)tc_readl(&tr->Int_Src);	/* flush */
	spin_unlock(&lp->lock);
	return IRQ_RETVAL(handled >= 0);
#endif /* TC35815_NAPI */
}
L
Linus Torvalds 已提交
1640

A
Atsushi Nemoto 已提交
1641 1642 1643 1644 1645 1646
#ifdef CONFIG_NET_POLL_CONTROLLER
static void tc35815_poll_controller(struct net_device *dev)
{
	disable_irq(dev->irq);
	tc35815_interrupt(dev->irq, dev);
	enable_irq(dev->irq);
L
Linus Torvalds 已提交
1647
}
A
Atsushi Nemoto 已提交
1648
#endif
L
Linus Torvalds 已提交
1649 1650

/* We have a good packet(s), get it/them out of the buffers. */
A
Atsushi Nemoto 已提交
1651 1652 1653 1654
#ifdef TC35815_NAPI
static int
tc35815_rx(struct net_device *dev, int limit)
#else
L
Linus Torvalds 已提交
1655 1656
static void
tc35815_rx(struct net_device *dev)
A
Atsushi Nemoto 已提交
1657
#endif
L
Linus Torvalds 已提交
1658
{
A
Atsushi Nemoto 已提交
1659
	struct tc35815_local *lp = netdev_priv(dev);
L
Linus Torvalds 已提交
1660 1661 1662 1663
	unsigned int fdctl;
	int i;
	int buf_free_count = 0;
	int fd_free_count = 0;
A
Atsushi Nemoto 已提交
1664 1665 1666
#ifdef TC35815_NAPI
	int received = 0;
#endif
L
Linus Torvalds 已提交
1667 1668 1669 1670 1671

	while (!((fdctl = le32_to_cpu(lp->rfd_cur->fd.FDCtl)) & FD_CownsFD)) {
		int status = le32_to_cpu(lp->rfd_cur->fd.FDStat);
		int pkt_len = fdctl & FD_FDLength_MASK;
		int bd_count = (fdctl & FD_BDCnt_MASK) >> FD_BDCnt_SHIFT;
A
Atsushi Nemoto 已提交
1672 1673 1674 1675
#ifdef DEBUG
		struct RxFD *next_rfd;
#endif
#if (RX_CTL_CMD & Rx_StripCRC) == 0
A
Atsushi Nemoto 已提交
1676
		pkt_len -= ETH_FCS_LEN;
A
Atsushi Nemoto 已提交
1677
#endif
L
Linus Torvalds 已提交
1678

A
Atsushi Nemoto 已提交
1679
		if (netif_msg_rx_status(lp))
L
Linus Torvalds 已提交
1680 1681 1682 1683
			dump_rxfd(lp->rfd_cur);
		if (status & Rx_Good) {
			struct sk_buff *skb;
			unsigned char *data;
A
Atsushi Nemoto 已提交
1684 1685 1686 1687
			int cur_bd;
#ifdef TC35815_USE_PACKEDBUFFER
			int offset;
#endif
1688

A
Atsushi Nemoto 已提交
1689 1690 1691 1692 1693 1694
#ifdef TC35815_NAPI
			if (--limit < 0)
				break;
#endif
#ifdef TC35815_USE_PACKEDBUFFER
			BUG_ON(bd_count > 2);
A
Atsushi Nemoto 已提交
1695
			skb = dev_alloc_skb(pkt_len + NET_IP_ALIGN);
L
Linus Torvalds 已提交
1696 1697 1698
			if (skb == NULL) {
				printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n",
				       dev->name);
A
Atsushi Nemoto 已提交
1699
				dev->stats.rx_dropped++;
L
Linus Torvalds 已提交
1700 1701
				break;
			}
A
Atsushi Nemoto 已提交
1702
			skb_reserve(skb, NET_IP_ALIGN);
L
Linus Torvalds 已提交
1703 1704 1705 1706 1707 1708 1709 1710 1711

			data = skb_put(skb, pkt_len);

			/* copy from receive buffer */
			cur_bd = 0;
			offset = 0;
			while (offset < pkt_len && cur_bd < bd_count) {
				int len = le32_to_cpu(lp->rfd_cur->bd[cur_bd].BDCtl) &
					BD_BuffLength_MASK;
A
Atsushi Nemoto 已提交
1712 1713 1714 1715 1716 1717 1718 1719
				dma_addr_t dma = le32_to_cpu(lp->rfd_cur->bd[cur_bd].BuffData);
				void *rxbuf = rxbuf_bus_to_virt(lp, dma);
				if (offset + len > pkt_len)
					len = pkt_len - offset;
#ifdef TC35815_DMA_SYNC_ONDEMAND
				pci_dma_sync_single_for_cpu(lp->pci_dev,
							    dma, len,
							    PCI_DMA_FROMDEVICE);
L
Linus Torvalds 已提交
1720 1721
#endif
				memcpy(data + offset, rxbuf, len);
1722 1723 1724 1725 1726
#ifdef TC35815_DMA_SYNC_ONDEMAND
				pci_dma_sync_single_for_device(lp->pci_dev,
							       dma, len,
							       PCI_DMA_FROMDEVICE);
#endif
L
Linus Torvalds 已提交
1727 1728 1729
				offset += len;
				cur_bd++;
			}
A
Atsushi Nemoto 已提交
1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746
#else /* TC35815_USE_PACKEDBUFFER */
			BUG_ON(bd_count > 1);
			cur_bd = (le32_to_cpu(lp->rfd_cur->bd[0].BDCtl)
				  & BD_RxBDID_MASK) >> BD_RxBDID_SHIFT;
#ifdef DEBUG
			if (cur_bd >= RX_BUF_NUM) {
				printk("%s: invalid BDID.\n", dev->name);
				panic_queues(dev);
			}
			BUG_ON(lp->rx_skbs[cur_bd].skb_dma !=
			       (le32_to_cpu(lp->rfd_cur->bd[0].BuffData) & ~3));
			if (!lp->rx_skbs[cur_bd].skb) {
				printk("%s: NULL skb.\n", dev->name);
				panic_queues(dev);
			}
#else
			BUG_ON(cur_bd >= RX_BUF_NUM);
L
Linus Torvalds 已提交
1747
#endif
A
Atsushi Nemoto 已提交
1748 1749 1750 1751 1752 1753
			skb = lp->rx_skbs[cur_bd].skb;
			prefetch(skb->data);
			lp->rx_skbs[cur_bd].skb = NULL;
			pci_unmap_single(lp->pci_dev,
					 lp->rx_skbs[cur_bd].skb_dma,
					 RX_BUF_SIZE, PCI_DMA_FROMDEVICE);
A
Atsushi Nemoto 已提交
1754 1755 1756
			if (!HAVE_DMA_RXALIGN(lp) && NET_IP_ALIGN)
				memmove(skb->data, skb->data - NET_IP_ALIGN,
					pkt_len);
A
Atsushi Nemoto 已提交
1757 1758 1759
			data = skb_put(skb, pkt_len);
#endif /* TC35815_USE_PACKEDBUFFER */
			if (netif_msg_pktdata(lp))
L
Linus Torvalds 已提交
1760 1761
				print_eth(data);
			skb->protocol = eth_type_trans(skb, dev);
A
Atsushi Nemoto 已提交
1762 1763 1764 1765
#ifdef TC35815_NAPI
			netif_receive_skb(skb);
			received++;
#else
L
Linus Torvalds 已提交
1766
			netif_rx(skb);
A
Atsushi Nemoto 已提交
1767
#endif
A
Atsushi Nemoto 已提交
1768 1769
			dev->stats.rx_packets++;
			dev->stats.rx_bytes += pkt_len;
L
Linus Torvalds 已提交
1770
		} else {
A
Atsushi Nemoto 已提交
1771
			dev->stats.rx_errors++;
A
Atsushi Nemoto 已提交
1772 1773
			printk(KERN_DEBUG "%s: Rx error (status %x)\n",
			       dev->name, status & Rx_Stat_Mask);
L
Linus Torvalds 已提交
1774 1775 1776 1777 1778
			/* WORKAROUND: LongErr and CRCErr means Overflow. */
			if ((status & Rx_LongErr) && (status & Rx_CRCErr)) {
				status &= ~(Rx_LongErr|Rx_CRCErr);
				status |= Rx_Over;
			}
A
Atsushi Nemoto 已提交
1779 1780 1781 1782 1783 1784 1785 1786
			if (status & Rx_LongErr)
				dev->stats.rx_length_errors++;
			if (status & Rx_Over)
				dev->stats.rx_fifo_errors++;
			if (status & Rx_CRCErr)
				dev->stats.rx_crc_errors++;
			if (status & Rx_Align)
				dev->stats.rx_frame_errors++;
L
Linus Torvalds 已提交
1787 1788 1789 1790 1791 1792 1793
		}

		if (bd_count > 0) {
			/* put Free Buffer back to controller */
			int bdctl = le32_to_cpu(lp->rfd_cur->bd[bd_count - 1].BDCtl);
			unsigned char id =
				(bdctl & BD_RxBDID_MASK) >> BD_RxBDID_SHIFT;
A
Atsushi Nemoto 已提交
1794 1795
#ifdef DEBUG
			if (id >= RX_BUF_NUM) {
L
Linus Torvalds 已提交
1796 1797 1798
				printk("%s: invalid BDID.\n", dev->name);
				panic_queues(dev);
			}
A
Atsushi Nemoto 已提交
1799 1800 1801
#else
			BUG_ON(id >= RX_BUF_NUM);
#endif
L
Linus Torvalds 已提交
1802
			/* free old buffers */
A
Atsushi Nemoto 已提交
1803 1804 1805
#ifdef TC35815_USE_PACKEDBUFFER
			while (lp->fbl_curid != id)
#else
1806
			lp->fbl_count--;
A
Atsushi Nemoto 已提交
1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818
			while (lp->fbl_count < RX_BUF_NUM)
#endif
			{
#ifdef TC35815_USE_PACKEDBUFFER
				unsigned char curid = lp->fbl_curid;
#else
				unsigned char curid =
					(id + 1 + lp->fbl_count) % RX_BUF_NUM;
#endif
				struct BDesc *bd = &lp->fbl_ptr->bd[curid];
#ifdef DEBUG
				bdctl = le32_to_cpu(bd->BDCtl);
L
Linus Torvalds 已提交
1819 1820 1821 1822 1823
				if (bdctl & BD_CownsBD) {
					printk("%s: Freeing invalid BD.\n",
					       dev->name);
					panic_queues(dev);
				}
A
Atsushi Nemoto 已提交
1824
#endif
1825
				/* pass BD to controller */
A
Atsushi Nemoto 已提交
1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836
#ifndef TC35815_USE_PACKEDBUFFER
				if (!lp->rx_skbs[curid].skb) {
					lp->rx_skbs[curid].skb =
						alloc_rxbuf_skb(dev,
								lp->pci_dev,
								&lp->rx_skbs[curid].skb_dma);
					if (!lp->rx_skbs[curid].skb)
						break; /* try on next reception */
					bd->BuffData = cpu_to_le32(lp->rx_skbs[curid].skb_dma);
				}
#endif /* TC35815_USE_PACKEDBUFFER */
L
Linus Torvalds 已提交
1837
				/* Note: BDLength was modified by chip. */
A
Atsushi Nemoto 已提交
1838 1839 1840 1841 1842 1843
				bd->BDCtl = cpu_to_le32(BD_CownsBD |
							(curid << BD_RxBDID_SHIFT) |
							RX_BUF_SIZE);
#ifdef TC35815_USE_PACKEDBUFFER
				lp->fbl_curid = (curid + 1) % RX_BUF_NUM;
				if (netif_msg_rx_status(lp)) {
L
Linus Torvalds 已提交
1844 1845 1846 1847
					printk("%s: Entering new FBD %d\n",
					       dev->name, lp->fbl_curid);
					dump_frfd(lp->fbl_ptr);
				}
A
Atsushi Nemoto 已提交
1848 1849 1850
#else
				lp->fbl_count++;
#endif
L
Linus Torvalds 已提交
1851 1852 1853 1854 1855
				buf_free_count++;
			}
		}

		/* put RxFD back to controller */
A
Atsushi Nemoto 已提交
1856 1857 1858
#ifdef DEBUG
		next_rfd = fd_bus_to_virt(lp,
					  le32_to_cpu(lp->rfd_cur->fd.FDNext));
L
Linus Torvalds 已提交
1859 1860 1861 1862
		if (next_rfd < lp->rfd_base || next_rfd > lp->rfd_limit) {
			printk("%s: RxFD FDNext invalid.\n", dev->name);
			panic_queues(dev);
		}
A
Atsushi Nemoto 已提交
1863
#endif
L
Linus Torvalds 已提交
1864
		for (i = 0; i < (bd_count + 1) / 2 + 1; i++) {
1865
			/* pass FD to controller */
A
Atsushi Nemoto 已提交
1866 1867 1868 1869 1870
#ifdef DEBUG
			lp->rfd_cur->fd.FDNext = cpu_to_le32(0xdeaddead);
#else
			lp->rfd_cur->fd.FDNext = cpu_to_le32(FD_Next_EOL);
#endif
L
Linus Torvalds 已提交
1871 1872 1873 1874
			lp->rfd_cur->fd.FDCtl = cpu_to_le32(FD_CownsFD);
			lp->rfd_cur++;
			fd_free_count++;
		}
A
Atsushi Nemoto 已提交
1875 1876 1877 1878 1879 1880 1881
		if (lp->rfd_cur > lp->rfd_limit)
			lp->rfd_cur = lp->rfd_base;
#ifdef DEBUG
		if (lp->rfd_cur != next_rfd)
			printk("rfd_cur = %p, next_rfd %p\n",
			       lp->rfd_cur, next_rfd);
#endif
L
Linus Torvalds 已提交
1882 1883 1884 1885
	}

	/* re-enable BL/FDA Exhaust interrupts. */
	if (fd_free_count) {
A
Atsushi Nemoto 已提交
1886 1887 1888 1889
		struct tc35815_regs __iomem *tr =
			(struct tc35815_regs __iomem *)dev->base_addr;
		u32 en, en_old = tc_readl(&tr->Int_En);
		en = en_old | Int_FDAExEn;
L
Linus Torvalds 已提交
1890
		if (buf_free_count)
A
Atsushi Nemoto 已提交
1891 1892 1893
			en |= Int_BLExEn;
		if (en != en_old)
			tc_writel(en, &tr->Int_En);
L
Linus Torvalds 已提交
1894
	}
A
Atsushi Nemoto 已提交
1895 1896 1897
#ifdef TC35815_NAPI
	return received;
#endif
L
Linus Torvalds 已提交
1898 1899
}

A
Atsushi Nemoto 已提交
1900
#ifdef TC35815_NAPI
1901
static int tc35815_poll(struct napi_struct *napi, int budget)
A
Atsushi Nemoto 已提交
1902
{
1903 1904
	struct tc35815_local *lp = container_of(napi, struct tc35815_local, napi);
	struct net_device *dev = lp->dev;
A
Atsushi Nemoto 已提交
1905 1906 1907 1908 1909 1910 1911 1912 1913 1914
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;
	int received = 0, handled;
	u32 status;

	spin_lock(&lp->lock);
	status = tc_readl(&tr->Int_Src);
	do {
		tc_writel(status, &tr->Int_Src);	/* write to clear */

1915
		handled = tc35815_do_interrupt(dev, status, budget - received);
A
Atsushi Nemoto 已提交
1916 1917
		if (handled >= 0) {
			received += handled;
1918
			if (received >= budget)
A
Atsushi Nemoto 已提交
1919 1920 1921 1922 1923 1924
				break;
		}
		status = tc_readl(&tr->Int_Src);
	} while (status);
	spin_unlock(&lp->lock);

1925
	if (received < budget) {
1926
		napi_complete(napi);
1927 1928 1929 1930
		/* enable interrupts */
		tc_writel(tc_readl(&tr->DMA_Ctl) & ~DMA_IntMask, &tr->DMA_Ctl);
	}
	return received;
A
Atsushi Nemoto 已提交
1931 1932 1933
}
#endif

L
Linus Torvalds 已提交
1934 1935 1936 1937 1938 1939 1940 1941 1942
#ifdef NO_CHECK_CARRIER
#define TX_STA_ERR	(Tx_ExColl|Tx_Under|Tx_Defer|Tx_LateColl|Tx_TxPar|Tx_SQErr)
#else
#define TX_STA_ERR	(Tx_ExColl|Tx_Under|Tx_Defer|Tx_NCarr|Tx_LateColl|Tx_TxPar|Tx_SQErr)
#endif

static void
tc35815_check_tx_stat(struct net_device *dev, int status)
{
A
Atsushi Nemoto 已提交
1943
	struct tc35815_local *lp = netdev_priv(dev);
L
Linus Torvalds 已提交
1944 1945 1946 1947
	const char *msg = NULL;

	/* count collisions */
	if (status & Tx_ExColl)
A
Atsushi Nemoto 已提交
1948
		dev->stats.collisions += 16;
L
Linus Torvalds 已提交
1949
	if (status & Tx_TxColl_MASK)
A
Atsushi Nemoto 已提交
1950
		dev->stats.collisions += status & Tx_TxColl_MASK;
L
Linus Torvalds 已提交
1951

A
Atsushi Nemoto 已提交
1952 1953
#ifndef NO_CHECK_CARRIER
	/* TX4939 does not have NCarr */
A
Atsushi Nemoto 已提交
1954
	if (lp->chiptype == TC35815_TX4939)
A
Atsushi Nemoto 已提交
1955 1956
		status &= ~Tx_NCarr;
#ifdef WORKAROUND_LOSTCAR
L
Linus Torvalds 已提交
1957
	/* WORKAROUND: ignore LostCrS in full duplex operation */
A
Atsushi Nemoto 已提交
1958
	if (!lp->link || lp->duplex == DUPLEX_FULL)
L
Linus Torvalds 已提交
1959
		status &= ~Tx_NCarr;
A
Atsushi Nemoto 已提交
1960 1961
#endif
#endif
L
Linus Torvalds 已提交
1962 1963 1964

	if (!(status & TX_STA_ERR)) {
		/* no error. */
A
Atsushi Nemoto 已提交
1965
		dev->stats.tx_packets++;
L
Linus Torvalds 已提交
1966 1967 1968
		return;
	}

A
Atsushi Nemoto 已提交
1969
	dev->stats.tx_errors++;
L
Linus Torvalds 已提交
1970
	if (status & Tx_ExColl) {
A
Atsushi Nemoto 已提交
1971
		dev->stats.tx_aborted_errors++;
L
Linus Torvalds 已提交
1972 1973 1974
		msg = "Excessive Collision.";
	}
	if (status & Tx_Under) {
A
Atsushi Nemoto 已提交
1975
		dev->stats.tx_fifo_errors++;
L
Linus Torvalds 已提交
1976
		msg = "Tx FIFO Underrun.";
A
Atsushi Nemoto 已提交
1977 1978 1979 1980 1981 1982 1983 1984 1985
		if (lp->lstats.tx_underrun < TX_THRESHOLD_KEEP_LIMIT) {
			lp->lstats.tx_underrun++;
			if (lp->lstats.tx_underrun >= TX_THRESHOLD_KEEP_LIMIT) {
				struct tc35815_regs __iomem *tr =
					(struct tc35815_regs __iomem *)dev->base_addr;
				tc_writel(TX_THRESHOLD_MAX, &tr->TxThrsh);
				msg = "Tx FIFO Underrun.Change Tx threshold to max.";
			}
		}
L
Linus Torvalds 已提交
1986 1987
	}
	if (status & Tx_Defer) {
A
Atsushi Nemoto 已提交
1988
		dev->stats.tx_fifo_errors++;
L
Linus Torvalds 已提交
1989 1990 1991 1992
		msg = "Excessive Deferral.";
	}
#ifndef NO_CHECK_CARRIER
	if (status & Tx_NCarr) {
A
Atsushi Nemoto 已提交
1993
		dev->stats.tx_carrier_errors++;
L
Linus Torvalds 已提交
1994 1995 1996 1997
		msg = "Lost Carrier Sense.";
	}
#endif
	if (status & Tx_LateColl) {
A
Atsushi Nemoto 已提交
1998
		dev->stats.tx_aborted_errors++;
L
Linus Torvalds 已提交
1999 2000 2001
		msg = "Late Collision.";
	}
	if (status & Tx_TxPar) {
A
Atsushi Nemoto 已提交
2002
		dev->stats.tx_fifo_errors++;
L
Linus Torvalds 已提交
2003 2004 2005
		msg = "Transmit Parity Error.";
	}
	if (status & Tx_SQErr) {
A
Atsushi Nemoto 已提交
2006
		dev->stats.tx_heartbeat_errors++;
L
Linus Torvalds 已提交
2007 2008
		msg = "Signal Quality Error.";
	}
A
Atsushi Nemoto 已提交
2009
	if (msg && netif_msg_tx_err(lp))
L
Linus Torvalds 已提交
2010 2011 2012
		printk(KERN_WARNING "%s: %s (%#x)\n", dev->name, msg, status);
}

A
Atsushi Nemoto 已提交
2013 2014 2015
/* This handles TX complete events posted by the device
 * via interrupts.
 */
L
Linus Torvalds 已提交
2016 2017 2018
static void
tc35815_txdone(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
2019
	struct tc35815_local *lp = netdev_priv(dev);
L
Linus Torvalds 已提交
2020 2021 2022 2023 2024 2025 2026 2027 2028
	struct TxFD *txfd;
	unsigned int fdctl;

	txfd = &lp->tfd_base[lp->tfd_end];
	while (lp->tfd_start != lp->tfd_end &&
	       !((fdctl = le32_to_cpu(txfd->fd.FDCtl)) & FD_CownsFD)) {
		int status = le32_to_cpu(txfd->fd.FDStat);
		struct sk_buff *skb;
		unsigned long fdnext = le32_to_cpu(txfd->fd.FDNext);
A
Atsushi Nemoto 已提交
2029
		u32 fdsystem = le32_to_cpu(txfd->fd.FDSystem);
L
Linus Torvalds 已提交
2030

A
Atsushi Nemoto 已提交
2031
		if (netif_msg_tx_done(lp)) {
L
Linus Torvalds 已提交
2032 2033 2034 2035 2036
			printk("%s: complete TxFD.\n", dev->name);
			dump_txfd(txfd);
		}
		tc35815_check_tx_stat(dev, status);

A
Atsushi Nemoto 已提交
2037 2038 2039 2040 2041 2042 2043 2044 2045 2046
		skb = fdsystem != 0xffffffff ?
			lp->tx_skbs[fdsystem].skb : NULL;
#ifdef DEBUG
		if (lp->tx_skbs[lp->tfd_end].skb != skb) {
			printk("%s: tx_skbs mismatch.\n", dev->name);
			panic_queues(dev);
		}
#else
		BUG_ON(lp->tx_skbs[lp->tfd_end].skb != skb);
#endif
L
Linus Torvalds 已提交
2047
		if (skb) {
A
Atsushi Nemoto 已提交
2048
			dev->stats.tx_bytes += skb->len;
A
Atsushi Nemoto 已提交
2049 2050 2051 2052
			pci_unmap_single(lp->pci_dev, lp->tx_skbs[lp->tfd_end].skb_dma, skb->len, PCI_DMA_TODEVICE);
			lp->tx_skbs[lp->tfd_end].skb = NULL;
			lp->tx_skbs[lp->tfd_end].skb_dma = 0;
#ifdef TC35815_NAPI
L
Linus Torvalds 已提交
2053
			dev_kfree_skb_any(skb);
A
Atsushi Nemoto 已提交
2054 2055 2056
#else
			dev_kfree_skb_irq(skb);
#endif
L
Linus Torvalds 已提交
2057
		}
A
Atsushi Nemoto 已提交
2058
		txfd->fd.FDSystem = cpu_to_le32(0xffffffff);
L
Linus Torvalds 已提交
2059 2060 2061

		lp->tfd_end = (lp->tfd_end + 1) % TX_FD_NUM;
		txfd = &lp->tfd_base[lp->tfd_end];
A
Atsushi Nemoto 已提交
2062 2063
#ifdef DEBUG
		if ((fdnext & ~FD_Next_EOL) != fd_virt_to_bus(lp, txfd)) {
L
Linus Torvalds 已提交
2064 2065 2066
			printk("%s: TxFD FDNext invalid.\n", dev->name);
			panic_queues(dev);
		}
A
Atsushi Nemoto 已提交
2067
#endif
L
Linus Torvalds 已提交
2068 2069 2070
		if (fdnext & FD_Next_EOL) {
			/* DMA Transmitter has been stopping... */
			if (lp->tfd_end != lp->tfd_start) {
A
Atsushi Nemoto 已提交
2071 2072
				struct tc35815_regs __iomem *tr =
					(struct tc35815_regs __iomem *)dev->base_addr;
L
Linus Torvalds 已提交
2073
				int head = (lp->tfd_start + TX_FD_NUM - 1) % TX_FD_NUM;
A
Atsushi Nemoto 已提交
2074
				struct TxFD *txhead = &lp->tfd_base[head];
L
Linus Torvalds 已提交
2075 2076 2077
				int qlen = (lp->tfd_start + TX_FD_NUM
					    - lp->tfd_end) % TX_FD_NUM;

A
Atsushi Nemoto 已提交
2078
#ifdef DEBUG
L
Linus Torvalds 已提交
2079 2080 2081 2082
				if (!(le32_to_cpu(txfd->fd.FDCtl) & FD_CownsFD)) {
					printk("%s: TxFD FDCtl invalid.\n", dev->name);
					panic_queues(dev);
				}
A
Atsushi Nemoto 已提交
2083
#endif
L
Linus Torvalds 已提交
2084 2085 2086 2087 2088 2089 2090 2091 2092 2093
				/* log max queue length */
				if (lp->lstats.max_tx_qlen < qlen)
					lp->lstats.max_tx_qlen = qlen;


				/* start DMA Transmitter again */
				txhead->fd.FDNext |= cpu_to_le32(FD_Next_EOL);
#ifdef GATHER_TXINT
				txhead->fd.FDCtl |= cpu_to_le32(FD_FrmOpt_IntTx);
#endif
A
Atsushi Nemoto 已提交
2094
				if (netif_msg_tx_queued(lp)) {
L
Linus Torvalds 已提交
2095 2096 2097 2098
					printk("%s: start TxFD on queue.\n",
					       dev->name);
					dump_txfd(txfd);
				}
A
Atsushi Nemoto 已提交
2099
				tc_writel(fd_virt_to_bus(lp, txfd), &tr->TxFrmPtr);
L
Linus Torvalds 已提交
2100 2101 2102 2103 2104
			}
			break;
		}
	}

A
Atsushi Nemoto 已提交
2105 2106 2107 2108
	/* If we had stopped the queue due to a "tx full"
	 * condition, and space has now been made available,
	 * wake up the queue.
	 */
A
Atsushi Nemoto 已提交
2109
	if (netif_queue_stopped(dev) && !tc35815_tx_full(dev))
A
Atsushi Nemoto 已提交
2110
		netif_wake_queue(dev);
L
Linus Torvalds 已提交
2111 2112 2113 2114 2115 2116
}

/* The inverse routine to tc35815_open(). */
static int
tc35815_close(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
2117
	struct tc35815_local *lp = netdev_priv(dev);
2118

L
Linus Torvalds 已提交
2119
	netif_stop_queue(dev);
2120 2121 2122
#ifdef TC35815_NAPI
	napi_disable(&lp->napi);
#endif
A
Atsushi Nemoto 已提交
2123 2124 2125
	if (lp->phy_dev)
		phy_stop(lp->phy_dev);
	cancel_work_sync(&lp->restart_work);
L
Linus Torvalds 已提交
2126 2127 2128 2129 2130 2131 2132 2133

	/* Flush the Tx and disable Rx here. */
	tc35815_chip_reset(dev);
	free_irq(dev->irq, dev);

	tc35815_free_queues(dev);

	return 0;
A
Atsushi Nemoto 已提交
2134

L
Linus Torvalds 已提交
2135 2136 2137 2138 2139 2140 2141 2142
}

/*
 * Get the current statistics.
 * This may be called with the card open or closed.
 */
static struct net_device_stats *tc35815_get_stats(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
2143 2144
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;
A
Atsushi Nemoto 已提交
2145
	if (netif_running(dev))
L
Linus Torvalds 已提交
2146
		/* Update the statistics from the device registers. */
A
Atsushi Nemoto 已提交
2147
		dev->stats.rx_missed_errors = tc_readl(&tr->Miss_Cnt);
L
Linus Torvalds 已提交
2148

A
Atsushi Nemoto 已提交
2149
	return &dev->stats;
L
Linus Torvalds 已提交
2150 2151
}

A
Atsushi Nemoto 已提交
2152
static void tc35815_set_cam_entry(struct net_device *dev, int index, unsigned char *addr)
L
Linus Torvalds 已提交
2153
{
A
Atsushi Nemoto 已提交
2154
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2155 2156
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;
L
Linus Torvalds 已提交
2157
	int cam_index = index * 6;
A
Atsushi Nemoto 已提交
2158 2159
	u32 cam_data;
	u32 saved_addr;
A
Atsushi Nemoto 已提交
2160

L
Linus Torvalds 已提交
2161 2162
	saved_addr = tc_readl(&tr->CAM_Adr);

A
Atsushi Nemoto 已提交
2163
	if (netif_msg_hw(lp))
J
Johannes Berg 已提交
2164 2165
		printk(KERN_DEBUG "%s: CAM %d: %pM\n",
			dev->name, index, addr);
L
Linus Torvalds 已提交
2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201
	if (index & 1) {
		/* read modify write */
		tc_writel(cam_index - 2, &tr->CAM_Adr);
		cam_data = tc_readl(&tr->CAM_Data) & 0xffff0000;
		cam_data |= addr[0] << 8 | addr[1];
		tc_writel(cam_data, &tr->CAM_Data);
		/* write whole word */
		tc_writel(cam_index + 2, &tr->CAM_Adr);
		cam_data = (addr[2] << 24) | (addr[3] << 16) | (addr[4] << 8) | addr[5];
		tc_writel(cam_data, &tr->CAM_Data);
	} else {
		/* write whole word */
		tc_writel(cam_index, &tr->CAM_Adr);
		cam_data = (addr[0] << 24) | (addr[1] << 16) | (addr[2] << 8) | addr[3];
		tc_writel(cam_data, &tr->CAM_Data);
		/* read modify write */
		tc_writel(cam_index + 4, &tr->CAM_Adr);
		cam_data = tc_readl(&tr->CAM_Data) & 0x0000ffff;
		cam_data |= addr[4] << 24 | (addr[5] << 16);
		tc_writel(cam_data, &tr->CAM_Data);
	}

	tc_writel(saved_addr, &tr->CAM_Adr);
}


/*
 * Set or clear the multicast filter for this adaptor.
 * num_addrs == -1	Promiscuous mode, receive all packets
 * num_addrs == 0	Normal mode, clear multicast list
 * num_addrs > 0	Multicast mode, receive normal and MC packets,
 *			and do best-effort filtering.
 */
static void
tc35815_set_multicast_list(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
2202 2203
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;
L
Linus Torvalds 已提交
2204

A
Atsushi Nemoto 已提交
2205
	if (dev->flags & IFF_PROMISC) {
A
Atsushi Nemoto 已提交
2206 2207 2208
#ifdef WORKAROUND_100HALF_PROMISC
		/* With some (all?) 100MHalf HUB, controller will hang
		 * if we enabled promiscuous mode before linkup... */
A
Atsushi Nemoto 已提交
2209
		struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2210 2211

		if (!lp->link)
A
Atsushi Nemoto 已提交
2212 2213
			return;
#endif
L
Linus Torvalds 已提交
2214 2215
		/* Enable promiscuous mode */
		tc_writel(CAM_CompEn | CAM_BroadAcc | CAM_GroupAcc | CAM_StationAcc, &tr->CAM_Ctl);
A
Atsushi Nemoto 已提交
2216 2217
	} else if ((dev->flags & IFF_ALLMULTI) ||
		  dev->mc_count > CAM_ENTRY_MAX - 3) {
L
Linus Torvalds 已提交
2218 2219 2220
		/* CAM 0, 1, 20 are reserved. */
		/* Disable promiscuous mode, use normal mode. */
		tc_writel(CAM_CompEn | CAM_BroadAcc | CAM_GroupAcc, &tr->CAM_Ctl);
A
Atsushi Nemoto 已提交
2221 2222
	} else if (dev->mc_count) {
		struct dev_mc_list *cur_addr = dev->mc_list;
L
Linus Torvalds 已提交
2223 2224 2225 2226 2227 2228 2229 2230 2231
		int i;
		int ena_bits = CAM_Ena_Bit(CAM_ENTRY_SOURCE);

		tc_writel(0, &tr->CAM_Ctl);
		/* Walk the address list, and load the filter */
		for (i = 0; i < dev->mc_count; i++, cur_addr = cur_addr->next) {
			if (!cur_addr)
				break;
			/* entry 0,1 is reserved. */
A
Atsushi Nemoto 已提交
2232
			tc35815_set_cam_entry(dev, i + 2, cur_addr->dmi_addr);
L
Linus Torvalds 已提交
2233 2234 2235 2236
			ena_bits |= CAM_Ena_Bit(i + 2);
		}
		tc_writel(ena_bits, &tr->CAM_Ena);
		tc_writel(CAM_CompEn | CAM_BroadAcc, &tr->CAM_Ctl);
A
Atsushi Nemoto 已提交
2237
	} else {
L
Linus Torvalds 已提交
2238 2239 2240 2241 2242
		tc_writel(CAM_Ena_Bit(CAM_ENTRY_SOURCE), &tr->CAM_Ena);
		tc_writel(CAM_CompEn | CAM_BroadAcc, &tr->CAM_Ctl);
	}
}

A
Atsushi Nemoto 已提交
2243
static void tc35815_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
L
Linus Torvalds 已提交
2244
{
A
Atsushi Nemoto 已提交
2245
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2246 2247 2248 2249
	strcpy(info->driver, MODNAME);
	strcpy(info->version, DRV_VERSION);
	strcpy(info->bus_info, pci_name(lp->pci_dev));
}
2250

A
Atsushi Nemoto 已提交
2251 2252
static int tc35815_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
{
A
Atsushi Nemoto 已提交
2253
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2254

A
Atsushi Nemoto 已提交
2255 2256 2257
	if (!lp->phy_dev)
		return -ENODEV;
	return phy_ethtool_gset(lp->phy_dev, cmd);
A
Atsushi Nemoto 已提交
2258 2259
}

A
Atsushi Nemoto 已提交
2260
static int tc35815_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
A
Atsushi Nemoto 已提交
2261
{
A
Atsushi Nemoto 已提交
2262
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2263

A
Atsushi Nemoto 已提交
2264 2265 2266
	if (!lp->phy_dev)
		return -ENODEV;
	return phy_ethtool_sset(lp->phy_dev, cmd);
A
Atsushi Nemoto 已提交
2267 2268 2269 2270
}

static u32 tc35815_get_msglevel(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
2271
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2272 2273 2274 2275 2276
	return lp->msg_enable;
}

static void tc35815_set_msglevel(struct net_device *dev, u32 datum)
{
A
Atsushi Nemoto 已提交
2277
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2278 2279 2280
	lp->msg_enable = datum;
}

2281
static int tc35815_get_sset_count(struct net_device *dev, int sset)
A
Atsushi Nemoto 已提交
2282
{
A
Atsushi Nemoto 已提交
2283
	struct tc35815_local *lp = netdev_priv(dev);
2284 2285 2286 2287 2288 2289 2290

	switch (sset) {
	case ETH_SS_STATS:
		return sizeof(lp->lstats) / sizeof(int);
	default:
		return -EOPNOTSUPP;
	}
A
Atsushi Nemoto 已提交
2291
}
L
Linus Torvalds 已提交
2292

A
Atsushi Nemoto 已提交
2293 2294
static void tc35815_get_ethtool_stats(struct net_device *dev, struct ethtool_stats *stats, u64 *data)
{
A
Atsushi Nemoto 已提交
2295
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319
	data[0] = lp->lstats.max_tx_qlen;
	data[1] = lp->lstats.tx_ints;
	data[2] = lp->lstats.rx_ints;
	data[3] = lp->lstats.tx_underrun;
}

static struct {
	const char str[ETH_GSTRING_LEN];
} ethtool_stats_keys[] = {
	{ "max_tx_qlen" },
	{ "tx_ints" },
	{ "rx_ints" },
	{ "tx_underrun" },
};

static void tc35815_get_strings(struct net_device *dev, u32 stringset, u8 *data)
{
	memcpy(data, ethtool_stats_keys, sizeof(ethtool_stats_keys));
}

static const struct ethtool_ops tc35815_ethtool_ops = {
	.get_drvinfo		= tc35815_get_drvinfo,
	.get_settings		= tc35815_get_settings,
	.set_settings		= tc35815_set_settings,
A
Atsushi Nemoto 已提交
2320
	.get_link		= ethtool_op_get_link,
A
Atsushi Nemoto 已提交
2321 2322 2323
	.get_msglevel		= tc35815_get_msglevel,
	.set_msglevel		= tc35815_set_msglevel,
	.get_strings		= tc35815_get_strings,
2324
	.get_sset_count		= tc35815_get_sset_count,
A
Atsushi Nemoto 已提交
2325 2326 2327 2328 2329
	.get_ethtool_stats	= tc35815_get_ethtool_stats,
};

static int tc35815_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
{
A
Atsushi Nemoto 已提交
2330
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2331 2332 2333

	if (!netif_running(dev))
		return -EINVAL;
A
Atsushi Nemoto 已提交
2334 2335 2336
	if (!lp->phy_dev)
		return -ENODEV;
	return phy_mii_ioctl(lp->phy_dev, if_mii(rq), cmd);
A
Atsushi Nemoto 已提交
2337 2338 2339 2340 2341 2342 2343
}

static void tc35815_chip_reset(struct net_device *dev)
{
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;
	int i;
L
Linus Torvalds 已提交
2344 2345
	/* reset the controller */
	tc_writel(MAC_Reset, &tr->MAC_Ctl);
A
Atsushi Nemoto 已提交
2346 2347 2348 2349 2350 2351 2352 2353 2354
	udelay(4); /* 3200ns */
	i = 0;
	while (tc_readl(&tr->MAC_Ctl) & MAC_Reset) {
		if (i++ > 100) {
			printk(KERN_ERR "%s: MAC reset failed.\n", dev->name);
			break;
		}
		mdelay(1);
	}
L
Linus Torvalds 已提交
2355 2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371
	tc_writel(0, &tr->MAC_Ctl);

	/* initialize registers to default value */
	tc_writel(0, &tr->DMA_Ctl);
	tc_writel(0, &tr->TxThrsh);
	tc_writel(0, &tr->TxPollCtr);
	tc_writel(0, &tr->RxFragSize);
	tc_writel(0, &tr->Int_En);
	tc_writel(0, &tr->FDA_Bas);
	tc_writel(0, &tr->FDA_Lim);
	tc_writel(0xffffffff, &tr->Int_Src);	/* Write 1 to clear */
	tc_writel(0, &tr->CAM_Ctl);
	tc_writel(0, &tr->Tx_Ctl);
	tc_writel(0, &tr->Rx_Ctl);
	tc_writel(0, &tr->CAM_Ena);
	(void)tc_readl(&tr->Miss_Cnt);	/* Read to clear */

A
Atsushi Nemoto 已提交
2372 2373 2374 2375 2376 2377 2378
	/* initialize internal SRAM */
	tc_writel(DMA_TestMode, &tr->DMA_Ctl);
	for (i = 0; i < 0x1000; i += 4) {
		tc_writel(i, &tr->CAM_Adr);
		tc_writel(0, &tr->CAM_Data);
	}
	tc_writel(0, &tr->DMA_Ctl);
L
Linus Torvalds 已提交
2379 2380 2381 2382
}

static void tc35815_chip_init(struct net_device *dev)
{
A
Atsushi Nemoto 已提交
2383
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2384 2385
	struct tc35815_regs __iomem *tr =
		(struct tc35815_regs __iomem *)dev->base_addr;
L
Linus Torvalds 已提交
2386 2387 2388
	unsigned long txctl = TX_CTL_CMD;

	/* load station address to CAM */
A
Atsushi Nemoto 已提交
2389
	tc35815_set_cam_entry(dev, CAM_ENTRY_SOURCE, dev->dev_addr);
L
Linus Torvalds 已提交
2390 2391 2392 2393 2394

	/* Enable CAM (broadcast and unicast) */
	tc_writel(CAM_Ena_Bit(CAM_ENTRY_SOURCE), &tr->CAM_Ena);
	tc_writel(CAM_CompEn | CAM_BroadAcc, &tr->CAM_Ctl);

A
Atsushi Nemoto 已提交
2395 2396 2397 2398 2399 2400
	/* Use DMA_RxAlign_2 to make IP header 4-byte aligned. */
	if (HAVE_DMA_RXALIGN(lp))
		tc_writel(DMA_BURST_SIZE | DMA_RxAlign_2, &tr->DMA_Ctl);
	else
		tc_writel(DMA_BURST_SIZE, &tr->DMA_Ctl);
#ifdef TC35815_USE_PACKEDBUFFER
L
Linus Torvalds 已提交
2401
	tc_writel(RxFrag_EnPack | ETH_ZLEN, &tr->RxFragSize);	/* Packing */
A
Atsushi Nemoto 已提交
2402 2403 2404
#else
	tc_writel(ETH_ZLEN, &tr->RxFragSize);
#endif
L
Linus Torvalds 已提交
2405 2406 2407 2408 2409
	tc_writel(0, &tr->TxPollCtr);	/* Batch mode */
	tc_writel(TX_THRESHOLD, &tr->TxThrsh);
	tc_writel(INT_EN_CMD, &tr->Int_En);

	/* set queues */
A
Atsushi Nemoto 已提交
2410
	tc_writel(fd_virt_to_bus(lp, lp->rfd_base), &tr->FDA_Bas);
L
Linus Torvalds 已提交
2411 2412 2413 2414
	tc_writel((unsigned long)lp->rfd_limit - (unsigned long)lp->rfd_base,
		  &tr->FDA_Lim);
	/*
	 * Activation method:
A
Atsushi Nemoto 已提交
2415
	 * First, enable the MAC Transmitter and the DMA Receive circuits.
L
Linus Torvalds 已提交
2416 2417
	 * Then enable the DMA Transmitter and the MAC Receive circuits.
	 */
A
Atsushi Nemoto 已提交
2418
	tc_writel(fd_virt_to_bus(lp, lp->fbl_ptr), &tr->BLFrmPtr);	/* start DMA receiver */
L
Linus Torvalds 已提交
2419
	tc_writel(RX_CTL_CMD, &tr->Rx_Ctl);	/* start MAC receiver */
A
Atsushi Nemoto 已提交
2420

L
Linus Torvalds 已提交
2421
	/* start MAC transmitter */
A
Atsushi Nemoto 已提交
2422 2423
#ifndef NO_CHECK_CARRIER
	/* TX4939 does not have EnLCarr */
A
Atsushi Nemoto 已提交
2424
	if (lp->chiptype == TC35815_TX4939)
A
Atsushi Nemoto 已提交
2425 2426
		txctl &= ~Tx_EnLCarr;
#ifdef WORKAROUND_LOSTCAR
L
Linus Torvalds 已提交
2427
	/* WORKAROUND: ignore LostCrS in full duplex operation */
A
Atsushi Nemoto 已提交
2428
	if (!lp->phy_dev || !lp->link || lp->duplex == DUPLEX_FULL)
A
Atsushi Nemoto 已提交
2429 2430 2431
		txctl &= ~Tx_EnLCarr;
#endif
#endif /* !NO_CHECK_CARRIER */
L
Linus Torvalds 已提交
2432 2433 2434 2435
#ifdef GATHER_TXINT
	txctl &= ~Tx_EnComp;	/* disable global tx completion int. */
#endif
	tc_writel(txctl, &tr->Tx_Ctl);
A
Atsushi Nemoto 已提交
2436 2437 2438 2439 2440 2441
}

#ifdef CONFIG_PM
static int tc35815_suspend(struct pci_dev *pdev, pm_message_t state)
{
	struct net_device *dev = pci_get_drvdata(pdev);
A
Atsushi Nemoto 已提交
2442
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2443 2444 2445 2446 2447 2448
	unsigned long flags;

	pci_save_state(pdev);
	if (!netif_running(dev))
		return 0;
	netif_device_detach(dev);
A
Atsushi Nemoto 已提交
2449 2450
	if (lp->phy_dev)
		phy_stop(lp->phy_dev);
A
Atsushi Nemoto 已提交
2451 2452
	spin_lock_irqsave(&lp->lock, flags);
	tc35815_chip_reset(dev);
L
Linus Torvalds 已提交
2453
	spin_unlock_irqrestore(&lp->lock, flags);
A
Atsushi Nemoto 已提交
2454 2455
	pci_set_power_state(pdev, PCI_D3hot);
	return 0;
L
Linus Torvalds 已提交
2456 2457
}

A
Atsushi Nemoto 已提交
2458 2459 2460
static int tc35815_resume(struct pci_dev *pdev)
{
	struct net_device *dev = pci_get_drvdata(pdev);
A
Atsushi Nemoto 已提交
2461
	struct tc35815_local *lp = netdev_priv(dev);
A
Atsushi Nemoto 已提交
2462 2463 2464 2465 2466 2467

	pci_restore_state(pdev);
	if (!netif_running(dev))
		return 0;
	pci_set_power_state(pdev, PCI_D0);
	tc35815_restart(dev);
2468
	netif_carrier_off(dev);
A
Atsushi Nemoto 已提交
2469 2470
	if (lp->phy_dev)
		phy_start(lp->phy_dev);
A
Atsushi Nemoto 已提交
2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484
	netif_device_attach(dev);
	return 0;
}
#endif /* CONFIG_PM */

static struct pci_driver tc35815_pci_driver = {
	.name		= MODNAME,
	.id_table	= tc35815_pci_tbl,
	.probe		= tc35815_init_one,
	.remove		= __devexit_p(tc35815_remove_one),
#ifdef CONFIG_PM
	.suspend	= tc35815_suspend,
	.resume		= tc35815_resume,
#endif
L
Linus Torvalds 已提交
2485 2486
};

A
Atsushi Nemoto 已提交
2487 2488 2489 2490 2491
module_param_named(speed, options.speed, int, 0);
MODULE_PARM_DESC(speed, "0:auto, 10:10Mbps, 100:100Mbps");
module_param_named(duplex, options.duplex, int, 0);
MODULE_PARM_DESC(duplex, "0:auto, 1:half, 2:full");

L
Linus Torvalds 已提交
2492 2493
static int __init tc35815_init_module(void)
{
A
Atsushi Nemoto 已提交
2494
	return pci_register_driver(&tc35815_pci_driver);
L
Linus Torvalds 已提交
2495 2496 2497 2498
}

static void __exit tc35815_cleanup_module(void)
{
A
Atsushi Nemoto 已提交
2499
	pci_unregister_driver(&tc35815_pci_driver);
L
Linus Torvalds 已提交
2500
}
2501

L
Linus Torvalds 已提交
2502 2503
module_init(tc35815_init_module);
module_exit(tc35815_cleanup_module);
A
Atsushi Nemoto 已提交
2504 2505 2506

MODULE_DESCRIPTION("TOSHIBA TC35815 PCI 10M/100M Ethernet driver");
MODULE_LICENSE("GPL");