| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* yellowfin.c: A Packet Engines G-NIC ethernet driver for linux. */ | 
 | 2 | /* | 
 | 3 | 	Written 1997-2001 by Donald Becker. | 
 | 4 |  | 
 | 5 | 	This software may be used and distributed according to the terms of | 
 | 6 | 	the GNU General Public License (GPL), incorporated herein by reference. | 
 | 7 | 	Drivers based on or derived from this code fall under the GPL and must | 
 | 8 | 	retain the authorship, copyright and license notice.  This file is not | 
 | 9 | 	a complete program and may only be used when the entire operating | 
 | 10 | 	system is licensed under the GPL. | 
 | 11 |  | 
 | 12 | 	This driver is for the Packet Engines G-NIC PCI Gigabit Ethernet adapter. | 
 | 13 | 	It also supports the Symbios Logic version of the same chip core. | 
 | 14 |  | 
 | 15 | 	The author may be reached as becker@scyld.com, or C/O | 
 | 16 | 	Scyld Computing Corporation | 
 | 17 | 	410 Severn Ave., Suite 210 | 
 | 18 | 	Annapolis MD 21403 | 
 | 19 |  | 
 | 20 | 	Support and updates available at | 
 | 21 | 	http://www.scyld.com/network/yellowfin.html | 
| Jeff Garzik | 03a8c66 | 2006-06-27 07:57:22 -0400 | [diff] [blame] | 22 | 	[link no longer provides useful info -jgarzik] | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | */ | 
 | 25 |  | 
 | 26 | #define DRV_NAME	"yellowfin" | 
| Andy Gospodarek | d5b2069 | 2006-09-11 17:39:18 -0400 | [diff] [blame] | 27 | #define DRV_VERSION	"2.1" | 
 | 28 | #define DRV_RELDATE	"Sep 11, 2006" | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 |  | 
 | 30 | #define PFX DRV_NAME ": " | 
 | 31 |  | 
 | 32 | /* The user-configurable values. | 
 | 33 |    These may be modified when a driver module is loaded.*/ | 
 | 34 |  | 
 | 35 | static int debug = 1;			/* 1 normal messages, 0 quiet .. 7 verbose. */ | 
 | 36 | /* Maximum events (Rx packets, etc.) to handle at each interrupt. */ | 
 | 37 | static int max_interrupt_work = 20; | 
 | 38 | static int mtu; | 
 | 39 | #ifdef YF_PROTOTYPE			/* Support for prototype hardware errata. */ | 
 | 40 | /* System-wide count of bogus-rx frames. */ | 
 | 41 | static int bogus_rx; | 
 | 42 | static int dma_ctrl = 0x004A0263; 			/* Constrained by errata */ | 
 | 43 | static int fifo_cfg = 0x0020;				/* Bypass external Tx FIFO. */ | 
 | 44 | #elif defined(YF_NEW)					/* A future perfect board :->.  */ | 
 | 45 | static int dma_ctrl = 0x00CAC277;			/* Override when loading module! */ | 
 | 46 | static int fifo_cfg = 0x0028; | 
 | 47 | #else | 
| Arjan van de Ven | f71e130 | 2006-03-03 21:33:57 -0500 | [diff] [blame] | 48 | static const int dma_ctrl = 0x004A0263; 			/* Constrained by errata */ | 
 | 49 | static const int fifo_cfg = 0x0020;				/* Bypass external Tx FIFO. */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 50 | #endif | 
 | 51 |  | 
 | 52 | /* Set the copy breakpoint for the copy-only-tiny-frames scheme. | 
 | 53 |    Setting to > 1514 effectively disables this feature. */ | 
 | 54 | static int rx_copybreak; | 
 | 55 |  | 
 | 56 | /* Used to pass the media type, etc. | 
 | 57 |    No media types are currently defined.  These exist for driver | 
 | 58 |    interoperability. | 
 | 59 | */ | 
 | 60 | #define MAX_UNITS 8				/* More are supported, limit only on options */ | 
 | 61 | static int options[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1}; | 
 | 62 | static int full_duplex[MAX_UNITS] = {-1, -1, -1, -1, -1, -1, -1, -1}; | 
 | 63 |  | 
 | 64 | /* Do ugly workaround for GX server chipset errata. */ | 
 | 65 | static int gx_fix; | 
 | 66 |  | 
 | 67 | /* Operational parameters that are set at compile time. */ | 
 | 68 |  | 
 | 69 | /* Keep the ring sizes a power of two for efficiency. | 
 | 70 |    Making the Tx ring too long decreases the effectiveness of channel | 
 | 71 |    bonding and packet priority. | 
 | 72 |    There are no ill effects from too-large receive rings. */ | 
 | 73 | #define TX_RING_SIZE	16 | 
 | 74 | #define TX_QUEUE_SIZE	12		/* Must be > 4 && <= TX_RING_SIZE */ | 
 | 75 | #define RX_RING_SIZE	64 | 
 | 76 | #define STATUS_TOTAL_SIZE	TX_RING_SIZE*sizeof(struct tx_status_words) | 
 | 77 | #define TX_TOTAL_SIZE		2*TX_RING_SIZE*sizeof(struct yellowfin_desc) | 
 | 78 | #define RX_TOTAL_SIZE		RX_RING_SIZE*sizeof(struct yellowfin_desc) | 
 | 79 |  | 
 | 80 | /* Operational parameters that usually are not changed. */ | 
 | 81 | /* Time in jiffies before concluding the transmitter is hung. */ | 
 | 82 | #define TX_TIMEOUT  (2*HZ) | 
 | 83 | #define PKT_BUF_SZ		1536			/* Size of each temporary Rx buffer.*/ | 
 | 84 |  | 
 | 85 | #define yellowfin_debug debug | 
 | 86 |  | 
 | 87 | #include <linux/module.h> | 
 | 88 | #include <linux/kernel.h> | 
 | 89 | #include <linux/string.h> | 
 | 90 | #include <linux/timer.h> | 
 | 91 | #include <linux/errno.h> | 
 | 92 | #include <linux/ioport.h> | 
 | 93 | #include <linux/slab.h> | 
 | 94 | #include <linux/interrupt.h> | 
 | 95 | #include <linux/pci.h> | 
 | 96 | #include <linux/init.h> | 
 | 97 | #include <linux/mii.h> | 
 | 98 | #include <linux/netdevice.h> | 
 | 99 | #include <linux/etherdevice.h> | 
 | 100 | #include <linux/skbuff.h> | 
 | 101 | #include <linux/ethtool.h> | 
 | 102 | #include <linux/crc32.h> | 
 | 103 | #include <linux/bitops.h> | 
 | 104 | #include <asm/uaccess.h> | 
 | 105 | #include <asm/processor.h>		/* Processor type for cache alignment. */ | 
 | 106 | #include <asm/unaligned.h> | 
 | 107 | #include <asm/io.h> | 
 | 108 |  | 
 | 109 | /* These identify the driver base version and may not be removed. */ | 
 | 110 | static char version[] __devinitdata = | 
 | 111 | KERN_INFO DRV_NAME ".c:v1.05  1/09/2001  Written by Donald Becker <becker@scyld.com>\n" | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 | KERN_INFO "  (unofficial 2.4.x port, " DRV_VERSION ", " DRV_RELDATE ")\n"; | 
 | 113 |  | 
 | 114 | MODULE_AUTHOR("Donald Becker <becker@scyld.com>"); | 
 | 115 | MODULE_DESCRIPTION("Packet Engines Yellowfin G-NIC Gigabit Ethernet driver"); | 
 | 116 | MODULE_LICENSE("GPL"); | 
 | 117 |  | 
 | 118 | module_param(max_interrupt_work, int, 0); | 
 | 119 | module_param(mtu, int, 0); | 
 | 120 | module_param(debug, int, 0); | 
 | 121 | module_param(rx_copybreak, int, 0); | 
 | 122 | module_param_array(options, int, NULL, 0); | 
 | 123 | module_param_array(full_duplex, int, NULL, 0); | 
 | 124 | module_param(gx_fix, int, 0); | 
 | 125 | MODULE_PARM_DESC(max_interrupt_work, "G-NIC maximum events handled per interrupt"); | 
 | 126 | MODULE_PARM_DESC(mtu, "G-NIC MTU (all boards)"); | 
 | 127 | MODULE_PARM_DESC(debug, "G-NIC debug level (0-7)"); | 
 | 128 | MODULE_PARM_DESC(rx_copybreak, "G-NIC copy breakpoint for copy-only-tiny-frames"); | 
 | 129 | MODULE_PARM_DESC(options, "G-NIC: Bits 0-3: media type, bit 17: full duplex"); | 
 | 130 | MODULE_PARM_DESC(full_duplex, "G-NIC full duplex setting(s) (1)"); | 
 | 131 | MODULE_PARM_DESC(gx_fix, "G-NIC: enable GX server chipset bug workaround (0-1)"); | 
 | 132 |  | 
 | 133 | /* | 
 | 134 | 				Theory of Operation | 
 | 135 |  | 
 | 136 | I. Board Compatibility | 
 | 137 |  | 
 | 138 | This device driver is designed for the Packet Engines "Yellowfin" Gigabit | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 139 | Ethernet adapter.  The G-NIC 64-bit PCI card is supported, as well as the | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 140 | Symbios 53C885E dual function chip. | 
 | 141 |  | 
 | 142 | II. Board-specific settings | 
 | 143 |  | 
 | 144 | PCI bus devices are configured by the system at boot time, so no jumpers | 
 | 145 | need to be set on the board.  The system BIOS preferably should assign the | 
 | 146 | PCI INTA signal to an otherwise unused system IRQ line. | 
 | 147 | Note: Kernel versions earlier than 1.3.73 do not support shared PCI | 
 | 148 | interrupt lines. | 
 | 149 |  | 
 | 150 | III. Driver operation | 
 | 151 |  | 
 | 152 | IIIa. Ring buffers | 
 | 153 |  | 
 | 154 | The Yellowfin uses the Descriptor Based DMA Architecture specified by Apple. | 
 | 155 | This is a descriptor list scheme similar to that used by the EEPro100 and | 
 | 156 | Tulip.  This driver uses two statically allocated fixed-size descriptor lists | 
 | 157 | formed into rings by a branch from the final descriptor to the beginning of | 
 | 158 | the list.  The ring sizes are set at compile time by RX/TX_RING_SIZE. | 
 | 159 |  | 
 | 160 | The driver allocates full frame size skbuffs for the Rx ring buffers at | 
 | 161 | open() time and passes the skb->data field to the Yellowfin as receive data | 
 | 162 | buffers.  When an incoming frame is less than RX_COPYBREAK bytes long, | 
 | 163 | a fresh skbuff is allocated and the frame is copied to the new skbuff. | 
 | 164 | When the incoming frame is larger, the skbuff is passed directly up the | 
 | 165 | protocol stack and replaced by a newly allocated skbuff. | 
 | 166 |  | 
 | 167 | The RX_COPYBREAK value is chosen to trade-off the memory wasted by | 
 | 168 | using a full-sized skbuff for small frames vs. the copying costs of larger | 
 | 169 | frames.  For small frames the copying cost is negligible (esp. considering | 
 | 170 | that we are pre-loading the cache with immediately useful header | 
 | 171 | information).  For large frames the copying cost is non-trivial, and the | 
 | 172 | larger copy might flush the cache of useful data. | 
 | 173 |  | 
 | 174 | IIIC. Synchronization | 
 | 175 |  | 
 | 176 | The driver runs as two independent, single-threaded flows of control.  One | 
 | 177 | is the send-packet routine, which enforces single-threaded use by the | 
 | 178 | dev->tbusy flag.  The other thread is the interrupt handler, which is single | 
 | 179 | threaded by the hardware and other software. | 
 | 180 |  | 
 | 181 | The send packet thread has partial control over the Tx ring and 'dev->tbusy' | 
 | 182 | flag.  It sets the tbusy flag whenever it's queuing a Tx packet. If the next | 
 | 183 | queue slot is empty, it clears the tbusy flag when finished otherwise it sets | 
 | 184 | the 'yp->tx_full' flag. | 
 | 185 |  | 
 | 186 | The interrupt handler has exclusive control over the Rx ring and records stats | 
 | 187 | from the Tx ring.  After reaping the stats, it marks the Tx queue entry as | 
 | 188 | empty by incrementing the dirty_tx mark. Iff the 'yp->tx_full' flag is set, it | 
 | 189 | clears both the tx_full and tbusy flags. | 
 | 190 |  | 
 | 191 | IV. Notes | 
 | 192 |  | 
 | 193 | Thanks to Kim Stearns of Packet Engines for providing a pair of G-NIC boards. | 
 | 194 | Thanks to Bruce Faust of Digitalscape for providing both their SYM53C885 board | 
 | 195 | and an AlphaStation to verifty the Alpha port! | 
 | 196 |  | 
 | 197 | IVb. References | 
 | 198 |  | 
 | 199 | Yellowfin Engineering Design Specification, 4/23/97 Preliminary/Confidential | 
 | 200 | Symbios SYM53C885 PCI-SCSI/Fast Ethernet Multifunction Controller Preliminary | 
 | 201 |    Data Manual v3.0 | 
 | 202 | http://cesdis.gsfc.nasa.gov/linux/misc/NWay.html | 
 | 203 | http://cesdis.gsfc.nasa.gov/linux/misc/100mbps.html | 
 | 204 |  | 
 | 205 | IVc. Errata | 
 | 206 |  | 
 | 207 | See Packet Engines confidential appendix (prototype chips only). | 
 | 208 | */ | 
 | 209 |  | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 210 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 211 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 212 | enum capability_flags { | 
 | 213 | 	HasMII=1, FullTxStatus=2, IsGigabit=4, HasMulticastBug=8, FullRxStatus=16, | 
 | 214 | 	HasMACAddrBug=32, /* Only on early revs.  */ | 
 | 215 | 	DontUseEeprom=64, /* Don't read the MAC from the EEPROm. */ | 
 | 216 | }; | 
