| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1 | /* | 
|  | 2 | * tc35815.c: A TOSHIBA TC35815CF PCI 10/100Mbps ethernet driver for linux. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3 | * | 
|  | 4 | * Based on skelton.c by Donald Becker. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5 | * | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 6 | * This driver is a replacement of older and less maintained version. | 
|  | 7 | * This is a header of the older version: | 
|  | 8 | *	-----<snip>----- | 
|  | 9 | *	Copyright 2001 MontaVista Software Inc. | 
|  | 10 | *	Author: MontaVista Software, Inc. | 
|  | 11 | *		ahennessy@mvista.com | 
|  | 12 | *	Copyright (C) 2000-2001 Toshiba Corporation | 
|  | 13 | *	static const char *version = | 
|  | 14 | *		"tc35815.c:v0.00 26/07/2000 by Toshiba Corporation\n"; | 
|  | 15 | *	-----<snip>----- | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | * | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 17 | * This file is subject to the terms and conditions of the GNU General Public | 
|  | 18 | * License.  See the file "COPYING" in the main directory of this archive | 
|  | 19 | * for more details. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | * | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 21 | * (C) Copyright TOSHIBA CORPORATION 2004-2005 | 
|  | 22 | * All Rights Reserved. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | */ | 
|  | 24 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 25 | #ifdef TC35815_NAPI | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 26 | #define DRV_VERSION	"1.37-NAPI" | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 27 | #else | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 28 | #define DRV_VERSION	"1.37" | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 29 | #endif | 
|  | 30 | static const char *version = "tc35815.c:v" DRV_VERSION "\n"; | 
|  | 31 | #define MODNAME			"tc35815" | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 32 |  | 
|  | 33 | #include <linux/module.h> | 
|  | 34 | #include <linux/kernel.h> | 
|  | 35 | #include <linux/types.h> | 
|  | 36 | #include <linux/fcntl.h> | 
|  | 37 | #include <linux/interrupt.h> | 
|  | 38 | #include <linux/ioport.h> | 
|  | 39 | #include <linux/in.h> | 
|  | 40 | #include <linux/slab.h> | 
|  | 41 | #include <linux/string.h> | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 42 | #include <linux/spinlock.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | #include <linux/errno.h> | 
|  | 44 | #include <linux/init.h> | 
|  | 45 | #include <linux/netdevice.h> | 
|  | 46 | #include <linux/etherdevice.h> | 
|  | 47 | #include <linux/skbuff.h> | 
|  | 48 | #include <linux/delay.h> | 
|  | 49 | #include <linux/pci.h> | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 50 | #include <linux/phy.h> | 
|  | 51 | #include <linux/workqueue.h> | 
| Atsushi Nemoto | bd43da8 | 2007-06-29 22:34:53 +0900 | [diff] [blame] | 52 | #include <linux/platform_device.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | #include <asm/io.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 54 | #include <asm/byteorder.h> | 
|  | 55 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 56 | /* First, a few definitions that the brave might change. */ | 
|  | 57 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | #define GATHER_TXINT	/* On-Demand Tx Interrupt */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 59 | #define WORKAROUND_LOSTCAR | 
|  | 60 | #define WORKAROUND_100HALF_PROMISC | 
|  | 61 | /* #define TC35815_USE_PACKEDBUFFER */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 63 | enum tc35815_chiptype { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 64 | TC35815CF = 0, | 
|  | 65 | TC35815_NWU, | 
|  | 66 | TC35815_TX4939, | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 67 | }; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 68 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 69 | /* indexed by tc35815_chiptype, above */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 70 | static const struct { | 
|  | 71 | const char *name; | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 72 | } chip_info[] __devinitdata = { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 73 | { "TOSHIBA TC35815CF 10/100BaseTX" }, | 
|  | 74 | { "TOSHIBA TC35815 with Wake on LAN" }, | 
|  | 75 | { "TOSHIBA TC35815/TX4939" }, | 
|  | 76 | }; | 
|  | 77 |  | 
|  | 78 | static const struct pci_device_id tc35815_pci_tbl[] = { | 
|  | 79 | {PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_TC35815CF), .driver_data = TC35815CF }, | 
|  | 80 | {PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_TC35815_NWU), .driver_data = TC35815_NWU }, | 
|  | 81 | {PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_TC35815_TX4939), .driver_data = TC35815_TX4939 }, | 
|  | 82 | {0,} | 
|  | 83 | }; | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 84 | MODULE_DEVICE_TABLE(pci, tc35815_pci_tbl); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 85 |  | 
|  | 86 | /* see MODULE_PARM_DESC */ | 
|  | 87 | static struct tc35815_options { | 
|  | 88 | int speed; | 
|  | 89 | int duplex; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 90 | } options; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 91 |  | 
|  | 92 | /* | 
|  | 93 | * Registers | 
|  | 94 | */ | 
|  | 95 | struct tc35815_regs { | 
| Atsushi Nemoto | 22adf7e | 2008-04-11 00:24:45 +0900 | [diff] [blame] | 96 | __u32 DMA_Ctl;		/* 0x00 */ | 
|  | 97 | __u32 TxFrmPtr; | 
|  | 98 | __u32 TxThrsh; | 
|  | 99 | __u32 TxPollCtr; | 
|  | 100 | __u32 BLFrmPtr; | 
|  | 101 | __u32 RxFragSize; | 
|  | 102 | __u32 Int_En; | 
|  | 103 | __u32 FDA_Bas; | 
|  | 104 | __u32 FDA_Lim;		/* 0x20 */ | 
|  | 105 | __u32 Int_Src; | 
|  | 106 | __u32 unused0[2]; | 
|  | 107 | __u32 PauseCnt; | 
|  | 108 | __u32 RemPauCnt; | 
|  | 109 | __u32 TxCtlFrmStat; | 
|  | 110 | __u32 unused1; | 
|  | 111 | __u32 MAC_Ctl;		/* 0x40 */ | 
|  | 112 | __u32 CAM_Ctl; | 
|  | 113 | __u32 Tx_Ctl; | 
|  | 114 | __u32 Tx_Stat; | 
|  | 115 | __u32 Rx_Ctl; | 
|  | 116 | __u32 Rx_Stat; | 
|  | 117 | __u32 MD_Data; | 
|  | 118 | __u32 MD_CA; | 
|  | 119 | __u32 CAM_Adr;		/* 0x60 */ | 
|  | 120 | __u32 CAM_Data; | 
|  | 121 | __u32 CAM_Ena; | 
|  | 122 | __u32 PROM_Ctl; | 
|  | 123 | __u32 PROM_Data; | 
|  | 124 | __u32 Algn_Cnt; | 
|  | 125 | __u32 CRC_Cnt; | 
|  | 126 | __u32 Miss_Cnt; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 127 | }; | 
|  | 128 |  | 
|  | 129 | /* | 
|  | 130 | * Bit assignments | 
|  | 131 | */ | 
|  | 132 | /* DMA_Ctl bit asign ------------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 133 | #define DMA_RxAlign	       0x00c00000 /* 1:Reception Alignment	     */ | 
|  | 134 | #define DMA_RxAlign_1	       0x00400000 | 
|  | 135 | #define DMA_RxAlign_2	       0x00800000 | 
|  | 136 | #define DMA_RxAlign_3	       0x00c00000 | 
|  | 137 | #define DMA_M66EnStat	       0x00080000 /* 1:66MHz Enable State	     */ | 
|  | 138 | #define DMA_IntMask	       0x00040000 /* 1:Interupt mask		     */ | 
|  | 139 | #define DMA_SWIntReq	       0x00020000 /* 1:Software Interrupt request    */ | 
|  | 140 | #define DMA_TxWakeUp	       0x00010000 /* 1:Transmit Wake Up		     */ | 
|  | 141 | #define DMA_RxBigE	       0x00008000 /* 1:Receive Big Endian	     */ | 
|  | 142 | #define DMA_TxBigE	       0x00004000 /* 1:Transmit Big Endian	     */ | 
|  | 143 | #define DMA_TestMode	       0x00002000 /* 1:Test Mode		     */ | 
|  | 144 | #define DMA_PowrMgmnt	       0x00001000 /* 1:Power Management		     */ | 
|  | 145 | #define DMA_DmBurst_Mask       0x000001fc /* DMA Burst size		     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 146 |  | 
|  | 147 | /* RxFragSize bit asign ---------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 148 | #define RxFrag_EnPack	       0x00008000 /* 1:Enable Packing		     */ | 
|  | 149 | #define RxFrag_MinFragMask     0x00000ffc /* Minimum Fragment		     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 150 |  | 
|  | 151 | /* MAC_Ctl bit asign ------------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 152 | #define MAC_Link10	       0x00008000 /* 1:Link Status 10Mbits	     */ | 
|  | 153 | #define MAC_EnMissRoll	       0x00002000 /* 1:Enable Missed Roll	     */ | 
|  | 154 | #define MAC_MissRoll	       0x00000400 /* 1:Missed Roll		     */ | 
|  | 155 | #define MAC_Loop10	       0x00000080 /* 1:Loop 10 Mbps		     */ | 
|  | 156 | #define MAC_Conn_Auto	       0x00000000 /*00:Connection mode (Automatic)   */ | 
|  | 157 | #define MAC_Conn_10M	       0x00000020 /*01:		       (10Mbps endec)*/ | 
|  | 158 | #define MAC_Conn_Mll	       0x00000040 /*10:		       (Mll clock)   */ | 
|  | 159 | #define MAC_MacLoop	       0x00000010 /* 1:MAC Loopback		     */ | 
|  | 160 | #define MAC_FullDup	       0x00000008 /* 1:Full Duplex 0:Half Duplex     */ | 
|  | 161 | #define MAC_Reset	       0x00000004 /* 1:Software Reset		     */ | 
|  | 162 | #define MAC_HaltImm	       0x00000002 /* 1:Halt Immediate		     */ | 
|  | 163 | #define MAC_HaltReq	       0x00000001 /* 1:Halt request		     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 164 |  | 
|  | 165 | /* PROM_Ctl bit asign ------------------------------------------------------ */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 166 | #define PROM_Busy	       0x00008000 /* 1:Busy (Start Operation)	     */ | 
|  | 167 | #define PROM_Read	       0x00004000 /*10:Read operation		     */ | 
|  | 168 | #define PROM_Write	       0x00002000 /*01:Write operation		     */ | 
|  | 169 | #define PROM_Erase	       0x00006000 /*11:Erase operation		     */ | 
|  | 170 | /*00:Enable or Disable Writting,   */ | 
|  | 171 | /*	  as specified in PROM_Addr. */ | 
|  | 172 | #define PROM_Addr_Ena	       0x00000030 /*11xxxx:PROM Write enable	     */ | 
|  | 173 | /*00xxxx:	      disable	     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 174 |  | 
|  | 175 | /* CAM_Ctl bit asign ------------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 176 | #define CAM_CompEn	       0x00000010 /* 1:CAM Compare Enable	     */ | 
|  | 177 | #define CAM_NegCAM	       0x00000008 /* 1:Reject packets CAM recognizes,*/ | 
|  | 178 | /*			accept other */ | 
|  | 179 | #define CAM_BroadAcc	       0x00000004 /* 1:Broadcast assept		     */ | 
|  | 180 | #define CAM_GroupAcc	       0x00000002 /* 1:Multicast assept		     */ | 
|  | 181 | #define CAM_StationAcc	       0x00000001 /* 1:unicast accept		     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 182 |  | 
|  | 183 | /* CAM_Ena bit asign ------------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 184 | #define CAM_ENTRY_MAX		       21   /* CAM Data entry max count	     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 185 | #define CAM_Ena_Mask ((1<<CAM_ENTRY_MAX)-1) /* CAM Enable bits (Max 21bits)  */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 186 | #define CAM_Ena_Bit(index)	(1 << (index)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 187 | #define CAM_ENTRY_DESTINATION	0 | 
|  | 188 | #define CAM_ENTRY_SOURCE	1 | 
|  | 189 | #define CAM_ENTRY_MACCTL	20 | 
|  | 190 |  | 
|  | 191 | /* Tx_Ctl bit asign -------------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 192 | #define Tx_En		       0x00000001 /* 1:Transmit enable		     */ | 
|  | 193 | #define Tx_TxHalt	       0x00000002 /* 1:Transmit Halt Request	     */ | 
|  | 194 | #define Tx_NoPad	       0x00000004 /* 1:Suppress Padding		     */ | 
|  | 195 | #define Tx_NoCRC	       0x00000008 /* 1:Suppress Padding		     */ | 
|  | 196 | #define Tx_FBack	       0x00000010 /* 1:Fast Back-off		     */ | 
|  | 197 | #define Tx_EnUnder	       0x00000100 /* 1:Enable Underrun		     */ | 
|  | 198 | #define Tx_EnExDefer	       0x00000200 /* 1:Enable Excessive Deferral     */ | 
|  | 199 | #define Tx_EnLCarr	       0x00000400 /* 1:Enable Lost Carrier	     */ | 
|  | 200 | #define Tx_EnExColl	       0x00000800 /* 1:Enable Excessive Collision    */ | 
|  | 201 | #define Tx_EnLateColl	       0x00001000 /* 1:Enable Late Collision	     */ | 
|  | 202 | #define Tx_EnTxPar	       0x00002000 /* 1:Enable Transmit Parity	     */ | 
|  | 203 | #define Tx_EnComp	       0x00004000 /* 1:Enable Completion	     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 204 |  | 
|  | 205 | /* Tx_Stat bit asign ------------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 206 | #define Tx_TxColl_MASK	       0x0000000F /* Tx Collision Count		     */ | 
|  | 207 | #define Tx_ExColl	       0x00000010 /* Excessive Collision	     */ | 
|  | 208 | #define Tx_TXDefer	       0x00000020 /* Transmit Defered		     */ | 
|  | 209 | #define Tx_Paused	       0x00000040 /* Transmit Paused		     */ | 
|  | 210 | #define Tx_IntTx	       0x00000080 /* Interrupt on Tx		     */ | 
|  | 211 | #define Tx_Under	       0x00000100 /* Underrun			     */ | 
|  | 212 | #define Tx_Defer	       0x00000200 /* Deferral			     */ | 
|  | 213 | #define Tx_NCarr	       0x00000400 /* No Carrier			     */ | 
|  | 214 | #define Tx_10Stat	       0x00000800 /* 10Mbps Status		     */ | 
|  | 215 | #define Tx_LateColl	       0x00001000 /* Late Collision		     */ | 
|  | 216 | #define Tx_TxPar	       0x00002000 /* Tx Parity Error		     */ | 
|  | 217 | #define Tx_Comp		       0x00004000 /* Completion			     */ | 
|  | 218 | #define Tx_Halted	       0x00008000 /* Tx Halted			     */ | 
|  | 219 | #define Tx_SQErr	       0x00010000 /* Signal Quality Error(SQE)	     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 220 |  | 
|  | 221 | /* Rx_Ctl bit asign -------------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 222 | #define Rx_EnGood	       0x00004000 /* 1:Enable Good		     */ | 
|  | 223 | #define Rx_EnRxPar	       0x00002000 /* 1:Enable Receive Parity	     */ | 
|  | 224 | #define Rx_EnLongErr	       0x00000800 /* 1:Enable Long Error	     */ | 
|  | 225 | #define Rx_EnOver	       0x00000400 /* 1:Enable OverFlow		     */ | 
|  | 226 | #define Rx_EnCRCErr	       0x00000200 /* 1:Enable CRC Error		     */ | 
|  | 227 | #define Rx_EnAlign	       0x00000100 /* 1:Enable Alignment		     */ | 
|  | 228 | #define Rx_IgnoreCRC	       0x00000040 /* 1:Ignore CRC Value		     */ | 
|  | 229 | #define Rx_StripCRC	       0x00000010 /* 1:Strip CRC Value		     */ | 
|  | 230 | #define Rx_ShortEn	       0x00000008 /* 1:Short Enable		     */ | 
|  | 231 | #define Rx_LongEn	       0x00000004 /* 1:Long Enable		     */ | 
|  | 232 | #define Rx_RxHalt	       0x00000002 /* 1:Receive Halt Request	     */ | 
|  | 233 | #define Rx_RxEn		       0x00000001 /* 1:Receive Intrrupt Enable	     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 234 |  | 
|  | 235 | /* Rx_Stat bit asign ------------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 236 | #define Rx_Halted	       0x00008000 /* Rx Halted			     */ | 
|  | 237 | #define Rx_Good		       0x00004000 /* Rx Good			     */ | 
|  | 238 | #define Rx_RxPar	       0x00002000 /* Rx Parity Error		     */ | 
|  | 239 | /* 0x00001000    not use			     */ | 
|  | 240 | #define Rx_LongErr	       0x00000800 /* Rx Long Error		     */ | 
|  | 241 | #define Rx_Over		       0x00000400 /* Rx Overflow		     */ | 
|  | 242 | #define Rx_CRCErr	       0x00000200 /* Rx CRC Error		     */ | 
|  | 243 | #define Rx_Align	       0x00000100 /* Rx Alignment Error		     */ | 
|  | 244 | #define Rx_10Stat	       0x00000080 /* Rx 10Mbps Status		     */ | 
|  | 245 | #define Rx_IntRx	       0x00000040 /* Rx Interrupt		     */ | 
|  | 246 | #define Rx_CtlRecd	       0x00000020 /* Rx Control Receive		     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 247 |  | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 248 | #define Rx_Stat_Mask	       0x0000EFC0 /* Rx All Status Mask		     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 249 |  | 
|  | 250 | /* Int_En bit asign -------------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 251 | #define Int_NRAbtEn	       0x00000800 /* 1:Non-recoverable Abort Enable  */ | 
|  | 252 | #define Int_TxCtlCmpEn	       0x00000400 /* 1:Transmit Ctl Complete Enable  */ | 
|  | 253 | #define Int_DmParErrEn	       0x00000200 /* 1:DMA Parity Error Enable	     */ | 
|  | 254 | #define Int_DParDEn	       0x00000100 /* 1:Data Parity Error Enable	     */ | 
|  | 255 | #define Int_EarNotEn	       0x00000080 /* 1:Early Notify Enable	     */ | 
|  | 256 | #define Int_DParErrEn	       0x00000040 /* 1:Detected Parity Error Enable  */ | 
|  | 257 | #define Int_SSysErrEn	       0x00000020 /* 1:Signalled System Error Enable */ | 
|  | 258 | #define Int_RMasAbtEn	       0x00000010 /* 1:Received Master Abort Enable  */ | 
|  | 259 | #define Int_RTargAbtEn	       0x00000008 /* 1:Received Target Abort Enable  */ | 
|  | 260 | #define Int_STargAbtEn	       0x00000004 /* 1:Signalled Target Abort Enable */ | 
|  | 261 | #define Int_BLExEn	       0x00000002 /* 1:Buffer List Exhausted Enable  */ | 
|  | 262 | #define Int_FDAExEn	       0x00000001 /* 1:Free Descriptor Area	     */ | 
|  | 263 | /*		   Exhausted Enable  */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 264 |  | 
|  | 265 | /* Int_Src bit asign ------------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 266 | #define Int_NRabt	       0x00004000 /* 1:Non Recoverable error	     */ | 
|  | 267 | #define Int_DmParErrStat       0x00002000 /* 1:DMA Parity Error & Clear	     */ | 
|  | 268 | #define Int_BLEx	       0x00001000 /* 1:Buffer List Empty & Clear     */ | 
|  | 269 | #define Int_FDAEx	       0x00000800 /* 1:FDA Empty & Clear	     */ | 
|  | 270 | #define Int_IntNRAbt	       0x00000400 /* 1:Non Recoverable Abort	     */ | 
|  | 271 | #define Int_IntCmp	       0x00000200 /* 1:MAC control packet complete   */ | 
|  | 272 | #define Int_IntExBD	       0x00000100 /* 1:Interrupt Extra BD & Clear    */ | 
|  | 273 | #define Int_DmParErr	       0x00000080 /* 1:DMA Parity Error & Clear	     */ | 
|  | 274 | #define Int_IntEarNot	       0x00000040 /* 1:Receive Data write & Clear    */ | 
|  | 275 | #define Int_SWInt	       0x00000020 /* 1:Software request & Clear	     */ | 
|  | 276 | #define Int_IntBLEx	       0x00000010 /* 1:Buffer List Empty & Clear     */ | 
|  | 277 | #define Int_IntFDAEx	       0x00000008 /* 1:FDA Empty & Clear	     */ | 
|  | 278 | #define Int_IntPCI	       0x00000004 /* 1:PCI controller & Clear	     */ | 
|  | 279 | #define Int_IntMacRx	       0x00000002 /* 1:Rx controller & Clear	     */ | 
|  | 280 | #define Int_IntMacTx	       0x00000001 /* 1:Tx controller & Clear	     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 281 |  | 
|  | 282 | /* MD_CA bit asign --------------------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 283 | #define MD_CA_PreSup	       0x00001000 /* 1:Preamble Supress		     */ | 
|  | 284 | #define MD_CA_Busy	       0x00000800 /* 1:Busy (Start Operation)	     */ | 
|  | 285 | #define MD_CA_Wr	       0x00000400 /* 1:Write 0:Read		     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 286 |  | 
|  | 287 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 288 | /* | 
|  | 289 | * Descriptors | 
|  | 290 | */ | 
|  | 291 |  | 
|  | 292 | /* Frame descripter */ | 
|  | 293 | struct FDesc { | 
|  | 294 | volatile __u32 FDNext; | 
|  | 295 | volatile __u32 FDSystem; | 
|  | 296 | volatile __u32 FDStat; | 
|  | 297 | volatile __u32 FDCtl; | 
|  | 298 | }; | 
|  | 299 |  | 
|  | 300 | /* Buffer descripter */ | 
|  | 301 | struct BDesc { | 
|  | 302 | volatile __u32 BuffData; | 
|  | 303 | volatile __u32 BDCtl; | 
|  | 304 | }; | 
|  | 305 |  | 
|  | 306 | #define FD_ALIGN	16 | 
|  | 307 |  | 
|  | 308 | /* Frame Descripter bit asign ---------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 309 | #define FD_FDLength_MASK       0x0000FFFF /* Length MASK		     */ | 
|  | 310 | #define FD_BDCnt_MASK	       0x001F0000 /* BD count MASK in FD	     */ | 
|  | 311 | #define FD_FrmOpt_MASK	       0x7C000000 /* Frame option MASK		     */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 312 | #define FD_FrmOpt_BigEndian    0x40000000 /* Tx/Rx */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 313 | #define FD_FrmOpt_IntTx	       0x20000000 /* Tx only */ | 
|  | 314 | #define FD_FrmOpt_NoCRC	       0x10000000 /* Tx only */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 315 | #define FD_FrmOpt_NoPadding    0x08000000 /* Tx only */ | 
|  | 316 | #define FD_FrmOpt_Packing      0x04000000 /* Rx only */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 317 | #define FD_CownsFD	       0x80000000 /* FD Controller owner bit	     */ | 
|  | 318 | #define FD_Next_EOL	       0x00000001 /* FD EOL indicator		     */ | 
|  | 319 | #define FD_BDCnt_SHIFT	       16 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 320 |  | 
|  | 321 | /* Buffer Descripter bit asign --------------------------------------------- */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 322 | #define BD_BuffLength_MASK     0x0000FFFF /* Recieve Data Size		     */ | 
|  | 323 | #define BD_RxBDID_MASK	       0x00FF0000 /* BD ID Number MASK		     */ | 
|  | 324 | #define BD_RxBDSeqN_MASK       0x7F000000 /* Rx BD Sequence Number	     */ | 
|  | 325 | #define BD_CownsBD	       0x80000000 /* BD Controller owner bit	     */ | 
|  | 326 | #define BD_RxBDID_SHIFT	       16 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 327 | #define BD_RxBDSeqN_SHIFT      24 | 
|  | 328 |  | 
|  | 329 |  | 
|  | 330 | /* Some useful constants. */ | 
|  | 331 | #undef NO_CHECK_CARRIER	/* Does not check No-Carrier with TP */ | 
|  | 332 |  | 
|  | 333 | #ifdef NO_CHECK_CARRIER | 
|  | 334 | #define TX_CTL_CMD	(Tx_EnComp | Tx_EnTxPar | Tx_EnLateColl | \ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 335 | Tx_EnExColl | Tx_EnExDefer | Tx_EnUnder | \ | 
|  | 336 | Tx_En)	/* maybe  0x7b01 */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 337 | #else | 
|  | 338 | #define TX_CTL_CMD	(Tx_EnComp | Tx_EnTxPar | Tx_EnLateColl | \ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 339 | Tx_EnExColl | Tx_EnLCarr | Tx_EnExDefer | Tx_EnUnder | \ | 
|  | 340 | Tx_En)	/* maybe  0x7b01 */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 341 | #endif | 
|  | 342 | #define RX_CTL_CMD	(Rx_EnGood | Rx_EnRxPar | Rx_EnLongErr | Rx_EnOver \ | 
|  | 343 | | Rx_EnCRCErr | Rx_EnAlign | Rx_RxEn)	/* maybe 0x6f01 */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 344 | #define INT_EN_CMD  (Int_NRAbtEn | \ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 345 | Int_DmParErrEn | Int_DParDEn | Int_DParErrEn | \ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 346 | Int_SSysErrEn  | Int_RMasAbtEn | Int_RTargAbtEn | \ | 
|  | 347 | Int_STargAbtEn | \ | 
|  | 348 | Int_BLExEn  | Int_FDAExEn) /* maybe 0xb7f*/ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 349 | #define DMA_CTL_CMD	DMA_BURST_SIZE | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 350 | #define HAVE_DMA_RXALIGN(lp)	likely((lp)->chiptype != TC35815CF) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 351 |  | 
|  | 352 | /* Tuning parameters */ | 
|  | 353 | #define DMA_BURST_SIZE	32 | 
|  | 354 | #define TX_THRESHOLD	1024 | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 355 | /* used threshold with packet max byte for low pci transfer ability.*/ | 
|  | 356 | #define TX_THRESHOLD_MAX 1536 | 
|  | 357 | /* setting threshold max value when overrun error occured this count. */ | 
|  | 358 | #define TX_THRESHOLD_KEEP_LIMIT 10 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 359 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 360 | /* 16 + RX_BUF_NUM * 8 + RX_FD_NUM * 16 + TX_FD_NUM * 32 <= PAGE_SIZE*FD_PAGE_NUM */ | 
|  | 361 | #ifdef TC35815_USE_PACKEDBUFFER | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 362 | #define FD_PAGE_NUM 2 | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 363 | #define RX_BUF_NUM	8	/* >= 2 */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 364 | #define RX_FD_NUM	250	/* >= 32 */ | 
|  | 365 | #define TX_FD_NUM	128 | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 366 | #define RX_BUF_SIZE	PAGE_SIZE | 
|  | 367 | #else /* TC35815_USE_PACKEDBUFFER */ | 
|  | 368 | #define FD_PAGE_NUM 4 | 
|  | 369 | #define RX_BUF_NUM	128	/* < 256 */ | 
|  | 370 | #define RX_FD_NUM	256	/* >= 32 */ | 
|  | 371 | #define TX_FD_NUM	128 | 
|  | 372 | #if RX_CTL_CMD & Rx_LongEn | 
|  | 373 | #define RX_BUF_SIZE	PAGE_SIZE | 
|  | 374 | #elif RX_CTL_CMD & Rx_StripCRC | 
|  | 375 | #define RX_BUF_SIZE	ALIGN(ETH_FRAME_LEN + 4 + 2, 32) /* +2: reserve */ | 
|  | 376 | #else | 
|  | 377 | #define RX_BUF_SIZE	ALIGN(ETH_FRAME_LEN + 2, 32) /* +2: reserve */ | 
|  | 378 | #endif | 
|  | 379 | #endif /* TC35815_USE_PACKEDBUFFER */ | 
|  | 380 | #define RX_FD_RESERVE	(2 / 2)	/* max 2 BD per RxFD */ | 
|  | 381 | #define NAPI_WEIGHT	16 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 382 |  | 
|  | 383 | struct TxFD { | 
|  | 384 | struct FDesc fd; | 
|  | 385 | struct BDesc bd; | 
|  | 386 | struct BDesc unused; | 
|  | 387 | }; | 
|  | 388 |  | 
|  | 389 | struct RxFD { | 
|  | 390 | struct FDesc fd; | 
|  | 391 | struct BDesc bd[0];	/* variable length */ | 
|  | 392 | }; | 
|  | 393 |  | 
|  | 394 | struct FrFD { | 
|  | 395 | struct FDesc fd; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 396 | struct BDesc bd[RX_BUF_NUM]; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 397 | }; | 
|  | 398 |  | 
|  | 399 |  | 
| Atsushi Nemoto | 22adf7e | 2008-04-11 00:24:45 +0900 | [diff] [blame] | 400 | #define tc_readl(addr)	ioread32(addr) | 
|  | 401 | #define tc_writel(d, addr)	iowrite32(d, addr) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 402 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 403 | #define TC35815_TX_TIMEOUT  msecs_to_jiffies(400) | 
|  | 404 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 405 | /* Information that need to be kept for each controller. */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 406 | struct tc35815_local { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 407 | struct pci_dev *pci_dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 408 |  | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 409 | struct net_device *dev; | 
|  | 410 | struct napi_struct napi; | 
|  | 411 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 412 | /* statistics */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 413 | struct { | 
|  | 414 | int max_tx_qlen; | 
|  | 415 | int tx_ints; | 
|  | 416 | int rx_ints; | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 417 | int tx_underrun; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 418 | } lstats; | 
|  | 419 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 420 | /* Tx control lock.  This protects the transmit buffer ring | 
|  | 421 | * state along with the "tx full" state of the driver.  This | 
|  | 422 | * means all netif_queue flow control actions are protected | 
|  | 423 | * by this lock as well. | 
|  | 424 | */ | 
|  | 425 | spinlock_t lock; | 
|  | 426 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 427 | struct mii_bus mii_bus; | 
|  | 428 | struct phy_device *phy_dev; | 
|  | 429 | int duplex; | 
|  | 430 | int speed; | 
|  | 431 | int link; | 
|  | 432 | struct work_struct restart_work; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 433 |  | 
|  | 434 | /* | 
|  | 435 | * Transmitting: Batch Mode. | 
|  | 436 | *	1 BD in 1 TxFD. | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 437 | * Receiving: Packing Mode. (TC35815_USE_PACKEDBUFFER) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 438 | *	1 circular FD for Free Buffer List. | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 439 | *	RX_BUF_NUM BD in Free Buffer FD. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 440 | *	One Free Buffer BD has PAGE_SIZE data buffer. | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 441 | * Or Non-Packing Mode. | 
|  | 442 | *	1 circular FD for Free Buffer List. | 
|  | 443 | *	RX_BUF_NUM BD in Free Buffer FD. | 
|  | 444 | *	One Free Buffer BD has ETH_FRAME_LEN data buffer. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 445 | */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 446 | void *fd_buf;	/* for TxFD, RxFD, FrFD */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 447 | dma_addr_t fd_buf_dma; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 448 | struct TxFD *tfd_base; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 449 | unsigned int tfd_start; | 
|  | 450 | unsigned int tfd_end; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 451 | struct RxFD *rfd_base; | 
|  | 452 | struct RxFD *rfd_limit; | 
|  | 453 | struct RxFD *rfd_cur; | 
|  | 454 | struct FrFD *fbl_ptr; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 455 | #ifdef TC35815_USE_PACKEDBUFFER | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 456 | unsigned char fbl_curid; | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 457 | void *data_buf[RX_BUF_NUM];		/* packing */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 458 | dma_addr_t data_buf_dma[RX_BUF_NUM]; | 
|  | 459 | struct { | 
|  | 460 | struct sk_buff *skb; | 
|  | 461 | dma_addr_t skb_dma; | 
|  | 462 | } tx_skbs[TX_FD_NUM]; | 
|  | 463 | #else | 
|  | 464 | unsigned int fbl_count; | 
|  | 465 | struct { | 
|  | 466 | struct sk_buff *skb; | 
|  | 467 | dma_addr_t skb_dma; | 
|  | 468 | } tx_skbs[TX_FD_NUM], rx_skbs[RX_BUF_NUM]; | 
|  | 469 | #endif | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 470 | u32 msg_enable; | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 471 | enum tc35815_chiptype chiptype; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 472 | }; | 
|  | 473 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 474 | static inline dma_addr_t fd_virt_to_bus(struct tc35815_local *lp, void *virt) | 
|  | 475 | { | 
|  | 476 | return lp->fd_buf_dma + ((u8 *)virt - (u8 *)lp->fd_buf); | 
|  | 477 | } | 
|  | 478 | #ifdef DEBUG | 
|  | 479 | static inline void *fd_bus_to_virt(struct tc35815_local *lp, dma_addr_t bus) | 
|  | 480 | { | 
|  | 481 | return (void *)((u8 *)lp->fd_buf + (bus - lp->fd_buf_dma)); | 
|  | 482 | } | 
|  | 483 | #endif | 
|  | 484 | #ifdef TC35815_USE_PACKEDBUFFER | 
|  | 485 | static inline void *rxbuf_bus_to_virt(struct tc35815_local *lp, dma_addr_t bus) | 
|  | 486 | { | 
|  | 487 | int i; | 
|  | 488 | for (i = 0; i < RX_BUF_NUM; i++) { | 
|  | 489 | if (bus >= lp->data_buf_dma[i] && | 
|  | 490 | bus < lp->data_buf_dma[i] + PAGE_SIZE) | 
|  | 491 | return (void *)((u8 *)lp->data_buf[i] + | 
|  | 492 | (bus - lp->data_buf_dma[i])); | 
|  | 493 | } | 
|  | 494 | return NULL; | 
|  | 495 | } | 
|  | 496 |  | 
|  | 497 | #define TC35815_DMA_SYNC_ONDEMAND | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 498 | static void *alloc_rxbuf_page(struct pci_dev *hwdev, dma_addr_t *dma_handle) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 499 | { | 
|  | 500 | #ifdef TC35815_DMA_SYNC_ONDEMAND | 
|  | 501 | void *buf; | 
|  | 502 | /* pci_map + pci_dma_sync will be more effective than | 
|  | 503 | * pci_alloc_consistent on some archs. */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 504 | buf = (void *)__get_free_page(GFP_ATOMIC); | 
|  | 505 | if (!buf) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 506 | return NULL; | 
|  | 507 | *dma_handle = pci_map_single(hwdev, buf, PAGE_SIZE, | 
|  | 508 | PCI_DMA_FROMDEVICE); | 
| FUJITA Tomonori | 8d8bb39 | 2008-07-25 19:44:49 -0700 | [diff] [blame] | 509 | if (pci_dma_mapping_error(hwdev, *dma_handle)) { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 510 | free_page((unsigned long)buf); | 
|  | 511 | return NULL; | 
|  | 512 | } | 
|  | 513 | return buf; | 
|  | 514 | #else | 
|  | 515 | return pci_alloc_consistent(hwdev, PAGE_SIZE, dma_handle); | 
|  | 516 | #endif | 
|  | 517 | } | 
|  | 518 |  | 
|  | 519 | static void free_rxbuf_page(struct pci_dev *hwdev, void *buf, dma_addr_t dma_handle) | 
|  | 520 | { | 
|  | 521 | #ifdef TC35815_DMA_SYNC_ONDEMAND | 
|  | 522 | pci_unmap_single(hwdev, dma_handle, PAGE_SIZE, PCI_DMA_FROMDEVICE); | 
|  | 523 | free_page((unsigned long)buf); | 
|  | 524 | #else | 
|  | 525 | pci_free_consistent(hwdev, PAGE_SIZE, buf, dma_handle); | 
|  | 526 | #endif | 
|  | 527 | } | 
|  | 528 | #else /* TC35815_USE_PACKEDBUFFER */ | 
|  | 529 | static struct sk_buff *alloc_rxbuf_skb(struct net_device *dev, | 
|  | 530 | struct pci_dev *hwdev, | 
|  | 531 | dma_addr_t *dma_handle) | 
|  | 532 | { | 
|  | 533 | struct sk_buff *skb; | 
|  | 534 | skb = dev_alloc_skb(RX_BUF_SIZE); | 
|  | 535 | if (!skb) | 
|  | 536 | return NULL; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 537 | *dma_handle = pci_map_single(hwdev, skb->data, RX_BUF_SIZE, | 
|  | 538 | PCI_DMA_FROMDEVICE); | 
| FUJITA Tomonori | 8d8bb39 | 2008-07-25 19:44:49 -0700 | [diff] [blame] | 539 | if (pci_dma_mapping_error(hwdev, *dma_handle)) { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 540 | dev_kfree_skb_any(skb); | 
|  | 541 | return NULL; | 
|  | 542 | } | 
|  | 543 | skb_reserve(skb, 2);	/* make IP header 4byte aligned */ | 
|  | 544 | return skb; | 
|  | 545 | } | 
|  | 546 |  | 
|  | 547 | static void free_rxbuf_skb(struct pci_dev *hwdev, struct sk_buff *skb, dma_addr_t dma_handle) | 
|  | 548 | { | 
|  | 549 | pci_unmap_single(hwdev, dma_handle, RX_BUF_SIZE, | 
|  | 550 | PCI_DMA_FROMDEVICE); | 
|  | 551 | dev_kfree_skb_any(skb); | 
|  | 552 | } | 
|  | 553 | #endif /* TC35815_USE_PACKEDBUFFER */ | 
|  | 554 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 555 | /* Index to functions, as function prototypes. */ | 
|  | 556 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 557 | static int	tc35815_open(struct net_device *dev); | 
|  | 558 | static int	tc35815_send_packet(struct sk_buff *skb, struct net_device *dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 559 | static irqreturn_t	tc35815_interrupt(int irq, void *dev_id); | 
|  | 560 | #ifdef TC35815_NAPI | 
|  | 561 | static int	tc35815_rx(struct net_device *dev, int limit); | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 562 | static int	tc35815_poll(struct napi_struct *napi, int budget); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 563 | #else | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 564 | static void	tc35815_rx(struct net_device *dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 565 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 566 | static void	tc35815_txdone(struct net_device *dev); | 
|  | 567 | static int	tc35815_close(struct net_device *dev); | 
|  | 568 | static struct	net_device_stats *tc35815_get_stats(struct net_device *dev); | 
|  | 569 | static void	tc35815_set_multicast_list(struct net_device *dev); | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 570 | static void	tc35815_tx_timeout(struct net_device *dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 571 | static int	tc35815_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); | 
|  | 572 | #ifdef CONFIG_NET_POLL_CONTROLLER | 
|  | 573 | static void	tc35815_poll_controller(struct net_device *dev); | 
|  | 574 | #endif | 
|  | 575 | static const struct ethtool_ops tc35815_ethtool_ops; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 576 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 577 | /* Example routines you must write ;->. */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 578 | static void	tc35815_chip_reset(struct net_device *dev); | 
|  | 579 | static void	tc35815_chip_init(struct net_device *dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 580 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 581 | #ifdef DEBUG | 
|  | 582 | static void	panic_queues(struct net_device *dev); | 
|  | 583 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 584 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 585 | static void tc35815_restart_work(struct work_struct *work); | 
|  | 586 |  | 
|  | 587 | static int tc_mdio_read(struct mii_bus *bus, int mii_id, int regnum) | 
|  | 588 | { | 
|  | 589 | struct net_device *dev = bus->priv; | 
|  | 590 | struct tc35815_regs __iomem *tr = | 
|  | 591 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 592 | unsigned long timeout = jiffies + 10; | 
|  | 593 |  | 
|  | 594 | tc_writel(MD_CA_Busy | (mii_id << 5) | (regnum & 0x1f), &tr->MD_CA); | 
|  | 595 | while (tc_readl(&tr->MD_CA) & MD_CA_Busy) { | 
|  | 596 | if (time_after(jiffies, timeout)) | 
|  | 597 | return -EIO; | 
|  | 598 | cpu_relax(); | 
|  | 599 | } | 
|  | 600 | return tc_readl(&tr->MD_Data) & 0xffff; | 
|  | 601 | } | 
|  | 602 |  | 
|  | 603 | static int tc_mdio_write(struct mii_bus *bus, int mii_id, int regnum, u16 val) | 
|  | 604 | { | 
|  | 605 | struct net_device *dev = bus->priv; | 
|  | 606 | struct tc35815_regs __iomem *tr = | 
|  | 607 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 608 | unsigned long timeout = jiffies + 10; | 
|  | 609 |  | 
|  | 610 | tc_writel(val, &tr->MD_Data); | 
|  | 611 | tc_writel(MD_CA_Busy | MD_CA_Wr | (mii_id << 5) | (regnum & 0x1f), | 
|  | 612 | &tr->MD_CA); | 
|  | 613 | while (tc_readl(&tr->MD_CA) & MD_CA_Busy) { | 
|  | 614 | if (time_after(jiffies, timeout)) | 
|  | 615 | return -EIO; | 
|  | 616 | cpu_relax(); | 
|  | 617 | } | 
|  | 618 | return 0; | 
|  | 619 | } | 
|  | 620 |  | 
|  | 621 | static void tc_handle_link_change(struct net_device *dev) | 
|  | 622 | { | 
|  | 623 | struct tc35815_local *lp = netdev_priv(dev); | 
|  | 624 | struct phy_device *phydev = lp->phy_dev; | 
|  | 625 | unsigned long flags; | 
|  | 626 | int status_change = 0; | 
|  | 627 |  | 
|  | 628 | spin_lock_irqsave(&lp->lock, flags); | 
|  | 629 | if (phydev->link && | 
|  | 630 | (lp->speed != phydev->speed || lp->duplex != phydev->duplex)) { | 
|  | 631 | struct tc35815_regs __iomem *tr = | 
|  | 632 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 633 | u32 reg; | 
|  | 634 |  | 
|  | 635 | reg = tc_readl(&tr->MAC_Ctl); | 
|  | 636 | reg |= MAC_HaltReq; | 
|  | 637 | tc_writel(reg, &tr->MAC_Ctl); | 
|  | 638 | if (phydev->duplex == DUPLEX_FULL) | 
|  | 639 | reg |= MAC_FullDup; | 
|  | 640 | else | 
|  | 641 | reg &= ~MAC_FullDup; | 
|  | 642 | tc_writel(reg, &tr->MAC_Ctl); | 
|  | 643 | reg &= ~MAC_HaltReq; | 
|  | 644 | tc_writel(reg, &tr->MAC_Ctl); | 
|  | 645 |  | 
|  | 646 | /* | 
|  | 647 | * TX4939 PCFG.SPEEDn bit will be changed on | 
|  | 648 | * NETDEV_CHANGE event. | 
|  | 649 | */ | 
|  | 650 |  | 
|  | 651 | #if !defined(NO_CHECK_CARRIER) && defined(WORKAROUND_LOSTCAR) | 
|  | 652 | /* | 
|  | 653 | * WORKAROUND: enable LostCrS only if half duplex | 
|  | 654 | * operation. | 
|  | 655 | * (TX4939 does not have EnLCarr) | 
|  | 656 | */ | 
|  | 657 | if (phydev->duplex == DUPLEX_HALF && | 
|  | 658 | lp->chiptype != TC35815_TX4939) | 
|  | 659 | tc_writel(tc_readl(&tr->Tx_Ctl) | Tx_EnLCarr, | 
|  | 660 | &tr->Tx_Ctl); | 
|  | 661 | #endif | 
|  | 662 |  | 
|  | 663 | lp->speed = phydev->speed; | 
|  | 664 | lp->duplex = phydev->duplex; | 
|  | 665 | status_change = 1; | 
|  | 666 | } | 
|  | 667 |  | 
|  | 668 | if (phydev->link != lp->link) { | 
|  | 669 | if (phydev->link) { | 
|  | 670 | #ifdef WORKAROUND_100HALF_PROMISC | 
|  | 671 | /* delayed promiscuous enabling */ | 
|  | 672 | if (dev->flags & IFF_PROMISC) | 
|  | 673 | tc35815_set_multicast_list(dev); | 
|  | 674 | #endif | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 675 | } else { | 
|  | 676 | lp->speed = 0; | 
|  | 677 | lp->duplex = -1; | 
|  | 678 | } | 
|  | 679 | lp->link = phydev->link; | 
|  | 680 |  | 
|  | 681 | status_change = 1; | 
|  | 682 | } | 
|  | 683 | spin_unlock_irqrestore(&lp->lock, flags); | 
|  | 684 |  | 
|  | 685 | if (status_change && netif_msg_link(lp)) { | 
|  | 686 | phy_print_status(phydev); | 
|  | 687 | #ifdef DEBUG | 
|  | 688 | printk(KERN_DEBUG | 
|  | 689 | "%s: MII BMCR %04x BMSR %04x LPA %04x\n", | 
|  | 690 | dev->name, | 
|  | 691 | phy_read(phydev, MII_BMCR), | 
|  | 692 | phy_read(phydev, MII_BMSR), | 
|  | 693 | phy_read(phydev, MII_LPA)); | 
|  | 694 | #endif | 
|  | 695 | } | 
|  | 696 | } | 
|  | 697 |  | 
|  | 698 | static int tc_mii_probe(struct net_device *dev) | 
|  | 699 | { | 
|  | 700 | struct tc35815_local *lp = netdev_priv(dev); | 
|  | 701 | struct phy_device *phydev = NULL; | 
|  | 702 | int phy_addr; | 
|  | 703 | u32 dropmask; | 
|  | 704 |  | 
|  | 705 | /* find the first phy */ | 
|  | 706 | for (phy_addr = 0; phy_addr < PHY_MAX_ADDR; phy_addr++) { | 
|  | 707 | if (lp->mii_bus.phy_map[phy_addr]) { | 
|  | 708 | if (phydev) { | 
|  | 709 | printk(KERN_ERR "%s: multiple PHYs found\n", | 
|  | 710 | dev->name); | 
|  | 711 | return -EINVAL; | 
|  | 712 | } | 
|  | 713 | phydev = lp->mii_bus.phy_map[phy_addr]; | 
|  | 714 | break; | 
|  | 715 | } | 
|  | 716 | } | 
|  | 717 |  | 
|  | 718 | if (!phydev) { | 
|  | 719 | printk(KERN_ERR "%s: no PHY found\n", dev->name); | 
|  | 720 | return -ENODEV; | 
|  | 721 | } | 
|  | 722 |  | 
|  | 723 | /* attach the mac to the phy */ | 
|  | 724 | phydev = phy_connect(dev, phydev->dev.bus_id, | 
|  | 725 | &tc_handle_link_change, 0, | 
|  | 726 | lp->chiptype == TC35815_TX4939 ? | 
|  | 727 | PHY_INTERFACE_MODE_RMII : PHY_INTERFACE_MODE_MII); | 
|  | 728 | if (IS_ERR(phydev)) { | 
|  | 729 | printk(KERN_ERR "%s: Could not attach to PHY\n", dev->name); | 
|  | 730 | return PTR_ERR(phydev); | 
|  | 731 | } | 
|  | 732 | printk(KERN_INFO "%s: attached PHY driver [%s] " | 
|  | 733 | "(mii_bus:phy_addr=%s, id=%x)\n", | 
|  | 734 | dev->name, phydev->drv->name, phydev->dev.bus_id, | 
|  | 735 | phydev->phy_id); | 
|  | 736 |  | 
|  | 737 | /* mask with MAC supported features */ | 
|  | 738 | phydev->supported &= PHY_BASIC_FEATURES; | 
|  | 739 | dropmask = 0; | 
|  | 740 | if (options.speed == 10) | 
|  | 741 | dropmask |= SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full; | 
|  | 742 | else if (options.speed == 100) | 
|  | 743 | dropmask |= SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full; | 
|  | 744 | if (options.duplex == 1) | 
|  | 745 | dropmask |= SUPPORTED_10baseT_Full | SUPPORTED_100baseT_Full; | 
|  | 746 | else if (options.duplex == 2) | 
|  | 747 | dropmask |= SUPPORTED_10baseT_Half | SUPPORTED_100baseT_Half; | 
|  | 748 | phydev->supported &= ~dropmask; | 
|  | 749 | phydev->advertising = phydev->supported; | 
|  | 750 |  | 
|  | 751 | lp->link = 0; | 
|  | 752 | lp->speed = 0; | 
|  | 753 | lp->duplex = -1; | 
|  | 754 | lp->phy_dev = phydev; | 
|  | 755 |  | 
|  | 756 | return 0; | 
|  | 757 | } | 
|  | 758 |  | 
|  | 759 | static int tc_mii_init(struct net_device *dev) | 
|  | 760 | { | 
|  | 761 | struct tc35815_local *lp = netdev_priv(dev); | 
|  | 762 | int err; | 
|  | 763 | int i; | 
|  | 764 |  | 
|  | 765 | lp->mii_bus.name = "tc35815_mii_bus"; | 
|  | 766 | lp->mii_bus.read = tc_mdio_read; | 
|  | 767 | lp->mii_bus.write = tc_mdio_write; | 
| Atsushi Nemoto | 10e05f7 | 2008-04-13 00:11:46 +0900 | [diff] [blame] | 768 | snprintf(lp->mii_bus.id, MII_BUS_ID_SIZE, "%x", | 
|  | 769 | (lp->pci_dev->bus->number << 8) | lp->pci_dev->devfn); | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 770 | lp->mii_bus.priv = dev; | 
|  | 771 | lp->mii_bus.dev = &lp->pci_dev->dev; | 
|  | 772 | lp->mii_bus.irq = kmalloc(sizeof(int) * PHY_MAX_ADDR, GFP_KERNEL); | 
|  | 773 | if (!lp->mii_bus.irq) { | 
|  | 774 | err = -ENOMEM; | 
|  | 775 | goto err_out; | 
|  | 776 | } | 
|  | 777 |  | 
|  | 778 | for (i = 0; i < PHY_MAX_ADDR; i++) | 
|  | 779 | lp->mii_bus.irq[i] = PHY_POLL; | 
|  | 780 |  | 
|  | 781 | err = mdiobus_register(&lp->mii_bus); | 
|  | 782 | if (err) | 
|  | 783 | goto err_out_free_mdio_irq; | 
|  | 784 | err = tc_mii_probe(dev); | 
|  | 785 | if (err) | 
|  | 786 | goto err_out_unregister_bus; | 
|  | 787 | return 0; | 
|  | 788 |  | 
|  | 789 | err_out_unregister_bus: | 
|  | 790 | mdiobus_unregister(&lp->mii_bus); | 
|  | 791 | err_out_free_mdio_irq: | 
|  | 792 | kfree(lp->mii_bus.irq); | 
|  | 793 | err_out: | 
|  | 794 | return err; | 
|  | 795 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 796 |  | 
| Atsushi Nemoto | bd43da8 | 2007-06-29 22:34:53 +0900 | [diff] [blame] | 797 | #ifdef CONFIG_CPU_TX49XX | 
|  | 798 | /* | 
|  | 799 | * Find a platform_device providing a MAC address.  The platform code | 
|  | 800 | * should provide a "tc35815-mac" device with a MAC address in its | 
|  | 801 | * platform_data. | 
|  | 802 | */ | 
|  | 803 | static int __devinit tc35815_mac_match(struct device *dev, void *data) | 
|  | 804 | { | 
|  | 805 | struct platform_device *plat_dev = to_platform_device(dev); | 
|  | 806 | struct pci_dev *pci_dev = data; | 
| Atsushi Nemoto | 06675e6 | 2008-01-19 01:15:52 +0900 | [diff] [blame] | 807 | unsigned int id = pci_dev->irq; | 
| Atsushi Nemoto | bd43da8 | 2007-06-29 22:34:53 +0900 | [diff] [blame] | 808 | return !strcmp(plat_dev->name, "tc35815-mac") && plat_dev->id == id; | 
|  | 809 | } | 
|  | 810 |  | 
|  | 811 | static int __devinit tc35815_read_plat_dev_addr(struct net_device *dev) | 
|  | 812 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 813 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | bd43da8 | 2007-06-29 22:34:53 +0900 | [diff] [blame] | 814 | struct device *pd = bus_find_device(&platform_bus_type, NULL, | 
|  | 815 | lp->pci_dev, tc35815_mac_match); | 
|  | 816 | if (pd) { | 
|  | 817 | if (pd->platform_data) | 
|  | 818 | memcpy(dev->dev_addr, pd->platform_data, ETH_ALEN); | 
|  | 819 | put_device(pd); | 
|  | 820 | return is_valid_ether_addr(dev->dev_addr) ? 0 : -ENODEV; | 
|  | 821 | } | 
|  | 822 | return -ENODEV; | 
|  | 823 | } | 
|  | 824 | #else | 
| Yoichi Yuasa | 308a906 | 2007-07-18 11:13:42 +0900 | [diff] [blame] | 825 | static int __devinit tc35815_read_plat_dev_addr(struct net_device *dev) | 
| Atsushi Nemoto | bd43da8 | 2007-06-29 22:34:53 +0900 | [diff] [blame] | 826 | { | 
|  | 827 | return -ENODEV; | 
|  | 828 | } | 
|  | 829 | #endif | 
|  | 830 |  | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 831 | static int __devinit tc35815_init_dev_addr(struct net_device *dev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 832 | { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 833 | struct tc35815_regs __iomem *tr = | 
|  | 834 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 835 | int i; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 836 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 837 | while (tc_readl(&tr->PROM_Ctl) & PROM_Busy) | 
|  | 838 | ; | 
|  | 839 | for (i = 0; i < 6; i += 2) { | 
|  | 840 | unsigned short data; | 
|  | 841 | tc_writel(PROM_Busy | PROM_Read | (i / 2 + 2), &tr->PROM_Ctl); | 
|  | 842 | while (tc_readl(&tr->PROM_Ctl) & PROM_Busy) | 
|  | 843 | ; | 
|  | 844 | data = tc_readl(&tr->PROM_Data); | 
|  | 845 | dev->dev_addr[i] = data & 0xff; | 
|  | 846 | dev->dev_addr[i+1] = data >> 8; | 
|  | 847 | } | 
| Atsushi Nemoto | bd43da8 | 2007-06-29 22:34:53 +0900 | [diff] [blame] | 848 | if (!is_valid_ether_addr(dev->dev_addr)) | 
|  | 849 | return tc35815_read_plat_dev_addr(dev); | 
|  | 850 | return 0; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 851 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 852 |  | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 853 | static int __devinit tc35815_init_one(struct pci_dev *pdev, | 
|  | 854 | const struct pci_device_id *ent) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 855 | { | 
|  | 856 | void __iomem *ioaddr = NULL; | 
|  | 857 | struct net_device *dev; | 
|  | 858 | struct tc35815_local *lp; | 
|  | 859 | int rc; | 
| Atsushi Nemoto | 958eb80 | 2008-04-11 00:24:24 +0900 | [diff] [blame] | 860 | DECLARE_MAC_BUF(mac); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 861 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 862 | static int printed_version; | 
|  | 863 | if (!printed_version++) { | 
|  | 864 | printk(version); | 
|  | 865 | dev_printk(KERN_DEBUG, &pdev->dev, | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 866 | "speed:%d duplex:%d\n", | 
|  | 867 | options.speed, options.duplex); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 868 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 869 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 870 | if (!pdev->irq) { | 
|  | 871 | dev_warn(&pdev->dev, "no IRQ assigned.\n"); | 
|  | 872 | return -ENODEV; | 
|  | 873 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 874 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 875 | /* dev zeroed in alloc_etherdev */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 876 | dev = alloc_etherdev(sizeof(*lp)); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 877 | if (dev == NULL) { | 
|  | 878 | dev_err(&pdev->dev, "unable to alloc new ethernet\n"); | 
|  | 879 | return -ENOMEM; | 
|  | 880 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 881 | SET_NETDEV_DEV(dev, &pdev->dev); | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 882 | lp = netdev_priv(dev); | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 883 | lp->dev = dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 884 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 885 | /* enable device (incl. PCI PM wakeup), and bus-mastering */ | 
| Atsushi Nemoto | 22adf7e | 2008-04-11 00:24:45 +0900 | [diff] [blame] | 886 | rc = pcim_enable_device(pdev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 887 | if (rc) | 
|  | 888 | goto err_out; | 
| Atsushi Nemoto | 22adf7e | 2008-04-11 00:24:45 +0900 | [diff] [blame] | 889 | rc = pcim_iomap_regions(pdev, 1 << 1, MODNAME); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 890 | if (rc) | 
|  | 891 | goto err_out; | 
| Atsushi Nemoto | 22adf7e | 2008-04-11 00:24:45 +0900 | [diff] [blame] | 892 | pci_set_master(pdev); | 
|  | 893 | ioaddr = pcim_iomap_table(pdev)[1]; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 894 |  | 
|  | 895 | /* Initialize the device structure. */ | 
|  | 896 | dev->open = tc35815_open; | 
|  | 897 | dev->hard_start_xmit = tc35815_send_packet; | 
|  | 898 | dev->stop = tc35815_close; | 
|  | 899 | dev->get_stats = tc35815_get_stats; | 
|  | 900 | dev->set_multicast_list = tc35815_set_multicast_list; | 
|  | 901 | dev->do_ioctl = tc35815_ioctl; | 
|  | 902 | dev->ethtool_ops = &tc35815_ethtool_ops; | 
|  | 903 | dev->tx_timeout = tc35815_tx_timeout; | 
|  | 904 | dev->watchdog_timeo = TC35815_TX_TIMEOUT; | 
|  | 905 | #ifdef TC35815_NAPI | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 906 | netif_napi_add(dev, &lp->napi, tc35815_poll, NAPI_WEIGHT); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 907 | #endif | 
|  | 908 | #ifdef CONFIG_NET_POLL_CONTROLLER | 
|  | 909 | dev->poll_controller = tc35815_poll_controller; | 
|  | 910 | #endif | 
|  | 911 |  | 
|  | 912 | dev->irq = pdev->irq; | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 913 | dev->base_addr = (unsigned long)ioaddr; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 914 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 915 | INIT_WORK(&lp->restart_work, tc35815_restart_work); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 916 | spin_lock_init(&lp->lock); | 
|  | 917 | lp->pci_dev = pdev; | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 918 | lp->chiptype = ent->driver_data; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 919 |  | 
|  | 920 | lp->msg_enable = NETIF_MSG_TX_ERR | NETIF_MSG_HW | NETIF_MSG_DRV | NETIF_MSG_LINK; | 
|  | 921 | pci_set_drvdata(pdev, dev); | 
|  | 922 |  | 
|  | 923 | /* Soft reset the chip. */ | 
|  | 924 | tc35815_chip_reset(dev); | 
|  | 925 |  | 
|  | 926 | /* Retrieve the ethernet address. */ | 
| Atsushi Nemoto | bd43da8 | 2007-06-29 22:34:53 +0900 | [diff] [blame] | 927 | if (tc35815_init_dev_addr(dev)) { | 
|  | 928 | dev_warn(&pdev->dev, "not valid ether addr\n"); | 
|  | 929 | random_ether_addr(dev->dev_addr); | 
|  | 930 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 931 |  | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 932 | rc = register_netdev(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 933 | if (rc) | 
| Atsushi Nemoto | 22adf7e | 2008-04-11 00:24:45 +0900 | [diff] [blame] | 934 | goto err_out; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 935 |  | 
|  | 936 | memcpy(dev->perm_addr, dev->dev_addr, dev->addr_len); | 
| Atsushi Nemoto | 958eb80 | 2008-04-11 00:24:24 +0900 | [diff] [blame] | 937 | printk(KERN_INFO "%s: %s at 0x%lx, %s, IRQ %d\n", | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 938 | dev->name, | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 939 | chip_info[ent->driver_data].name, | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 940 | dev->base_addr, | 
| Atsushi Nemoto | 958eb80 | 2008-04-11 00:24:24 +0900 | [diff] [blame] | 941 | print_mac(mac, dev->dev_addr), | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 942 | dev->irq); | 
|  | 943 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 944 | rc = tc_mii_init(dev); | 
|  | 945 | if (rc) | 
|  | 946 | goto err_out_unregister; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 947 |  | 
|  | 948 | return 0; | 
|  | 949 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 950 | err_out_unregister: | 
|  | 951 | unregister_netdev(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 952 | err_out: | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 953 | free_netdev(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 954 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 955 | } | 
|  | 956 |  | 
|  | 957 |  | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 958 | static void __devexit tc35815_remove_one(struct pci_dev *pdev) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 959 | { | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 960 | struct net_device *dev = pci_get_drvdata(pdev); | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 961 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 962 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 963 | phy_disconnect(lp->phy_dev); | 
|  | 964 | mdiobus_unregister(&lp->mii_bus); | 
|  | 965 | kfree(lp->mii_bus.irq); | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 966 | unregister_netdev(dev); | 
|  | 967 | free_netdev(dev); | 
|  | 968 | pci_set_drvdata(pdev, NULL); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 969 | } | 
|  | 970 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 971 | static int | 
|  | 972 | tc35815_init_queues(struct net_device *dev) | 
|  | 973 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 974 | struct tc35815_local *lp = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 975 | int i; | 
|  | 976 | unsigned long fd_addr; | 
|  | 977 |  | 
|  | 978 | if (!lp->fd_buf) { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 979 | BUG_ON(sizeof(struct FDesc) + | 
|  | 980 | sizeof(struct BDesc) * RX_BUF_NUM + | 
|  | 981 | sizeof(struct FDesc) * RX_FD_NUM + | 
|  | 982 | sizeof(struct TxFD) * TX_FD_NUM > | 
|  | 983 | PAGE_SIZE * FD_PAGE_NUM); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 984 |  | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 985 | lp->fd_buf = pci_alloc_consistent(lp->pci_dev, | 
|  | 986 | PAGE_SIZE * FD_PAGE_NUM, | 
|  | 987 | &lp->fd_buf_dma); | 
|  | 988 | if (!lp->fd_buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 989 | return -ENOMEM; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 990 | for (i = 0; i < RX_BUF_NUM; i++) { | 
|  | 991 | #ifdef TC35815_USE_PACKEDBUFFER | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 992 | lp->data_buf[i] = | 
|  | 993 | alloc_rxbuf_page(lp->pci_dev, | 
|  | 994 | &lp->data_buf_dma[i]); | 
|  | 995 | if (!lp->data_buf[i]) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 996 | while (--i >= 0) { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 997 | free_rxbuf_page(lp->pci_dev, | 
|  | 998 | lp->data_buf[i], | 
|  | 999 | lp->data_buf_dma[i]); | 
|  | 1000 | lp->data_buf[i] = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1001 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1002 | pci_free_consistent(lp->pci_dev, | 
|  | 1003 | PAGE_SIZE * FD_PAGE_NUM, | 
|  | 1004 | lp->fd_buf, | 
|  | 1005 | lp->fd_buf_dma); | 
|  | 1006 | lp->fd_buf = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1007 | return -ENOMEM; | 
|  | 1008 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1009 | #else | 
|  | 1010 | lp->rx_skbs[i].skb = | 
|  | 1011 | alloc_rxbuf_skb(dev, lp->pci_dev, | 
|  | 1012 | &lp->rx_skbs[i].skb_dma); | 
|  | 1013 | if (!lp->rx_skbs[i].skb) { | 
|  | 1014 | while (--i >= 0) { | 
|  | 1015 | free_rxbuf_skb(lp->pci_dev, | 
|  | 1016 | lp->rx_skbs[i].skb, | 
|  | 1017 | lp->rx_skbs[i].skb_dma); | 
|  | 1018 | lp->rx_skbs[i].skb = NULL; | 
|  | 1019 | } | 
|  | 1020 | pci_free_consistent(lp->pci_dev, | 
|  | 1021 | PAGE_SIZE * FD_PAGE_NUM, | 
|  | 1022 | lp->fd_buf, | 
|  | 1023 | lp->fd_buf_dma); | 
|  | 1024 | lp->fd_buf = NULL; | 
|  | 1025 | return -ENOMEM; | 
|  | 1026 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1027 | #endif | 
|  | 1028 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1029 | printk(KERN_DEBUG "%s: FD buf %p DataBuf", | 
|  | 1030 | dev->name, lp->fd_buf); | 
|  | 1031 | #ifdef TC35815_USE_PACKEDBUFFER | 
|  | 1032 | printk(" DataBuf"); | 
|  | 1033 | for (i = 0; i < RX_BUF_NUM; i++) | 
|  | 1034 | printk(" %p", lp->data_buf[i]); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1035 | #endif | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1036 | printk("\n"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1037 | } else { | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 1038 | for (i = 0; i < FD_PAGE_NUM; i++) | 
|  | 1039 | clear_page((void *)((unsigned long)lp->fd_buf + | 
|  | 1040 | i * PAGE_SIZE)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1041 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1042 | fd_addr = (unsigned long)lp->fd_buf; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1043 |  | 
|  | 1044 | /* Free Descriptors (for Receive) */ | 
|  | 1045 | lp->rfd_base = (struct RxFD *)fd_addr; | 
|  | 1046 | fd_addr += sizeof(struct RxFD) * RX_FD_NUM; | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 1047 | for (i = 0; i < RX_FD_NUM; i++) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1048 | lp->rfd_base[i].fd.FDCtl = cpu_to_le32(FD_CownsFD); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1049 | lp->rfd_cur = lp->rfd_base; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1050 | lp->rfd_limit = (struct RxFD *)fd_addr - (RX_FD_RESERVE + 1); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1051 |  | 
|  | 1052 | /* Transmit Descriptors */ | 
|  | 1053 | lp->tfd_base = (struct TxFD *)fd_addr; | 
|  | 1054 | fd_addr += sizeof(struct TxFD) * TX_FD_NUM; | 
|  | 1055 | for (i = 0; i < TX_FD_NUM; i++) { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1056 | lp->tfd_base[i].fd.FDNext = cpu_to_le32(fd_virt_to_bus(lp, &lp->tfd_base[i+1])); | 
|  | 1057 | lp->tfd_base[i].fd.FDSystem = cpu_to_le32(0xffffffff); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1058 | lp->tfd_base[i].fd.FDCtl = cpu_to_le32(0); | 
|  | 1059 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1060 | lp->tfd_base[TX_FD_NUM-1].fd.FDNext = cpu_to_le32(fd_virt_to_bus(lp, &lp->tfd_base[0])); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1061 | lp->tfd_start = 0; | 
|  | 1062 | lp->tfd_end = 0; | 
|  | 1063 |  | 
|  | 1064 | /* Buffer List (for Receive) */ | 
|  | 1065 | lp->fbl_ptr = (struct FrFD *)fd_addr; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1066 | lp->fbl_ptr->fd.FDNext = cpu_to_le32(fd_virt_to_bus(lp, lp->fbl_ptr)); | 
|  | 1067 | lp->fbl_ptr->fd.FDCtl = cpu_to_le32(RX_BUF_NUM | FD_CownsFD); | 
|  | 1068 | #ifndef TC35815_USE_PACKEDBUFFER | 
|  | 1069 | /* | 
|  | 1070 | * move all allocated skbs to head of rx_skbs[] array. | 
|  | 1071 | * fbl_count mighe not be RX_BUF_NUM if alloc_rxbuf_skb() in | 
|  | 1072 | * tc35815_rx() had failed. | 
|  | 1073 | */ | 
|  | 1074 | lp->fbl_count = 0; | 
|  | 1075 | for (i = 0; i < RX_BUF_NUM; i++) { | 
|  | 1076 | if (lp->rx_skbs[i].skb) { | 
|  | 1077 | if (i != lp->fbl_count) { | 
|  | 1078 | lp->rx_skbs[lp->fbl_count].skb = | 
|  | 1079 | lp->rx_skbs[i].skb; | 
|  | 1080 | lp->rx_skbs[lp->fbl_count].skb_dma = | 
|  | 1081 | lp->rx_skbs[i].skb_dma; | 
|  | 1082 | } | 
|  | 1083 | lp->fbl_count++; | 
|  | 1084 | } | 
|  | 1085 | } | 
|  | 1086 | #endif | 
|  | 1087 | for (i = 0; i < RX_BUF_NUM; i++) { | 
|  | 1088 | #ifdef TC35815_USE_PACKEDBUFFER | 
|  | 1089 | lp->fbl_ptr->bd[i].BuffData = cpu_to_le32(lp->data_buf_dma[i]); | 
|  | 1090 | #else | 
|  | 1091 | if (i >= lp->fbl_count) { | 
|  | 1092 | lp->fbl_ptr->bd[i].BuffData = 0; | 
|  | 1093 | lp->fbl_ptr->bd[i].BDCtl = 0; | 
|  | 1094 | continue; | 
|  | 1095 | } | 
|  | 1096 | lp->fbl_ptr->bd[i].BuffData = | 
|  | 1097 | cpu_to_le32(lp->rx_skbs[i].skb_dma); | 
|  | 1098 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1099 | /* BDID is index of FrFD.bd[] */ | 
|  | 1100 | lp->fbl_ptr->bd[i].BDCtl = | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1101 | cpu_to_le32(BD_CownsBD | (i << BD_RxBDID_SHIFT) | | 
|  | 1102 | RX_BUF_SIZE); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1103 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1104 | #ifdef TC35815_USE_PACKEDBUFFER | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1105 | lp->fbl_curid = 0; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1106 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1107 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1108 | printk(KERN_DEBUG "%s: TxFD %p RxFD %p FrFD %p\n", | 
|  | 1109 | dev->name, lp->tfd_base, lp->rfd_base, lp->fbl_ptr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1110 | return 0; | 
|  | 1111 | } | 
|  | 1112 |  | 
|  | 1113 | static void | 
|  | 1114 | tc35815_clear_queues(struct net_device *dev) | 
|  | 1115 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 1116 | struct tc35815_local *lp = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1117 | int i; | 
|  | 1118 |  | 
|  | 1119 | for (i = 0; i < TX_FD_NUM; i++) { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1120 | u32 fdsystem = le32_to_cpu(lp->tfd_base[i].fd.FDSystem); | 
|  | 1121 | struct sk_buff *skb = | 
|  | 1122 | fdsystem != 0xffffffff ? | 
|  | 1123 | lp->tx_skbs[fdsystem].skb : NULL; | 
|  | 1124 | #ifdef DEBUG | 
|  | 1125 | if (lp->tx_skbs[i].skb != skb) { | 
|  | 1126 | printk("%s: tx_skbs mismatch(%d).\n", dev->name, i); | 
|  | 1127 | panic_queues(dev); | 
|  | 1128 | } | 
|  | 1129 | #else | 
|  | 1130 | BUG_ON(lp->tx_skbs[i].skb != skb); | 
|  | 1131 | #endif | 
|  | 1132 | if (skb) { | 
|  | 1133 | pci_unmap_single(lp->pci_dev, lp->tx_skbs[i].skb_dma, skb->len, PCI_DMA_TODEVICE); | 
|  | 1134 | lp->tx_skbs[i].skb = NULL; | 
|  | 1135 | lp->tx_skbs[i].skb_dma = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1136 | dev_kfree_skb_any(skb); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1137 | } | 
|  | 1138 | lp->tfd_base[i].fd.FDSystem = cpu_to_le32(0xffffffff); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1139 | } | 
|  | 1140 |  | 
|  | 1141 | tc35815_init_queues(dev); | 
|  | 1142 | } | 
|  | 1143 |  | 
|  | 1144 | static void | 
|  | 1145 | tc35815_free_queues(struct net_device *dev) | 
|  | 1146 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 1147 | struct tc35815_local *lp = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1148 | int i; | 
|  | 1149 |  | 
|  | 1150 | if (lp->tfd_base) { | 
|  | 1151 | for (i = 0; i < TX_FD_NUM; i++) { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1152 | u32 fdsystem = le32_to_cpu(lp->tfd_base[i].fd.FDSystem); | 
|  | 1153 | struct sk_buff *skb = | 
|  | 1154 | fdsystem != 0xffffffff ? | 
|  | 1155 | lp->tx_skbs[fdsystem].skb : NULL; | 
|  | 1156 | #ifdef DEBUG | 
|  | 1157 | if (lp->tx_skbs[i].skb != skb) { | 
|  | 1158 | printk("%s: tx_skbs mismatch(%d).\n", dev->name, i); | 
|  | 1159 | panic_queues(dev); | 
|  | 1160 | } | 
|  | 1161 | #else | 
|  | 1162 | BUG_ON(lp->tx_skbs[i].skb != skb); | 
|  | 1163 | #endif | 
|  | 1164 | if (skb) { | 
|  | 1165 | dev_kfree_skb(skb); | 
|  | 1166 | pci_unmap_single(lp->pci_dev, lp->tx_skbs[i].skb_dma, skb->len, PCI_DMA_TODEVICE); | 
|  | 1167 | lp->tx_skbs[i].skb = NULL; | 
|  | 1168 | lp->tx_skbs[i].skb_dma = 0; | 
|  | 1169 | } | 
|  | 1170 | lp->tfd_base[i].fd.FDSystem = cpu_to_le32(0xffffffff); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1171 | } | 
|  | 1172 | } | 
|  | 1173 |  | 
|  | 1174 | lp->rfd_base = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1175 | lp->rfd_limit = NULL; | 
|  | 1176 | lp->rfd_cur = NULL; | 
|  | 1177 | lp->fbl_ptr = NULL; | 
|  | 1178 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1179 | for (i = 0; i < RX_BUF_NUM; i++) { | 
|  | 1180 | #ifdef TC35815_USE_PACKEDBUFFER | 
|  | 1181 | if (lp->data_buf[i]) { | 
|  | 1182 | free_rxbuf_page(lp->pci_dev, | 
|  | 1183 | lp->data_buf[i], lp->data_buf_dma[i]); | 
|  | 1184 | lp->data_buf[i] = NULL; | 
|  | 1185 | } | 
|  | 1186 | #else | 
|  | 1187 | if (lp->rx_skbs[i].skb) { | 
|  | 1188 | free_rxbuf_skb(lp->pci_dev, lp->rx_skbs[i].skb, | 
|  | 1189 | lp->rx_skbs[i].skb_dma); | 
|  | 1190 | lp->rx_skbs[i].skb = NULL; | 
|  | 1191 | } | 
|  | 1192 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1193 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1194 | if (lp->fd_buf) { | 
|  | 1195 | pci_free_consistent(lp->pci_dev, PAGE_SIZE * FD_PAGE_NUM, | 
|  | 1196 | lp->fd_buf, lp->fd_buf_dma); | 
|  | 1197 | lp->fd_buf = NULL; | 
|  | 1198 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1199 | } | 
|  | 1200 |  | 
|  | 1201 | static void | 
|  | 1202 | dump_txfd(struct TxFD *fd) | 
|  | 1203 | { | 
|  | 1204 | printk("TxFD(%p): %08x %08x %08x %08x\n", fd, | 
|  | 1205 | le32_to_cpu(fd->fd.FDNext), | 
|  | 1206 | le32_to_cpu(fd->fd.FDSystem), | 
|  | 1207 | le32_to_cpu(fd->fd.FDStat), | 
|  | 1208 | le32_to_cpu(fd->fd.FDCtl)); | 
|  | 1209 | printk("BD: "); | 
|  | 1210 | printk(" %08x %08x", | 
|  | 1211 | le32_to_cpu(fd->bd.BuffData), | 
|  | 1212 | le32_to_cpu(fd->bd.BDCtl)); | 
|  | 1213 | printk("\n"); | 
|  | 1214 | } | 
|  | 1215 |  | 
|  | 1216 | static int | 
|  | 1217 | dump_rxfd(struct RxFD *fd) | 
|  | 1218 | { | 
|  | 1219 | int i, bd_count = (le32_to_cpu(fd->fd.FDCtl) & FD_BDCnt_MASK) >> FD_BDCnt_SHIFT; | 
|  | 1220 | if (bd_count > 8) | 
|  | 1221 | bd_count = 8; | 
|  | 1222 | printk("RxFD(%p): %08x %08x %08x %08x\n", fd, | 
|  | 1223 | le32_to_cpu(fd->fd.FDNext), | 
|  | 1224 | le32_to_cpu(fd->fd.FDSystem), | 
|  | 1225 | le32_to_cpu(fd->fd.FDStat), | 
|  | 1226 | le32_to_cpu(fd->fd.FDCtl)); | 
|  | 1227 | if (le32_to_cpu(fd->fd.FDCtl) & FD_CownsFD) | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 1228 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1229 | printk("BD: "); | 
|  | 1230 | for (i = 0; i < bd_count; i++) | 
|  | 1231 | printk(" %08x %08x", | 
|  | 1232 | le32_to_cpu(fd->bd[i].BuffData), | 
|  | 1233 | le32_to_cpu(fd->bd[i].BDCtl)); | 
|  | 1234 | printk("\n"); | 
|  | 1235 | return bd_count; | 
|  | 1236 | } | 
|  | 1237 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1238 | #if defined(DEBUG) || defined(TC35815_USE_PACKEDBUFFER) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1239 | static void | 
|  | 1240 | dump_frfd(struct FrFD *fd) | 
|  | 1241 | { | 
|  | 1242 | int i; | 
|  | 1243 | printk("FrFD(%p): %08x %08x %08x %08x\n", fd, | 
|  | 1244 | le32_to_cpu(fd->fd.FDNext), | 
|  | 1245 | le32_to_cpu(fd->fd.FDSystem), | 
|  | 1246 | le32_to_cpu(fd->fd.FDStat), | 
|  | 1247 | le32_to_cpu(fd->fd.FDCtl)); | 
|  | 1248 | printk("BD: "); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1249 | for (i = 0; i < RX_BUF_NUM; i++) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1250 | printk(" %08x %08x", | 
|  | 1251 | le32_to_cpu(fd->bd[i].BuffData), | 
|  | 1252 | le32_to_cpu(fd->bd[i].BDCtl)); | 
|  | 1253 | printk("\n"); | 
|  | 1254 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1255 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1256 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1257 | #ifdef DEBUG | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1258 | static void | 
|  | 1259 | panic_queues(struct net_device *dev) | 
|  | 1260 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 1261 | struct tc35815_local *lp = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1262 | int i; | 
|  | 1263 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1264 | printk("TxFD base %p, start %u, end %u\n", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1265 | lp->tfd_base, lp->tfd_start, lp->tfd_end); | 
|  | 1266 | printk("RxFD base %p limit %p cur %p\n", | 
|  | 1267 | lp->rfd_base, lp->rfd_limit, lp->rfd_cur); | 
|  | 1268 | printk("FrFD %p\n", lp->fbl_ptr); | 
|  | 1269 | for (i = 0; i < TX_FD_NUM; i++) | 
|  | 1270 | dump_txfd(&lp->tfd_base[i]); | 
|  | 1271 | for (i = 0; i < RX_FD_NUM; i++) { | 
|  | 1272 | int bd_count = dump_rxfd(&lp->rfd_base[i]); | 
|  | 1273 | i += (bd_count + 1) / 2;	/* skip BDs */ | 
|  | 1274 | } | 
|  | 1275 | dump_frfd(lp->fbl_ptr); | 
|  | 1276 | panic("%s: Illegal queue state.", dev->name); | 
|  | 1277 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1278 | #endif | 
|  | 1279 |  | 
| Atsushi Nemoto | 958eb80 | 2008-04-11 00:24:24 +0900 | [diff] [blame] | 1280 | static void print_eth(const u8 *add) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1281 | { | 
| Atsushi Nemoto | 958eb80 | 2008-04-11 00:24:24 +0900 | [diff] [blame] | 1282 | DECLARE_MAC_BUF(mac); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1283 |  | 
| Atsushi Nemoto | 958eb80 | 2008-04-11 00:24:24 +0900 | [diff] [blame] | 1284 | printk(KERN_DEBUG "print_eth(%p)\n", add); | 
|  | 1285 | printk(KERN_DEBUG " %s =>", print_mac(mac, add + 6)); | 
|  | 1286 | printk(KERN_CONT " %s : %02x%02x\n", | 
|  | 1287 | print_mac(mac, add), add[12], add[13]); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1288 | } | 
|  | 1289 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1290 | static int tc35815_tx_full(struct net_device *dev) | 
|  | 1291 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 1292 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1293 | return ((lp->tfd_start + 1) % TX_FD_NUM == lp->tfd_end); | 
|  | 1294 | } | 
|  | 1295 |  | 
|  | 1296 | static void tc35815_restart(struct net_device *dev) | 
|  | 1297 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 1298 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1299 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 1300 | if (lp->phy_dev) { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1301 | int timeout; | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 1302 |  | 
|  | 1303 | phy_write(lp->phy_dev, MII_BMCR, BMCR_RESET); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1304 | timeout = 100; | 
|  | 1305 | while (--timeout) { | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 1306 | if (!(phy_read(lp->phy_dev, MII_BMCR) & BMCR_RESET)) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1307 | break; | 
|  | 1308 | udelay(1); | 
|  | 1309 | } | 
|  | 1310 | if (!timeout) | 
|  | 1311 | printk(KERN_ERR "%s: BMCR reset failed.\n", dev->name); | 
|  | 1312 | } | 
|  | 1313 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 1314 | spin_lock_irq(&lp->lock); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1315 | tc35815_chip_reset(dev); | 
|  | 1316 | tc35815_clear_queues(dev); | 
|  | 1317 | tc35815_chip_init(dev); | 
|  | 1318 | /* Reconfigure CAM again since tc35815_chip_init() initialize it. */ | 
|  | 1319 | tc35815_set_multicast_list(dev); | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 1320 | spin_unlock_irq(&lp->lock); | 
|  | 1321 |  | 
|  | 1322 | netif_wake_queue(dev); | 
|  | 1323 | } | 
|  | 1324 |  | 
|  | 1325 | static void tc35815_restart_work(struct work_struct *work) | 
|  | 1326 | { | 
|  | 1327 | struct tc35815_local *lp = | 
|  | 1328 | container_of(work, struct tc35815_local, restart_work); | 
|  | 1329 | struct net_device *dev = lp->dev; | 
|  | 1330 |  | 
|  | 1331 | tc35815_restart(dev); | 
|  | 1332 | } | 
|  | 1333 |  | 
|  | 1334 | static void tc35815_schedule_restart(struct net_device *dev) | 
|  | 1335 | { | 
|  | 1336 | struct tc35815_local *lp = netdev_priv(dev); | 
|  | 1337 | struct tc35815_regs __iomem *tr = | 
|  | 1338 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 1339 |  | 
|  | 1340 | /* disable interrupts */ | 
|  | 1341 | tc_writel(0, &tr->Int_En); | 
|  | 1342 | tc_writel(tc_readl(&tr->DMA_Ctl) | DMA_IntMask, &tr->DMA_Ctl); | 
|  | 1343 | schedule_work(&lp->restart_work); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1344 | } | 
|  | 1345 |  | 
|  | 1346 | static void tc35815_tx_timeout(struct net_device *dev) | 
|  | 1347 | { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1348 | struct tc35815_regs __iomem *tr = | 
|  | 1349 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 1350 |  | 
|  | 1351 | printk(KERN_WARNING "%s: transmit timed out, status %#x\n", | 
|  | 1352 | dev->name, tc_readl(&tr->Tx_Stat)); | 
|  | 1353 |  | 
|  | 1354 | /* Try to restart the adaptor. */ | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 1355 | tc35815_schedule_restart(dev); | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1356 | dev->stats.tx_errors++; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1357 | } | 
|  | 1358 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1359 | /* | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 1360 | * Open/initialize the controller. This is called (in the current kernel) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1361 | * sometime after booting when the 'ifconfig' program is run. | 
|  | 1362 | * | 
|  | 1363 | * This routine should set everything up anew at each open, even | 
|  | 1364 | * registers that "should" only need to be set once at boot, so that | 
|  | 1365 | * there is non-reboot way to recover if something goes wrong. | 
|  | 1366 | */ | 
|  | 1367 | static int | 
|  | 1368 | tc35815_open(struct net_device *dev) | 
|  | 1369 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 1370 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1371 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1372 | /* | 
|  | 1373 | * This is used if the interrupt line can turned off (shared). | 
|  | 1374 | * See 3c503.c for an example of selecting the IRQ at config-time. | 
|  | 1375 | */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 1376 | if (request_irq(dev->irq, &tc35815_interrupt, IRQF_SHARED, | 
|  | 1377 | dev->name, dev)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1378 | return -EAGAIN; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1379 |  | 
|  | 1380 | tc35815_chip_reset(dev); | 
|  | 1381 |  | 
|  | 1382 | if (tc35815_init_queues(dev) != 0) { | 
|  | 1383 | free_irq(dev->irq, dev); | 
|  | 1384 | return -EAGAIN; | 
|  | 1385 | } | 
|  | 1386 |  | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 1387 | #ifdef TC35815_NAPI | 
|  | 1388 | napi_enable(&lp->napi); | 
|  | 1389 | #endif | 
|  | 1390 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1391 | /* Reset the hardware here. Don't forget to set the station address. */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1392 | spin_lock_irq(&lp->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1393 | tc35815_chip_init(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1394 | spin_unlock_irq(&lp->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1395 |  | 
| Atsushi Nemoto | 59524a3 | 2008-06-25 11:41:01 +0900 | [diff] [blame] | 1396 | netif_carrier_off(dev); | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 1397 | /* schedule a link state check */ | 
|  | 1398 | phy_start(lp->phy_dev); | 
|  | 1399 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1400 | /* We are now ready to accept transmit requeusts from | 
|  | 1401 | * the queueing layer of the networking. | 
|  | 1402 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1403 | netif_start_queue(dev); | 
|  | 1404 |  | 
|  | 1405 | return 0; | 
|  | 1406 | } | 
|  | 1407 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1408 | /* This will only be invoked if your driver is _not_ in XOFF state. | 
|  | 1409 | * What this means is that you need not check it, and that this | 
|  | 1410 | * invariant will hold if you make sure that the netif_*_queue() | 
|  | 1411 | * calls are done at the proper times. | 
|  | 1412 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1413 | static int tc35815_send_packet(struct sk_buff *skb, struct net_device *dev) | 
|  | 1414 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 1415 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1416 | struct TxFD *txfd; | 
|  | 1417 | unsigned long flags; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1418 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1419 | /* If some error occurs while trying to transmit this | 
|  | 1420 | * packet, you should return '1' from this function. | 
|  | 1421 | * In such a case you _may not_ do anything to the | 
|  | 1422 | * SKB, it is still owned by the network queueing | 
|  | 1423 | * layer when an error is returned.  This means you | 
|  | 1424 | * may not modify any SKB fields, you may not free | 
|  | 1425 | * the SKB, etc. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1426 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1427 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1428 | /* This is the most common case for modern hardware. | 
|  | 1429 | * The spinlock protects this code from the TX complete | 
|  | 1430 | * hardware interrupt handler.  Queue flow control is | 
|  | 1431 | * thus managed under this lock as well. | 
|  | 1432 | */ | 
|  | 1433 | spin_lock_irqsave(&lp->lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1434 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1435 | /* failsafe... (handle txdone now if half of FDs are used) */ | 
|  | 1436 | if ((lp->tfd_start + TX_FD_NUM - lp->tfd_end) % TX_FD_NUM > | 
|  | 1437 | TX_FD_NUM / 2) | 
|  | 1438 | tc35815_txdone(dev); | 
|  | 1439 |  | 
|  | 1440 | if (netif_msg_pktdata(lp)) | 
|  | 1441 | print_eth(skb->data); | 
|  | 1442 | #ifdef DEBUG | 
|  | 1443 | if (lp->tx_skbs[lp->tfd_start].skb) { | 
|  | 1444 | printk("%s: tx_skbs conflict.\n", dev->name); | 
|  | 1445 | panic_queues(dev); | 
|  | 1446 | } | 
|  | 1447 | #else | 
|  | 1448 | BUG_ON(lp->tx_skbs[lp->tfd_start].skb); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1449 | #endif | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1450 | lp->tx_skbs[lp->tfd_start].skb = skb; | 
|  | 1451 | lp->tx_skbs[lp->tfd_start].skb_dma = pci_map_single(lp->pci_dev, skb->data, skb->len, PCI_DMA_TODEVICE); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1452 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1453 | /*add to ring */ | 
|  | 1454 | txfd = &lp->tfd_base[lp->tfd_start]; | 
|  | 1455 | txfd->bd.BuffData = cpu_to_le32(lp->tx_skbs[lp->tfd_start].skb_dma); | 
|  | 1456 | txfd->bd.BDCtl = cpu_to_le32(skb->len); | 
|  | 1457 | txfd->fd.FDSystem = cpu_to_le32(lp->tfd_start); | 
|  | 1458 | txfd->fd.FDCtl = cpu_to_le32(FD_CownsFD | (1 << FD_BDCnt_SHIFT)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1459 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1460 | if (lp->tfd_start == lp->tfd_end) { | 
|  | 1461 | struct tc35815_regs __iomem *tr = | 
|  | 1462 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 1463 | /* Start DMA Transmitter. */ | 
|  | 1464 | txfd->fd.FDNext |= cpu_to_le32(FD_Next_EOL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1465 | #ifdef GATHER_TXINT | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1466 | txfd->fd.FDCtl |= cpu_to_le32(FD_FrmOpt_IntTx); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1467 | #endif | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1468 | if (netif_msg_tx_queued(lp)) { | 
|  | 1469 | printk("%s: starting TxFD.\n", dev->name); | 
|  | 1470 | dump_txfd(txfd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1471 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1472 | tc_writel(fd_virt_to_bus(lp, txfd), &tr->TxFrmPtr); | 
|  | 1473 | } else { | 
|  | 1474 | txfd->fd.FDNext &= cpu_to_le32(~FD_Next_EOL); | 
|  | 1475 | if (netif_msg_tx_queued(lp)) { | 
|  | 1476 | printk("%s: queueing TxFD.\n", dev->name); | 
|  | 1477 | dump_txfd(txfd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1478 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1479 | } | 
|  | 1480 | lp->tfd_start = (lp->tfd_start + 1) % TX_FD_NUM; | 
|  | 1481 |  | 
|  | 1482 | dev->trans_start = jiffies; | 
|  | 1483 |  | 
|  | 1484 | /* If we just used up the very last entry in the | 
|  | 1485 | * TX ring on this device, tell the queueing | 
|  | 1486 | * layer to send no more. | 
|  | 1487 | */ | 
|  | 1488 | if (tc35815_tx_full(dev)) { | 
|  | 1489 | if (netif_msg_tx_queued(lp)) | 
|  | 1490 | printk(KERN_WARNING "%s: TxFD Exhausted.\n", dev->name); | 
|  | 1491 | netif_stop_queue(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1492 | } | 
|  | 1493 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1494 | /* When the TX completion hw interrupt arrives, this | 
|  | 1495 | * is when the transmit statistics are updated. | 
|  | 1496 | */ | 
|  | 1497 |  | 
|  | 1498 | spin_unlock_irqrestore(&lp->lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1499 | return 0; | 
|  | 1500 | } | 
|  | 1501 |  | 
|  | 1502 | #define FATAL_ERROR_INT \ | 
|  | 1503 | (Int_IntPCI | Int_DmParErr | Int_IntNRAbt) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1504 | static void tc35815_fatal_error_interrupt(struct net_device *dev, u32 status) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1505 | { | 
|  | 1506 | static int count; | 
|  | 1507 | printk(KERN_WARNING "%s: Fatal Error Intterrupt (%#x):", | 
|  | 1508 | dev->name, status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1509 | if (status & Int_IntPCI) | 
|  | 1510 | printk(" IntPCI"); | 
|  | 1511 | if (status & Int_DmParErr) | 
|  | 1512 | printk(" DmParErr"); | 
|  | 1513 | if (status & Int_IntNRAbt) | 
|  | 1514 | printk(" IntNRAbt"); | 
|  | 1515 | printk("\n"); | 
|  | 1516 | if (count++ > 100) | 
|  | 1517 | panic("%s: Too many fatal errors.", dev->name); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1518 | printk(KERN_WARNING "%s: Resetting ...\n", dev->name); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1519 | /* Try to restart the adaptor. */ | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 1520 | tc35815_schedule_restart(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1521 | } | 
|  | 1522 |  | 
|  | 1523 | #ifdef TC35815_NAPI | 
|  | 1524 | static int tc35815_do_interrupt(struct net_device *dev, u32 status, int limit) | 
|  | 1525 | #else | 
|  | 1526 | static int tc35815_do_interrupt(struct net_device *dev, u32 status) | 
|  | 1527 | #endif | 
|  | 1528 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 1529 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1530 | struct tc35815_regs __iomem *tr = | 
|  | 1531 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 1532 | int ret = -1; | 
|  | 1533 |  | 
|  | 1534 | /* Fatal errors... */ | 
|  | 1535 | if (status & FATAL_ERROR_INT) { | 
|  | 1536 | tc35815_fatal_error_interrupt(dev, status); | 
|  | 1537 | return 0; | 
|  | 1538 | } | 
|  | 1539 | /* recoverable errors */ | 
|  | 1540 | if (status & Int_IntFDAEx) { | 
|  | 1541 | /* disable FDAEx int. (until we make rooms...) */ | 
|  | 1542 | tc_writel(tc_readl(&tr->Int_En) & ~Int_FDAExEn, &tr->Int_En); | 
|  | 1543 | printk(KERN_WARNING | 
|  | 1544 | "%s: Free Descriptor Area Exhausted (%#x).\n", | 
|  | 1545 | dev->name, status); | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1546 | dev->stats.rx_dropped++; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1547 | ret = 0; | 
|  | 1548 | } | 
|  | 1549 | if (status & Int_IntBLEx) { | 
|  | 1550 | /* disable BLEx int. (until we make rooms...) */ | 
|  | 1551 | tc_writel(tc_readl(&tr->Int_En) & ~Int_BLExEn, &tr->Int_En); | 
|  | 1552 | printk(KERN_WARNING | 
|  | 1553 | "%s: Buffer List Exhausted (%#x).\n", | 
|  | 1554 | dev->name, status); | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1555 | dev->stats.rx_dropped++; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1556 | ret = 0; | 
|  | 1557 | } | 
|  | 1558 | if (status & Int_IntExBD) { | 
|  | 1559 | printk(KERN_WARNING | 
|  | 1560 | "%s: Excessive Buffer Descriptiors (%#x).\n", | 
|  | 1561 | dev->name, status); | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1562 | dev->stats.rx_length_errors++; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1563 | ret = 0; | 
|  | 1564 | } | 
|  | 1565 |  | 
|  | 1566 | /* normal notification */ | 
|  | 1567 | if (status & Int_IntMacRx) { | 
|  | 1568 | /* Got a packet(s). */ | 
|  | 1569 | #ifdef TC35815_NAPI | 
|  | 1570 | ret = tc35815_rx(dev, limit); | 
|  | 1571 | #else | 
|  | 1572 | tc35815_rx(dev); | 
|  | 1573 | ret = 0; | 
|  | 1574 | #endif | 
|  | 1575 | lp->lstats.rx_ints++; | 
|  | 1576 | } | 
|  | 1577 | if (status & Int_IntMacTx) { | 
|  | 1578 | /* Transmit complete. */ | 
|  | 1579 | lp->lstats.tx_ints++; | 
|  | 1580 | tc35815_txdone(dev); | 
|  | 1581 | netif_wake_queue(dev); | 
|  | 1582 | ret = 0; | 
|  | 1583 | } | 
|  | 1584 | return ret; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1585 | } | 
|  | 1586 |  | 
|  | 1587 | /* | 
|  | 1588 | * The typical workload of the driver: | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1589 | * Handle the network interface interrupts. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1590 | */ | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 1591 | static irqreturn_t tc35815_interrupt(int irq, void *dev_id) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1592 | { | 
|  | 1593 | struct net_device *dev = dev_id; | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 1594 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1595 | struct tc35815_regs __iomem *tr = | 
|  | 1596 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 1597 | #ifdef TC35815_NAPI | 
|  | 1598 | u32 dmactl = tc_readl(&tr->DMA_Ctl); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1599 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1600 | if (!(dmactl & DMA_IntMask)) { | 
|  | 1601 | /* disable interrupts */ | 
|  | 1602 | tc_writel(dmactl | DMA_IntMask, &tr->DMA_Ctl); | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 1603 | if (netif_rx_schedule_prep(dev, &lp->napi)) | 
|  | 1604 | __netif_rx_schedule(dev, &lp->napi); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1605 | else { | 
|  | 1606 | printk(KERN_ERR "%s: interrupt taken in poll\n", | 
|  | 1607 | dev->name); | 
|  | 1608 | BUG(); | 
|  | 1609 | } | 
|  | 1610 | (void)tc_readl(&tr->Int_Src);	/* flush */ | 
|  | 1611 | return IRQ_HANDLED; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1612 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1613 | return IRQ_NONE; | 
|  | 1614 | #else | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1615 | int handled; | 
|  | 1616 | u32 status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1617 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1618 | spin_lock(&lp->lock); | 
|  | 1619 | status = tc_readl(&tr->Int_Src); | 
|  | 1620 | tc_writel(status, &tr->Int_Src);	/* write to clear */ | 
|  | 1621 | handled = tc35815_do_interrupt(dev, status); | 
|  | 1622 | (void)tc_readl(&tr->Int_Src);	/* flush */ | 
|  | 1623 | spin_unlock(&lp->lock); | 
|  | 1624 | return IRQ_RETVAL(handled >= 0); | 
|  | 1625 | #endif /* TC35815_NAPI */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1626 | } | 
|  | 1627 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1628 | #ifdef CONFIG_NET_POLL_CONTROLLER | 
|  | 1629 | static void tc35815_poll_controller(struct net_device *dev) | 
|  | 1630 | { | 
|  | 1631 | disable_irq(dev->irq); | 
|  | 1632 | tc35815_interrupt(dev->irq, dev); | 
|  | 1633 | enable_irq(dev->irq); | 
|  | 1634 | } | 
|  | 1635 | #endif | 
|  | 1636 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1637 | /* We have a good packet(s), get it/them out of the buffers. */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1638 | #ifdef TC35815_NAPI | 
|  | 1639 | static int | 
|  | 1640 | tc35815_rx(struct net_device *dev, int limit) | 
|  | 1641 | #else | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1642 | static void | 
|  | 1643 | tc35815_rx(struct net_device *dev) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1644 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1645 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 1646 | struct tc35815_local *lp = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1647 | unsigned int fdctl; | 
|  | 1648 | int i; | 
|  | 1649 | int buf_free_count = 0; | 
|  | 1650 | int fd_free_count = 0; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1651 | #ifdef TC35815_NAPI | 
|  | 1652 | int received = 0; | 
|  | 1653 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1654 |  | 
|  | 1655 | while (!((fdctl = le32_to_cpu(lp->rfd_cur->fd.FDCtl)) & FD_CownsFD)) { | 
|  | 1656 | int status = le32_to_cpu(lp->rfd_cur->fd.FDStat); | 
|  | 1657 | int pkt_len = fdctl & FD_FDLength_MASK; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1658 | int bd_count = (fdctl & FD_BDCnt_MASK) >> FD_BDCnt_SHIFT; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1659 | #ifdef DEBUG | 
|  | 1660 | struct RxFD *next_rfd; | 
|  | 1661 | #endif | 
|  | 1662 | #if (RX_CTL_CMD & Rx_StripCRC) == 0 | 
|  | 1663 | pkt_len -= 4; | 
|  | 1664 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1665 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1666 | if (netif_msg_rx_status(lp)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1667 | dump_rxfd(lp->rfd_cur); | 
|  | 1668 | if (status & Rx_Good) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1669 | struct sk_buff *skb; | 
|  | 1670 | unsigned char *data; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1671 | int cur_bd; | 
|  | 1672 | #ifdef TC35815_USE_PACKEDBUFFER | 
|  | 1673 | int offset; | 
|  | 1674 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1675 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1676 | #ifdef TC35815_NAPI | 
|  | 1677 | if (--limit < 0) | 
|  | 1678 | break; | 
|  | 1679 | #endif | 
|  | 1680 | #ifdef TC35815_USE_PACKEDBUFFER | 
|  | 1681 | BUG_ON(bd_count > 2); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1682 | skb = dev_alloc_skb(pkt_len + 2); /* +2: for reserve */ | 
|  | 1683 | if (skb == NULL) { | 
|  | 1684 | printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n", | 
|  | 1685 | dev->name); | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1686 | dev->stats.rx_dropped++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1687 | break; | 
|  | 1688 | } | 
|  | 1689 | skb_reserve(skb, 2);   /* 16 bit alignment */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1690 |  | 
|  | 1691 | data = skb_put(skb, pkt_len); | 
|  | 1692 |  | 
|  | 1693 | /* copy from receive buffer */ | 
|  | 1694 | cur_bd = 0; | 
|  | 1695 | offset = 0; | 
|  | 1696 | while (offset < pkt_len && cur_bd < bd_count) { | 
|  | 1697 | int len = le32_to_cpu(lp->rfd_cur->bd[cur_bd].BDCtl) & | 
|  | 1698 | BD_BuffLength_MASK; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1699 | dma_addr_t dma = le32_to_cpu(lp->rfd_cur->bd[cur_bd].BuffData); | 
|  | 1700 | void *rxbuf = rxbuf_bus_to_virt(lp, dma); | 
|  | 1701 | if (offset + len > pkt_len) | 
|  | 1702 | len = pkt_len - offset; | 
|  | 1703 | #ifdef TC35815_DMA_SYNC_ONDEMAND | 
|  | 1704 | pci_dma_sync_single_for_cpu(lp->pci_dev, | 
|  | 1705 | dma, len, | 
|  | 1706 | PCI_DMA_FROMDEVICE); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1707 | #endif | 
|  | 1708 | memcpy(data + offset, rxbuf, len); | 
| Atsushi Nemoto | 793bc0a | 2007-03-14 01:02:20 +0900 | [diff] [blame] | 1709 | #ifdef TC35815_DMA_SYNC_ONDEMAND | 
|  | 1710 | pci_dma_sync_single_for_device(lp->pci_dev, | 
|  | 1711 | dma, len, | 
|  | 1712 | PCI_DMA_FROMDEVICE); | 
|  | 1713 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1714 | offset += len; | 
|  | 1715 | cur_bd++; | 
|  | 1716 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1717 | #else /* TC35815_USE_PACKEDBUFFER */ | 
|  | 1718 | BUG_ON(bd_count > 1); | 
|  | 1719 | cur_bd = (le32_to_cpu(lp->rfd_cur->bd[0].BDCtl) | 
|  | 1720 | & BD_RxBDID_MASK) >> BD_RxBDID_SHIFT; | 
|  | 1721 | #ifdef DEBUG | 
|  | 1722 | if (cur_bd >= RX_BUF_NUM) { | 
|  | 1723 | printk("%s: invalid BDID.\n", dev->name); | 
|  | 1724 | panic_queues(dev); | 
|  | 1725 | } | 
|  | 1726 | BUG_ON(lp->rx_skbs[cur_bd].skb_dma != | 
|  | 1727 | (le32_to_cpu(lp->rfd_cur->bd[0].BuffData) & ~3)); | 
|  | 1728 | if (!lp->rx_skbs[cur_bd].skb) { | 
|  | 1729 | printk("%s: NULL skb.\n", dev->name); | 
|  | 1730 | panic_queues(dev); | 
|  | 1731 | } | 
|  | 1732 | #else | 
|  | 1733 | BUG_ON(cur_bd >= RX_BUF_NUM); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1734 | #endif | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1735 | skb = lp->rx_skbs[cur_bd].skb; | 
|  | 1736 | prefetch(skb->data); | 
|  | 1737 | lp->rx_skbs[cur_bd].skb = NULL; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1738 | pci_unmap_single(lp->pci_dev, | 
|  | 1739 | lp->rx_skbs[cur_bd].skb_dma, | 
|  | 1740 | RX_BUF_SIZE, PCI_DMA_FROMDEVICE); | 
|  | 1741 | if (!HAVE_DMA_RXALIGN(lp)) | 
|  | 1742 | memmove(skb->data, skb->data - 2, pkt_len); | 
|  | 1743 | data = skb_put(skb, pkt_len); | 
|  | 1744 | #endif /* TC35815_USE_PACKEDBUFFER */ | 
|  | 1745 | if (netif_msg_pktdata(lp)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1746 | print_eth(data); | 
|  | 1747 | skb->protocol = eth_type_trans(skb, dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1748 | #ifdef TC35815_NAPI | 
|  | 1749 | netif_receive_skb(skb); | 
|  | 1750 | received++; | 
|  | 1751 | #else | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1752 | netif_rx(skb); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1753 | #endif | 
|  | 1754 | dev->last_rx = jiffies; | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1755 | dev->stats.rx_packets++; | 
|  | 1756 | dev->stats.rx_bytes += pkt_len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1757 | } else { | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1758 | dev->stats.rx_errors++; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1759 | printk(KERN_DEBUG "%s: Rx error (status %x)\n", | 
|  | 1760 | dev->name, status & Rx_Stat_Mask); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1761 | /* WORKAROUND: LongErr and CRCErr means Overflow. */ | 
|  | 1762 | if ((status & Rx_LongErr) && (status & Rx_CRCErr)) { | 
|  | 1763 | status &= ~(Rx_LongErr|Rx_CRCErr); | 
|  | 1764 | status |= Rx_Over; | 
|  | 1765 | } | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1766 | if (status & Rx_LongErr) | 
|  | 1767 | dev->stats.rx_length_errors++; | 
|  | 1768 | if (status & Rx_Over) | 
|  | 1769 | dev->stats.rx_fifo_errors++; | 
|  | 1770 | if (status & Rx_CRCErr) | 
|  | 1771 | dev->stats.rx_crc_errors++; | 
|  | 1772 | if (status & Rx_Align) | 
|  | 1773 | dev->stats.rx_frame_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1774 | } | 
|  | 1775 |  | 
|  | 1776 | if (bd_count > 0) { | 
|  | 1777 | /* put Free Buffer back to controller */ | 
|  | 1778 | int bdctl = le32_to_cpu(lp->rfd_cur->bd[bd_count - 1].BDCtl); | 
|  | 1779 | unsigned char id = | 
|  | 1780 | (bdctl & BD_RxBDID_MASK) >> BD_RxBDID_SHIFT; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1781 | #ifdef DEBUG | 
|  | 1782 | if (id >= RX_BUF_NUM) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1783 | printk("%s: invalid BDID.\n", dev->name); | 
|  | 1784 | panic_queues(dev); | 
|  | 1785 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1786 | #else | 
|  | 1787 | BUG_ON(id >= RX_BUF_NUM); | 
|  | 1788 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1789 | /* free old buffers */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1790 | #ifdef TC35815_USE_PACKEDBUFFER | 
|  | 1791 | while (lp->fbl_curid != id) | 
|  | 1792 | #else | 
| Atsushi Nemoto | ccc57aa | 2008-06-26 17:14:15 +0900 | [diff] [blame] | 1793 | lp->fbl_count--; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1794 | while (lp->fbl_count < RX_BUF_NUM) | 
|  | 1795 | #endif | 
|  | 1796 | { | 
|  | 1797 | #ifdef TC35815_USE_PACKEDBUFFER | 
|  | 1798 | unsigned char curid = lp->fbl_curid; | 
|  | 1799 | #else | 
|  | 1800 | unsigned char curid = | 
|  | 1801 | (id + 1 + lp->fbl_count) % RX_BUF_NUM; | 
|  | 1802 | #endif | 
|  | 1803 | struct BDesc *bd = &lp->fbl_ptr->bd[curid]; | 
|  | 1804 | #ifdef DEBUG | 
|  | 1805 | bdctl = le32_to_cpu(bd->BDCtl); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1806 | if (bdctl & BD_CownsBD) { | 
|  | 1807 | printk("%s: Freeing invalid BD.\n", | 
|  | 1808 | dev->name); | 
|  | 1809 | panic_queues(dev); | 
|  | 1810 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1811 | #endif | 
| Robert P. J. Day | 3a4fa0a | 2007-10-19 23:10:43 +0200 | [diff] [blame] | 1812 | /* pass BD to controller */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1813 | #ifndef TC35815_USE_PACKEDBUFFER | 
|  | 1814 | if (!lp->rx_skbs[curid].skb) { | 
|  | 1815 | lp->rx_skbs[curid].skb = | 
|  | 1816 | alloc_rxbuf_skb(dev, | 
|  | 1817 | lp->pci_dev, | 
|  | 1818 | &lp->rx_skbs[curid].skb_dma); | 
|  | 1819 | if (!lp->rx_skbs[curid].skb) | 
|  | 1820 | break; /* try on next reception */ | 
|  | 1821 | bd->BuffData = cpu_to_le32(lp->rx_skbs[curid].skb_dma); | 
|  | 1822 | } | 
|  | 1823 | #endif /* TC35815_USE_PACKEDBUFFER */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1824 | /* Note: BDLength was modified by chip. */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1825 | bd->BDCtl = cpu_to_le32(BD_CownsBD | | 
|  | 1826 | (curid << BD_RxBDID_SHIFT) | | 
|  | 1827 | RX_BUF_SIZE); | 
|  | 1828 | #ifdef TC35815_USE_PACKEDBUFFER | 
|  | 1829 | lp->fbl_curid = (curid + 1) % RX_BUF_NUM; | 
|  | 1830 | if (netif_msg_rx_status(lp)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1831 | printk("%s: Entering new FBD %d\n", | 
|  | 1832 | dev->name, lp->fbl_curid); | 
|  | 1833 | dump_frfd(lp->fbl_ptr); | 
|  | 1834 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1835 | #else | 
|  | 1836 | lp->fbl_count++; | 
|  | 1837 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1838 | buf_free_count++; | 
|  | 1839 | } | 
|  | 1840 | } | 
|  | 1841 |  | 
|  | 1842 | /* put RxFD back to controller */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1843 | #ifdef DEBUG | 
|  | 1844 | next_rfd = fd_bus_to_virt(lp, | 
|  | 1845 | le32_to_cpu(lp->rfd_cur->fd.FDNext)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1846 | if (next_rfd < lp->rfd_base || next_rfd > lp->rfd_limit) { | 
|  | 1847 | printk("%s: RxFD FDNext invalid.\n", dev->name); | 
|  | 1848 | panic_queues(dev); | 
|  | 1849 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1850 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1851 | for (i = 0; i < (bd_count + 1) / 2 + 1; i++) { | 
| Robert P. J. Day | 3a4fa0a | 2007-10-19 23:10:43 +0200 | [diff] [blame] | 1852 | /* pass FD to controller */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1853 | #ifdef DEBUG | 
|  | 1854 | lp->rfd_cur->fd.FDNext = cpu_to_le32(0xdeaddead); | 
|  | 1855 | #else | 
|  | 1856 | lp->rfd_cur->fd.FDNext = cpu_to_le32(FD_Next_EOL); | 
|  | 1857 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1858 | lp->rfd_cur->fd.FDCtl = cpu_to_le32(FD_CownsFD); | 
|  | 1859 | lp->rfd_cur++; | 
|  | 1860 | fd_free_count++; | 
|  | 1861 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1862 | if (lp->rfd_cur > lp->rfd_limit) | 
|  | 1863 | lp->rfd_cur = lp->rfd_base; | 
|  | 1864 | #ifdef DEBUG | 
|  | 1865 | if (lp->rfd_cur != next_rfd) | 
|  | 1866 | printk("rfd_cur = %p, next_rfd %p\n", | 
|  | 1867 | lp->rfd_cur, next_rfd); | 
|  | 1868 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1869 | } | 
|  | 1870 |  | 
|  | 1871 | /* re-enable BL/FDA Exhaust interrupts. */ | 
|  | 1872 | if (fd_free_count) { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1873 | struct tc35815_regs __iomem *tr = | 
|  | 1874 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 1875 | u32 en, en_old = tc_readl(&tr->Int_En); | 
|  | 1876 | en = en_old | Int_FDAExEn; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1877 | if (buf_free_count) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1878 | en |= Int_BLExEn; | 
|  | 1879 | if (en != en_old) | 
|  | 1880 | tc_writel(en, &tr->Int_En); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1881 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1882 | #ifdef TC35815_NAPI | 
|  | 1883 | return received; | 
|  | 1884 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1885 | } | 
|  | 1886 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1887 | #ifdef TC35815_NAPI | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 1888 | static int tc35815_poll(struct napi_struct *napi, int budget) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1889 | { | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 1890 | struct tc35815_local *lp = container_of(napi, struct tc35815_local, napi); | 
|  | 1891 | struct net_device *dev = lp->dev; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1892 | struct tc35815_regs __iomem *tr = | 
|  | 1893 | (struct tc35815_regs __iomem *)dev->base_addr; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1894 | int received = 0, handled; | 
|  | 1895 | u32 status; | 
|  | 1896 |  | 
|  | 1897 | spin_lock(&lp->lock); | 
|  | 1898 | status = tc_readl(&tr->Int_Src); | 
|  | 1899 | do { | 
|  | 1900 | tc_writel(status, &tr->Int_Src);	/* write to clear */ | 
|  | 1901 |  | 
|  | 1902 | handled = tc35815_do_interrupt(dev, status, limit); | 
|  | 1903 | if (handled >= 0) { | 
|  | 1904 | received += handled; | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 1905 | if (received >= budget) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1906 | break; | 
|  | 1907 | } | 
|  | 1908 | status = tc_readl(&tr->Int_Src); | 
|  | 1909 | } while (status); | 
|  | 1910 | spin_unlock(&lp->lock); | 
|  | 1911 |  | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 1912 | if (received < budget) { | 
|  | 1913 | netif_rx_complete(dev, napi); | 
|  | 1914 | /* enable interrupts */ | 
|  | 1915 | tc_writel(tc_readl(&tr->DMA_Ctl) & ~DMA_IntMask, &tr->DMA_Ctl); | 
|  | 1916 | } | 
|  | 1917 | return received; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1918 | } | 
|  | 1919 | #endif | 
|  | 1920 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1921 | #ifdef NO_CHECK_CARRIER | 
|  | 1922 | #define TX_STA_ERR	(Tx_ExColl|Tx_Under|Tx_Defer|Tx_LateColl|Tx_TxPar|Tx_SQErr) | 
|  | 1923 | #else | 
|  | 1924 | #define TX_STA_ERR	(Tx_ExColl|Tx_Under|Tx_Defer|Tx_NCarr|Tx_LateColl|Tx_TxPar|Tx_SQErr) | 
|  | 1925 | #endif | 
|  | 1926 |  | 
|  | 1927 | static void | 
|  | 1928 | tc35815_check_tx_stat(struct net_device *dev, int status) | 
|  | 1929 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 1930 | struct tc35815_local *lp = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1931 | const char *msg = NULL; | 
|  | 1932 |  | 
|  | 1933 | /* count collisions */ | 
|  | 1934 | if (status & Tx_ExColl) | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1935 | dev->stats.collisions += 16; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1936 | if (status & Tx_TxColl_MASK) | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1937 | dev->stats.collisions += status & Tx_TxColl_MASK; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1938 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1939 | #ifndef NO_CHECK_CARRIER | 
|  | 1940 | /* TX4939 does not have NCarr */ | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 1941 | if (lp->chiptype == TC35815_TX4939) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1942 | status &= ~Tx_NCarr; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1943 | #ifdef WORKAROUND_LOSTCAR | 
|  | 1944 | /* WORKAROUND: ignore LostCrS in full duplex operation */ | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 1945 | if (!lp->link || lp->duplex == DUPLEX_FULL) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1946 | status &= ~Tx_NCarr; | 
|  | 1947 | #endif | 
|  | 1948 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1949 |  | 
|  | 1950 | if (!(status & TX_STA_ERR)) { | 
|  | 1951 | /* no error. */ | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1952 | dev->stats.tx_packets++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1953 | return; | 
|  | 1954 | } | 
|  | 1955 |  | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1956 | dev->stats.tx_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1957 | if (status & Tx_ExColl) { | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1958 | dev->stats.tx_aborted_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1959 | msg = "Excessive Collision."; | 
|  | 1960 | } | 
|  | 1961 | if (status & Tx_Under) { | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1962 | dev->stats.tx_fifo_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1963 | msg = "Tx FIFO Underrun."; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1964 | if (lp->lstats.tx_underrun < TX_THRESHOLD_KEEP_LIMIT) { | 
|  | 1965 | lp->lstats.tx_underrun++; | 
|  | 1966 | if (lp->lstats.tx_underrun >= TX_THRESHOLD_KEEP_LIMIT) { | 
|  | 1967 | struct tc35815_regs __iomem *tr = | 
|  | 1968 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 1969 | tc_writel(TX_THRESHOLD_MAX, &tr->TxThrsh); | 
|  | 1970 | msg = "Tx FIFO Underrun.Change Tx threshold to max."; | 
|  | 1971 | } | 
|  | 1972 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1973 | } | 
|  | 1974 | if (status & Tx_Defer) { | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1975 | dev->stats.tx_fifo_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1976 | msg = "Excessive Deferral."; | 
|  | 1977 | } | 
|  | 1978 | #ifndef NO_CHECK_CARRIER | 
|  | 1979 | if (status & Tx_NCarr) { | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1980 | dev->stats.tx_carrier_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1981 | msg = "Lost Carrier Sense."; | 
|  | 1982 | } | 
|  | 1983 | #endif | 
|  | 1984 | if (status & Tx_LateColl) { | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1985 | dev->stats.tx_aborted_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1986 | msg = "Late Collision."; | 
|  | 1987 | } | 
|  | 1988 | if (status & Tx_TxPar) { | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1989 | dev->stats.tx_fifo_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1990 | msg = "Transmit Parity Error."; | 
|  | 1991 | } | 
|  | 1992 | if (status & Tx_SQErr) { | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 1993 | dev->stats.tx_heartbeat_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1994 | msg = "Signal Quality Error."; | 
|  | 1995 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 1996 | if (msg && netif_msg_tx_err(lp)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1997 | printk(KERN_WARNING "%s: %s (%#x)\n", dev->name, msg, status); | 
|  | 1998 | } | 
|  | 1999 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2000 | /* This handles TX complete events posted by the device | 
|  | 2001 | * via interrupts. | 
|  | 2002 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2003 | static void | 
|  | 2004 | tc35815_txdone(struct net_device *dev) | 
|  | 2005 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2006 | struct tc35815_local *lp = netdev_priv(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2007 | struct TxFD *txfd; | 
|  | 2008 | unsigned int fdctl; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2009 |  | 
|  | 2010 | txfd = &lp->tfd_base[lp->tfd_end]; | 
|  | 2011 | while (lp->tfd_start != lp->tfd_end && | 
|  | 2012 | !((fdctl = le32_to_cpu(txfd->fd.FDCtl)) & FD_CownsFD)) { | 
|  | 2013 | int status = le32_to_cpu(txfd->fd.FDStat); | 
|  | 2014 | struct sk_buff *skb; | 
|  | 2015 | unsigned long fdnext = le32_to_cpu(txfd->fd.FDNext); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2016 | u32 fdsystem = le32_to_cpu(txfd->fd.FDSystem); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2017 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2018 | if (netif_msg_tx_done(lp)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2019 | printk("%s: complete TxFD.\n", dev->name); | 
|  | 2020 | dump_txfd(txfd); | 
|  | 2021 | } | 
|  | 2022 | tc35815_check_tx_stat(dev, status); | 
|  | 2023 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2024 | skb = fdsystem != 0xffffffff ? | 
|  | 2025 | lp->tx_skbs[fdsystem].skb : NULL; | 
|  | 2026 | #ifdef DEBUG | 
|  | 2027 | if (lp->tx_skbs[lp->tfd_end].skb != skb) { | 
|  | 2028 | printk("%s: tx_skbs mismatch.\n", dev->name); | 
|  | 2029 | panic_queues(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2030 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2031 | #else | 
|  | 2032 | BUG_ON(lp->tx_skbs[lp->tfd_end].skb != skb); | 
|  | 2033 | #endif | 
|  | 2034 | if (skb) { | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 2035 | dev->stats.tx_bytes += skb->len; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2036 | pci_unmap_single(lp->pci_dev, lp->tx_skbs[lp->tfd_end].skb_dma, skb->len, PCI_DMA_TODEVICE); | 
|  | 2037 | lp->tx_skbs[lp->tfd_end].skb = NULL; | 
|  | 2038 | lp->tx_skbs[lp->tfd_end].skb_dma = 0; | 
|  | 2039 | #ifdef TC35815_NAPI | 
|  | 2040 | dev_kfree_skb_any(skb); | 
|  | 2041 | #else | 
|  | 2042 | dev_kfree_skb_irq(skb); | 
|  | 2043 | #endif | 
|  | 2044 | } | 
|  | 2045 | txfd->fd.FDSystem = cpu_to_le32(0xffffffff); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2046 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2047 | lp->tfd_end = (lp->tfd_end + 1) % TX_FD_NUM; | 
|  | 2048 | txfd = &lp->tfd_base[lp->tfd_end]; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2049 | #ifdef DEBUG | 
|  | 2050 | if ((fdnext & ~FD_Next_EOL) != fd_virt_to_bus(lp, txfd)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2051 | printk("%s: TxFD FDNext invalid.\n", dev->name); | 
|  | 2052 | panic_queues(dev); | 
|  | 2053 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2054 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2055 | if (fdnext & FD_Next_EOL) { | 
|  | 2056 | /* DMA Transmitter has been stopping... */ | 
|  | 2057 | if (lp->tfd_end != lp->tfd_start) { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2058 | struct tc35815_regs __iomem *tr = | 
|  | 2059 | (struct tc35815_regs __iomem *)dev->base_addr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2060 | int head = (lp->tfd_start + TX_FD_NUM - 1) % TX_FD_NUM; | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 2061 | struct TxFD *txhead = &lp->tfd_base[head]; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2062 | int qlen = (lp->tfd_start + TX_FD_NUM | 
|  | 2063 | - lp->tfd_end) % TX_FD_NUM; | 
|  | 2064 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2065 | #ifdef DEBUG | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2066 | if (!(le32_to_cpu(txfd->fd.FDCtl) & FD_CownsFD)) { | 
|  | 2067 | printk("%s: TxFD FDCtl invalid.\n", dev->name); | 
|  | 2068 | panic_queues(dev); | 
|  | 2069 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2070 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2071 | /* log max queue length */ | 
|  | 2072 | if (lp->lstats.max_tx_qlen < qlen) | 
|  | 2073 | lp->lstats.max_tx_qlen = qlen; | 
|  | 2074 |  | 
|  | 2075 |  | 
|  | 2076 | /* start DMA Transmitter again */ | 
|  | 2077 | txhead->fd.FDNext |= cpu_to_le32(FD_Next_EOL); | 
|  | 2078 | #ifdef GATHER_TXINT | 
|  | 2079 | txhead->fd.FDCtl |= cpu_to_le32(FD_FrmOpt_IntTx); | 
|  | 2080 | #endif | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2081 | if (netif_msg_tx_queued(lp)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2082 | printk("%s: start TxFD on queue.\n", | 
|  | 2083 | dev->name); | 
|  | 2084 | dump_txfd(txfd); | 
|  | 2085 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2086 | tc_writel(fd_virt_to_bus(lp, txfd), &tr->TxFrmPtr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2087 | } | 
|  | 2088 | break; | 
|  | 2089 | } | 
|  | 2090 | } | 
|  | 2091 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2092 | /* If we had stopped the queue due to a "tx full" | 
|  | 2093 | * condition, and space has now been made available, | 
|  | 2094 | * wake up the queue. | 
|  | 2095 | */ | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 2096 | if (netif_queue_stopped(dev) && !tc35815_tx_full(dev)) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2097 | netif_wake_queue(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2098 | } | 
|  | 2099 |  | 
|  | 2100 | /* The inverse routine to tc35815_open(). */ | 
|  | 2101 | static int | 
|  | 2102 | tc35815_close(struct net_device *dev) | 
|  | 2103 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2104 | struct tc35815_local *lp = netdev_priv(dev); | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 2105 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2106 | netif_stop_queue(dev); | 
| Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 2107 | #ifdef TC35815_NAPI | 
|  | 2108 | napi_disable(&lp->napi); | 
|  | 2109 | #endif | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 2110 | if (lp->phy_dev) | 
|  | 2111 | phy_stop(lp->phy_dev); | 
|  | 2112 | cancel_work_sync(&lp->restart_work); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2113 |  | 
|  | 2114 | /* Flush the Tx and disable Rx here. */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2115 | tc35815_chip_reset(dev); | 
|  | 2116 | free_irq(dev->irq, dev); | 
|  | 2117 |  | 
|  | 2118 | tc35815_free_queues(dev); | 
|  | 2119 |  | 
|  | 2120 | return 0; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2121 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2122 | } | 
|  | 2123 |  | 
|  | 2124 | /* | 
|  | 2125 | * Get the current statistics. | 
|  | 2126 | * This may be called with the card open or closed. | 
|  | 2127 | */ | 
|  | 2128 | static struct net_device_stats *tc35815_get_stats(struct net_device *dev) | 
|  | 2129 | { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2130 | struct tc35815_regs __iomem *tr = | 
|  | 2131 | (struct tc35815_regs __iomem *)dev->base_addr; | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 2132 | if (netif_running(dev)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2133 | /* Update the statistics from the device registers. */ | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 2134 | dev->stats.rx_missed_errors = tc_readl(&tr->Miss_Cnt); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2135 |  | 
| Atsushi Nemoto | c201abd9 | 2008-04-11 00:24:12 +0900 | [diff] [blame] | 2136 | return &dev->stats; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2137 | } | 
|  | 2138 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2139 | static void tc35815_set_cam_entry(struct net_device *dev, int index, unsigned char *addr) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2140 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2141 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2142 | struct tc35815_regs __iomem *tr = | 
|  | 2143 | (struct tc35815_regs __iomem *)dev->base_addr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2144 | int cam_index = index * 6; | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2145 | u32 cam_data; | 
|  | 2146 | u32 saved_addr; | 
| Atsushi Nemoto | 958eb80 | 2008-04-11 00:24:24 +0900 | [diff] [blame] | 2147 | DECLARE_MAC_BUF(mac); | 
|  | 2148 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2149 | saved_addr = tc_readl(&tr->CAM_Adr); | 
|  | 2150 |  | 
| Atsushi Nemoto | 958eb80 | 2008-04-11 00:24:24 +0900 | [diff] [blame] | 2151 | if (netif_msg_hw(lp)) | 
|  | 2152 | printk(KERN_DEBUG "%s: CAM %d: %s\n", | 
|  | 2153 | dev->name, index, print_mac(mac, addr)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2154 | if (index & 1) { | 
|  | 2155 | /* read modify write */ | 
|  | 2156 | tc_writel(cam_index - 2, &tr->CAM_Adr); | 
|  | 2157 | cam_data = tc_readl(&tr->CAM_Data) & 0xffff0000; | 
|  | 2158 | cam_data |= addr[0] << 8 | addr[1]; | 
|  | 2159 | tc_writel(cam_data, &tr->CAM_Data); | 
|  | 2160 | /* write whole word */ | 
|  | 2161 | tc_writel(cam_index + 2, &tr->CAM_Adr); | 
|  | 2162 | cam_data = (addr[2] << 24) | (addr[3] << 16) | (addr[4] << 8) | addr[5]; | 
|  | 2163 | tc_writel(cam_data, &tr->CAM_Data); | 
|  | 2164 | } else { | 
|  | 2165 | /* write whole word */ | 
|  | 2166 | tc_writel(cam_index, &tr->CAM_Adr); | 
|  | 2167 | cam_data = (addr[0] << 24) | (addr[1] << 16) | (addr[2] << 8) | addr[3]; | 
|  | 2168 | tc_writel(cam_data, &tr->CAM_Data); | 
|  | 2169 | /* read modify write */ | 
|  | 2170 | tc_writel(cam_index + 4, &tr->CAM_Adr); | 
|  | 2171 | cam_data = tc_readl(&tr->CAM_Data) & 0x0000ffff; | 
|  | 2172 | cam_data |= addr[4] << 24 | (addr[5] << 16); | 
|  | 2173 | tc_writel(cam_data, &tr->CAM_Data); | 
|  | 2174 | } | 
|  | 2175 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2176 | tc_writel(saved_addr, &tr->CAM_Adr); | 
|  | 2177 | } | 
|  | 2178 |  | 
|  | 2179 |  | 
|  | 2180 | /* | 
|  | 2181 | * Set or clear the multicast filter for this adaptor. | 
|  | 2182 | * num_addrs == -1	Promiscuous mode, receive all packets | 
|  | 2183 | * num_addrs == 0	Normal mode, clear multicast list | 
|  | 2184 | * num_addrs > 0	Multicast mode, receive normal and MC packets, | 
|  | 2185 | *			and do best-effort filtering. | 
|  | 2186 | */ | 
|  | 2187 | static void | 
|  | 2188 | tc35815_set_multicast_list(struct net_device *dev) | 
|  | 2189 | { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2190 | struct tc35815_regs __iomem *tr = | 
|  | 2191 | (struct tc35815_regs __iomem *)dev->base_addr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2192 |  | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 2193 | if (dev->flags & IFF_PROMISC) { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2194 | #ifdef WORKAROUND_100HALF_PROMISC | 
|  | 2195 | /* With some (all?) 100MHalf HUB, controller will hang | 
|  | 2196 | * if we enabled promiscuous mode before linkup... */ | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2197 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 2198 |  | 
|  | 2199 | if (!lp->link) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2200 | return; | 
|  | 2201 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2202 | /* Enable promiscuous mode */ | 
|  | 2203 | tc_writel(CAM_CompEn | CAM_BroadAcc | CAM_GroupAcc | CAM_StationAcc, &tr->CAM_Ctl); | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 2204 | } else if ((dev->flags & IFF_ALLMULTI) || | 
|  | 2205 | dev->mc_count > CAM_ENTRY_MAX - 3) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2206 | /* CAM 0, 1, 20 are reserved. */ | 
|  | 2207 | /* Disable promiscuous mode, use normal mode. */ | 
|  | 2208 | tc_writel(CAM_CompEn | CAM_BroadAcc | CAM_GroupAcc, &tr->CAM_Ctl); | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 2209 | } else if (dev->mc_count) { | 
|  | 2210 | struct dev_mc_list *cur_addr = dev->mc_list; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2211 | int i; | 
|  | 2212 | int ena_bits = CAM_Ena_Bit(CAM_ENTRY_SOURCE); | 
|  | 2213 |  | 
|  | 2214 | tc_writel(0, &tr->CAM_Ctl); | 
|  | 2215 | /* Walk the address list, and load the filter */ | 
|  | 2216 | for (i = 0; i < dev->mc_count; i++, cur_addr = cur_addr->next) { | 
|  | 2217 | if (!cur_addr) | 
|  | 2218 | break; | 
|  | 2219 | /* entry 0,1 is reserved. */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2220 | tc35815_set_cam_entry(dev, i + 2, cur_addr->dmi_addr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2221 | ena_bits |= CAM_Ena_Bit(i + 2); | 
|  | 2222 | } | 
|  | 2223 | tc_writel(ena_bits, &tr->CAM_Ena); | 
|  | 2224 | tc_writel(CAM_CompEn | CAM_BroadAcc, &tr->CAM_Ctl); | 
| Atsushi Nemoto | 7f225b4 | 2008-04-11 00:25:31 +0900 | [diff] [blame] | 2225 | } else { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2226 | tc_writel(CAM_Ena_Bit(CAM_ENTRY_SOURCE), &tr->CAM_Ena); | 
|  | 2227 | tc_writel(CAM_CompEn | CAM_BroadAcc, &tr->CAM_Ctl); | 
|  | 2228 | } | 
|  | 2229 | } | 
|  | 2230 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2231 | static void tc35815_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2232 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2233 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2234 | strcpy(info->driver, MODNAME); | 
|  | 2235 | strcpy(info->version, DRV_VERSION); | 
|  | 2236 | strcpy(info->bus_info, pci_name(lp->pci_dev)); | 
|  | 2237 | } | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 2238 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2239 | static int tc35815_get_settings(struct net_device *dev, struct ethtool_cmd *cmd) | 
|  | 2240 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2241 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 2242 |  | 
|  | 2243 | if (!lp->phy_dev) | 
|  | 2244 | return -ENODEV; | 
|  | 2245 | return phy_ethtool_gset(lp->phy_dev, cmd); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2246 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2247 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2248 | static int tc35815_set_settings(struct net_device *dev, struct ethtool_cmd *cmd) | 
|  | 2249 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2250 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2251 |  | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 2252 | if (!lp->phy_dev) | 
|  | 2253 | return -ENODEV; | 
|  | 2254 | return phy_ethtool_sset(lp->phy_dev, cmd); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2255 | } | 
|  | 2256 |  | 
|  | 2257 | static u32 tc35815_get_msglevel(struct net_device *dev) | 
|  | 2258 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2259 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2260 | return lp->msg_enable; | 
|  | 2261 | } | 
|  | 2262 |  | 
|  | 2263 | static void tc35815_set_msglevel(struct net_device *dev, u32 datum) | 
|  | 2264 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2265 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2266 | lp->msg_enable = datum; | 
|  | 2267 | } | 
|  | 2268 |  | 
| Jeff Garzik | b9f2c04 | 2007-10-03 18:07:32 -0700 | [diff] [blame] | 2269 | static int tc35815_get_sset_count(struct net_device *dev, int sset) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2270 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2271 | struct tc35815_local *lp = netdev_priv(dev); | 
| Jeff Garzik | b9f2c04 | 2007-10-03 18:07:32 -0700 | [diff] [blame] | 2272 |  | 
|  | 2273 | switch (sset) { | 
|  | 2274 | case ETH_SS_STATS: | 
|  | 2275 | return sizeof(lp->lstats) / sizeof(int); | 
|  | 2276 | default: | 
|  | 2277 | return -EOPNOTSUPP; | 
|  | 2278 | } | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2279 | } | 
|  | 2280 |  | 
|  | 2281 | static void tc35815_get_ethtool_stats(struct net_device *dev, struct ethtool_stats *stats, u64 *data) | 
|  | 2282 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2283 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2284 | data[0] = lp->lstats.max_tx_qlen; | 
|  | 2285 | data[1] = lp->lstats.tx_ints; | 
|  | 2286 | data[2] = lp->lstats.rx_ints; | 
|  | 2287 | data[3] = lp->lstats.tx_underrun; | 
|  | 2288 | } | 
|  | 2289 |  | 
|  | 2290 | static struct { | 
|  | 2291 | const char str[ETH_GSTRING_LEN]; | 
|  | 2292 | } ethtool_stats_keys[] = { | 
|  | 2293 | { "max_tx_qlen" }, | 
|  | 2294 | { "tx_ints" }, | 
|  | 2295 | { "rx_ints" }, | 
|  | 2296 | { "tx_underrun" }, | 
|  | 2297 | }; | 
|  | 2298 |  | 
|  | 2299 | static void tc35815_get_strings(struct net_device *dev, u32 stringset, u8 *data) | 
|  | 2300 | { | 
|  | 2301 | memcpy(data, ethtool_stats_keys, sizeof(ethtool_stats_keys)); | 
|  | 2302 | } | 
|  | 2303 |  | 
|  | 2304 | static const struct ethtool_ops tc35815_ethtool_ops = { | 
|  | 2305 | .get_drvinfo		= tc35815_get_drvinfo, | 
|  | 2306 | .get_settings		= tc35815_get_settings, | 
|  | 2307 | .set_settings		= tc35815_set_settings, | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 2308 | .get_link		= ethtool_op_get_link, | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2309 | .get_msglevel		= tc35815_get_msglevel, | 
|  | 2310 | .set_msglevel		= tc35815_set_msglevel, | 
|  | 2311 | .get_strings		= tc35815_get_strings, | 
| Jeff Garzik | b9f2c04 | 2007-10-03 18:07:32 -0700 | [diff] [blame] | 2312 | .get_sset_count		= tc35815_get_sset_count, | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2313 | .get_ethtool_stats	= tc35815_get_ethtool_stats, | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2314 | }; | 
|  | 2315 |  | 
|  | 2316 | static int tc35815_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) | 
|  | 2317 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2318 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2319 |  | 
|  | 2320 | if (!netif_running(dev)) | 
|  | 2321 | return -EINVAL; | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 2322 | if (!lp->phy_dev) | 
|  | 2323 | return -ENODEV; | 
|  | 2324 | return phy_mii_ioctl(lp->phy_dev, if_mii(rq), cmd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2325 | } | 
|  | 2326 |  | 
|  | 2327 | static void tc35815_chip_reset(struct net_device *dev) | 
|  | 2328 | { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2329 | struct tc35815_regs __iomem *tr = | 
|  | 2330 | (struct tc35815_regs __iomem *)dev->base_addr; | 
|  | 2331 | int i; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2332 | /* reset the controller */ | 
|  | 2333 | tc_writel(MAC_Reset, &tr->MAC_Ctl); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2334 | udelay(4); /* 3200ns */ | 
|  | 2335 | i = 0; | 
|  | 2336 | while (tc_readl(&tr->MAC_Ctl) & MAC_Reset) { | 
|  | 2337 | if (i++ > 100) { | 
|  | 2338 | printk(KERN_ERR "%s: MAC reset failed.\n", dev->name); | 
|  | 2339 | break; | 
|  | 2340 | } | 
|  | 2341 | mdelay(1); | 
|  | 2342 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2343 | tc_writel(0, &tr->MAC_Ctl); | 
|  | 2344 |  | 
|  | 2345 | /* initialize registers to default value */ | 
|  | 2346 | tc_writel(0, &tr->DMA_Ctl); | 
|  | 2347 | tc_writel(0, &tr->TxThrsh); | 
|  | 2348 | tc_writel(0, &tr->TxPollCtr); | 
|  | 2349 | tc_writel(0, &tr->RxFragSize); | 
|  | 2350 | tc_writel(0, &tr->Int_En); | 
|  | 2351 | tc_writel(0, &tr->FDA_Bas); | 
|  | 2352 | tc_writel(0, &tr->FDA_Lim); | 
|  | 2353 | tc_writel(0xffffffff, &tr->Int_Src);	/* Write 1 to clear */ | 
|  | 2354 | tc_writel(0, &tr->CAM_Ctl); | 
|  | 2355 | tc_writel(0, &tr->Tx_Ctl); | 
|  | 2356 | tc_writel(0, &tr->Rx_Ctl); | 
|  | 2357 | tc_writel(0, &tr->CAM_Ena); | 
|  | 2358 | (void)tc_readl(&tr->Miss_Cnt);	/* Read to clear */ | 
|  | 2359 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2360 | /* initialize internal SRAM */ | 
|  | 2361 | tc_writel(DMA_TestMode, &tr->DMA_Ctl); | 
|  | 2362 | for (i = 0; i < 0x1000; i += 4) { | 
|  | 2363 | tc_writel(i, &tr->CAM_Adr); | 
|  | 2364 | tc_writel(0, &tr->CAM_Data); | 
|  | 2365 | } | 
|  | 2366 | tc_writel(0, &tr->DMA_Ctl); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2367 | } | 
|  | 2368 |  | 
|  | 2369 | static void tc35815_chip_init(struct net_device *dev) | 
|  | 2370 | { | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2371 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2372 | struct tc35815_regs __iomem *tr = | 
|  | 2373 | (struct tc35815_regs __iomem *)dev->base_addr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2374 | unsigned long txctl = TX_CTL_CMD; | 
|  | 2375 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2376 | /* load station address to CAM */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2377 | tc35815_set_cam_entry(dev, CAM_ENTRY_SOURCE, dev->dev_addr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2378 |  | 
|  | 2379 | /* Enable CAM (broadcast and unicast) */ | 
|  | 2380 | tc_writel(CAM_Ena_Bit(CAM_ENTRY_SOURCE), &tr->CAM_Ena); | 
|  | 2381 | tc_writel(CAM_CompEn | CAM_BroadAcc, &tr->CAM_Ctl); | 
|  | 2382 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2383 | /* Use DMA_RxAlign_2 to make IP header 4-byte aligned. */ | 
|  | 2384 | if (HAVE_DMA_RXALIGN(lp)) | 
|  | 2385 | tc_writel(DMA_BURST_SIZE | DMA_RxAlign_2, &tr->DMA_Ctl); | 
|  | 2386 | else | 
|  | 2387 | tc_writel(DMA_BURST_SIZE, &tr->DMA_Ctl); | 
|  | 2388 | #ifdef TC35815_USE_PACKEDBUFFER | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2389 | tc_writel(RxFrag_EnPack | ETH_ZLEN, &tr->RxFragSize);	/* Packing */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2390 | #else | 
|  | 2391 | tc_writel(ETH_ZLEN, &tr->RxFragSize); | 
|  | 2392 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2393 | tc_writel(0, &tr->TxPollCtr);	/* Batch mode */ | 
|  | 2394 | tc_writel(TX_THRESHOLD, &tr->TxThrsh); | 
|  | 2395 | tc_writel(INT_EN_CMD, &tr->Int_En); | 
|  | 2396 |  | 
|  | 2397 | /* set queues */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2398 | tc_writel(fd_virt_to_bus(lp, lp->rfd_base), &tr->FDA_Bas); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2399 | tc_writel((unsigned long)lp->rfd_limit - (unsigned long)lp->rfd_base, | 
|  | 2400 | &tr->FDA_Lim); | 
|  | 2401 | /* | 
|  | 2402 | * Activation method: | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2403 | * First, enable the MAC Transmitter and the DMA Receive circuits. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2404 | * Then enable the DMA Transmitter and the MAC Receive circuits. | 
|  | 2405 | */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2406 | tc_writel(fd_virt_to_bus(lp, lp->fbl_ptr), &tr->BLFrmPtr);	/* start DMA receiver */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2407 | tc_writel(RX_CTL_CMD, &tr->Rx_Ctl);	/* start MAC receiver */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2408 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2409 | /* start MAC transmitter */ | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2410 | #ifndef NO_CHECK_CARRIER | 
|  | 2411 | /* TX4939 does not have EnLCarr */ | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 2412 | if (lp->chiptype == TC35815_TX4939) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2413 | txctl &= ~Tx_EnLCarr; | 
|  | 2414 | #ifdef WORKAROUND_LOSTCAR | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2415 | /* WORKAROUND: ignore LostCrS in full duplex operation */ | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 2416 | if (!lp->phy_dev || !lp->link || lp->duplex == DUPLEX_FULL) | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2417 | txctl &= ~Tx_EnLCarr; | 
|  | 2418 | #endif | 
|  | 2419 | #endif /* !NO_CHECK_CARRIER */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2420 | #ifdef GATHER_TXINT | 
|  | 2421 | txctl &= ~Tx_EnComp;	/* disable global tx completion int. */ | 
|  | 2422 | #endif | 
|  | 2423 | tc_writel(txctl, &tr->Tx_Ctl); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2424 | } | 
|  | 2425 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2426 | #ifdef CONFIG_PM | 
|  | 2427 | static int tc35815_suspend(struct pci_dev *pdev, pm_message_t state) | 
|  | 2428 | { | 
|  | 2429 | struct net_device *dev = pci_get_drvdata(pdev); | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2430 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2431 | unsigned long flags; | 
|  | 2432 |  | 
|  | 2433 | pci_save_state(pdev); | 
|  | 2434 | if (!netif_running(dev)) | 
|  | 2435 | return 0; | 
|  | 2436 | netif_device_detach(dev); | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 2437 | if (lp->phy_dev) | 
|  | 2438 | phy_stop(lp->phy_dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2439 | spin_lock_irqsave(&lp->lock, flags); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2440 | tc35815_chip_reset(dev); | 
|  | 2441 | spin_unlock_irqrestore(&lp->lock, flags); | 
|  | 2442 | pci_set_power_state(pdev, PCI_D3hot); | 
|  | 2443 | return 0; | 
|  | 2444 | } | 
|  | 2445 |  | 
|  | 2446 | static int tc35815_resume(struct pci_dev *pdev) | 
|  | 2447 | { | 
|  | 2448 | struct net_device *dev = pci_get_drvdata(pdev); | 
| Atsushi Nemoto | ee79b7f | 2008-04-11 00:24:36 +0900 | [diff] [blame] | 2449 | struct tc35815_local *lp = netdev_priv(dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2450 |  | 
|  | 2451 | pci_restore_state(pdev); | 
|  | 2452 | if (!netif_running(dev)) | 
|  | 2453 | return 0; | 
|  | 2454 | pci_set_power_state(pdev, PCI_D0); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2455 | tc35815_restart(dev); | 
| Atsushi Nemoto | 59524a3 | 2008-06-25 11:41:01 +0900 | [diff] [blame] | 2456 | netif_carrier_off(dev); | 
| Atsushi Nemoto | c6686fe | 2008-04-12 00:47:46 +0900 | [diff] [blame] | 2457 | if (lp->phy_dev) | 
|  | 2458 | phy_start(lp->phy_dev); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2459 | netif_device_attach(dev); | 
|  | 2460 | return 0; | 
|  | 2461 | } | 
|  | 2462 | #endif /* CONFIG_PM */ | 
|  | 2463 |  | 
|  | 2464 | static struct pci_driver tc35815_pci_driver = { | 
|  | 2465 | .name		= MODNAME, | 
|  | 2466 | .id_table	= tc35815_pci_tbl, | 
|  | 2467 | .probe		= tc35815_init_one, | 
|  | 2468 | .remove		= __devexit_p(tc35815_remove_one), | 
|  | 2469 | #ifdef CONFIG_PM | 
|  | 2470 | .suspend	= tc35815_suspend, | 
|  | 2471 | .resume		= tc35815_resume, | 
|  | 2472 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2473 | }; | 
|  | 2474 |  | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2475 | module_param_named(speed, options.speed, int, 0); | 
|  | 2476 | MODULE_PARM_DESC(speed, "0:auto, 10:10Mbps, 100:100Mbps"); | 
|  | 2477 | module_param_named(duplex, options.duplex, int, 0); | 
|  | 2478 | MODULE_PARM_DESC(duplex, "0:auto, 1:half, 2:full"); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2479 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2480 | static int __init tc35815_init_module(void) | 
|  | 2481 | { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2482 | return pci_register_driver(&tc35815_pci_driver); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2483 | } | 
|  | 2484 |  | 
|  | 2485 | static void __exit tc35815_cleanup_module(void) | 
|  | 2486 | { | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2487 | pci_unregister_driver(&tc35815_pci_driver); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2488 | } | 
| Jeff Garzik | 420e852 | 2007-02-24 17:02:16 -0500 | [diff] [blame] | 2489 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2490 | module_init(tc35815_init_module); | 
|  | 2491 | module_exit(tc35815_cleanup_module); | 
| Atsushi Nemoto | eea221c | 2007-03-03 23:54:59 +0900 | [diff] [blame] | 2492 |  | 
|  | 2493 | MODULE_DESCRIPTION("TOSHIBA TC35815 PCI 10M/100M Ethernet driver"); | 
|  | 2494 | MODULE_LICENSE("GPL"); |