| Jeff Garzik | c3d8e68 | 2006-06-27 08:54:34 -0400 | [diff] [blame] | 217 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 218 | /* The PCI I/O space extent. */ | 
| Jeff Garzik | c3d8e68 | 2006-06-27 08:54:34 -0400 | [diff] [blame] | 219 | enum { | 
 | 220 | 	YELLOWFIN_SIZE	= 0x100, | 
 | 221 | }; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 222 |  | 
 | 223 | struct pci_id_info { | 
 | 224 |         const char *name; | 
 | 225 |         struct match_info { | 
 | 226 |                 int     pci, pci_mask, subsystem, subsystem_mask; | 
 | 227 |                 int revision, revision_mask;                            /* Only 8 bits. */ | 
 | 228 |         } id; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 229 |         int drv_flags;                          /* Driver use, intended as capability flags. */ | 
 | 230 | }; | 
 | 231 |  | 
| Arjan van de Ven | f71e130 | 2006-03-03 21:33:57 -0500 | [diff] [blame] | 232 | static const struct pci_id_info pci_id_tbl[] = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 233 | 	{"Yellowfin G-NIC Gigabit Ethernet", { 0x07021000, 0xffffffff}, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 234 | 	 FullTxStatus | IsGigabit | HasMulticastBug | HasMACAddrBug | DontUseEeprom}, | 
 | 235 | 	{"Symbios SYM83C885", { 0x07011000, 0xffffffff}, | 
| Jeff Garzik | c3d8e68 | 2006-06-27 08:54:34 -0400 | [diff] [blame] | 236 | 	  HasMII | DontUseEeprom }, | 
| Jeff Garzik | 1f1bd5f | 2006-06-26 23:47:50 -0400 | [diff] [blame] | 237 | 	{ } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 238 | }; | 
 | 239 |  | 
| Jeff Garzik | 1f1bd5f | 2006-06-26 23:47:50 -0400 | [diff] [blame] | 240 | static const struct pci_device_id yellowfin_pci_tbl[] = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 241 | 	{ 0x1000, 0x0702, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 }, | 
 | 242 | 	{ 0x1000, 0x0701, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1 }, | 
| Jeff Garzik | 1f1bd5f | 2006-06-26 23:47:50 -0400 | [diff] [blame] | 243 | 	{ } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 244 | }; | 
 | 245 | MODULE_DEVICE_TABLE (pci, yellowfin_pci_tbl); | 
 | 246 |  | 
 | 247 |  | 
 | 248 | /* Offsets to the Yellowfin registers.  Various sizes and alignments. */ | 
 | 249 | enum yellowfin_offsets { | 
 | 250 | 	TxCtrl=0x00, TxStatus=0x04, TxPtr=0x0C, | 
 | 251 | 	TxIntrSel=0x10, TxBranchSel=0x14, TxWaitSel=0x18, | 
 | 252 | 	RxCtrl=0x40, RxStatus=0x44, RxPtr=0x4C, | 
 | 253 | 	RxIntrSel=0x50, RxBranchSel=0x54, RxWaitSel=0x58, | 
 | 254 | 	EventStatus=0x80, IntrEnb=0x82, IntrClear=0x84, IntrStatus=0x86, | 
 | 255 | 	ChipRev=0x8C, DMACtrl=0x90, TxThreshold=0x94, | 
 | 256 | 	Cnfg=0xA0, FrameGap0=0xA2, FrameGap1=0xA4, | 
 | 257 | 	MII_Cmd=0xA6, MII_Addr=0xA8, MII_Wr_Data=0xAA, MII_Rd_Data=0xAC, | 
 | 258 | 	MII_Status=0xAE, | 
 | 259 | 	RxDepth=0xB8, FlowCtrl=0xBC, | 
 | 260 | 	AddrMode=0xD0, StnAddr=0xD2, HashTbl=0xD8, FIFOcfg=0xF8, | 
 | 261 | 	EEStatus=0xF0, EECtrl=0xF1, EEAddr=0xF2, EERead=0xF3, EEWrite=0xF4, | 
 | 262 | 	EEFeature=0xF5, | 
 | 263 | }; | 
 | 264 |  | 
 | 265 | /* The Yellowfin Rx and Tx buffer descriptors. | 
 | 266 |    Elements are written as 32 bit for endian portability. */ | 
 | 267 | struct yellowfin_desc { | 
| Al Viro | e5a3142 | 2007-12-22 17:53:02 +0000 | [diff] [blame] | 268 | 	__le32 dbdma_cmd; | 
 | 269 | 	__le32 addr; | 
 | 270 | 	__le32 branch_addr; | 
 | 271 | 	__le32 result_status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 272 | }; | 
 | 273 |  | 
 | 274 | struct tx_status_words { | 
 | 275 | #ifdef __BIG_ENDIAN | 
 | 276 | 	u16 tx_errs; | 
 | 277 | 	u16 tx_cnt; | 
 | 278 | 	u16 paused; | 
 | 279 | 	u16 total_tx_cnt; | 
 | 280 | #else  /* Little endian chips. */ | 
 | 281 | 	u16 tx_cnt; | 
 | 282 | 	u16 tx_errs; | 
 | 283 | 	u16 total_tx_cnt; | 
 | 284 | 	u16 paused; | 
 | 285 | #endif /* __BIG_ENDIAN */ | 
 | 286 | }; | 
 | 287 |  | 
 | 288 | /* Bits in yellowfin_desc.cmd */ | 
 | 289 | enum desc_cmd_bits { | 
 | 290 | 	CMD_TX_PKT=0x10000000, CMD_RX_BUF=0x20000000, CMD_TXSTATUS=0x30000000, | 
 | 291 | 	CMD_NOP=0x60000000, CMD_STOP=0x70000000, | 
 | 292 | 	BRANCH_ALWAYS=0x0C0000, INTR_ALWAYS=0x300000, WAIT_ALWAYS=0x030000, | 
 | 293 | 	BRANCH_IFTRUE=0x040000, | 
 | 294 | }; | 
 | 295 |  | 
 | 296 | /* Bits in yellowfin_desc.status */ | 
 | 297 | enum desc_status_bits { RX_EOP=0x0040, }; | 
 | 298 |  | 
 | 299 | /* Bits in the interrupt status/mask registers. */ | 
 | 300 | enum intr_status_bits { | 
 | 301 | 	IntrRxDone=0x01, IntrRxInvalid=0x02, IntrRxPCIFault=0x04,IntrRxPCIErr=0x08, | 
 | 302 | 	IntrTxDone=0x10, IntrTxInvalid=0x20, IntrTxPCIFault=0x40,IntrTxPCIErr=0x80, | 
 | 303 | 	IntrEarlyRx=0x100, IntrWakeup=0x200, }; | 
 | 304 |  | 
 | 305 | #define PRIV_ALIGN	31 	/* Required alignment mask */ | 
 | 306 | #define MII_CNT		4 | 
 | 307 | struct yellowfin_private { | 
 | 308 | 	/* Descriptor rings first for alignment. | 
 | 309 | 	   Tx requires a second descriptor for status. */ | 
 | 310 | 	struct yellowfin_desc *rx_ring; | 
 | 311 | 	struct yellowfin_desc *tx_ring; | 
 | 312 | 	struct sk_buff* rx_skbuff[RX_RING_SIZE]; | 
 | 313 | 	struct sk_buff* tx_skbuff[TX_RING_SIZE]; | 
 | 314 | 	dma_addr_t rx_ring_dma; | 
 | 315 | 	dma_addr_t tx_ring_dma; | 
 | 316 |  | 
 | 317 | 	struct tx_status_words *tx_status; | 
 | 318 | 	dma_addr_t tx_status_dma; | 
 | 319 |  | 
 | 320 | 	struct timer_list timer;	/* Media selection timer. */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 321 | 	/* Frequently used and paired value: keep adjacent for cache effect. */ | 
 | 322 | 	int chip_id, drv_flags; | 
 | 323 | 	struct pci_dev *pci_dev; | 
 | 324 | 	unsigned int cur_rx, dirty_rx;		/* Producer/consumer ring indices */ | 
 | 325 | 	unsigned int rx_buf_sz;				/* Based on MTU+slack. */ | 
 | 326 | 	struct tx_status_words *tx_tail_desc; | 
 | 327 | 	unsigned int cur_tx, dirty_tx; | 
 | 328 | 	int tx_threshold; | 
 | 329 | 	unsigned int tx_full:1;				/* The Tx queue is full. */ | 
 | 330 | 	unsigned int full_duplex:1;			/* Full-duplex operation requested. */ | 
 | 331 | 	unsigned int duplex_lock:1; | 
 | 332 | 	unsigned int medialock:1;			/* Do not sense media. */ | 
 | 333 | 	unsigned int default_port:4;		/* Last dev->if_port value. */ | 
 | 334 | 	/* MII transceiver section. */ | 
 | 335 | 	int mii_cnt;						/* MII device addresses. */ | 
 | 336 | 	u16 advertising;					/* NWay media advertisement */ | 
 | 337 | 	unsigned char phys[MII_CNT];		/* MII device addresses, only first one used */ | 
 | 338 | 	spinlock_t lock; | 
 | 339 | 	void __iomem *base; | 
 | 340 | }; | 
 | 341 |  | 
 | 342 | static int read_eeprom(void __iomem *ioaddr, int location); | 
 | 343 | static int mdio_read(void __iomem *ioaddr, int phy_id, int location); | 
 | 344 | static void mdio_write(void __iomem *ioaddr, int phy_id, int location, int value); | 
 | 345 | static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); | 
 | 346 | static int yellowfin_open(struct net_device *dev); | 
 | 347 | static void yellowfin_timer(unsigned long data); | 
 | 348 | static void yellowfin_tx_timeout(struct net_device *dev); | 
 | 349 | static void yellowfin_init_ring(struct net_device *dev); | 
 | 350 | static int yellowfin_start_xmit(struct sk_buff *skb, struct net_device *dev); | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 351 | static irqreturn_t yellowfin_interrupt(int irq, void *dev_instance); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 352 | static int yellowfin_rx(struct net_device *dev); | 
 | 353 | static void yellowfin_error(struct net_device *dev, int intr_status); | 
 | 354 | static int yellowfin_close(struct net_device *dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 355 | static void set_rx_mode(struct net_device *dev); | 
| Jeff Garzik | 7282d49 | 2006-09-13 14:30:00 -0400 | [diff] [blame] | 356 | static const struct ethtool_ops ethtool_ops; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 357 |  | 
 | 358 |  | 
 | 359 | static int __devinit yellowfin_init_one(struct pci_dev *pdev, | 
 | 360 | 					const struct pci_device_id *ent) | 
 | 361 | { | 
 | 362 | 	struct net_device *dev; | 
 | 363 | 	struct yellowfin_private *np; | 
 | 364 | 	int irq; | 
 | 365 | 	int chip_idx = ent->driver_data; | 
 | 366 | 	static int find_cnt; | 
 | 367 | 	void __iomem *ioaddr; | 
 | 368 | 	int i, option = find_cnt < MAX_UNITS ? options[find_cnt] : 0; | 
 | 369 | 	int drv_flags = pci_id_tbl[chip_idx].drv_flags; | 
 | 370 |         void *ring_space; | 
 | 371 |         dma_addr_t ring_dma; | 
 | 372 | #ifdef USE_IO_OPS | 
 | 373 | 	int bar = 0; | 
 | 374 | #else | 
 | 375 | 	int bar = 1; | 
 | 376 | #endif | 
| Joe Perches | 0795af5 | 2007-10-03 17:59:30 -0700 | [diff] [blame] | 377 | 	DECLARE_MAC_BUF(mac); | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 378 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 379 | /* when built into the kernel, we only print version if device is found */ | 
 | 380 | #ifndef MODULE | 
 | 381 | 	static int printed_version; | 
 | 382 | 	if (!printed_version++) | 
 | 383 | 		printk(version); | 
 | 384 | #endif | 
 | 385 |  | 
 | 386 | 	i = pci_enable_device(pdev); | 
 | 387 | 	if (i) return i; | 
 | 388 |  | 
 | 389 | 	dev = alloc_etherdev(sizeof(*np)); | 
 | 390 | 	if (!dev) { | 
 | 391 | 		printk (KERN_ERR PFX "cannot allocate ethernet device\n"); | 
 | 392 | 		return -ENOMEM; | 
 | 393 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 394 | 	SET_NETDEV_DEV(dev, &pdev->dev); | 
 | 395 |  | 
 | 396 | 	np = netdev_priv(dev); | 
 | 397 |  | 
 | 398 | 	if (pci_request_regions(pdev, DRV_NAME)) | 
 | 399 | 		goto err_out_free_netdev; | 
 | 400 |  | 
 | 401 | 	pci_set_master (pdev); | 
 | 402 |  | 
 | 403 | 	ioaddr = pci_iomap(pdev, bar, YELLOWFIN_SIZE); | 
 | 404 | 	if (!ioaddr) | 
 | 405 | 		goto err_out_free_res; | 
 | 406 |  | 
 | 407 | 	irq = pdev->irq; | 
 | 408 |  | 
 | 409 | 	if (drv_flags & DontUseEeprom) | 
 | 410 | 		for (i = 0; i < 6; i++) | 
 | 411 | 			dev->dev_addr[i] = ioread8(ioaddr + StnAddr + i); | 
 | 412 | 	else { | 
 | 413 | 		int ee_offset = (read_eeprom(ioaddr, 6) == 0xff ? 0x100 : 0); | 
 | 414 | 		for (i = 0; i < 6; i++) | 
 | 415 | 			dev->dev_addr[i] = read_eeprom(ioaddr, ee_offset + i); | 
 | 416 | 	} | 
 | 417 |  | 
 | 418 | 	/* Reset the chip. */ | 
 | 419 | 	iowrite32(0x80000000, ioaddr + DMACtrl); | 
 | 420 |  | 
 | 421 | 	dev->base_addr = (unsigned long)ioaddr; | 
 | 422 | 	dev->irq = irq; | 
 | 423 |  | 
 | 424 | 	pci_set_drvdata(pdev, dev); | 
 | 425 | 	spin_lock_init(&np->lock); | 
 | 426 |  | 
 | 427 | 	np->pci_dev = pdev; | 
 | 428 | 	np->chip_id = chip_idx; | 
 | 429 | 	np->drv_flags = drv_flags; | 
 | 430 | 	np->base = ioaddr; | 
 | 431 |  | 
 | 432 | 	ring_space = pci_alloc_consistent(pdev, TX_TOTAL_SIZE, &ring_dma); | 
 | 433 | 	if (!ring_space) | 
 | 434 | 		goto err_out_cleardev; | 
 | 435 | 	np->tx_ring = (struct yellowfin_desc *)ring_space; | 
 | 436 | 	np->tx_ring_dma = ring_dma; | 
 | 437 |  | 
 | 438 | 	ring_space = pci_alloc_consistent(pdev, RX_TOTAL_SIZE, &ring_dma); | 
 | 439 | 	if (!ring_space) | 
 | 440 | 		goto err_out_unmap_tx; | 
 | 441 | 	np->rx_ring = (struct yellowfin_desc *)ring_space; | 
 | 442 | 	np->rx_ring_dma = ring_dma; | 
 | 443 |  | 
 | 444 | 	ring_space = pci_alloc_consistent(pdev, STATUS_TOTAL_SIZE, &ring_dma); | 
 | 445 | 	if (!ring_space) | 
 | 446 | 		goto err_out_unmap_rx; | 
 | 447 | 	np->tx_status = (struct tx_status_words *)ring_space; | 
 | 448 | 	np->tx_status_dma = ring_dma; | 
 | 449 |  | 
 | 450 | 	if (dev->mem_start) | 
 | 451 | 		option = dev->mem_start; | 
 | 452 |  | 
 | 453 | 	/* The lower four bits are the media type. */ | 
 | 454 | 	if (option > 0) { | 
 | 455 | 		if (option & 0x200) | 
 | 456 | 			np->full_duplex = 1; | 
 | 457 | 		np->default_port = option & 15; | 
 | 458 | 		if (np->default_port) | 
 | 459 | 			np->medialock = 1; | 
 | 460 | 	} | 
 | 461 | 	if (find_cnt < MAX_UNITS  &&  full_duplex[find_cnt] > 0) | 
 | 462 | 		np->full_duplex = 1; | 
 | 463 |  | 
 | 464 | 	if (np->full_duplex) | 
 | 465 | 		np->duplex_lock = 1; | 
 | 466 |  | 
 | 467 | 	/* The Yellowfin-specific entries in the device structure. */ | 
 | 468 | 	dev->open = &yellowfin_open; | 
 | 469 | 	dev->hard_start_xmit = &yellowfin_start_xmit; | 
 | 470 | 	dev->stop = &yellowfin_close; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 471 | 	dev->set_multicast_list = &set_rx_mode; | 
 | 472 | 	dev->do_ioctl = &netdev_ioctl; | 
 | 473 | 	SET_ETHTOOL_OPS(dev, ðtool_ops); | 
 | 474 | 	dev->tx_timeout = yellowfin_tx_timeout; | 
 | 475 | 	dev->watchdog_timeo = TX_TIMEOUT; | 
 | 476 |  | 
 | 477 | 	if (mtu) | 
 | 478 | 		dev->mtu = mtu; | 
 | 479 |  | 
 | 480 | 	i = register_netdev(dev); | 
 | 481 | 	if (i) | 
 | 482 | 		goto err_out_unmap_status; | 
 | 483 |  | 
| Joe Perches | 0795af5 | 2007-10-03 17:59:30 -0700 | [diff] [blame] | 484 | 	printk(KERN_INFO "%s: %s type %8x at %p, %s, IRQ %d.\n", | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 485 | 		   dev->name, pci_id_tbl[chip_idx].name, | 
| Joe Perches | 0795af5 | 2007-10-03 17:59:30 -0700 | [diff] [blame] | 486 | 		   ioread32(ioaddr + ChipRev), ioaddr, | 
 | 487 | 		   print_mac(mac, dev->dev_addr), irq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 488 |  | 
 | 489 | 	if (np->drv_flags & HasMII) { | 
 | 490 | 		int phy, phy_idx = 0; | 
 | 491 | 		for (phy = 0; phy < 32 && phy_idx < MII_CNT; phy++) { | 
 | 492 | 			int mii_status = mdio_read(ioaddr, phy, 1); | 
 | 493 | 			if (mii_status != 0xffff  &&  mii_status != 0x0000) { | 
 | 494 | 				np->phys[phy_idx++] = phy; | 
 | 495 | 				np->advertising = mdio_read(ioaddr, phy, 4); | 
 | 496 | 				printk(KERN_INFO "%s: MII PHY found at address %d, status " | 
 | 497 | 					   "0x%4.4x advertising %4.4x.\n", | 
 | 498 | 					   dev->name, phy, mii_status, np->advertising); | 
 | 499 | 			} | 
 | 500 | 		} | 
 | 501 | 		np->mii_cnt = phy_idx; | 
 | 502 | 	} | 
 | 503 |  | 
 | 504 | 	find_cnt++; | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 505 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 506 | 	return 0; | 
 | 507 |  | 
 | 508 | err_out_unmap_status: | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 509 |         pci_free_consistent(pdev, STATUS_TOTAL_SIZE, np->tx_status, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 510 | 		np->tx_status_dma); | 
 | 511 | err_out_unmap_rx: | 
 | 512 |         pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, np->rx_ring_dma); | 
 | 513 | err_out_unmap_tx: | 
 | 514 |         pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, np->tx_ring_dma); | 
 | 515 | err_out_cleardev: | 
 | 516 | 	pci_set_drvdata(pdev, NULL); | 
 | 517 | 	pci_iounmap(pdev, ioaddr); | 
 | 518 | err_out_free_res: | 
 | 519 | 	pci_release_regions(pdev); | 
 | 520 | err_out_free_netdev: | 
 | 521 | 	free_netdev (dev); | 
 | 522 | 	return -ENODEV; | 
 | 523 | } | 
 | 524 |  | 
 | 525 | static int __devinit read_eeprom(void __iomem *ioaddr, int location) | 
 | 526 | { | 
 | 527 | 	int bogus_cnt = 10000;		/* Typical 33Mhz: 1050 ticks */ | 
 | 528 |  | 
 | 529 | 	iowrite8(location, ioaddr + EEAddr); | 
 | 530 | 	iowrite8(0x30 | ((location >> 8) & 7), ioaddr + EECtrl); | 
 | 531 | 	while ((ioread8(ioaddr + EEStatus) & 0x80)  &&  --bogus_cnt > 0) | 
 | 532 | 		; | 
 | 533 | 	return ioread8(ioaddr + EERead); | 
 | 534 | } | 
 | 535 |  | 
 | 536 | /* MII Managemen Data I/O accesses. | 
 | 537 |    These routines assume the MDIO controller is idle, and do not exit until | 
 | 538 |    the command is finished. */ | 
 | 539 |  | 
 | 540 | static int mdio_read(void __iomem *ioaddr, int phy_id, int location) | 
 | 541 | { | 
 | 542 | 	int i; | 
 | 543 |  | 
 | 544 | 	iowrite16((phy_id<<8) + location, ioaddr + MII_Addr); | 
 | 545 | 	iowrite16(1, ioaddr + MII_Cmd); | 
 | 546 | 	for (i = 10000; i >= 0; i--) | 
 | 547 | 		if ((ioread16(ioaddr + MII_Status) & 1) == 0) | 
 | 548 | 			break; | 
 | 549 | 	return ioread16(ioaddr + MII_Rd_Data); | 
 | 550 | } | 
 | 551 |  | 
 | 552 | static void mdio_write(void __iomem *ioaddr, int phy_id, int location, int value) | 
 | 553 | { | 
 | 554 | 	int i; | 
 | 555 |  | 
 | 556 | 	iowrite16((phy_id<<8) + location, ioaddr + MII_Addr); | 
 | 557 | 	iowrite16(value, ioaddr + MII_Wr_Data); | 
 | 558 |  | 
 | 559 | 	/* Wait for the command to finish. */ | 
 | 560 | 	for (i = 10000; i >= 0; i--) | 
 | 561 | 		if ((ioread16(ioaddr + MII_Status) & 1) == 0) | 
 | 562 | 			break; | 
 | 563 | 	return; | 
 | 564 | } | 
 | 565 |  | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 566 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 567 | static int yellowfin_open(struct net_device *dev) | 
 | 568 | { | 
 | 569 | 	struct yellowfin_private *yp = netdev_priv(dev); | 
 | 570 | 	void __iomem *ioaddr = yp->base; | 
 | 571 | 	int i; | 
 | 572 |  | 
 | 573 | 	/* Reset the chip. */ | 
 | 574 | 	iowrite32(0x80000000, ioaddr + DMACtrl); | 
 | 575 |  | 
| Thomas Gleixner | 1fb9df5 | 2006-07-01 19:29:39 -0700 | [diff] [blame] | 576 | 	i = request_irq(dev->irq, &yellowfin_interrupt, IRQF_SHARED, dev->name, dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 577 | 	if (i) return i; | 
 | 578 |  | 
 | 579 | 	if (yellowfin_debug > 1) | 
 | 580 | 		printk(KERN_DEBUG "%s: yellowfin_open() irq %d.\n", | 
 | 581 | 			   dev->name, dev->irq); | 
 | 582 |  | 
 | 583 | 	yellowfin_init_ring(dev); | 
 | 584 |  | 
 | 585 | 	iowrite32(yp->rx_ring_dma, ioaddr + RxPtr); | 
 | 586 | 	iowrite32(yp->tx_ring_dma, ioaddr + TxPtr); | 
 | 587 |  | 
 | 588 | 	for (i = 0; i < 6; i++) | 
 | 589 | 		iowrite8(dev->dev_addr[i], ioaddr + StnAddr + i); | 
 | 590 |  | 
 | 591 | 	/* Set up various condition 'select' registers. | 
 | 592 | 	   There are no options here. */ | 
 | 593 | 	iowrite32(0x00800080, ioaddr + TxIntrSel); 	/* Interrupt on Tx abort */ | 
 | 594 | 	iowrite32(0x00800080, ioaddr + TxBranchSel);	/* Branch on Tx abort */ | 
 | 595 | 	iowrite32(0x00400040, ioaddr + TxWaitSel); 	/* Wait on Tx status */ | 
 | 596 | 	iowrite32(0x00400040, ioaddr + RxIntrSel);	/* Interrupt on Rx done */ | 
 | 597 | 	iowrite32(0x00400040, ioaddr + RxBranchSel);	/* Branch on Rx error */ | 
 | 598 | 	iowrite32(0x00400040, ioaddr + RxWaitSel);	/* Wait on Rx done */ | 
 | 599 |  | 
 | 600 | 	/* Initialize other registers: with so many this eventually this will | 
 | 601 | 	   converted to an offset/value list. */ | 
 | 602 | 	iowrite32(dma_ctrl, ioaddr + DMACtrl); | 
 | 603 | 	iowrite16(fifo_cfg, ioaddr + FIFOcfg); | 
 | 604 | 	/* Enable automatic generation of flow control frames, period 0xffff. */ | 
 | 605 | 	iowrite32(0x0030FFFF, ioaddr + FlowCtrl); | 
 | 606 |  | 
 | 607 | 	yp->tx_threshold = 32; | 
 | 608 | 	iowrite32(yp->tx_threshold, ioaddr + TxThreshold); | 
 | 609 |  | 
 | 610 | 	if (dev->if_port == 0) | 
 | 611 | 		dev->if_port = yp->default_port; | 
 | 612 |  | 
 | 613 | 	netif_start_queue(dev); | 
 | 614 |  | 
 | 615 | 	/* Setting the Rx mode will start the Rx process. */ | 
 | 616 | 	if (yp->drv_flags & IsGigabit) { | 
 | 617 | 		/* We are always in full-duplex mode with gigabit! */ | 
 | 618 | 		yp->full_duplex = 1; | 
 | 619 | 		iowrite16(0x01CF, ioaddr + Cnfg); | 
 | 620 | 	} else { | 
 | 621 | 		iowrite16(0x0018, ioaddr + FrameGap0); /* 0060/4060 for non-MII 10baseT */ | 
 | 622 | 		iowrite16(0x1018, ioaddr + FrameGap1); | 
 | 623 | 		iowrite16(0x101C | (yp->full_duplex ? 2 : 0), ioaddr + Cnfg); | 
 | 624 | 	} | 
 | 625 | 	set_rx_mode(dev); | 
 | 626 |  | 
 | 627 | 	/* Enable interrupts by setting the interrupt mask. */ | 
 | 628 | 	iowrite16(0x81ff, ioaddr + IntrEnb);			/* See enum intr_status_bits */ | 
 | 629 | 	iowrite16(0x0000, ioaddr + EventStatus);		/* Clear non-interrupting events */ | 
 | 630 | 	iowrite32(0x80008000, ioaddr + RxCtrl);		/* Start Rx and Tx channels. */ | 
 | 631 | 	iowrite32(0x80008000, ioaddr + TxCtrl); | 
 | 632 |  | 
 | 633 | 	if (yellowfin_debug > 2) { | 
 | 634 | 		printk(KERN_DEBUG "%s: Done yellowfin_open().\n", | 
 | 635 | 			   dev->name); | 
 | 636 | 	} | 
 | 637 |  | 
 | 638 | 	/* Set the timer to check for link beat. */ | 
 | 639 | 	init_timer(&yp->timer); | 
 | 640 | 	yp->timer.expires = jiffies + 3*HZ; | 
 | 641 | 	yp->timer.data = (unsigned long)dev; | 
 | 642 | 	yp->timer.function = &yellowfin_timer;				/* timer handler */ | 
 | 643 | 	add_timer(&yp->timer); | 
 | 644 |  | 
 | 645 | 	return 0; | 
 | 646 | } | 
 | 647 |  | 
 | 648 | static void yellowfin_timer(unsigned long data) | 
 | 649 | { | 
 | 650 | 	struct net_device *dev = (struct net_device *)data; | 
 | 651 | 	struct yellowfin_private *yp = netdev_priv(dev); | 
 | 652 | 	void __iomem *ioaddr = yp->base; | 
 | 653 | 	int next_tick = 60*HZ; | 
 | 654 |  | 
 | 655 | 	if (yellowfin_debug > 3) { | 
 | 656 | 		printk(KERN_DEBUG "%s: Yellowfin timer tick, status %8.8x.\n", | 
 | 657 | 			   dev->name, ioread16(ioaddr + IntrStatus)); | 
 | 658 | 	} | 
 | 659 |  | 
 | 660 | 	if (yp->mii_cnt) { | 
 | 661 | 		int bmsr = mdio_read(ioaddr, yp->phys[0], MII_BMSR); | 
 | 662 | 		int lpa = mdio_read(ioaddr, yp->phys[0], MII_LPA); | 
 | 663 | 		int negotiated = lpa & yp->advertising; | 
 | 664 | 		if (yellowfin_debug > 1) | 
 | 665 | 			printk(KERN_DEBUG "%s: MII #%d status register is %4.4x, " | 
 | 666 | 				   "link partner capability %4.4x.\n", | 
 | 667 | 				   dev->name, yp->phys[0], bmsr, lpa); | 
 | 668 |  | 
 | 669 | 		yp->full_duplex = mii_duplex(yp->duplex_lock, negotiated); | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 670 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 671 | 		iowrite16(0x101C | (yp->full_duplex ? 2 : 0), ioaddr + Cnfg); | 
 | 672 |  | 
 | 673 | 		if (bmsr & BMSR_LSTATUS) | 
 | 674 | 			next_tick = 60*HZ; | 
 | 675 | 		else | 
 | 676 | 			next_tick = 3*HZ; | 
 | 677 | 	} | 
 | 678 |  | 
 | 679 | 	yp->timer.expires = jiffies + next_tick; | 
 | 680 | 	add_timer(&yp->timer); | 
 | 681 | } | 
 | 682 |  | 
 | 683 | static void yellowfin_tx_timeout(struct net_device *dev) | 
 | 684 | { | 
 | 685 | 	struct yellowfin_private *yp = netdev_priv(dev); | 
 | 686 | 	void __iomem *ioaddr = yp->base; | 
 | 687 |  | 
 | 688 | 	printk(KERN_WARNING "%s: Yellowfin transmit timed out at %d/%d Tx " | 
 | 689 | 		   "status %4.4x, Rx status %4.4x, resetting...\n", | 
 | 690 | 		   dev->name, yp->cur_tx, yp->dirty_tx, | 
 | 691 | 		   ioread32(ioaddr + TxStatus), ioread32(ioaddr + RxStatus)); | 
 | 692 |  | 
 | 693 | 	/* Note: these should be KERN_DEBUG. */ | 
 | 694 | 	if (yellowfin_debug) { | 
 | 695 | 		int i; | 
 | 696 | 		printk(KERN_WARNING "  Rx ring %p: ", yp->rx_ring); | 
 | 697 | 		for (i = 0; i < RX_RING_SIZE; i++) | 
 | 698 | 			printk(" %8.8x", yp->rx_ring[i].result_status); | 
 | 699 | 		printk("\n"KERN_WARNING"  Tx ring %p: ", yp->tx_ring); | 
 | 700 | 		for (i = 0; i < TX_RING_SIZE; i++) | 
 | 701 | 			printk(" %4.4x /%8.8x", yp->tx_status[i].tx_errs, | 
 | 702 | 				   yp->tx_ring[i].result_status); | 
 | 703 | 		printk("\n"); | 
 | 704 | 	} | 
 | 705 |  | 
 | 706 | 	/* If the hardware is found to hang regularly, we will update the code | 
 | 707 | 	   to reinitialize the chip here. */ | 
 | 708 | 	dev->if_port = 0; | 
 | 709 |  | 
 | 710 | 	/* Wake the potentially-idle transmit channel. */ | 
 | 711 | 	iowrite32(0x10001000, yp->base + TxCtrl); | 
 | 712 | 	if (yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE) | 
 | 713 | 		netif_wake_queue (dev);		/* Typical path */ | 
 | 714 |  | 
 | 715 | 	dev->trans_start = jiffies; | 
| Jeff Garzik | 09f75cd | 2007-10-03 17:41:50 -0700 | [diff] [blame] | 716 | 	dev->stats.tx_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 717 | } | 
 | 718 |  | 
 | 719 | /* Initialize the Rx and Tx rings, along with various 'dev' bits. */ | 
 | 720 | static void yellowfin_init_ring(struct net_device *dev) | 
 | 721 | { | 
 | 722 | 	struct yellowfin_private *yp = netdev_priv(dev); | 
 | 723 | 	int i; | 
 | 724 |  | 
 | 725 | 	yp->tx_full = 0; | 
 | 726 | 	yp->cur_rx = yp->cur_tx = 0; | 
 | 727 | 	yp->dirty_tx = 0; | 
 | 728 |  | 
 | 729 | 	yp->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32); | 
 | 730 |  | 
 | 731 | 	for (i = 0; i < RX_RING_SIZE; i++) { | 
 | 732 | 		yp->rx_ring[i].dbdma_cmd = | 
 | 733 | 			cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | yp->rx_buf_sz); | 
 | 734 | 		yp->rx_ring[i].branch_addr = cpu_to_le32(yp->rx_ring_dma + | 
 | 735 | 			((i+1)%RX_RING_SIZE)*sizeof(struct yellowfin_desc)); | 
 | 736 | 	} | 
 | 737 |  | 
 | 738 | 	for (i = 0; i < RX_RING_SIZE; i++) { | 
 | 739 | 		struct sk_buff *skb = dev_alloc_skb(yp->rx_buf_sz); | 
 | 740 | 		yp->rx_skbuff[i] = skb; | 
 | 741 | 		if (skb == NULL) | 
 | 742 | 			break; | 
 | 743 | 		skb->dev = dev;		/* Mark as being used by this device. */ | 
 | 744 | 		skb_reserve(skb, 2);	/* 16 byte align the IP header. */ | 
 | 745 | 		yp->rx_ring[i].addr = cpu_to_le32(pci_map_single(yp->pci_dev, | 
| David S. Miller | 689be43 | 2005-06-28 15:25:31 -0700 | [diff] [blame] | 746 | 			skb->data, yp->rx_buf_sz, PCI_DMA_FROMDEVICE)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 747 | 	} | 
 | 748 | 	yp->rx_ring[i-1].dbdma_cmd = cpu_to_le32(CMD_STOP); | 
 | 749 | 	yp->dirty_rx = (unsigned int)(i - RX_RING_SIZE); | 
 | 750 |  | 
 | 751 | #define NO_TXSTATS | 
 | 752 | #ifdef NO_TXSTATS | 
 | 753 | 	/* In this mode the Tx ring needs only a single descriptor. */ | 
 | 754 | 	for (i = 0; i < TX_RING_SIZE; i++) { | 
 | 755 | 		yp->tx_skbuff[i] = NULL; | 
 | 756 | 		yp->tx_ring[i].dbdma_cmd = cpu_to_le32(CMD_STOP); | 
 | 757 | 		yp->tx_ring[i].branch_addr = cpu_to_le32(yp->tx_ring_dma + | 
 | 758 | 			((i+1)%TX_RING_SIZE)*sizeof(struct yellowfin_desc)); | 
 | 759 | 	} | 
 | 760 | 	/* Wrap ring */ | 
 | 761 | 	yp->tx_ring[--i].dbdma_cmd = cpu_to_le32(CMD_STOP | BRANCH_ALWAYS); | 
 | 762 | #else | 
 | 763 | { | 
 | 764 | 	int j; | 
 | 765 |  | 
 | 766 | 	/* Tx ring needs a pair of descriptors, the second for the status. */ | 
 | 767 | 	for (i = 0; i < TX_RING_SIZE; i++) { | 
 | 768 | 		j = 2*i; | 
 | 769 | 		yp->tx_skbuff[i] = 0; | 
 | 770 | 		/* Branch on Tx error. */ | 
 | 771 | 		yp->tx_ring[j].dbdma_cmd = cpu_to_le32(CMD_STOP); | 
 | 772 | 		yp->tx_ring[j].branch_addr = cpu_to_le32(yp->tx_ring_dma + | 
| Mariusz Kozlowski | 80950f8 | 2008-03-28 14:41:29 -0700 | [diff] [blame] | 773 | 			(j+1)*sizeof(struct yellowfin_desc)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 774 | 		j++; | 
 | 775 | 		if (yp->flags & FullTxStatus) { | 
 | 776 | 			yp->tx_ring[j].dbdma_cmd = | 
 | 777 | 				cpu_to_le32(CMD_TXSTATUS | sizeof(*yp->tx_status)); | 
 | 778 | 			yp->tx_ring[j].request_cnt = sizeof(*yp->tx_status); | 
 | 779 | 			yp->tx_ring[j].addr = cpu_to_le32(yp->tx_status_dma + | 
| Mariusz Kozlowski | 80950f8 | 2008-03-28 14:41:29 -0700 | [diff] [blame] | 780 | 				i*sizeof(struct tx_status_words)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 781 | 		} else { | 
 | 782 | 			/* Symbios chips write only tx_errs word. */ | 
 | 783 | 			yp->tx_ring[j].dbdma_cmd = | 
 | 784 | 				cpu_to_le32(CMD_TXSTATUS | INTR_ALWAYS | 2); | 
 | 785 | 			yp->tx_ring[j].request_cnt = 2; | 
 | 786 | 			/* Om pade ummmmm... */ | 
 | 787 | 			yp->tx_ring[j].addr = cpu_to_le32(yp->tx_status_dma + | 
 | 788 | 				i*sizeof(struct tx_status_words) + | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 789 | 				&(yp->tx_status[0].tx_errs) - | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 790 | 				&(yp->tx_status[0])); | 
 | 791 | 		} | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 792 | 		yp->tx_ring[j].branch_addr = cpu_to_le32(yp->tx_ring_dma + | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 793 | 			((j+1)%(2*TX_RING_SIZE))*sizeof(struct yellowfin_desc)); | 
 | 794 | 	} | 
 | 795 | 	/* Wrap ring */ | 
 | 796 | 	yp->tx_ring[++j].dbdma_cmd |= cpu_to_le32(BRANCH_ALWAYS | INTR_ALWAYS); | 
 | 797 | } | 
 | 798 | #endif | 
 | 799 | 	yp->tx_tail_desc = &yp->tx_status[0]; | 
 | 800 | 	return; | 
 | 801 | } | 
 | 802 |  | 
 | 803 | static int yellowfin_start_xmit(struct sk_buff *skb, struct net_device *dev) | 
 | 804 | { | 
 | 805 | 	struct yellowfin_private *yp = netdev_priv(dev); | 
 | 806 | 	unsigned entry; | 
 | 807 | 	int len = skb->len; | 
 | 808 |  | 
 | 809 | 	netif_stop_queue (dev); | 
 | 810 |  | 
 | 811 | 	/* Note: Ordering is important here, set the field with the | 
 | 812 | 	   "ownership" bit last, and only then increment cur_tx. */ | 
 | 813 |  | 
 | 814 | 	/* Calculate the next Tx descriptor entry. */ | 
 | 815 | 	entry = yp->cur_tx % TX_RING_SIZE; | 
 | 816 |  | 
 | 817 | 	if (gx_fix) {	/* Note: only works for paddable protocols e.g.  IP. */ | 
 | 818 | 		int cacheline_end = ((unsigned long)skb->data + skb->len) % 32; | 
 | 819 | 		/* Fix GX chipset errata. */ | 
 | 820 | 		if (cacheline_end > 24  || cacheline_end == 0) { | 
 | 821 | 			len = skb->len + 32 - cacheline_end + 1; | 
| Herbert Xu | 5b057c6 | 2006-06-23 02:06:41 -0700 | [diff] [blame] | 822 | 			if (skb_padto(skb, len)) { | 
 | 823 | 				yp->tx_skbuff[entry] = NULL; | 
 | 824 | 				netif_wake_queue(dev); | 
 | 825 | 				return 0; | 
 | 826 | 			} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 827 | 		} | 
 | 828 | 	} | 
 | 829 | 	yp->tx_skbuff[entry] = skb; | 
 | 830 |  | 
 | 831 | #ifdef NO_TXSTATS | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 832 | 	yp->tx_ring[entry].addr = cpu_to_le32(pci_map_single(yp->pci_dev, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 833 | 		skb->data, len, PCI_DMA_TODEVICE)); | 
 | 834 | 	yp->tx_ring[entry].result_status = 0; | 
 | 835 | 	if (entry >= TX_RING_SIZE-1) { | 
 | 836 | 		/* New stop command. */ | 
 | 837 | 		yp->tx_ring[0].dbdma_cmd = cpu_to_le32(CMD_STOP); | 
 | 838 | 		yp->tx_ring[TX_RING_SIZE-1].dbdma_cmd = | 
 | 839 | 			cpu_to_le32(CMD_TX_PKT|BRANCH_ALWAYS | len); | 
 | 840 | 	} else { | 
 | 841 | 		yp->tx_ring[entry+1].dbdma_cmd = cpu_to_le32(CMD_STOP); | 
 | 842 | 		yp->tx_ring[entry].dbdma_cmd = | 
 | 843 | 			cpu_to_le32(CMD_TX_PKT | BRANCH_IFTRUE | len); | 
 | 844 | 	} | 
 | 845 | 	yp->cur_tx++; | 
 | 846 | #else | 
 | 847 | 	yp->tx_ring[entry<<1].request_cnt = len; | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 848 | 	yp->tx_ring[entry<<1].addr = cpu_to_le32(pci_map_single(yp->pci_dev, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 849 | 		skb->data, len, PCI_DMA_TODEVICE)); | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 850 | 	/* The input_last (status-write) command is constant, but we must | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 851 | 	   rewrite the subsequent 'stop' command. */ | 
 | 852 |  | 
 | 853 | 	yp->cur_tx++; | 
 | 854 | 	{ | 
 | 855 | 		unsigned next_entry = yp->cur_tx % TX_RING_SIZE; | 
 | 856 | 		yp->tx_ring[next_entry<<1].dbdma_cmd = cpu_to_le32(CMD_STOP); | 
 | 857 | 	} | 
 | 858 | 	/* Final step -- overwrite the old 'stop' command. */ | 
 | 859 |  | 
 | 860 | 	yp->tx_ring[entry<<1].dbdma_cmd = | 
 | 861 | 		cpu_to_le32( ((entry % 6) == 0 ? CMD_TX_PKT|INTR_ALWAYS|BRANCH_IFTRUE : | 
 | 862 | 					  CMD_TX_PKT | BRANCH_IFTRUE) | len); | 
 | 863 | #endif | 
 | 864 |  | 
 | 865 | 	/* Non-x86 Todo: explicitly flush cache lines here. */ | 
 | 866 |  | 
 | 867 | 	/* Wake the potentially-idle transmit channel. */ | 
 | 868 | 	iowrite32(0x10001000, yp->base + TxCtrl); | 
 | 869 |  | 
 | 870 | 	if (yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE) | 
 | 871 | 		netif_start_queue (dev);		/* Typical path */ | 
 | 872 | 	else | 
 | 873 | 		yp->tx_full = 1; | 
 | 874 | 	dev->trans_start = jiffies; | 
 | 875 |  | 
 | 876 | 	if (yellowfin_debug > 4) { | 
 | 877 | 		printk(KERN_DEBUG "%s: Yellowfin transmit frame #%d queued in slot %d.\n", | 
 | 878 | 			   dev->name, yp->cur_tx, entry); | 
 | 879 | 	} | 
 | 880 | 	return 0; | 
 | 881 | } | 
 | 882 |  | 
 | 883 | /* The interrupt handler does all of the Rx thread work and cleans up | 
 | 884 |    after the Tx thread. */ | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 885 | static irqreturn_t yellowfin_interrupt(int irq, void *dev_instance) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 886 | { | 
 | 887 | 	struct net_device *dev = dev_instance; | 
 | 888 | 	struct yellowfin_private *yp; | 
 | 889 | 	void __iomem *ioaddr; | 
 | 890 | 	int boguscnt = max_interrupt_work; | 
 | 891 | 	unsigned int handled = 0; | 
 | 892 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 893 | 	yp = netdev_priv(dev); | 
 | 894 | 	ioaddr = yp->base; | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 895 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 896 | 	spin_lock (&yp->lock); | 
 | 897 |  | 
 | 898 | 	do { | 
 | 899 | 		u16 intr_status = ioread16(ioaddr + IntrClear); | 
 | 900 |  | 
 | 901 | 		if (yellowfin_debug > 4) | 
 | 902 | 			printk(KERN_DEBUG "%s: Yellowfin interrupt, status %4.4x.\n", | 
 | 903 | 				   dev->name, intr_status); | 
 | 904 |  | 
 | 905 | 		if (intr_status == 0) | 
 | 906 | 			break; | 
 | 907 | 		handled = 1; | 
 | 908 |  | 
 | 909 | 		if (intr_status & (IntrRxDone | IntrEarlyRx)) { | 
 | 910 | 			yellowfin_rx(dev); | 
 | 911 | 			iowrite32(0x10001000, ioaddr + RxCtrl);		/* Wake Rx engine. */ | 
 | 912 | 		} | 
 | 913 |  | 
 | 914 | #ifdef NO_TXSTATS | 
 | 915 | 		for (; yp->cur_tx - yp->dirty_tx > 0; yp->dirty_tx++) { | 
 | 916 | 			int entry = yp->dirty_tx % TX_RING_SIZE; | 
 | 917 | 			struct sk_buff *skb; | 
 | 918 |  | 
 | 919 | 			if (yp->tx_ring[entry].result_status == 0) | 
 | 920 | 				break; | 
 | 921 | 			skb = yp->tx_skbuff[entry]; | 
| Jeff Garzik | 09f75cd | 2007-10-03 17:41:50 -0700 | [diff] [blame] | 922 | 			dev->stats.tx_packets++; | 
 | 923 | 			dev->stats.tx_bytes += skb->len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 924 | 			/* Free the original skb. */ | 
| Al Viro | e5a3142 | 2007-12-22 17:53:02 +0000 | [diff] [blame] | 925 | 			pci_unmap_single(yp->pci_dev, le32_to_cpu(yp->tx_ring[entry].addr), | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 926 | 				skb->len, PCI_DMA_TODEVICE); | 
 | 927 | 			dev_kfree_skb_irq(skb); | 
 | 928 | 			yp->tx_skbuff[entry] = NULL; | 
 | 929 | 		} | 
 | 930 | 		if (yp->tx_full | 
 | 931 | 			&& yp->cur_tx - yp->dirty_tx < TX_QUEUE_SIZE - 4) { | 
 | 932 | 			/* The ring is no longer full, clear tbusy. */ | 
 | 933 | 			yp->tx_full = 0; | 
 | 934 | 			netif_wake_queue(dev); | 
 | 935 | 		} | 
 | 936 | #else | 
 | 937 | 		if ((intr_status & IntrTxDone) || (yp->tx_tail_desc->tx_errs)) { | 
 | 938 | 			unsigned dirty_tx = yp->dirty_tx; | 
 | 939 |  | 
 | 940 | 			for (dirty_tx = yp->dirty_tx; yp->cur_tx - dirty_tx > 0; | 
 | 941 | 				 dirty_tx++) { | 
 | 942 | 				/* Todo: optimize this. */ | 
 | 943 | 				int entry = dirty_tx % TX_RING_SIZE; | 
 | 944 | 				u16 tx_errs = yp->tx_status[entry].tx_errs; | 
 | 945 | 				struct sk_buff *skb; | 
 | 946 |  | 
 | 947 | #ifndef final_version | 
 | 948 | 				if (yellowfin_debug > 5) | 
 | 949 | 					printk(KERN_DEBUG "%s: Tx queue %d check, Tx status " | 
 | 950 | 						   "%4.4x %4.4x %4.4x %4.4x.\n", | 
 | 951 | 						   dev->name, entry, | 
 | 952 | 						   yp->tx_status[entry].tx_cnt, | 
 | 953 | 						   yp->tx_status[entry].tx_errs, | 
 | 954 | 						   yp->tx_status[entry].total_tx_cnt, | 
 | 955 | 						   yp->tx_status[entry].paused); | 
 | 956 | #endif | 
 | 957 | 				if (tx_errs == 0) | 
 | 958 | 					break;	/* It still hasn't been Txed */ | 
 | 959 | 				skb = yp->tx_skbuff[entry]; | 
 | 960 | 				if (tx_errs & 0xF810) { | 
 | 961 | 					/* There was an major error, log it. */ | 
 | 962 | #ifndef final_version | 
 | 963 | 					if (yellowfin_debug > 1) | 
 | 964 | 						printk(KERN_DEBUG "%s: Transmit error, Tx status %4.4x.\n", | 
 | 965 | 							   dev->name, tx_errs); | 
 | 966 | #endif | 
| Jeff Garzik | 09f75cd | 2007-10-03 17:41:50 -0700 | [diff] [blame] | 967 | 					dev->stats.tx_errors++; | 
 | 968 | 					if (tx_errs & 0xF800) dev->stats.tx_aborted_errors++; | 
 | 969 | 					if (tx_errs & 0x0800) dev->stats.tx_carrier_errors++; | 
 | 970 | 					if (tx_errs & 0x2000) dev->stats.tx_window_errors++; | 
 | 971 | 					if (tx_errs & 0x8000) dev->stats.tx_fifo_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 972 | 				} else { | 
 | 973 | #ifndef final_version | 
 | 974 | 					if (yellowfin_debug > 4) | 
 | 975 | 						printk(KERN_DEBUG "%s: Normal transmit, Tx status %4.4x.\n", | 
 | 976 | 							   dev->name, tx_errs); | 
 | 977 | #endif | 
| Jeff Garzik | 09f75cd | 2007-10-03 17:41:50 -0700 | [diff] [blame] | 978 | 					dev->stats.tx_bytes += skb->len; | 
 | 979 | 					dev->stats.collisions += tx_errs & 15; | 
 | 980 | 					dev->stats.tx_packets++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 981 | 				} | 
 | 982 | 				/* Free the original skb. */ | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 983 | 				pci_unmap_single(yp->pci_dev, | 
 | 984 | 					yp->tx_ring[entry<<1].addr, skb->len, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 985 | 					PCI_DMA_TODEVICE); | 
 | 986 | 				dev_kfree_skb_irq(skb); | 
 | 987 | 				yp->tx_skbuff[entry] = 0; | 
 | 988 | 				/* Mark status as empty. */ | 
 | 989 | 				yp->tx_status[entry].tx_errs = 0; | 
 | 990 | 			} | 
 | 991 |  | 
 | 992 | #ifndef final_version | 
 | 993 | 			if (yp->cur_tx - dirty_tx > TX_RING_SIZE) { | 
 | 994 | 				printk(KERN_ERR "%s: Out-of-sync dirty pointer, %d vs. %d, full=%d.\n", | 
 | 995 | 					   dev->name, dirty_tx, yp->cur_tx, yp->tx_full); | 
 | 996 | 				dirty_tx += TX_RING_SIZE; | 
 | 997 | 			} | 
 | 998 | #endif | 
 | 999 |  | 
 | 1000 | 			if (yp->tx_full | 
 | 1001 | 				&& yp->cur_tx - dirty_tx < TX_QUEUE_SIZE - 2) { | 
 | 1002 | 				/* The ring is no longer full, clear tbusy. */ | 
 | 1003 | 				yp->tx_full = 0; | 
 | 1004 | 				netif_wake_queue(dev); | 
 | 1005 | 			} | 
 | 1006 |  | 
 | 1007 | 			yp->dirty_tx = dirty_tx; | 
 | 1008 | 			yp->tx_tail_desc = &yp->tx_status[dirty_tx % TX_RING_SIZE]; | 
 | 1009 | 		} | 
 | 1010 | #endif | 
 | 1011 |  | 
 | 1012 | 		/* Log errors and other uncommon events. */ | 
 | 1013 | 		if (intr_status & 0x2ee)	/* Abnormal error summary. */ | 
 | 1014 | 			yellowfin_error(dev, intr_status); | 
 | 1015 |  | 
 | 1016 | 		if (--boguscnt < 0) { | 
 | 1017 | 			printk(KERN_WARNING "%s: Too much work at interrupt, " | 
 | 1018 | 				   "status=0x%4.4x.\n", | 
 | 1019 | 				   dev->name, intr_status); | 
 | 1020 | 			break; | 
 | 1021 | 		} | 
 | 1022 | 	} while (1); | 
 | 1023 |  | 
 | 1024 | 	if (yellowfin_debug > 3) | 
 | 1025 | 		printk(KERN_DEBUG "%s: exiting interrupt, status=%#4.4x.\n", | 
 | 1026 | 			   dev->name, ioread16(ioaddr + IntrStatus)); | 
 | 1027 |  | 
 | 1028 | 	spin_unlock (&yp->lock); | 
 | 1029 | 	return IRQ_RETVAL(handled); | 
 | 1030 | } | 
 | 1031 |  | 
 | 1032 | /* This routine is logically part of the interrupt handler, but separated | 
 | 1033 |    for clarity and better register allocation. */ | 
 | 1034 | static int yellowfin_rx(struct net_device *dev) | 
 | 1035 | { | 
 | 1036 | 	struct yellowfin_private *yp = netdev_priv(dev); | 
 | 1037 | 	int entry = yp->cur_rx % RX_RING_SIZE; | 
 | 1038 | 	int boguscnt = yp->dirty_rx + RX_RING_SIZE - yp->cur_rx; | 
 | 1039 |  | 
 | 1040 | 	if (yellowfin_debug > 4) { | 
 | 1041 | 		printk(KERN_DEBUG " In yellowfin_rx(), entry %d status %8.8x.\n", | 
 | 1042 | 			   entry, yp->rx_ring[entry].result_status); | 
 | 1043 | 		printk(KERN_DEBUG "   #%d desc. %8.8x %8.8x %8.8x.\n", | 
 | 1044 | 			   entry, yp->rx_ring[entry].dbdma_cmd, yp->rx_ring[entry].addr, | 
 | 1045 | 			   yp->rx_ring[entry].result_status); | 
 | 1046 | 	} | 
 | 1047 |  | 
 | 1048 | 	/* If EOP is set on the next entry, it's a new packet. Send it up. */ | 
 | 1049 | 	while (1) { | 
 | 1050 | 		struct yellowfin_desc *desc = &yp->rx_ring[entry]; | 
 | 1051 | 		struct sk_buff *rx_skb = yp->rx_skbuff[entry]; | 
 | 1052 | 		s16 frame_status; | 
 | 1053 | 		u16 desc_status; | 
 | 1054 | 		int data_size; | 
 | 1055 | 		u8 *buf_addr; | 
 | 1056 |  | 
 | 1057 | 		if(!desc->result_status) | 
 | 1058 | 			break; | 
| Al Viro | e5a3142 | 2007-12-22 17:53:02 +0000 | [diff] [blame] | 1059 | 		pci_dma_sync_single_for_cpu(yp->pci_dev, le32_to_cpu(desc->addr), | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1060 | 			yp->rx_buf_sz, PCI_DMA_FROMDEVICE); | 
 | 1061 | 		desc_status = le32_to_cpu(desc->result_status) >> 16; | 
| David S. Miller | 689be43 | 2005-06-28 15:25:31 -0700 | [diff] [blame] | 1062 | 		buf_addr = rx_skb->data; | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1063 | 		data_size = (le32_to_cpu(desc->dbdma_cmd) - | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1064 | 			le32_to_cpu(desc->result_status)) & 0xffff; | 
| Harvey Harrison | 6caf52a | 2008-04-29 01:03:36 -0700 | [diff] [blame] | 1065 | 		frame_status = get_unaligned_le16(&(buf_addr[data_size - 2])); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1066 | 		if (yellowfin_debug > 4) | 
 | 1067 | 			printk(KERN_DEBUG "  yellowfin_rx() status was %4.4x.\n", | 
 | 1068 | 				   frame_status); | 
 | 1069 | 		if (--boguscnt < 0) | 
 | 1070 | 			break; | 
 | 1071 | 		if ( ! (desc_status & RX_EOP)) { | 
 | 1072 | 			if (data_size != 0) | 
 | 1073 | 				printk(KERN_WARNING "%s: Oversized Ethernet frame spanned multiple buffers," | 
 | 1074 | 					   " status %4.4x, data_size %d!\n", dev->name, desc_status, data_size); | 
| Jeff Garzik | 09f75cd | 2007-10-03 17:41:50 -0700 | [diff] [blame] | 1075 | 			dev->stats.rx_length_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1076 | 		} else if ((yp->drv_flags & IsGigabit)  &&  (frame_status & 0x0038)) { | 
 | 1077 | 			/* There was a error. */ | 
 | 1078 | 			if (yellowfin_debug > 3) | 
 | 1079 | 				printk(KERN_DEBUG "  yellowfin_rx() Rx error was %4.4x.\n", | 
 | 1080 | 					   frame_status); | 
| Jeff Garzik | 09f75cd | 2007-10-03 17:41:50 -0700 | [diff] [blame] | 1081 | 			dev->stats.rx_errors++; | 
 | 1082 | 			if (frame_status & 0x0060) dev->stats.rx_length_errors++; | 
 | 1083 | 			if (frame_status & 0x0008) dev->stats.rx_frame_errors++; | 
 | 1084 | 			if (frame_status & 0x0010) dev->stats.rx_crc_errors++; | 
 | 1085 | 			if (frame_status < 0) dev->stats.rx_dropped++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1086 | 		} else if ( !(yp->drv_flags & IsGigabit)  && | 
 | 1087 | 				   ((buf_addr[data_size-1] & 0x85) || buf_addr[data_size-2] & 0xC0)) { | 
 | 1088 | 			u8 status1 = buf_addr[data_size-2]; | 
 | 1089 | 			u8 status2 = buf_addr[data_size-1]; | 
| Jeff Garzik | 09f75cd | 2007-10-03 17:41:50 -0700 | [diff] [blame] | 1090 | 			dev->stats.rx_errors++; | 
 | 1091 | 			if (status1 & 0xC0) dev->stats.rx_length_errors++; | 
 | 1092 | 			if (status2 & 0x03) dev->stats.rx_frame_errors++; | 
 | 1093 | 			if (status2 & 0x04) dev->stats.rx_crc_errors++; | 
 | 1094 | 			if (status2 & 0x80) dev->stats.rx_dropped++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1095 | #ifdef YF_PROTOTYPE		/* Support for prototype hardware errata. */ | 
 | 1096 | 		} else if ((yp->flags & HasMACAddrBug)  && | 
 | 1097 | 			memcmp(le32_to_cpu(yp->rx_ring_dma + | 
 | 1098 | 				entry*sizeof(struct yellowfin_desc)), | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1099 | 				dev->dev_addr, 6) != 0 && | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1100 | 			memcmp(le32_to_cpu(yp->rx_ring_dma + | 
 | 1101 | 				entry*sizeof(struct yellowfin_desc)), | 
 | 1102 | 				"\377\377\377\377\377\377", 6) != 0) { | 
| Joe Perches | 0795af5 | 2007-10-03 17:59:30 -0700 | [diff] [blame] | 1103 | 			if (bogus_rx++ == 0) { | 
 | 1104 | 				DECLARE_MAC_BUF(mac); | 
 | 1105 | 				printk(KERN_WARNING "%s: Bad frame to %s\n", | 
 | 1106 | 					   dev->name, print_mac(mac, buf_addr)); | 
 | 1107 | 			} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1108 | #endif | 
 | 1109 | 		} else { | 
 | 1110 | 			struct sk_buff *skb; | 
 | 1111 | 			int pkt_len = data_size - | 
 | 1112 | 				(yp->chip_id ? 7 : 8 + buf_addr[data_size - 8]); | 
 | 1113 | 			/* To verify: Yellowfin Length should omit the CRC! */ | 
 | 1114 |  | 
 | 1115 | #ifndef final_version | 
 | 1116 | 			if (yellowfin_debug > 4) | 
 | 1117 | 				printk(KERN_DEBUG "  yellowfin_rx() normal Rx pkt length %d" | 
 | 1118 | 					   " of %d, bogus_cnt %d.\n", | 
 | 1119 | 					   pkt_len, data_size, boguscnt); | 
 | 1120 | #endif | 
 | 1121 | 			/* Check if the packet is long enough to just pass up the skbuff | 
 | 1122 | 			   without copying to a properly sized skbuff. */ | 
 | 1123 | 			if (pkt_len > rx_copybreak) { | 
 | 1124 | 				skb_put(skb = rx_skb, pkt_len); | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1125 | 				pci_unmap_single(yp->pci_dev, | 
| Al Viro | e5a3142 | 2007-12-22 17:53:02 +0000 | [diff] [blame] | 1126 | 					le32_to_cpu(yp->rx_ring[entry].addr), | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1127 | 					yp->rx_buf_sz, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1128 | 					PCI_DMA_FROMDEVICE); | 
 | 1129 | 				yp->rx_skbuff[entry] = NULL; | 
 | 1130 | 			} else { | 
 | 1131 | 				skb = dev_alloc_skb(pkt_len + 2); | 
 | 1132 | 				if (skb == NULL) | 
 | 1133 | 					break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1134 | 				skb_reserve(skb, 2);	/* 16 byte align the IP header */ | 
| David S. Miller | 8c7b7fa | 2007-07-10 22:08:12 -0700 | [diff] [blame] | 1135 | 				skb_copy_to_linear_data(skb, rx_skb->data, pkt_len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1136 | 				skb_put(skb, pkt_len); | 
| Al Viro | e5a3142 | 2007-12-22 17:53:02 +0000 | [diff] [blame] | 1137 | 				pci_dma_sync_single_for_device(yp->pci_dev, | 
 | 1138 | 								le32_to_cpu(desc->addr), | 
 | 1139 | 								yp->rx_buf_sz, | 
 | 1140 | 								PCI_DMA_FROMDEVICE); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1141 | 			} | 
 | 1142 | 			skb->protocol = eth_type_trans(skb, dev); | 
 | 1143 | 			netif_rx(skb); | 
 | 1144 | 			dev->last_rx = jiffies; | 
| Jeff Garzik | 09f75cd | 2007-10-03 17:41:50 -0700 | [diff] [blame] | 1145 | 			dev->stats.rx_packets++; | 
 | 1146 | 			dev->stats.rx_bytes += pkt_len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1147 | 		} | 
 | 1148 | 		entry = (++yp->cur_rx) % RX_RING_SIZE; | 
 | 1149 | 	} | 
 | 1150 |  | 
 | 1151 | 	/* Refill the Rx ring buffers. */ | 
 | 1152 | 	for (; yp->cur_rx - yp->dirty_rx > 0; yp->dirty_rx++) { | 
 | 1153 | 		entry = yp->dirty_rx % RX_RING_SIZE; | 
 | 1154 | 		if (yp->rx_skbuff[entry] == NULL) { | 
 | 1155 | 			struct sk_buff *skb = dev_alloc_skb(yp->rx_buf_sz); | 
 | 1156 | 			if (skb == NULL) | 
 | 1157 | 				break;				/* Better luck next round. */ | 
 | 1158 | 			yp->rx_skbuff[entry] = skb; | 
 | 1159 | 			skb->dev = dev;	/* Mark as being used by this device. */ | 
 | 1160 | 			skb_reserve(skb, 2);	/* Align IP on 16 byte boundaries */ | 
 | 1161 | 			yp->rx_ring[entry].addr = cpu_to_le32(pci_map_single(yp->pci_dev, | 
| David S. Miller | 689be43 | 2005-06-28 15:25:31 -0700 | [diff] [blame] | 1162 | 				skb->data, yp->rx_buf_sz, PCI_DMA_FROMDEVICE)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1163 | 		} | 
 | 1164 | 		yp->rx_ring[entry].dbdma_cmd = cpu_to_le32(CMD_STOP); | 
 | 1165 | 		yp->rx_ring[entry].result_status = 0;	/* Clear complete bit. */ | 
 | 1166 | 		if (entry != 0) | 
 | 1167 | 			yp->rx_ring[entry - 1].dbdma_cmd = | 
 | 1168 | 				cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | yp->rx_buf_sz); | 
 | 1169 | 		else | 
 | 1170 | 			yp->rx_ring[RX_RING_SIZE - 1].dbdma_cmd = | 
 | 1171 | 				cpu_to_le32(CMD_RX_BUF | INTR_ALWAYS | BRANCH_ALWAYS | 
 | 1172 | 							| yp->rx_buf_sz); | 
 | 1173 | 	} | 
 | 1174 |  | 
 | 1175 | 	return 0; | 
 | 1176 | } | 
 | 1177 |  | 
 | 1178 | static void yellowfin_error(struct net_device *dev, int intr_status) | 
 | 1179 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1180 | 	printk(KERN_ERR "%s: Something Wicked happened! %4.4x.\n", | 
 | 1181 | 		   dev->name, intr_status); | 
 | 1182 | 	/* Hmmmmm, it's not clear what to do here. */ | 
 | 1183 | 	if (intr_status & (IntrTxPCIErr | IntrTxPCIFault)) | 
| Jeff Garzik | 09f75cd | 2007-10-03 17:41:50 -0700 | [diff] [blame] | 1184 | 		dev->stats.tx_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1185 | 	if (intr_status & (IntrRxPCIErr | IntrRxPCIFault)) | 
| Jeff Garzik | 09f75cd | 2007-10-03 17:41:50 -0700 | [diff] [blame] | 1186 | 		dev->stats.rx_errors++; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1187 | } | 
 | 1188 |  | 
 | 1189 | static int yellowfin_close(struct net_device *dev) | 
 | 1190 | { | 
 | 1191 | 	struct yellowfin_private *yp = netdev_priv(dev); | 
 | 1192 | 	void __iomem *ioaddr = yp->base; | 
 | 1193 | 	int i; | 
 | 1194 |  | 
 | 1195 | 	netif_stop_queue (dev); | 
 | 1196 |  | 
 | 1197 | 	if (yellowfin_debug > 1) { | 
 | 1198 | 		printk(KERN_DEBUG "%s: Shutting down ethercard, status was Tx %4.4x " | 
 | 1199 | 			   "Rx %4.4x Int %2.2x.\n", | 
 | 1200 | 			   dev->name, ioread16(ioaddr + TxStatus), | 
 | 1201 | 			   ioread16(ioaddr + RxStatus), | 
 | 1202 | 			   ioread16(ioaddr + IntrStatus)); | 
 | 1203 | 		printk(KERN_DEBUG "%s: Queue pointers were Tx %d / %d,  Rx %d / %d.\n", | 
 | 1204 | 			   dev->name, yp->cur_tx, yp->dirty_tx, yp->cur_rx, yp->dirty_rx); | 
 | 1205 | 	} | 
 | 1206 |  | 
 | 1207 | 	/* Disable interrupts by clearing the interrupt mask. */ | 
 | 1208 | 	iowrite16(0x0000, ioaddr + IntrEnb); | 
 | 1209 |  | 
 | 1210 | 	/* Stop the chip's Tx and Rx processes. */ | 
 | 1211 | 	iowrite32(0x80000000, ioaddr + RxCtrl); | 
 | 1212 | 	iowrite32(0x80000000, ioaddr + TxCtrl); | 
 | 1213 |  | 
 | 1214 | 	del_timer(&yp->timer); | 
 | 1215 |  | 
 | 1216 | #if defined(__i386__) | 
 | 1217 | 	if (yellowfin_debug > 2) { | 
 | 1218 | 		printk("\n"KERN_DEBUG"  Tx ring at %8.8llx:\n", | 
 | 1219 | 				(unsigned long long)yp->tx_ring_dma); | 
 | 1220 | 		for (i = 0; i < TX_RING_SIZE*2; i++) | 
 | 1221 | 			printk(" %c #%d desc. %8.8x %8.8x %8.8x %8.8x.\n", | 
 | 1222 | 				   ioread32(ioaddr + TxPtr) == (long)&yp->tx_ring[i] ? '>' : ' ', | 
 | 1223 | 				   i, yp->tx_ring[i].dbdma_cmd, yp->tx_ring[i].addr, | 
 | 1224 | 				   yp->tx_ring[i].branch_addr, yp->tx_ring[i].result_status); | 
 | 1225 | 		printk(KERN_DEBUG "  Tx status %p:\n", yp->tx_status); | 
 | 1226 | 		for (i = 0; i < TX_RING_SIZE; i++) | 
 | 1227 | 			printk("   #%d status %4.4x %4.4x %4.4x %4.4x.\n", | 
 | 1228 | 				   i, yp->tx_status[i].tx_cnt, yp->tx_status[i].tx_errs, | 
 | 1229 | 				   yp->tx_status[i].total_tx_cnt, yp->tx_status[i].paused); | 
 | 1230 |  | 
 | 1231 | 		printk("\n"KERN_DEBUG "  Rx ring %8.8llx:\n", | 
 | 1232 | 				(unsigned long long)yp->rx_ring_dma); | 
 | 1233 | 		for (i = 0; i < RX_RING_SIZE; i++) { | 
 | 1234 | 			printk(KERN_DEBUG " %c #%d desc. %8.8x %8.8x %8.8x\n", | 
 | 1235 | 				   ioread32(ioaddr + RxPtr) == (long)&yp->rx_ring[i] ? '>' : ' ', | 
 | 1236 | 				   i, yp->rx_ring[i].dbdma_cmd, yp->rx_ring[i].addr, | 
 | 1237 | 				   yp->rx_ring[i].result_status); | 
 | 1238 | 			if (yellowfin_debug > 6) { | 
 | 1239 | 				if (get_unaligned((u8*)yp->rx_ring[i].addr) != 0x69) { | 
 | 1240 | 					int j; | 
 | 1241 | 					for (j = 0; j < 0x50; j++) | 
 | 1242 | 						printk(" %4.4x", | 
 | 1243 | 							   get_unaligned(((u16*)yp->rx_ring[i].addr) + j)); | 
 | 1244 | 					printk("\n"); | 
 | 1245 | 				} | 
 | 1246 | 			} | 
 | 1247 | 		} | 
 | 1248 | 	} | 
 | 1249 | #endif /* __i386__ debugging only */ | 
 | 1250 |  | 
 | 1251 | 	free_irq(dev->irq, dev); | 
 | 1252 |  | 
 | 1253 | 	/* Free all the skbuffs in the Rx queue. */ | 
 | 1254 | 	for (i = 0; i < RX_RING_SIZE; i++) { | 
 | 1255 | 		yp->rx_ring[i].dbdma_cmd = cpu_to_le32(CMD_STOP); | 
| Al Viro | e5a3142 | 2007-12-22 17:53:02 +0000 | [diff] [blame] | 1256 | 		yp->rx_ring[i].addr = cpu_to_le32(0xBADF00D0); /* An invalid address. */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1257 | 		if (yp->rx_skbuff[i]) { | 
 | 1258 | 			dev_kfree_skb(yp->rx_skbuff[i]); | 
 | 1259 | 		} | 
 | 1260 | 		yp->rx_skbuff[i] = NULL; | 
 | 1261 | 	} | 
 | 1262 | 	for (i = 0; i < TX_RING_SIZE; i++) { | 
 | 1263 | 		if (yp->tx_skbuff[i]) | 
 | 1264 | 			dev_kfree_skb(yp->tx_skbuff[i]); | 
 | 1265 | 		yp->tx_skbuff[i] = NULL; | 
 | 1266 | 	} | 
 | 1267 |  | 
 | 1268 | #ifdef YF_PROTOTYPE			/* Support for prototype hardware errata. */ | 
 | 1269 | 	if (yellowfin_debug > 0) { | 
 | 1270 | 		printk(KERN_DEBUG "%s: Received %d frames that we should not have.\n", | 
 | 1271 | 			   dev->name, bogus_rx); | 
 | 1272 | 	} | 
 | 1273 | #endif | 
 | 1274 |  | 
 | 1275 | 	return 0; | 
 | 1276 | } | 
 | 1277 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1278 | /* Set or clear the multicast filter for this adaptor. */ | 
 | 1279 |  | 
 | 1280 | static void set_rx_mode(struct net_device *dev) | 
 | 1281 | { | 
 | 1282 | 	struct yellowfin_private *yp = netdev_priv(dev); | 
 | 1283 | 	void __iomem *ioaddr = yp->base; | 
 | 1284 | 	u16 cfg_value = ioread16(ioaddr + Cnfg); | 
 | 1285 |  | 
 | 1286 | 	/* Stop the Rx process to change any value. */ | 
 | 1287 | 	iowrite16(cfg_value & ~0x1000, ioaddr + Cnfg); | 
 | 1288 | 	if (dev->flags & IFF_PROMISC) {			/* Set promiscuous. */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1289 | 		iowrite16(0x000F, ioaddr + AddrMode); | 
 | 1290 | 	} else if ((dev->mc_count > 64)  ||  (dev->flags & IFF_ALLMULTI)) { | 
 | 1291 | 		/* Too many to filter well, or accept all multicasts. */ | 
 | 1292 | 		iowrite16(0x000B, ioaddr + AddrMode); | 
 | 1293 | 	} else if (dev->mc_count > 0) { /* Must use the multicast hash table. */ | 
 | 1294 | 		struct dev_mc_list *mclist; | 
 | 1295 | 		u16 hash_table[4]; | 
 | 1296 | 		int i; | 
 | 1297 | 		memset(hash_table, 0, sizeof(hash_table)); | 
 | 1298 | 		for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count; | 
 | 1299 | 			 i++, mclist = mclist->next) { | 
 | 1300 | 			unsigned int bit; | 
 | 1301 |  | 
 | 1302 | 			/* Due to a bug in the early chip versions, multiple filter | 
 | 1303 | 			   slots must be set for each address. */ | 
 | 1304 | 			if (yp->drv_flags & HasMulticastBug) { | 
 | 1305 | 				bit = (ether_crc_le(3, mclist->dmi_addr) >> 3) & 0x3f; | 
 | 1306 | 				hash_table[bit >> 4] |= (1 << bit); | 
 | 1307 | 				bit = (ether_crc_le(4, mclist->dmi_addr) >> 3) & 0x3f; | 
 | 1308 | 				hash_table[bit >> 4] |= (1 << bit); | 
 | 1309 | 				bit = (ether_crc_le(5, mclist->dmi_addr) >> 3) & 0x3f; | 
 | 1310 | 				hash_table[bit >> 4] |= (1 << bit); | 
 | 1311 | 			} | 
 | 1312 | 			bit = (ether_crc_le(6, mclist->dmi_addr) >> 3) & 0x3f; | 
 | 1313 | 			hash_table[bit >> 4] |= (1 << bit); | 
 | 1314 | 		} | 
 | 1315 | 		/* Copy the hash table to the chip. */ | 
 | 1316 | 		for (i = 0; i < 4; i++) | 
 | 1317 | 			iowrite16(hash_table[i], ioaddr + HashTbl + i*2); | 
 | 1318 | 		iowrite16(0x0003, ioaddr + AddrMode); | 
 | 1319 | 	} else {					/* Normal, unicast/broadcast-only mode. */ | 
 | 1320 | 		iowrite16(0x0001, ioaddr + AddrMode); | 
 | 1321 | 	} | 
 | 1322 | 	/* Restart the Rx process. */ | 
 | 1323 | 	iowrite16(cfg_value | 0x1000, ioaddr + Cnfg); | 
 | 1324 | } | 
 | 1325 |  | 
 | 1326 | static void yellowfin_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) | 
 | 1327 | { | 
 | 1328 | 	struct yellowfin_private *np = netdev_priv(dev); | 
 | 1329 | 	strcpy(info->driver, DRV_NAME); | 
 | 1330 | 	strcpy(info->version, DRV_VERSION); | 
 | 1331 | 	strcpy(info->bus_info, pci_name(np->pci_dev)); | 
 | 1332 | } | 
 | 1333 |  | 
| Jeff Garzik | 7282d49 | 2006-09-13 14:30:00 -0400 | [diff] [blame] | 1334 | static const struct ethtool_ops ethtool_ops = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1335 | 	.get_drvinfo = yellowfin_get_drvinfo | 
 | 1336 | }; | 
 | 1337 |  | 
 | 1338 | static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) | 
 | 1339 | { | 
 | 1340 | 	struct yellowfin_private *np = netdev_priv(dev); | 
 | 1341 | 	void __iomem *ioaddr = np->base; | 
 | 1342 | 	struct mii_ioctl_data *data = if_mii(rq); | 
 | 1343 |  | 
 | 1344 | 	switch(cmd) { | 
 | 1345 | 	case SIOCGMIIPHY:		/* Get address of MII PHY in use. */ | 
 | 1346 | 		data->phy_id = np->phys[0] & 0x1f; | 
 | 1347 | 		/* Fall Through */ | 
 | 1348 |  | 
 | 1349 | 	case SIOCGMIIREG:		/* Read MII PHY register. */ | 
 | 1350 | 		data->val_out = mdio_read(ioaddr, data->phy_id & 0x1f, data->reg_num & 0x1f); | 
 | 1351 | 		return 0; | 
 | 1352 |  | 
 | 1353 | 	case SIOCSMIIREG:		/* Write MII PHY register. */ | 
 | 1354 | 		if (!capable(CAP_NET_ADMIN)) | 
 | 1355 | 			return -EPERM; | 
 | 1356 | 		if (data->phy_id == np->phys[0]) { | 
 | 1357 | 			u16 value = data->val_in; | 
 | 1358 | 			switch (data->reg_num) { | 
 | 1359 | 			case 0: | 
 | 1360 | 				/* Check for autonegotiation on or reset. */ | 
 | 1361 | 				np->medialock = (value & 0x9000) ? 0 : 1; | 
 | 1362 | 				if (np->medialock) | 
 | 1363 | 					np->full_duplex = (value & 0x0100) ? 1 : 0; | 
 | 1364 | 				break; | 
 | 1365 | 			case 4: np->advertising = value; break; | 
 | 1366 | 			} | 
 | 1367 | 			/* Perhaps check_duplex(dev), depending on chip semantics. */ | 
 | 1368 | 		} | 
 | 1369 | 		mdio_write(ioaddr, data->phy_id & 0x1f, data->reg_num & 0x1f, data->val_in); | 
 | 1370 | 		return 0; | 
 | 1371 | 	default: | 
 | 1372 | 		return -EOPNOTSUPP; | 
 | 1373 | 	} | 
 | 1374 | } | 
 | 1375 |  | 
 | 1376 |  | 
 | 1377 | static void __devexit yellowfin_remove_one (struct pci_dev *pdev) | 
 | 1378 | { | 
 | 1379 | 	struct net_device *dev = pci_get_drvdata(pdev); | 
 | 1380 | 	struct yellowfin_private *np; | 
 | 1381 |  | 
| Eric Sesterhenn | 5d9428d | 2006-04-02 13:52:48 +0200 | [diff] [blame] | 1382 | 	BUG_ON(!dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1383 | 	np = netdev_priv(dev); | 
 | 1384 |  | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1385 |         pci_free_consistent(pdev, STATUS_TOTAL_SIZE, np->tx_status, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1386 | 		np->tx_status_dma); | 
 | 1387 | 	pci_free_consistent(pdev, RX_TOTAL_SIZE, np->rx_ring, np->rx_ring_dma); | 
 | 1388 | 	pci_free_consistent(pdev, TX_TOTAL_SIZE, np->tx_ring, np->tx_ring_dma); | 
 | 1389 | 	unregister_netdev (dev); | 
 | 1390 |  | 
 | 1391 | 	pci_iounmap(pdev, np->base); | 
 | 1392 |  | 
 | 1393 | 	pci_release_regions (pdev); | 
 | 1394 |  | 
 | 1395 | 	free_netdev (dev); | 
 | 1396 | 	pci_set_drvdata(pdev, NULL); | 
 | 1397 | } | 
 | 1398 |  | 
 | 1399 |  | 
 | 1400 | static struct pci_driver yellowfin_driver = { | 
 | 1401 | 	.name		= DRV_NAME, | 
 | 1402 | 	.id_table	= yellowfin_pci_tbl, | 
 | 1403 | 	.probe		= yellowfin_init_one, | 
 | 1404 | 	.remove		= __devexit_p(yellowfin_remove_one), | 
 | 1405 | }; | 
 | 1406 |  | 
 | 1407 |  | 
 | 1408 | static int __init yellowfin_init (void) | 
 | 1409 | { | 
 | 1410 | /* when a module, this is printed whether or not devices are found in probe */ | 
 | 1411 | #ifdef MODULE | 
 | 1412 | 	printk(version); | 
 | 1413 | #endif | 
| Jeff Garzik | 2991762 | 2006-08-19 17:48:59 -0400 | [diff] [blame] | 1414 | 	return pci_register_driver(&yellowfin_driver); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1415 | } | 
 | 1416 |  | 
 | 1417 |  | 
 | 1418 | static void __exit yellowfin_cleanup (void) | 
 | 1419 | { | 
 | 1420 | 	pci_unregister_driver (&yellowfin_driver); | 
 | 1421 | } | 
 | 1422 |  | 
 | 1423 |  | 
 | 1424 | module_init(yellowfin_init); | 
 | 1425 | module_exit(yellowfin_cleanup); | 
| Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1426 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1427 | /* | 
 | 1428 |  * Local variables: | 
 | 1429 |  *  compile-command: "gcc -DMODULE -Wall -Wstrict-prototypes -O6 -c yellowfin.c" | 
 | 1430 |  *  compile-command-alphaLX: "gcc -DMODULE -Wall -Wstrict-prototypes -O2 -c yellowfin.c -fomit-frame-pointer -fno-strength-reduce -mno-fp-regs -Wa,-m21164a -DBWX_USABLE -DBWIO_ENABLED" | 
 | 1431 |  *  simple-compile-command: "gcc -DMODULE -O6 -c yellowfin.c" | 
 | 1432 |  *  c-indent-level: 4 | 
 | 1433 |  *  c-basic-offset: 4 | 
 | 1434 |  *  tab-width: 4 | 
 | 1435 |  * End: | 
 | 1436 |  */ |