starfire.c (62992B)
1/* starfire.c: Linux device driver for the Adaptec Starfire network adapter. */ 2/* 3 Written 1998-2000 by Donald Becker. 4 5 Current maintainer is Ion Badulescu <ionut ta badula tod org>. Please 6 send all bug reports to me, and not to Donald Becker, as this code 7 has been heavily modified from Donald's original version. 8 9 This software may be used and distributed according to the terms of 10 the GNU General Public License (GPL), incorporated herein by reference. 11 Drivers based on or derived from this code fall under the GPL and must 12 retain the authorship, copyright and license notice. This file is not 13 a complete program and may only be used when the entire operating 14 system is licensed under the GPL. 15 16 The information below comes from Donald Becker's original driver: 17 18 The author may be reached as becker@scyld.com, or C/O 19 Scyld Computing Corporation 20 410 Severn Ave., Suite 210 21 Annapolis MD 21403 22 23 Support and updates available at 24 http://www.scyld.com/network/starfire.html 25 [link no longer provides useful info -jgarzik] 26 27*/ 28 29#define DRV_NAME "starfire" 30 31#include <linux/interrupt.h> 32#include <linux/module.h> 33#include <linux/kernel.h> 34#include <linux/pci.h> 35#include <linux/netdevice.h> 36#include <linux/etherdevice.h> 37#include <linux/init.h> 38#include <linux/delay.h> 39#include <linux/crc32.h> 40#include <linux/ethtool.h> 41#include <linux/mii.h> 42#include <linux/if_vlan.h> 43#include <linux/mm.h> 44#include <linux/firmware.h> 45#include <asm/processor.h> /* Processor type for cache alignment. */ 46#include <linux/uaccess.h> 47#include <asm/io.h> 48 49/* 50 * The current frame processor firmware fails to checksum a fragment 51 * of length 1. If and when this is fixed, the #define below can be removed. 52 */ 53#define HAS_BROKEN_FIRMWARE 54 55/* 56 * If using the broken firmware, data must be padded to the next 32-bit boundary. 57 */ 58#ifdef HAS_BROKEN_FIRMWARE 59#define PADDING_MASK 3 60#endif 61 62/* 63 * Define this if using the driver with the zero-copy patch 64 */ 65#define ZEROCOPY 66 67#if IS_ENABLED(CONFIG_VLAN_8021Q) 68#define VLAN_SUPPORT 69#endif 70 71/* The user-configurable values. 72 These may be modified when a driver module is loaded.*/ 73 74/* Used for tuning interrupt latency vs. overhead. */ 75static int intr_latency; 76static int small_frames; 77 78static int debug = 1; /* 1 normal messages, 0 quiet .. 7 verbose. */ 79static int max_interrupt_work = 20; 80static int mtu; 81/* Maximum number of multicast addresses to filter (vs. rx-all-multicast). 82 The Starfire has a 512 element hash table based on the Ethernet CRC. */ 83static const int multicast_filter_limit = 512; 84/* Whether to do TCP/UDP checksums in hardware */ 85static int enable_hw_cksum = 1; 86 87#define PKT_BUF_SZ 1536 /* Size of each temporary Rx buffer.*/ 88/* 89 * Set the copy breakpoint for the copy-only-tiny-frames scheme. 90 * Setting to > 1518 effectively disables this feature. 91 * 92 * NOTE: 93 * The ia64 doesn't allow for unaligned loads even of integers being 94 * misaligned on a 2 byte boundary. Thus always force copying of 95 * packets as the starfire doesn't allow for misaligned DMAs ;-( 96 * 23/10/2000 - Jes 97 * 98 * The Alpha and the Sparc don't like unaligned loads, either. On Sparc64, 99 * at least, having unaligned frames leads to a rather serious performance 100 * penalty. -Ion 101 */ 102#if defined(__ia64__) || defined(__alpha__) || defined(__sparc__) 103static int rx_copybreak = PKT_BUF_SZ; 104#else 105static int rx_copybreak /* = 0 */; 106#endif 107 108/* PCI DMA burst size -- on sparc64 we want to force it to 64 bytes, on the others the default of 128 is fine. */ 109#ifdef __sparc__ 110#define DMA_BURST_SIZE 64 111#else 112#define DMA_BURST_SIZE 128 113#endif 114 115/* Operational parameters that are set at compile time. */ 116 117/* The "native" ring sizes are either 256 or 2048. 118 However in some modes a descriptor may be marked to wrap the ring earlier. 119*/ 120#define RX_RING_SIZE 256 121#define TX_RING_SIZE 32 122/* The completion queues are fixed at 1024 entries i.e. 4K or 8KB. */ 123#define DONE_Q_SIZE 1024 124/* All queues must be aligned on a 256-byte boundary */ 125#define QUEUE_ALIGN 256 126 127#if RX_RING_SIZE > 256 128#define RX_Q_ENTRIES Rx2048QEntries 129#else 130#define RX_Q_ENTRIES Rx256QEntries 131#endif 132 133/* Operational parameters that usually are not changed. */ 134/* Time in jiffies before concluding the transmitter is hung. */ 135#define TX_TIMEOUT (2 * HZ) 136 137#ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT 138/* 64-bit dma_addr_t */ 139#define ADDR_64BITS /* This chip uses 64 bit addresses. */ 140#define netdrv_addr_t __le64 141#define cpu_to_dma(x) cpu_to_le64(x) 142#define dma_to_cpu(x) le64_to_cpu(x) 143#define RX_DESC_Q_ADDR_SIZE RxDescQAddr64bit 144#define TX_DESC_Q_ADDR_SIZE TxDescQAddr64bit 145#define RX_COMPL_Q_ADDR_SIZE RxComplQAddr64bit 146#define TX_COMPL_Q_ADDR_SIZE TxComplQAddr64bit 147#define RX_DESC_ADDR_SIZE RxDescAddr64bit 148#else /* 32-bit dma_addr_t */ 149#define netdrv_addr_t __le32 150#define cpu_to_dma(x) cpu_to_le32(x) 151#define dma_to_cpu(x) le32_to_cpu(x) 152#define RX_DESC_Q_ADDR_SIZE RxDescQAddr32bit 153#define TX_DESC_Q_ADDR_SIZE TxDescQAddr32bit 154#define RX_COMPL_Q_ADDR_SIZE RxComplQAddr32bit 155#define TX_COMPL_Q_ADDR_SIZE TxComplQAddr32bit 156#define RX_DESC_ADDR_SIZE RxDescAddr32bit 157#endif 158 159#define skb_first_frag_len(skb) skb_headlen(skb) 160#define skb_num_frags(skb) (skb_shinfo(skb)->nr_frags + 1) 161 162/* Firmware names */ 163#define FIRMWARE_RX "adaptec/starfire_rx.bin" 164#define FIRMWARE_TX "adaptec/starfire_tx.bin" 165 166MODULE_AUTHOR("Donald Becker <becker@scyld.com>"); 167MODULE_DESCRIPTION("Adaptec Starfire Ethernet driver"); 168MODULE_LICENSE("GPL"); 169MODULE_FIRMWARE(FIRMWARE_RX); 170MODULE_FIRMWARE(FIRMWARE_TX); 171 172module_param(max_interrupt_work, int, 0); 173module_param(mtu, int, 0); 174module_param(debug, int, 0); 175module_param(rx_copybreak, int, 0); 176module_param(intr_latency, int, 0); 177module_param(small_frames, int, 0); 178module_param(enable_hw_cksum, int, 0); 179MODULE_PARM_DESC(max_interrupt_work, "Maximum events handled per interrupt"); 180MODULE_PARM_DESC(mtu, "MTU (all boards)"); 181MODULE_PARM_DESC(debug, "Debug level (0-6)"); 182MODULE_PARM_DESC(rx_copybreak, "Copy breakpoint for copy-only-tiny-frames"); 183MODULE_PARM_DESC(intr_latency, "Maximum interrupt latency, in microseconds"); 184MODULE_PARM_DESC(small_frames, "Maximum size of receive frames that bypass interrupt latency (0,64,128,256,512)"); 185MODULE_PARM_DESC(enable_hw_cksum, "Enable/disable hardware cksum support (0/1)"); 186 187/* 188 Theory of Operation 189 190I. Board Compatibility 191 192This driver is for the Adaptec 6915 "Starfire" 64 bit PCI Ethernet adapter. 193 194II. Board-specific settings 195 196III. Driver operation 197 198IIIa. Ring buffers 199 200The Starfire hardware uses multiple fixed-size descriptor queues/rings. The 201ring sizes are set fixed by the hardware, but may optionally be wrapped 202earlier by the END bit in the descriptor. 203This driver uses that hardware queue size for the Rx ring, where a large 204number of entries has no ill effect beyond increases the potential backlog. 205The Tx ring is wrapped with the END bit, since a large hardware Tx queue 206disables the queue layer priority ordering and we have no mechanism to 207utilize the hardware two-level priority queue. When modifying the 208RX/TX_RING_SIZE pay close attention to page sizes and the ring-empty warning 209levels. 210 211IIIb/c. Transmit/Receive Structure 212 213See the Adaptec manual for the many possible structures, and options for 214each structure. There are far too many to document all of them here. 215 216For transmit this driver uses type 0/1 transmit descriptors (depending 217on the 32/64 bitness of the architecture), and relies on automatic 218minimum-length padding. It does not use the completion queue 219consumer index, but instead checks for non-zero status entries. 220 221For receive this driver uses type 2/3 receive descriptors. The driver 222allocates full frame size skbuffs for the Rx ring buffers, so all frames 223should fit in a single descriptor. The driver does not use the completion 224queue consumer index, but instead checks for non-zero status entries. 225 226When an incoming frame is less than RX_COPYBREAK bytes long, a fresh skbuff 227is allocated and the frame is copied to the new skbuff. When the incoming 228frame is larger, the skbuff is passed directly up the protocol stack. 229Buffers consumed this way are replaced by newly allocated skbuffs in a later 230phase of receive. 231 232A notable aspect of operation is that unaligned buffers are not permitted by 233the Starfire hardware. Thus the IP header at offset 14 in an ethernet frame 234isn't longword aligned, which may cause problems on some machine 235e.g. Alphas and IA64. For these architectures, the driver is forced to copy 236the frame into a new skbuff unconditionally. Copied frames are put into the 237skbuff at an offset of "+2", thus 16-byte aligning the IP header. 238 239IIId. Synchronization 240 241The driver runs as two independent, single-threaded flows of control. One 242is the send-packet routine, which enforces single-threaded use by the 243dev->tbusy flag. The other thread is the interrupt handler, which is single 244threaded by the hardware and interrupt handling software. 245 246The send packet thread has partial control over the Tx ring and the netif_queue 247status. If the number of free Tx slots in the ring falls below a certain number 248(currently hardcoded to 4), it signals the upper layer to stop the queue. 249 250The interrupt handler has exclusive control over the Rx ring and records stats 251from the Tx ring. After reaping the stats, it marks the Tx queue entry as 252empty by incrementing the dirty_tx mark. Iff the netif_queue is stopped and the 253number of free Tx slow is above the threshold, it signals the upper layer to 254restart the queue. 255 256IV. Notes 257 258IVb. References 259 260The Adaptec Starfire manuals, available only from Adaptec. 261http://www.scyld.com/expert/100mbps.html 262http://www.scyld.com/expert/NWay.html 263 264IVc. Errata 265 266- StopOnPerr is broken, don't enable 267- Hardware ethernet padding exposes random data, perform software padding 268 instead (unverified -- works correctly for all the hardware I have) 269 270*/ 271 272 273 274enum chip_capability_flags {CanHaveMII=1, }; 275 276enum chipset { 277 CH_6915 = 0, 278}; 279 280static const struct pci_device_id starfire_pci_tbl[] = { 281 { PCI_VDEVICE(ADAPTEC, 0x6915), CH_6915 }, 282 { 0, } 283}; 284MODULE_DEVICE_TABLE(pci, starfire_pci_tbl); 285 286/* A chip capabilities table, matching the CH_xxx entries in xxx_pci_tbl[] above. */ 287static const struct chip_info { 288 const char *name; 289 int drv_flags; 290} netdrv_tbl[] = { 291 { "Adaptec Starfire 6915", CanHaveMII }, 292}; 293 294 295/* Offsets to the device registers. 296 Unlike software-only systems, device drivers interact with complex hardware. 297 It's not useful to define symbolic names for every register bit in the 298 device. The name can only partially document the semantics and make 299 the driver longer and more difficult to read. 300 In general, only the important configuration values or bits changed 301 multiple times should be defined symbolically. 302*/ 303enum register_offsets { 304 PCIDeviceConfig=0x50040, GenCtrl=0x50070, IntrTimerCtrl=0x50074, 305 IntrClear=0x50080, IntrStatus=0x50084, IntrEnable=0x50088, 306 MIICtrl=0x52000, TxStationAddr=0x50120, EEPROMCtrl=0x51000, 307 GPIOCtrl=0x5008C, TxDescCtrl=0x50090, 308 TxRingPtr=0x50098, HiPriTxRingPtr=0x50094, /* Low and High priority. */ 309 TxRingHiAddr=0x5009C, /* 64 bit address extension. */ 310 TxProducerIdx=0x500A0, TxConsumerIdx=0x500A4, 311 TxThreshold=0x500B0, 312 CompletionHiAddr=0x500B4, TxCompletionAddr=0x500B8, 313 RxCompletionAddr=0x500BC, RxCompletionQ2Addr=0x500C0, 314 CompletionQConsumerIdx=0x500C4, RxDMACtrl=0x500D0, 315 RxDescQCtrl=0x500D4, RxDescQHiAddr=0x500DC, RxDescQAddr=0x500E0, 316 RxDescQIdx=0x500E8, RxDMAStatus=0x500F0, RxFilterMode=0x500F4, 317 TxMode=0x55000, VlanType=0x55064, 318 PerfFilterTable=0x56000, HashTable=0x56100, 319 TxGfpMem=0x58000, RxGfpMem=0x5a000, 320}; 321 322/* 323 * Bits in the interrupt status/mask registers. 324 * Warning: setting Intr[Ab]NormalSummary in the IntrEnable register 325 * enables all the interrupt sources that are or'ed into those status bits. 326 */ 327enum intr_status_bits { 328 IntrLinkChange=0xf0000000, IntrStatsMax=0x08000000, 329 IntrAbnormalSummary=0x02000000, IntrGeneralTimer=0x01000000, 330 IntrSoftware=0x800000, IntrRxComplQ1Low=0x400000, 331 IntrTxComplQLow=0x200000, IntrPCI=0x100000, 332 IntrDMAErr=0x080000, IntrTxDataLow=0x040000, 333 IntrRxComplQ2Low=0x020000, IntrRxDescQ1Low=0x010000, 334 IntrNormalSummary=0x8000, IntrTxDone=0x4000, 335 IntrTxDMADone=0x2000, IntrTxEmpty=0x1000, 336 IntrEarlyRxQ2=0x0800, IntrEarlyRxQ1=0x0400, 337 IntrRxQ2Done=0x0200, IntrRxQ1Done=0x0100, 338 IntrRxGFPDead=0x80, IntrRxDescQ2Low=0x40, 339 IntrNoTxCsum=0x20, IntrTxBadID=0x10, 340 IntrHiPriTxBadID=0x08, IntrRxGfp=0x04, 341 IntrTxGfp=0x02, IntrPCIPad=0x01, 342 /* not quite bits */ 343 IntrRxDone=IntrRxQ2Done | IntrRxQ1Done, 344 IntrRxEmpty=IntrRxDescQ1Low | IntrRxDescQ2Low, 345 IntrNormalMask=0xff00, IntrAbnormalMask=0x3ff00fe, 346}; 347 348/* Bits in the RxFilterMode register. */ 349enum rx_mode_bits { 350 AcceptBroadcast=0x04, AcceptAllMulticast=0x02, AcceptAll=0x01, 351 AcceptMulticast=0x10, PerfectFilter=0x40, HashFilter=0x30, 352 PerfectFilterVlan=0x80, MinVLANPrio=0xE000, VlanMode=0x0200, 353 WakeupOnGFP=0x0800, 354}; 355 356/* Bits in the TxMode register */ 357enum tx_mode_bits { 358 MiiSoftReset=0x8000, MIILoopback=0x4000, 359 TxFlowEnable=0x0800, RxFlowEnable=0x0400, 360 PadEnable=0x04, FullDuplex=0x02, HugeFrame=0x01, 361}; 362 363/* Bits in the TxDescCtrl register. */ 364enum tx_ctrl_bits { 365 TxDescSpaceUnlim=0x00, TxDescSpace32=0x10, TxDescSpace64=0x20, 366 TxDescSpace128=0x30, TxDescSpace256=0x40, 367 TxDescType0=0x00, TxDescType1=0x01, TxDescType2=0x02, 368 TxDescType3=0x03, TxDescType4=0x04, 369 TxNoDMACompletion=0x08, 370 TxDescQAddr64bit=0x80, TxDescQAddr32bit=0, 371 TxHiPriFIFOThreshShift=24, TxPadLenShift=16, 372 TxDMABurstSizeShift=8, 373}; 374 375/* Bits in the RxDescQCtrl register. */ 376enum rx_ctrl_bits { 377 RxBufferLenShift=16, RxMinDescrThreshShift=0, 378 RxPrefetchMode=0x8000, RxVariableQ=0x2000, 379 Rx2048QEntries=0x4000, Rx256QEntries=0, 380 RxDescAddr64bit=0x1000, RxDescAddr32bit=0, 381 RxDescQAddr64bit=0x0100, RxDescQAddr32bit=0, 382 RxDescSpace4=0x000, RxDescSpace8=0x100, 383 RxDescSpace16=0x200, RxDescSpace32=0x300, 384 RxDescSpace64=0x400, RxDescSpace128=0x500, 385 RxConsumerWrEn=0x80, 386}; 387 388/* Bits in the RxDMACtrl register. */ 389enum rx_dmactrl_bits { 390 RxReportBadFrames=0x80000000, RxDMAShortFrames=0x40000000, 391 RxDMABadFrames=0x20000000, RxDMACrcErrorFrames=0x10000000, 392 RxDMAControlFrame=0x08000000, RxDMAPauseFrame=0x04000000, 393 RxChecksumIgnore=0, RxChecksumRejectTCPUDP=0x02000000, 394 RxChecksumRejectTCPOnly=0x01000000, 395 RxCompletionQ2Enable=0x800000, 396 RxDMAQ2Disable=0, RxDMAQ2FPOnly=0x100000, 397 RxDMAQ2SmallPkt=0x200000, RxDMAQ2HighPrio=0x300000, 398 RxDMAQ2NonIP=0x400000, 399 RxUseBackupQueue=0x080000, RxDMACRC=0x040000, 400 RxEarlyIntThreshShift=12, RxHighPrioThreshShift=8, 401 RxBurstSizeShift=0, 402}; 403 404/* Bits in the RxCompletionAddr register */ 405enum rx_compl_bits { 406 RxComplQAddr64bit=0x80, RxComplQAddr32bit=0, 407 RxComplProducerWrEn=0x40, 408 RxComplType0=0x00, RxComplType1=0x10, 409 RxComplType2=0x20, RxComplType3=0x30, 410 RxComplThreshShift=0, 411}; 412 413/* Bits in the TxCompletionAddr register */ 414enum tx_compl_bits { 415 TxComplQAddr64bit=0x80, TxComplQAddr32bit=0, 416 TxComplProducerWrEn=0x40, 417 TxComplIntrStatus=0x20, 418 CommonQueueMode=0x10, 419 TxComplThreshShift=0, 420}; 421 422/* Bits in the GenCtrl register */ 423enum gen_ctrl_bits { 424 RxEnable=0x05, TxEnable=0x0a, 425 RxGFPEnable=0x10, TxGFPEnable=0x20, 426}; 427 428/* Bits in the IntrTimerCtrl register */ 429enum intr_ctrl_bits { 430 Timer10X=0x800, EnableIntrMasking=0x60, SmallFrameBypass=0x100, 431 SmallFrame64=0, SmallFrame128=0x200, SmallFrame256=0x400, SmallFrame512=0x600, 432 IntrLatencyMask=0x1f, 433}; 434 435/* The Rx and Tx buffer descriptors. */ 436struct starfire_rx_desc { 437 netdrv_addr_t rxaddr; 438}; 439enum rx_desc_bits { 440 RxDescValid=1, RxDescEndRing=2, 441}; 442 443/* Completion queue entry. */ 444struct short_rx_done_desc { 445 __le32 status; /* Low 16 bits is length. */ 446}; 447struct basic_rx_done_desc { 448 __le32 status; /* Low 16 bits is length. */ 449 __le16 vlanid; 450 __le16 status2; 451}; 452struct csum_rx_done_desc { 453 __le32 status; /* Low 16 bits is length. */ 454 __le16 csum; /* Partial checksum */ 455 __le16 status2; 456}; 457struct full_rx_done_desc { 458 __le32 status; /* Low 16 bits is length. */ 459 __le16 status3; 460 __le16 status2; 461 __le16 vlanid; 462 __le16 csum; /* partial checksum */ 463 __le32 timestamp; 464}; 465/* XXX: this is ugly and I'm not sure it's worth the trouble -Ion */ 466#ifdef VLAN_SUPPORT 467typedef struct full_rx_done_desc rx_done_desc; 468#define RxComplType RxComplType3 469#else /* not VLAN_SUPPORT */ 470typedef struct csum_rx_done_desc rx_done_desc; 471#define RxComplType RxComplType2 472#endif /* not VLAN_SUPPORT */ 473 474enum rx_done_bits { 475 RxOK=0x20000000, RxFIFOErr=0x10000000, RxBufQ2=0x08000000, 476}; 477 478/* Type 1 Tx descriptor. */ 479struct starfire_tx_desc_1 { 480 __le32 status; /* Upper bits are status, lower 16 length. */ 481 __le32 addr; 482}; 483 484/* Type 2 Tx descriptor. */ 485struct starfire_tx_desc_2 { 486 __le32 status; /* Upper bits are status, lower 16 length. */ 487 __le32 reserved; 488 __le64 addr; 489}; 490 491#ifdef ADDR_64BITS 492typedef struct starfire_tx_desc_2 starfire_tx_desc; 493#define TX_DESC_TYPE TxDescType2 494#else /* not ADDR_64BITS */ 495typedef struct starfire_tx_desc_1 starfire_tx_desc; 496#define TX_DESC_TYPE TxDescType1 497#endif /* not ADDR_64BITS */ 498#define TX_DESC_SPACING TxDescSpaceUnlim 499 500enum tx_desc_bits { 501 TxDescID=0xB0000000, 502 TxCRCEn=0x01000000, TxDescIntr=0x08000000, 503 TxRingWrap=0x04000000, TxCalTCP=0x02000000, 504}; 505struct tx_done_desc { 506 __le32 status; /* timestamp, index. */ 507#if 0 508 __le32 intrstatus; /* interrupt status */ 509#endif 510}; 511 512struct rx_ring_info { 513 struct sk_buff *skb; 514 dma_addr_t mapping; 515}; 516struct tx_ring_info { 517 struct sk_buff *skb; 518 dma_addr_t mapping; 519 unsigned int used_slots; 520}; 521 522#define PHY_CNT 2 523struct netdev_private { 524 /* Descriptor rings first for alignment. */ 525 struct starfire_rx_desc *rx_ring; 526 starfire_tx_desc *tx_ring; 527 dma_addr_t rx_ring_dma; 528 dma_addr_t tx_ring_dma; 529 /* The addresses of rx/tx-in-place skbuffs. */ 530 struct rx_ring_info rx_info[RX_RING_SIZE]; 531 struct tx_ring_info tx_info[TX_RING_SIZE]; 532 /* Pointers to completion queues (full pages). */ 533 rx_done_desc *rx_done_q; 534 dma_addr_t rx_done_q_dma; 535 unsigned int rx_done; 536 struct tx_done_desc *tx_done_q; 537 dma_addr_t tx_done_q_dma; 538 unsigned int tx_done; 539 struct napi_struct napi; 540 struct net_device *dev; 541 struct pci_dev *pci_dev; 542#ifdef VLAN_SUPPORT 543 unsigned long active_vlans[BITS_TO_LONGS(VLAN_N_VID)]; 544#endif 545 void *queue_mem; 546 dma_addr_t queue_mem_dma; 547 size_t queue_mem_size; 548 549 /* Frequently used values: keep some adjacent for cache effect. */ 550 spinlock_t lock; 551 unsigned int cur_rx, dirty_rx; /* Producer/consumer ring indices */ 552 unsigned int cur_tx, dirty_tx, reap_tx; 553 unsigned int rx_buf_sz; /* Based on MTU+slack. */ 554 /* These values keep track of the transceiver/media in use. */ 555 int speed100; /* Set if speed == 100MBit. */ 556 u32 tx_mode; 557 u32 intr_timer_ctrl; 558 u8 tx_threshold; 559 /* MII transceiver section. */ 560 struct mii_if_info mii_if; /* MII lib hooks/info */ 561 int phy_cnt; /* MII device addresses. */ 562 unsigned char phys[PHY_CNT]; /* MII device addresses. */ 563 void __iomem *base; 564}; 565 566 567static int mdio_read(struct net_device *dev, int phy_id, int location); 568static void mdio_write(struct net_device *dev, int phy_id, int location, int value); 569static int netdev_open(struct net_device *dev); 570static void check_duplex(struct net_device *dev); 571static void tx_timeout(struct net_device *dev, unsigned int txqueue); 572static void init_ring(struct net_device *dev); 573static netdev_tx_t start_tx(struct sk_buff *skb, struct net_device *dev); 574static irqreturn_t intr_handler(int irq, void *dev_instance); 575static void netdev_error(struct net_device *dev, int intr_status); 576static int __netdev_rx(struct net_device *dev, int *quota); 577static int netdev_poll(struct napi_struct *napi, int budget); 578static void refill_rx_ring(struct net_device *dev); 579static void netdev_error(struct net_device *dev, int intr_status); 580static void set_rx_mode(struct net_device *dev); 581static struct net_device_stats *get_stats(struct net_device *dev); 582static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); 583static int netdev_close(struct net_device *dev); 584static void netdev_media_change(struct net_device *dev); 585static const struct ethtool_ops ethtool_ops; 586 587 588#ifdef VLAN_SUPPORT 589static int netdev_vlan_rx_add_vid(struct net_device *dev, 590 __be16 proto, u16 vid) 591{ 592 struct netdev_private *np = netdev_priv(dev); 593 594 spin_lock(&np->lock); 595 if (debug > 1) 596 printk("%s: Adding vlanid %d to vlan filter\n", dev->name, vid); 597 set_bit(vid, np->active_vlans); 598 set_rx_mode(dev); 599 spin_unlock(&np->lock); 600 601 return 0; 602} 603 604static int netdev_vlan_rx_kill_vid(struct net_device *dev, 605 __be16 proto, u16 vid) 606{ 607 struct netdev_private *np = netdev_priv(dev); 608 609 spin_lock(&np->lock); 610 if (debug > 1) 611 printk("%s: removing vlanid %d from vlan filter\n", dev->name, vid); 612 clear_bit(vid, np->active_vlans); 613 set_rx_mode(dev); 614 spin_unlock(&np->lock); 615 616 return 0; 617} 618#endif /* VLAN_SUPPORT */ 619 620 621static const struct net_device_ops netdev_ops = { 622 .ndo_open = netdev_open, 623 .ndo_stop = netdev_close, 624 .ndo_start_xmit = start_tx, 625 .ndo_tx_timeout = tx_timeout, 626 .ndo_get_stats = get_stats, 627 .ndo_set_rx_mode = set_rx_mode, 628 .ndo_eth_ioctl = netdev_ioctl, 629 .ndo_set_mac_address = eth_mac_addr, 630 .ndo_validate_addr = eth_validate_addr, 631#ifdef VLAN_SUPPORT 632 .ndo_vlan_rx_add_vid = netdev_vlan_rx_add_vid, 633 .ndo_vlan_rx_kill_vid = netdev_vlan_rx_kill_vid, 634#endif 635}; 636 637static int starfire_init_one(struct pci_dev *pdev, 638 const struct pci_device_id *ent) 639{ 640 struct device *d = &pdev->dev; 641 struct netdev_private *np; 642 int i, irq, chip_idx = ent->driver_data; 643 struct net_device *dev; 644 u8 addr[ETH_ALEN]; 645 long ioaddr; 646 void __iomem *base; 647 int drv_flags, io_size; 648 int boguscnt; 649 650 if (pci_enable_device (pdev)) 651 return -EIO; 652 653 ioaddr = pci_resource_start(pdev, 0); 654 io_size = pci_resource_len(pdev, 0); 655 if (!ioaddr || ((pci_resource_flags(pdev, 0) & IORESOURCE_MEM) == 0)) { 656 dev_err(d, "no PCI MEM resources, aborting\n"); 657 return -ENODEV; 658 } 659 660 dev = alloc_etherdev(sizeof(*np)); 661 if (!dev) 662 return -ENOMEM; 663 664 SET_NETDEV_DEV(dev, &pdev->dev); 665 666 irq = pdev->irq; 667 668 if (pci_request_regions (pdev, DRV_NAME)) { 669 dev_err(d, "cannot reserve PCI resources, aborting\n"); 670 goto err_out_free_netdev; 671 } 672 673 base = ioremap(ioaddr, io_size); 674 if (!base) { 675 dev_err(d, "cannot remap %#x @ %#lx, aborting\n", 676 io_size, ioaddr); 677 goto err_out_free_res; 678 } 679 680 pci_set_master(pdev); 681 682 /* enable MWI -- it vastly improves Rx performance on sparc64 */ 683 pci_try_set_mwi(pdev); 684 685#ifdef ZEROCOPY 686 /* Starfire can do TCP/UDP checksumming */ 687 if (enable_hw_cksum) 688 dev->features |= NETIF_F_IP_CSUM | NETIF_F_SG; 689#endif /* ZEROCOPY */ 690 691#ifdef VLAN_SUPPORT 692 dev->features |= NETIF_F_HW_VLAN_CTAG_RX | NETIF_F_HW_VLAN_CTAG_FILTER; 693#endif /* VLAN_RX_KILL_VID */ 694#ifdef ADDR_64BITS 695 dev->features |= NETIF_F_HIGHDMA; 696#endif /* ADDR_64BITS */ 697 698 /* Serial EEPROM reads are hidden by the hardware. */ 699 for (i = 0; i < 6; i++) 700 addr[i] = readb(base + EEPROMCtrl + 20 - i); 701 eth_hw_addr_set(dev, addr); 702 703#if ! defined(final_version) /* Dump the EEPROM contents during development. */ 704 if (debug > 4) 705 for (i = 0; i < 0x20; i++) 706 printk("%2.2x%s", 707 (unsigned int)readb(base + EEPROMCtrl + i), 708 i % 16 != 15 ? " " : "\n"); 709#endif 710 711 /* Issue soft reset */ 712 writel(MiiSoftReset, base + TxMode); 713 udelay(1000); 714 writel(0, base + TxMode); 715 716 /* Reset the chip to erase previous misconfiguration. */ 717 writel(1, base + PCIDeviceConfig); 718 boguscnt = 1000; 719 while (--boguscnt > 0) { 720 udelay(10); 721 if ((readl(base + PCIDeviceConfig) & 1) == 0) 722 break; 723 } 724 if (boguscnt == 0) 725 printk("%s: chipset reset never completed!\n", dev->name); 726 /* wait a little longer */ 727 udelay(1000); 728 729 np = netdev_priv(dev); 730 np->dev = dev; 731 np->base = base; 732 spin_lock_init(&np->lock); 733 pci_set_drvdata(pdev, dev); 734 735 np->pci_dev = pdev; 736 737 np->mii_if.dev = dev; 738 np->mii_if.mdio_read = mdio_read; 739 np->mii_if.mdio_write = mdio_write; 740 np->mii_if.phy_id_mask = 0x1f; 741 np->mii_if.reg_num_mask = 0x1f; 742 743 drv_flags = netdrv_tbl[chip_idx].drv_flags; 744 745 np->speed100 = 1; 746 747 /* timer resolution is 128 * 0.8us */ 748 np->intr_timer_ctrl = (((intr_latency * 10) / 1024) & IntrLatencyMask) | 749 Timer10X | EnableIntrMasking; 750 751 if (small_frames > 0) { 752 np->intr_timer_ctrl |= SmallFrameBypass; 753 switch (small_frames) { 754 case 1 ... 64: 755 np->intr_timer_ctrl |= SmallFrame64; 756 break; 757 case 65 ... 128: 758 np->intr_timer_ctrl |= SmallFrame128; 759 break; 760 case 129 ... 256: 761 np->intr_timer_ctrl |= SmallFrame256; 762 break; 763 default: 764 np->intr_timer_ctrl |= SmallFrame512; 765 if (small_frames > 512) 766 printk("Adjusting small_frames down to 512\n"); 767 break; 768 } 769 } 770 771 dev->netdev_ops = &netdev_ops; 772 dev->watchdog_timeo = TX_TIMEOUT; 773 dev->ethtool_ops = ðtool_ops; 774 775 netif_napi_add_weight(dev, &np->napi, netdev_poll, max_interrupt_work); 776 777 if (mtu) 778 dev->mtu = mtu; 779 780 if (register_netdev(dev)) 781 goto err_out_cleardev; 782 783 printk(KERN_INFO "%s: %s at %p, %pM, IRQ %d.\n", 784 dev->name, netdrv_tbl[chip_idx].name, base, 785 dev->dev_addr, irq); 786 787 if (drv_flags & CanHaveMII) { 788 int phy, phy_idx = 0; 789 int mii_status; 790 for (phy = 0; phy < 32 && phy_idx < PHY_CNT; phy++) { 791 mdio_write(dev, phy, MII_BMCR, BMCR_RESET); 792 msleep(100); 793 boguscnt = 1000; 794 while (--boguscnt > 0) 795 if ((mdio_read(dev, phy, MII_BMCR) & BMCR_RESET) == 0) 796 break; 797 if (boguscnt == 0) { 798 printk("%s: PHY#%d reset never completed!\n", dev->name, phy); 799 continue; 800 } 801 mii_status = mdio_read(dev, phy, MII_BMSR); 802 if (mii_status != 0) { 803 np->phys[phy_idx++] = phy; 804 np->mii_if.advertising = mdio_read(dev, phy, MII_ADVERTISE); 805 printk(KERN_INFO "%s: MII PHY found at address %d, status " 806 "%#4.4x advertising %#4.4x.\n", 807 dev->name, phy, mii_status, np->mii_if.advertising); 808 /* there can be only one PHY on-board */ 809 break; 810 } 811 } 812 np->phy_cnt = phy_idx; 813 if (np->phy_cnt > 0) 814 np->mii_if.phy_id = np->phys[0]; 815 else 816 memset(&np->mii_if, 0, sizeof(np->mii_if)); 817 } 818 819 printk(KERN_INFO "%s: scatter-gather and hardware TCP cksumming %s.\n", 820 dev->name, enable_hw_cksum ? "enabled" : "disabled"); 821 return 0; 822 823err_out_cleardev: 824 iounmap(base); 825err_out_free_res: 826 pci_release_regions (pdev); 827err_out_free_netdev: 828 free_netdev(dev); 829 return -ENODEV; 830} 831 832 833/* Read the MII Management Data I/O (MDIO) interfaces. */ 834static int mdio_read(struct net_device *dev, int phy_id, int location) 835{ 836 struct netdev_private *np = netdev_priv(dev); 837 void __iomem *mdio_addr = np->base + MIICtrl + (phy_id<<7) + (location<<2); 838 int result, boguscnt=1000; 839 /* ??? Should we add a busy-wait here? */ 840 do { 841 result = readl(mdio_addr); 842 } while ((result & 0xC0000000) != 0x80000000 && --boguscnt > 0); 843 if (boguscnt == 0) 844 return 0; 845 if ((result & 0xffff) == 0xffff) 846 return 0; 847 return result & 0xffff; 848} 849 850 851static void mdio_write(struct net_device *dev, int phy_id, int location, int value) 852{ 853 struct netdev_private *np = netdev_priv(dev); 854 void __iomem *mdio_addr = np->base + MIICtrl + (phy_id<<7) + (location<<2); 855 writel(value, mdio_addr); 856 /* The busy-wait will occur before a read. */ 857} 858 859 860static int netdev_open(struct net_device *dev) 861{ 862 const struct firmware *fw_rx, *fw_tx; 863 const __be32 *fw_rx_data, *fw_tx_data; 864 struct netdev_private *np = netdev_priv(dev); 865 void __iomem *ioaddr = np->base; 866 const int irq = np->pci_dev->irq; 867 int i, retval; 868 size_t tx_size, rx_size; 869 size_t tx_done_q_size, rx_done_q_size, tx_ring_size, rx_ring_size; 870 871 /* Do we ever need to reset the chip??? */ 872 873 retval = request_irq(irq, intr_handler, IRQF_SHARED, dev->name, dev); 874 if (retval) 875 return retval; 876 877 /* Disable the Rx and Tx, and reset the chip. */ 878 writel(0, ioaddr + GenCtrl); 879 writel(1, ioaddr + PCIDeviceConfig); 880 if (debug > 1) 881 printk(KERN_DEBUG "%s: netdev_open() irq %d.\n", 882 dev->name, irq); 883 884 /* Allocate the various queues. */ 885 if (!np->queue_mem) { 886 tx_done_q_size = ((sizeof(struct tx_done_desc) * DONE_Q_SIZE + QUEUE_ALIGN - 1) / QUEUE_ALIGN) * QUEUE_ALIGN; 887 rx_done_q_size = ((sizeof(rx_done_desc) * DONE_Q_SIZE + QUEUE_ALIGN - 1) / QUEUE_ALIGN) * QUEUE_ALIGN; 888 tx_ring_size = ((sizeof(starfire_tx_desc) * TX_RING_SIZE + QUEUE_ALIGN - 1) / QUEUE_ALIGN) * QUEUE_ALIGN; 889 rx_ring_size = sizeof(struct starfire_rx_desc) * RX_RING_SIZE; 890 np->queue_mem_size = tx_done_q_size + rx_done_q_size + tx_ring_size + rx_ring_size; 891 np->queue_mem = dma_alloc_coherent(&np->pci_dev->dev, 892 np->queue_mem_size, 893 &np->queue_mem_dma, GFP_ATOMIC); 894 if (np->queue_mem == NULL) { 895 free_irq(irq, dev); 896 return -ENOMEM; 897 } 898 899 np->tx_done_q = np->queue_mem; 900 np->tx_done_q_dma = np->queue_mem_dma; 901 np->rx_done_q = (void *) np->tx_done_q + tx_done_q_size; 902 np->rx_done_q_dma = np->tx_done_q_dma + tx_done_q_size; 903 np->tx_ring = (void *) np->rx_done_q + rx_done_q_size; 904 np->tx_ring_dma = np->rx_done_q_dma + rx_done_q_size; 905 np->rx_ring = (void *) np->tx_ring + tx_ring_size; 906 np->rx_ring_dma = np->tx_ring_dma + tx_ring_size; 907 } 908 909 /* Start with no carrier, it gets adjusted later */ 910 netif_carrier_off(dev); 911 init_ring(dev); 912 /* Set the size of the Rx buffers. */ 913 writel((np->rx_buf_sz << RxBufferLenShift) | 914 (0 << RxMinDescrThreshShift) | 915 RxPrefetchMode | RxVariableQ | 916 RX_Q_ENTRIES | 917 RX_DESC_Q_ADDR_SIZE | RX_DESC_ADDR_SIZE | 918 RxDescSpace4, 919 ioaddr + RxDescQCtrl); 920 921 /* Set up the Rx DMA controller. */ 922 writel(RxChecksumIgnore | 923 (0 << RxEarlyIntThreshShift) | 924 (6 << RxHighPrioThreshShift) | 925 ((DMA_BURST_SIZE / 32) << RxBurstSizeShift), 926 ioaddr + RxDMACtrl); 927 928 /* Set Tx descriptor */ 929 writel((2 << TxHiPriFIFOThreshShift) | 930 (0 << TxPadLenShift) | 931 ((DMA_BURST_SIZE / 32) << TxDMABurstSizeShift) | 932 TX_DESC_Q_ADDR_SIZE | 933 TX_DESC_SPACING | TX_DESC_TYPE, 934 ioaddr + TxDescCtrl); 935 936 writel( (np->queue_mem_dma >> 16) >> 16, ioaddr + RxDescQHiAddr); 937 writel( (np->queue_mem_dma >> 16) >> 16, ioaddr + TxRingHiAddr); 938 writel( (np->queue_mem_dma >> 16) >> 16, ioaddr + CompletionHiAddr); 939 writel(np->rx_ring_dma, ioaddr + RxDescQAddr); 940 writel(np->tx_ring_dma, ioaddr + TxRingPtr); 941 942 writel(np->tx_done_q_dma, ioaddr + TxCompletionAddr); 943 writel(np->rx_done_q_dma | 944 RxComplType | 945 (0 << RxComplThreshShift), 946 ioaddr + RxCompletionAddr); 947 948 if (debug > 1) 949 printk(KERN_DEBUG "%s: Filling in the station address.\n", dev->name); 950 951 /* Fill both the Tx SA register and the Rx perfect filter. */ 952 for (i = 0; i < 6; i++) 953 writeb(dev->dev_addr[i], ioaddr + TxStationAddr + 5 - i); 954 /* The first entry is special because it bypasses the VLAN filter. 955 Don't use it. */ 956 writew(0, ioaddr + PerfFilterTable); 957 writew(0, ioaddr + PerfFilterTable + 4); 958 writew(0, ioaddr + PerfFilterTable + 8); 959 for (i = 1; i < 16; i++) { 960 const __be16 *eaddrs = (const __be16 *)dev->dev_addr; 961 void __iomem *setup_frm = ioaddr + PerfFilterTable + i * 16; 962 writew(be16_to_cpu(eaddrs[2]), setup_frm); setup_frm += 4; 963 writew(be16_to_cpu(eaddrs[1]), setup_frm); setup_frm += 4; 964 writew(be16_to_cpu(eaddrs[0]), setup_frm); setup_frm += 8; 965 } 966 967 /* Initialize other registers. */ 968 /* Configure the PCI bus bursts and FIFO thresholds. */ 969 np->tx_mode = TxFlowEnable|RxFlowEnable|PadEnable; /* modified when link is up. */ 970 writel(MiiSoftReset | np->tx_mode, ioaddr + TxMode); 971 udelay(1000); 972 writel(np->tx_mode, ioaddr + TxMode); 973 np->tx_threshold = 4; 974 writel(np->tx_threshold, ioaddr + TxThreshold); 975 976 writel(np->intr_timer_ctrl, ioaddr + IntrTimerCtrl); 977 978 napi_enable(&np->napi); 979 980 netif_start_queue(dev); 981 982 if (debug > 1) 983 printk(KERN_DEBUG "%s: Setting the Rx and Tx modes.\n", dev->name); 984 set_rx_mode(dev); 985 986 np->mii_if.advertising = mdio_read(dev, np->phys[0], MII_ADVERTISE); 987 check_duplex(dev); 988 989 /* Enable GPIO interrupts on link change */ 990 writel(0x0f00ff00, ioaddr + GPIOCtrl); 991 992 /* Set the interrupt mask */ 993 writel(IntrRxDone | IntrRxEmpty | IntrDMAErr | 994 IntrTxDMADone | IntrStatsMax | IntrLinkChange | 995 IntrRxGFPDead | IntrNoTxCsum | IntrTxBadID, 996 ioaddr + IntrEnable); 997 /* Enable PCI interrupts. */ 998 writel(0x00800000 | readl(ioaddr + PCIDeviceConfig), 999 ioaddr + PCIDeviceConfig); 1000 1001#ifdef VLAN_SUPPORT 1002 /* Set VLAN type to 802.1q */ 1003 writel(ETH_P_8021Q, ioaddr + VlanType); 1004#endif /* VLAN_SUPPORT */ 1005 1006 retval = request_firmware(&fw_rx, FIRMWARE_RX, &np->pci_dev->dev); 1007 if (retval) { 1008 printk(KERN_ERR "starfire: Failed to load firmware \"%s\"\n", 1009 FIRMWARE_RX); 1010 goto out_init; 1011 } 1012 if (fw_rx->size % 4) { 1013 printk(KERN_ERR "starfire: bogus length %zu in \"%s\"\n", 1014 fw_rx->size, FIRMWARE_RX); 1015 retval = -EINVAL; 1016 goto out_rx; 1017 } 1018 retval = request_firmware(&fw_tx, FIRMWARE_TX, &np->pci_dev->dev); 1019 if (retval) { 1020 printk(KERN_ERR "starfire: Failed to load firmware \"%s\"\n", 1021 FIRMWARE_TX); 1022 goto out_rx; 1023 } 1024 if (fw_tx->size % 4) { 1025 printk(KERN_ERR "starfire: bogus length %zu in \"%s\"\n", 1026 fw_tx->size, FIRMWARE_TX); 1027 retval = -EINVAL; 1028 goto out_tx; 1029 } 1030 fw_rx_data = (const __be32 *)&fw_rx->data[0]; 1031 fw_tx_data = (const __be32 *)&fw_tx->data[0]; 1032 rx_size = fw_rx->size / 4; 1033 tx_size = fw_tx->size / 4; 1034 1035 /* Load Rx/Tx firmware into the frame processors */ 1036 for (i = 0; i < rx_size; i++) 1037 writel(be32_to_cpup(&fw_rx_data[i]), ioaddr + RxGfpMem + i * 4); 1038 for (i = 0; i < tx_size; i++) 1039 writel(be32_to_cpup(&fw_tx_data[i]), ioaddr + TxGfpMem + i * 4); 1040 if (enable_hw_cksum) 1041 /* Enable the Rx and Tx units, and the Rx/Tx frame processors. */ 1042 writel(TxEnable|TxGFPEnable|RxEnable|RxGFPEnable, ioaddr + GenCtrl); 1043 else 1044 /* Enable the Rx and Tx units only. */ 1045 writel(TxEnable|RxEnable, ioaddr + GenCtrl); 1046 1047 if (debug > 1) 1048 printk(KERN_DEBUG "%s: Done netdev_open().\n", 1049 dev->name); 1050 1051out_tx: 1052 release_firmware(fw_tx); 1053out_rx: 1054 release_firmware(fw_rx); 1055out_init: 1056 if (retval) 1057 netdev_close(dev); 1058 return retval; 1059} 1060 1061 1062static void check_duplex(struct net_device *dev) 1063{ 1064 struct netdev_private *np = netdev_priv(dev); 1065 u16 reg0; 1066 int silly_count = 1000; 1067 1068 mdio_write(dev, np->phys[0], MII_ADVERTISE, np->mii_if.advertising); 1069 mdio_write(dev, np->phys[0], MII_BMCR, BMCR_RESET); 1070 udelay(500); 1071 while (--silly_count && mdio_read(dev, np->phys[0], MII_BMCR) & BMCR_RESET) 1072 /* do nothing */; 1073 if (!silly_count) { 1074 printk("%s: MII reset failed!\n", dev->name); 1075 return; 1076 } 1077 1078 reg0 = mdio_read(dev, np->phys[0], MII_BMCR); 1079 1080 if (!np->mii_if.force_media) { 1081 reg0 |= BMCR_ANENABLE | BMCR_ANRESTART; 1082 } else { 1083 reg0 &= ~(BMCR_ANENABLE | BMCR_ANRESTART); 1084 if (np->speed100) 1085 reg0 |= BMCR_SPEED100; 1086 if (np->mii_if.full_duplex) 1087 reg0 |= BMCR_FULLDPLX; 1088 printk(KERN_DEBUG "%s: Link forced to %sMbit %s-duplex\n", 1089 dev->name, 1090 np->speed100 ? "100" : "10", 1091 np->mii_if.full_duplex ? "full" : "half"); 1092 } 1093 mdio_write(dev, np->phys[0], MII_BMCR, reg0); 1094} 1095 1096 1097static void tx_timeout(struct net_device *dev, unsigned int txqueue) 1098{ 1099 struct netdev_private *np = netdev_priv(dev); 1100 void __iomem *ioaddr = np->base; 1101 int old_debug; 1102 1103 printk(KERN_WARNING "%s: Transmit timed out, status %#8.8x, " 1104 "resetting...\n", dev->name, (int) readl(ioaddr + IntrStatus)); 1105 1106 /* Perhaps we should reinitialize the hardware here. */ 1107 1108 /* 1109 * Stop and restart the interface. 1110 * Cheat and increase the debug level temporarily. 1111 */ 1112 old_debug = debug; 1113 debug = 2; 1114 netdev_close(dev); 1115 netdev_open(dev); 1116 debug = old_debug; 1117 1118 /* Trigger an immediate transmit demand. */ 1119 1120 netif_trans_update(dev); /* prevent tx timeout */ 1121 dev->stats.tx_errors++; 1122 netif_wake_queue(dev); 1123} 1124 1125 1126/* Initialize the Rx and Tx rings, along with various 'dev' bits. */ 1127static void init_ring(struct net_device *dev) 1128{ 1129 struct netdev_private *np = netdev_priv(dev); 1130 int i; 1131 1132 np->cur_rx = np->cur_tx = np->reap_tx = 0; 1133 np->dirty_rx = np->dirty_tx = np->rx_done = np->tx_done = 0; 1134 1135 np->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32); 1136 1137 /* Fill in the Rx buffers. Handle allocation failure gracefully. */ 1138 for (i = 0; i < RX_RING_SIZE; i++) { 1139 struct sk_buff *skb = netdev_alloc_skb(dev, np->rx_buf_sz); 1140 np->rx_info[i].skb = skb; 1141 if (skb == NULL) 1142 break; 1143 np->rx_info[i].mapping = dma_map_single(&np->pci_dev->dev, 1144 skb->data, 1145 np->rx_buf_sz, 1146 DMA_FROM_DEVICE); 1147 if (dma_mapping_error(&np->pci_dev->dev, np->rx_info[i].mapping)) { 1148 dev_kfree_skb(skb); 1149 np->rx_info[i].skb = NULL; 1150 break; 1151 } 1152 /* Grrr, we cannot offset to correctly align the IP header. */ 1153 np->rx_ring[i].rxaddr = cpu_to_dma(np->rx_info[i].mapping | RxDescValid); 1154 } 1155 writew(i - 1, np->base + RxDescQIdx); 1156 np->dirty_rx = (unsigned int)(i - RX_RING_SIZE); 1157 1158 /* Clear the remainder of the Rx buffer ring. */ 1159 for ( ; i < RX_RING_SIZE; i++) { 1160 np->rx_ring[i].rxaddr = 0; 1161 np->rx_info[i].skb = NULL; 1162 np->rx_info[i].mapping = 0; 1163 } 1164 /* Mark the last entry as wrapping the ring. */ 1165 np->rx_ring[RX_RING_SIZE - 1].rxaddr |= cpu_to_dma(RxDescEndRing); 1166 1167 /* Clear the completion rings. */ 1168 for (i = 0; i < DONE_Q_SIZE; i++) { 1169 np->rx_done_q[i].status = 0; 1170 np->tx_done_q[i].status = 0; 1171 } 1172 1173 for (i = 0; i < TX_RING_SIZE; i++) 1174 memset(&np->tx_info[i], 0, sizeof(np->tx_info[i])); 1175} 1176 1177 1178static netdev_tx_t start_tx(struct sk_buff *skb, struct net_device *dev) 1179{ 1180 struct netdev_private *np = netdev_priv(dev); 1181 unsigned int entry; 1182 unsigned int prev_tx; 1183 u32 status; 1184 int i, j; 1185 1186 /* 1187 * be cautious here, wrapping the queue has weird semantics 1188 * and we may not have enough slots even when it seems we do. 1189 */ 1190 if ((np->cur_tx - np->dirty_tx) + skb_num_frags(skb) * 2 > TX_RING_SIZE) { 1191 netif_stop_queue(dev); 1192 return NETDEV_TX_BUSY; 1193 } 1194 1195#if defined(ZEROCOPY) && defined(HAS_BROKEN_FIRMWARE) 1196 if (skb->ip_summed == CHECKSUM_PARTIAL) { 1197 if (skb_padto(skb, (skb->len + PADDING_MASK) & ~PADDING_MASK)) 1198 return NETDEV_TX_OK; 1199 } 1200#endif /* ZEROCOPY && HAS_BROKEN_FIRMWARE */ 1201 1202 prev_tx = np->cur_tx; 1203 entry = np->cur_tx % TX_RING_SIZE; 1204 for (i = 0; i < skb_num_frags(skb); i++) { 1205 int wrap_ring = 0; 1206 status = TxDescID; 1207 1208 if (i == 0) { 1209 np->tx_info[entry].skb = skb; 1210 status |= TxCRCEn; 1211 if (entry >= TX_RING_SIZE - skb_num_frags(skb)) { 1212 status |= TxRingWrap; 1213 wrap_ring = 1; 1214 } 1215 if (np->reap_tx) { 1216 status |= TxDescIntr; 1217 np->reap_tx = 0; 1218 } 1219 if (skb->ip_summed == CHECKSUM_PARTIAL) { 1220 status |= TxCalTCP; 1221 dev->stats.tx_compressed++; 1222 } 1223 status |= skb_first_frag_len(skb) | (skb_num_frags(skb) << 16); 1224 1225 np->tx_info[entry].mapping = 1226 dma_map_single(&np->pci_dev->dev, skb->data, 1227 skb_first_frag_len(skb), 1228 DMA_TO_DEVICE); 1229 } else { 1230 const skb_frag_t *this_frag = &skb_shinfo(skb)->frags[i - 1]; 1231 status |= skb_frag_size(this_frag); 1232 np->tx_info[entry].mapping = 1233 dma_map_single(&np->pci_dev->dev, 1234 skb_frag_address(this_frag), 1235 skb_frag_size(this_frag), 1236 DMA_TO_DEVICE); 1237 } 1238 if (dma_mapping_error(&np->pci_dev->dev, np->tx_info[entry].mapping)) { 1239 dev->stats.tx_dropped++; 1240 goto err_out; 1241 } 1242 1243 np->tx_ring[entry].addr = cpu_to_dma(np->tx_info[entry].mapping); 1244 np->tx_ring[entry].status = cpu_to_le32(status); 1245 if (debug > 3) 1246 printk(KERN_DEBUG "%s: Tx #%d/#%d slot %d status %#8.8x.\n", 1247 dev->name, np->cur_tx, np->dirty_tx, 1248 entry, status); 1249 if (wrap_ring) { 1250 np->tx_info[entry].used_slots = TX_RING_SIZE - entry; 1251 np->cur_tx += np->tx_info[entry].used_slots; 1252 entry = 0; 1253 } else { 1254 np->tx_info[entry].used_slots = 1; 1255 np->cur_tx += np->tx_info[entry].used_slots; 1256 entry++; 1257 } 1258 /* scavenge the tx descriptors twice per TX_RING_SIZE */ 1259 if (np->cur_tx % (TX_RING_SIZE / 2) == 0) 1260 np->reap_tx = 1; 1261 } 1262 1263 /* Non-x86: explicitly flush descriptor cache lines here. */ 1264 /* Ensure all descriptors are written back before the transmit is 1265 initiated. - Jes */ 1266 wmb(); 1267 1268 /* Update the producer index. */ 1269 writel(entry * (sizeof(starfire_tx_desc) / 8), np->base + TxProducerIdx); 1270 1271 /* 4 is arbitrary, but should be ok */ 1272 if ((np->cur_tx - np->dirty_tx) + 4 > TX_RING_SIZE) 1273 netif_stop_queue(dev); 1274 1275 return NETDEV_TX_OK; 1276 1277err_out: 1278 entry = prev_tx % TX_RING_SIZE; 1279 np->tx_info[entry].skb = NULL; 1280 if (i > 0) { 1281 dma_unmap_single(&np->pci_dev->dev, 1282 np->tx_info[entry].mapping, 1283 skb_first_frag_len(skb), DMA_TO_DEVICE); 1284 np->tx_info[entry].mapping = 0; 1285 entry = (entry + np->tx_info[entry].used_slots) % TX_RING_SIZE; 1286 for (j = 1; j < i; j++) { 1287 dma_unmap_single(&np->pci_dev->dev, 1288 np->tx_info[entry].mapping, 1289 skb_frag_size(&skb_shinfo(skb)->frags[j - 1]), 1290 DMA_TO_DEVICE); 1291 entry++; 1292 } 1293 } 1294 dev_kfree_skb_any(skb); 1295 np->cur_tx = prev_tx; 1296 return NETDEV_TX_OK; 1297} 1298 1299/* The interrupt handler does all of the Rx thread work and cleans up 1300 after the Tx thread. */ 1301static irqreturn_t intr_handler(int irq, void *dev_instance) 1302{ 1303 struct net_device *dev = dev_instance; 1304 struct netdev_private *np = netdev_priv(dev); 1305 void __iomem *ioaddr = np->base; 1306 int boguscnt = max_interrupt_work; 1307 int consumer; 1308 int tx_status; 1309 int handled = 0; 1310 1311 do { 1312 u32 intr_status = readl(ioaddr + IntrClear); 1313 1314 if (debug > 4) 1315 printk(KERN_DEBUG "%s: Interrupt status %#8.8x.\n", 1316 dev->name, intr_status); 1317 1318 if (intr_status == 0 || intr_status == (u32) -1) 1319 break; 1320 1321 handled = 1; 1322 1323 if (intr_status & (IntrRxDone | IntrRxEmpty)) { 1324 u32 enable; 1325 1326 if (likely(napi_schedule_prep(&np->napi))) { 1327 __napi_schedule(&np->napi); 1328 enable = readl(ioaddr + IntrEnable); 1329 enable &= ~(IntrRxDone | IntrRxEmpty); 1330 writel(enable, ioaddr + IntrEnable); 1331 /* flush PCI posting buffers */ 1332 readl(ioaddr + IntrEnable); 1333 } else { 1334 /* Paranoia check */ 1335 enable = readl(ioaddr + IntrEnable); 1336 if (enable & (IntrRxDone | IntrRxEmpty)) { 1337 printk(KERN_INFO 1338 "%s: interrupt while in poll!\n", 1339 dev->name); 1340 enable &= ~(IntrRxDone | IntrRxEmpty); 1341 writel(enable, ioaddr + IntrEnable); 1342 } 1343 } 1344 } 1345 1346 /* Scavenge the skbuff list based on the Tx-done queue. 1347 There are redundant checks here that may be cleaned up 1348 after the driver has proven to be reliable. */ 1349 consumer = readl(ioaddr + TxConsumerIdx); 1350 if (debug > 3) 1351 printk(KERN_DEBUG "%s: Tx Consumer index is %d.\n", 1352 dev->name, consumer); 1353 1354 while ((tx_status = le32_to_cpu(np->tx_done_q[np->tx_done].status)) != 0) { 1355 if (debug > 3) 1356 printk(KERN_DEBUG "%s: Tx completion #%d entry %d is %#8.8x.\n", 1357 dev->name, np->dirty_tx, np->tx_done, tx_status); 1358 if ((tx_status & 0xe0000000) == 0xa0000000) { 1359 dev->stats.tx_packets++; 1360 } else if ((tx_status & 0xe0000000) == 0x80000000) { 1361 u16 entry = (tx_status & 0x7fff) / sizeof(starfire_tx_desc); 1362 struct sk_buff *skb = np->tx_info[entry].skb; 1363 np->tx_info[entry].skb = NULL; 1364 dma_unmap_single(&np->pci_dev->dev, 1365 np->tx_info[entry].mapping, 1366 skb_first_frag_len(skb), 1367 DMA_TO_DEVICE); 1368 np->tx_info[entry].mapping = 0; 1369 np->dirty_tx += np->tx_info[entry].used_slots; 1370 entry = (entry + np->tx_info[entry].used_slots) % TX_RING_SIZE; 1371 { 1372 int i; 1373 for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) { 1374 dma_unmap_single(&np->pci_dev->dev, 1375 np->tx_info[entry].mapping, 1376 skb_frag_size(&skb_shinfo(skb)->frags[i]), 1377 DMA_TO_DEVICE); 1378 np->dirty_tx++; 1379 entry++; 1380 } 1381 } 1382 1383 dev_consume_skb_irq(skb); 1384 } 1385 np->tx_done_q[np->tx_done].status = 0; 1386 np->tx_done = (np->tx_done + 1) % DONE_Q_SIZE; 1387 } 1388 writew(np->tx_done, ioaddr + CompletionQConsumerIdx + 2); 1389 1390 if (netif_queue_stopped(dev) && 1391 (np->cur_tx - np->dirty_tx + 4 < TX_RING_SIZE)) { 1392 /* The ring is no longer full, wake the queue. */ 1393 netif_wake_queue(dev); 1394 } 1395 1396 /* Stats overflow */ 1397 if (intr_status & IntrStatsMax) 1398 get_stats(dev); 1399 1400 /* Media change interrupt. */ 1401 if (intr_status & IntrLinkChange) 1402 netdev_media_change(dev); 1403 1404 /* Abnormal error summary/uncommon events handlers. */ 1405 if (intr_status & IntrAbnormalSummary) 1406 netdev_error(dev, intr_status); 1407 1408 if (--boguscnt < 0) { 1409 if (debug > 1) 1410 printk(KERN_WARNING "%s: Too much work at interrupt, " 1411 "status=%#8.8x.\n", 1412 dev->name, intr_status); 1413 break; 1414 } 1415 } while (1); 1416 1417 if (debug > 4) 1418 printk(KERN_DEBUG "%s: exiting interrupt, status=%#8.8x.\n", 1419 dev->name, (int) readl(ioaddr + IntrStatus)); 1420 return IRQ_RETVAL(handled); 1421} 1422 1423 1424/* 1425 * This routine is logically part of the interrupt/poll handler, but separated 1426 * for clarity and better register allocation. 1427 */ 1428static int __netdev_rx(struct net_device *dev, int *quota) 1429{ 1430 struct netdev_private *np = netdev_priv(dev); 1431 u32 desc_status; 1432 int retcode = 0; 1433 1434 /* If EOP is set on the next entry, it's a new packet. Send it up. */ 1435 while ((desc_status = le32_to_cpu(np->rx_done_q[np->rx_done].status)) != 0) { 1436 struct sk_buff *skb; 1437 u16 pkt_len; 1438 int entry; 1439 rx_done_desc *desc = &np->rx_done_q[np->rx_done]; 1440 1441 if (debug > 4) 1442 printk(KERN_DEBUG " netdev_rx() status of %d was %#8.8x.\n", np->rx_done, desc_status); 1443 if (!(desc_status & RxOK)) { 1444 /* There was an error. */ 1445 if (debug > 2) 1446 printk(KERN_DEBUG " netdev_rx() Rx error was %#8.8x.\n", desc_status); 1447 dev->stats.rx_errors++; 1448 if (desc_status & RxFIFOErr) 1449 dev->stats.rx_fifo_errors++; 1450 goto next_rx; 1451 } 1452 1453 if (*quota <= 0) { /* out of rx quota */ 1454 retcode = 1; 1455 goto out; 1456 } 1457 (*quota)--; 1458 1459 pkt_len = desc_status; /* Implicitly Truncate */ 1460 entry = (desc_status >> 16) & 0x7ff; 1461 1462 if (debug > 4) 1463 printk(KERN_DEBUG " netdev_rx() normal Rx pkt length %d, quota %d.\n", pkt_len, *quota); 1464 /* Check if the packet is long enough to accept without copying 1465 to a minimally-sized skbuff. */ 1466 if (pkt_len < rx_copybreak && 1467 (skb = netdev_alloc_skb(dev, pkt_len + 2)) != NULL) { 1468 skb_reserve(skb, 2); /* 16 byte align the IP header */ 1469 dma_sync_single_for_cpu(&np->pci_dev->dev, 1470 np->rx_info[entry].mapping, 1471 pkt_len, DMA_FROM_DEVICE); 1472 skb_copy_to_linear_data(skb, np->rx_info[entry].skb->data, pkt_len); 1473 dma_sync_single_for_device(&np->pci_dev->dev, 1474 np->rx_info[entry].mapping, 1475 pkt_len, DMA_FROM_DEVICE); 1476 skb_put(skb, pkt_len); 1477 } else { 1478 dma_unmap_single(&np->pci_dev->dev, 1479 np->rx_info[entry].mapping, 1480 np->rx_buf_sz, DMA_FROM_DEVICE); 1481 skb = np->rx_info[entry].skb; 1482 skb_put(skb, pkt_len); 1483 np->rx_info[entry].skb = NULL; 1484 np->rx_info[entry].mapping = 0; 1485 } 1486#ifndef final_version /* Remove after testing. */ 1487 /* You will want this info for the initial debug. */ 1488 if (debug > 5) { 1489 printk(KERN_DEBUG " Rx data %pM %pM %2.2x%2.2x.\n", 1490 skb->data, skb->data + 6, 1491 skb->data[12], skb->data[13]); 1492 } 1493#endif 1494 1495 skb->protocol = eth_type_trans(skb, dev); 1496#ifdef VLAN_SUPPORT 1497 if (debug > 4) 1498 printk(KERN_DEBUG " netdev_rx() status2 of %d was %#4.4x.\n", np->rx_done, le16_to_cpu(desc->status2)); 1499#endif 1500 if (le16_to_cpu(desc->status2) & 0x0100) { 1501 skb->ip_summed = CHECKSUM_UNNECESSARY; 1502 dev->stats.rx_compressed++; 1503 } 1504 /* 1505 * This feature doesn't seem to be working, at least 1506 * with the two firmware versions I have. If the GFP sees 1507 * an IP fragment, it either ignores it completely, or reports 1508 * "bad checksum" on it. 1509 * 1510 * Maybe I missed something -- corrections are welcome. 1511 * Until then, the printk stays. :-) -Ion 1512 */ 1513 else if (le16_to_cpu(desc->status2) & 0x0040) { 1514 skb->ip_summed = CHECKSUM_COMPLETE; 1515 skb->csum = le16_to_cpu(desc->csum); 1516 printk(KERN_DEBUG "%s: checksum_hw, status2 = %#x\n", dev->name, le16_to_cpu(desc->status2)); 1517 } 1518#ifdef VLAN_SUPPORT 1519 if (le16_to_cpu(desc->status2) & 0x0200) { 1520 u16 vlid = le16_to_cpu(desc->vlanid); 1521 1522 if (debug > 4) { 1523 printk(KERN_DEBUG " netdev_rx() vlanid = %d\n", 1524 vlid); 1525 } 1526 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vlid); 1527 } 1528#endif /* VLAN_SUPPORT */ 1529 netif_receive_skb(skb); 1530 dev->stats.rx_packets++; 1531 1532 next_rx: 1533 np->cur_rx++; 1534 desc->status = 0; 1535 np->rx_done = (np->rx_done + 1) % DONE_Q_SIZE; 1536 } 1537 1538 if (*quota == 0) { /* out of rx quota */ 1539 retcode = 1; 1540 goto out; 1541 } 1542 writew(np->rx_done, np->base + CompletionQConsumerIdx); 1543 1544 out: 1545 refill_rx_ring(dev); 1546 if (debug > 5) 1547 printk(KERN_DEBUG " exiting netdev_rx(): %d, status of %d was %#8.8x.\n", 1548 retcode, np->rx_done, desc_status); 1549 return retcode; 1550} 1551 1552static int netdev_poll(struct napi_struct *napi, int budget) 1553{ 1554 struct netdev_private *np = container_of(napi, struct netdev_private, napi); 1555 struct net_device *dev = np->dev; 1556 u32 intr_status; 1557 void __iomem *ioaddr = np->base; 1558 int quota = budget; 1559 1560 do { 1561 writel(IntrRxDone | IntrRxEmpty, ioaddr + IntrClear); 1562 1563 if (__netdev_rx(dev, "a)) 1564 goto out; 1565 1566 intr_status = readl(ioaddr + IntrStatus); 1567 } while (intr_status & (IntrRxDone | IntrRxEmpty)); 1568 1569 napi_complete(napi); 1570 intr_status = readl(ioaddr + IntrEnable); 1571 intr_status |= IntrRxDone | IntrRxEmpty; 1572 writel(intr_status, ioaddr + IntrEnable); 1573 1574 out: 1575 if (debug > 5) 1576 printk(KERN_DEBUG " exiting netdev_poll(): %d.\n", 1577 budget - quota); 1578 1579 /* Restart Rx engine if stopped. */ 1580 return budget - quota; 1581} 1582 1583static void refill_rx_ring(struct net_device *dev) 1584{ 1585 struct netdev_private *np = netdev_priv(dev); 1586 struct sk_buff *skb; 1587 int entry = -1; 1588 1589 /* Refill the Rx ring buffers. */ 1590 for (; np->cur_rx - np->dirty_rx > 0; np->dirty_rx++) { 1591 entry = np->dirty_rx % RX_RING_SIZE; 1592 if (np->rx_info[entry].skb == NULL) { 1593 skb = netdev_alloc_skb(dev, np->rx_buf_sz); 1594 np->rx_info[entry].skb = skb; 1595 if (skb == NULL) 1596 break; /* Better luck next round. */ 1597 np->rx_info[entry].mapping = 1598 dma_map_single(&np->pci_dev->dev, skb->data, 1599 np->rx_buf_sz, DMA_FROM_DEVICE); 1600 if (dma_mapping_error(&np->pci_dev->dev, np->rx_info[entry].mapping)) { 1601 dev_kfree_skb(skb); 1602 np->rx_info[entry].skb = NULL; 1603 break; 1604 } 1605 np->rx_ring[entry].rxaddr = 1606 cpu_to_dma(np->rx_info[entry].mapping | RxDescValid); 1607 } 1608 if (entry == RX_RING_SIZE - 1) 1609 np->rx_ring[entry].rxaddr |= cpu_to_dma(RxDescEndRing); 1610 } 1611 if (entry >= 0) 1612 writew(entry, np->base + RxDescQIdx); 1613} 1614 1615 1616static void netdev_media_change(struct net_device *dev) 1617{ 1618 struct netdev_private *np = netdev_priv(dev); 1619 void __iomem *ioaddr = np->base; 1620 u16 reg0, reg1, reg4, reg5; 1621 u32 new_tx_mode; 1622 u32 new_intr_timer_ctrl; 1623 1624 /* reset status first */ 1625 mdio_read(dev, np->phys[0], MII_BMCR); 1626 mdio_read(dev, np->phys[0], MII_BMSR); 1627 1628 reg0 = mdio_read(dev, np->phys[0], MII_BMCR); 1629 reg1 = mdio_read(dev, np->phys[0], MII_BMSR); 1630 1631 if (reg1 & BMSR_LSTATUS) { 1632 /* link is up */ 1633 if (reg0 & BMCR_ANENABLE) { 1634 /* autonegotiation is enabled */ 1635 reg4 = mdio_read(dev, np->phys[0], MII_ADVERTISE); 1636 reg5 = mdio_read(dev, np->phys[0], MII_LPA); 1637 if (reg4 & ADVERTISE_100FULL && reg5 & LPA_100FULL) { 1638 np->speed100 = 1; 1639 np->mii_if.full_duplex = 1; 1640 } else if (reg4 & ADVERTISE_100HALF && reg5 & LPA_100HALF) { 1641 np->speed100 = 1; 1642 np->mii_if.full_duplex = 0; 1643 } else if (reg4 & ADVERTISE_10FULL && reg5 & LPA_10FULL) { 1644 np->speed100 = 0; 1645 np->mii_if.full_duplex = 1; 1646 } else { 1647 np->speed100 = 0; 1648 np->mii_if.full_duplex = 0; 1649 } 1650 } else { 1651 /* autonegotiation is disabled */ 1652 if (reg0 & BMCR_SPEED100) 1653 np->speed100 = 1; 1654 else 1655 np->speed100 = 0; 1656 if (reg0 & BMCR_FULLDPLX) 1657 np->mii_if.full_duplex = 1; 1658 else 1659 np->mii_if.full_duplex = 0; 1660 } 1661 netif_carrier_on(dev); 1662 printk(KERN_DEBUG "%s: Link is up, running at %sMbit %s-duplex\n", 1663 dev->name, 1664 np->speed100 ? "100" : "10", 1665 np->mii_if.full_duplex ? "full" : "half"); 1666 1667 new_tx_mode = np->tx_mode & ~FullDuplex; /* duplex setting */ 1668 if (np->mii_if.full_duplex) 1669 new_tx_mode |= FullDuplex; 1670 if (np->tx_mode != new_tx_mode) { 1671 np->tx_mode = new_tx_mode; 1672 writel(np->tx_mode | MiiSoftReset, ioaddr + TxMode); 1673 udelay(1000); 1674 writel(np->tx_mode, ioaddr + TxMode); 1675 } 1676 1677 new_intr_timer_ctrl = np->intr_timer_ctrl & ~Timer10X; 1678 if (np->speed100) 1679 new_intr_timer_ctrl |= Timer10X; 1680 if (np->intr_timer_ctrl != new_intr_timer_ctrl) { 1681 np->intr_timer_ctrl = new_intr_timer_ctrl; 1682 writel(new_intr_timer_ctrl, ioaddr + IntrTimerCtrl); 1683 } 1684 } else { 1685 netif_carrier_off(dev); 1686 printk(KERN_DEBUG "%s: Link is down\n", dev->name); 1687 } 1688} 1689 1690 1691static void netdev_error(struct net_device *dev, int intr_status) 1692{ 1693 struct netdev_private *np = netdev_priv(dev); 1694 1695 /* Came close to underrunning the Tx FIFO, increase threshold. */ 1696 if (intr_status & IntrTxDataLow) { 1697 if (np->tx_threshold <= PKT_BUF_SZ / 16) { 1698 writel(++np->tx_threshold, np->base + TxThreshold); 1699 printk(KERN_NOTICE "%s: PCI bus congestion, increasing Tx FIFO threshold to %d bytes\n", 1700 dev->name, np->tx_threshold * 16); 1701 } else 1702 printk(KERN_WARNING "%s: PCI Tx underflow -- adapter is probably malfunctioning\n", dev->name); 1703 } 1704 if (intr_status & IntrRxGFPDead) { 1705 dev->stats.rx_fifo_errors++; 1706 dev->stats.rx_errors++; 1707 } 1708 if (intr_status & (IntrNoTxCsum | IntrDMAErr)) { 1709 dev->stats.tx_fifo_errors++; 1710 dev->stats.tx_errors++; 1711 } 1712 if ((intr_status & ~(IntrNormalMask | IntrAbnormalSummary | IntrLinkChange | IntrStatsMax | IntrTxDataLow | IntrRxGFPDead | IntrNoTxCsum | IntrPCIPad)) && debug) 1713 printk(KERN_ERR "%s: Something Wicked happened! %#8.8x.\n", 1714 dev->name, intr_status); 1715} 1716 1717 1718static struct net_device_stats *get_stats(struct net_device *dev) 1719{ 1720 struct netdev_private *np = netdev_priv(dev); 1721 void __iomem *ioaddr = np->base; 1722 1723 /* This adapter architecture needs no SMP locks. */ 1724 dev->stats.tx_bytes = readl(ioaddr + 0x57010); 1725 dev->stats.rx_bytes = readl(ioaddr + 0x57044); 1726 dev->stats.tx_packets = readl(ioaddr + 0x57000); 1727 dev->stats.tx_aborted_errors = 1728 readl(ioaddr + 0x57024) + readl(ioaddr + 0x57028); 1729 dev->stats.tx_window_errors = readl(ioaddr + 0x57018); 1730 dev->stats.collisions = 1731 readl(ioaddr + 0x57004) + readl(ioaddr + 0x57008); 1732 1733 /* The chip only need report frame silently dropped. */ 1734 dev->stats.rx_dropped += readw(ioaddr + RxDMAStatus); 1735 writew(0, ioaddr + RxDMAStatus); 1736 dev->stats.rx_crc_errors = readl(ioaddr + 0x5703C); 1737 dev->stats.rx_frame_errors = readl(ioaddr + 0x57040); 1738 dev->stats.rx_length_errors = readl(ioaddr + 0x57058); 1739 dev->stats.rx_missed_errors = readl(ioaddr + 0x5707C); 1740 1741 return &dev->stats; 1742} 1743 1744#ifdef VLAN_SUPPORT 1745static u32 set_vlan_mode(struct netdev_private *np) 1746{ 1747 u32 ret = VlanMode; 1748 u16 vid; 1749 void __iomem *filter_addr = np->base + HashTable + 8; 1750 int vlan_count = 0; 1751 1752 for_each_set_bit(vid, np->active_vlans, VLAN_N_VID) { 1753 if (vlan_count == 32) 1754 break; 1755 writew(vid, filter_addr); 1756 filter_addr += 16; 1757 vlan_count++; 1758 } 1759 if (vlan_count == 32) { 1760 ret |= PerfectFilterVlan; 1761 while (vlan_count < 32) { 1762 writew(0, filter_addr); 1763 filter_addr += 16; 1764 vlan_count++; 1765 } 1766 } 1767 return ret; 1768} 1769#endif /* VLAN_SUPPORT */ 1770 1771static void set_rx_mode(struct net_device *dev) 1772{ 1773 struct netdev_private *np = netdev_priv(dev); 1774 void __iomem *ioaddr = np->base; 1775 u32 rx_mode = MinVLANPrio; 1776 struct netdev_hw_addr *ha; 1777 int i; 1778 1779#ifdef VLAN_SUPPORT 1780 rx_mode |= set_vlan_mode(np); 1781#endif /* VLAN_SUPPORT */ 1782 1783 if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */ 1784 rx_mode |= AcceptAll; 1785 } else if ((netdev_mc_count(dev) > multicast_filter_limit) || 1786 (dev->flags & IFF_ALLMULTI)) { 1787 /* Too many to match, or accept all multicasts. */ 1788 rx_mode |= AcceptBroadcast|AcceptAllMulticast|PerfectFilter; 1789 } else if (netdev_mc_count(dev) <= 14) { 1790 /* Use the 16 element perfect filter, skip first two entries. */ 1791 void __iomem *filter_addr = ioaddr + PerfFilterTable + 2 * 16; 1792 const __be16 *eaddrs; 1793 netdev_for_each_mc_addr(ha, dev) { 1794 eaddrs = (__be16 *) ha->addr; 1795 writew(be16_to_cpu(eaddrs[2]), filter_addr); filter_addr += 4; 1796 writew(be16_to_cpu(eaddrs[1]), filter_addr); filter_addr += 4; 1797 writew(be16_to_cpu(eaddrs[0]), filter_addr); filter_addr += 8; 1798 } 1799 eaddrs = (const __be16 *)dev->dev_addr; 1800 i = netdev_mc_count(dev) + 2; 1801 while (i++ < 16) { 1802 writew(be16_to_cpu(eaddrs[0]), filter_addr); filter_addr += 4; 1803 writew(be16_to_cpu(eaddrs[1]), filter_addr); filter_addr += 4; 1804 writew(be16_to_cpu(eaddrs[2]), filter_addr); filter_addr += 8; 1805 } 1806 rx_mode |= AcceptBroadcast|PerfectFilter; 1807 } else { 1808 /* Must use a multicast hash table. */ 1809 void __iomem *filter_addr; 1810 const __be16 *eaddrs; 1811 __le16 mc_filter[32] __attribute__ ((aligned(sizeof(long)))); /* Multicast hash filter */ 1812 1813 memset(mc_filter, 0, sizeof(mc_filter)); 1814 netdev_for_each_mc_addr(ha, dev) { 1815 /* The chip uses the upper 9 CRC bits 1816 as index into the hash table */ 1817 int bit_nr = ether_crc_le(ETH_ALEN, ha->addr) >> 23; 1818 __le32 *fptr = (__le32 *) &mc_filter[(bit_nr >> 4) & ~1]; 1819 1820 *fptr |= cpu_to_le32(1 << (bit_nr & 31)); 1821 } 1822 /* Clear the perfect filter list, skip first two entries. */ 1823 filter_addr = ioaddr + PerfFilterTable + 2 * 16; 1824 eaddrs = (const __be16 *)dev->dev_addr; 1825 for (i = 2; i < 16; i++) { 1826 writew(be16_to_cpu(eaddrs[0]), filter_addr); filter_addr += 4; 1827 writew(be16_to_cpu(eaddrs[1]), filter_addr); filter_addr += 4; 1828 writew(be16_to_cpu(eaddrs[2]), filter_addr); filter_addr += 8; 1829 } 1830 for (filter_addr = ioaddr + HashTable, i = 0; i < 32; filter_addr+= 16, i++) 1831 writew(mc_filter[i], filter_addr); 1832 rx_mode |= AcceptBroadcast|PerfectFilter|HashFilter; 1833 } 1834 writel(rx_mode, ioaddr + RxFilterMode); 1835} 1836 1837static int check_if_running(struct net_device *dev) 1838{ 1839 if (!netif_running(dev)) 1840 return -EINVAL; 1841 return 0; 1842} 1843 1844static void get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) 1845{ 1846 struct netdev_private *np = netdev_priv(dev); 1847 strlcpy(info->driver, DRV_NAME, sizeof(info->driver)); 1848 strlcpy(info->bus_info, pci_name(np->pci_dev), sizeof(info->bus_info)); 1849} 1850 1851static int get_link_ksettings(struct net_device *dev, 1852 struct ethtool_link_ksettings *cmd) 1853{ 1854 struct netdev_private *np = netdev_priv(dev); 1855 spin_lock_irq(&np->lock); 1856 mii_ethtool_get_link_ksettings(&np->mii_if, cmd); 1857 spin_unlock_irq(&np->lock); 1858 return 0; 1859} 1860 1861static int set_link_ksettings(struct net_device *dev, 1862 const struct ethtool_link_ksettings *cmd) 1863{ 1864 struct netdev_private *np = netdev_priv(dev); 1865 int res; 1866 spin_lock_irq(&np->lock); 1867 res = mii_ethtool_set_link_ksettings(&np->mii_if, cmd); 1868 spin_unlock_irq(&np->lock); 1869 check_duplex(dev); 1870 return res; 1871} 1872 1873static int nway_reset(struct net_device *dev) 1874{ 1875 struct netdev_private *np = netdev_priv(dev); 1876 return mii_nway_restart(&np->mii_if); 1877} 1878 1879static u32 get_link(struct net_device *dev) 1880{ 1881 struct netdev_private *np = netdev_priv(dev); 1882 return mii_link_ok(&np->mii_if); 1883} 1884 1885static u32 get_msglevel(struct net_device *dev) 1886{ 1887 return debug; 1888} 1889 1890static void set_msglevel(struct net_device *dev, u32 val) 1891{ 1892 debug = val; 1893} 1894 1895static const struct ethtool_ops ethtool_ops = { 1896 .begin = check_if_running, 1897 .get_drvinfo = get_drvinfo, 1898 .nway_reset = nway_reset, 1899 .get_link = get_link, 1900 .get_msglevel = get_msglevel, 1901 .set_msglevel = set_msglevel, 1902 .get_link_ksettings = get_link_ksettings, 1903 .set_link_ksettings = set_link_ksettings, 1904}; 1905 1906static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) 1907{ 1908 struct netdev_private *np = netdev_priv(dev); 1909 struct mii_ioctl_data *data = if_mii(rq); 1910 int rc; 1911 1912 if (!netif_running(dev)) 1913 return -EINVAL; 1914 1915 spin_lock_irq(&np->lock); 1916 rc = generic_mii_ioctl(&np->mii_if, data, cmd, NULL); 1917 spin_unlock_irq(&np->lock); 1918 1919 if ((cmd == SIOCSMIIREG) && (data->phy_id == np->phys[0])) 1920 check_duplex(dev); 1921 1922 return rc; 1923} 1924 1925static int netdev_close(struct net_device *dev) 1926{ 1927 struct netdev_private *np = netdev_priv(dev); 1928 void __iomem *ioaddr = np->base; 1929 int i; 1930 1931 netif_stop_queue(dev); 1932 1933 napi_disable(&np->napi); 1934 1935 if (debug > 1) { 1936 printk(KERN_DEBUG "%s: Shutting down ethercard, Intr status %#8.8x.\n", 1937 dev->name, (int) readl(ioaddr + IntrStatus)); 1938 printk(KERN_DEBUG "%s: Queue pointers were Tx %d / %d, Rx %d / %d.\n", 1939 dev->name, np->cur_tx, np->dirty_tx, 1940 np->cur_rx, np->dirty_rx); 1941 } 1942 1943 /* Disable interrupts by clearing the interrupt mask. */ 1944 writel(0, ioaddr + IntrEnable); 1945 1946 /* Stop the chip's Tx and Rx processes. */ 1947 writel(0, ioaddr + GenCtrl); 1948 readl(ioaddr + GenCtrl); 1949 1950 if (debug > 5) { 1951 printk(KERN_DEBUG" Tx ring at %#llx:\n", 1952 (long long) np->tx_ring_dma); 1953 for (i = 0; i < 8 /* TX_RING_SIZE is huge! */; i++) 1954 printk(KERN_DEBUG " #%d desc. %#8.8x %#llx -> %#8.8x.\n", 1955 i, le32_to_cpu(np->tx_ring[i].status), 1956 (long long) dma_to_cpu(np->tx_ring[i].addr), 1957 le32_to_cpu(np->tx_done_q[i].status)); 1958 printk(KERN_DEBUG " Rx ring at %#llx -> %p:\n", 1959 (long long) np->rx_ring_dma, np->rx_done_q); 1960 if (np->rx_done_q) 1961 for (i = 0; i < 8 /* RX_RING_SIZE */; i++) { 1962 printk(KERN_DEBUG " #%d desc. %#llx -> %#8.8x\n", 1963 i, (long long) dma_to_cpu(np->rx_ring[i].rxaddr), le32_to_cpu(np->rx_done_q[i].status)); 1964 } 1965 } 1966 1967 free_irq(np->pci_dev->irq, dev); 1968 1969 /* Free all the skbuffs in the Rx queue. */ 1970 for (i = 0; i < RX_RING_SIZE; i++) { 1971 np->rx_ring[i].rxaddr = cpu_to_dma(0xBADF00D0); /* An invalid address. */ 1972 if (np->rx_info[i].skb != NULL) { 1973 dma_unmap_single(&np->pci_dev->dev, 1974 np->rx_info[i].mapping, 1975 np->rx_buf_sz, DMA_FROM_DEVICE); 1976 dev_kfree_skb(np->rx_info[i].skb); 1977 } 1978 np->rx_info[i].skb = NULL; 1979 np->rx_info[i].mapping = 0; 1980 } 1981 for (i = 0; i < TX_RING_SIZE; i++) { 1982 struct sk_buff *skb = np->tx_info[i].skb; 1983 if (skb == NULL) 1984 continue; 1985 dma_unmap_single(&np->pci_dev->dev, np->tx_info[i].mapping, 1986 skb_first_frag_len(skb), DMA_TO_DEVICE); 1987 np->tx_info[i].mapping = 0; 1988 dev_kfree_skb(skb); 1989 np->tx_info[i].skb = NULL; 1990 } 1991 1992 return 0; 1993} 1994 1995static int __maybe_unused starfire_suspend(struct device *dev_d) 1996{ 1997 struct net_device *dev = dev_get_drvdata(dev_d); 1998 1999 if (netif_running(dev)) { 2000 netif_device_detach(dev); 2001 netdev_close(dev); 2002 } 2003 2004 return 0; 2005} 2006 2007static int __maybe_unused starfire_resume(struct device *dev_d) 2008{ 2009 struct net_device *dev = dev_get_drvdata(dev_d); 2010 2011 if (netif_running(dev)) { 2012 netdev_open(dev); 2013 netif_device_attach(dev); 2014 } 2015 2016 return 0; 2017} 2018 2019static void starfire_remove_one(struct pci_dev *pdev) 2020{ 2021 struct net_device *dev = pci_get_drvdata(pdev); 2022 struct netdev_private *np = netdev_priv(dev); 2023 2024 BUG_ON(!dev); 2025 2026 unregister_netdev(dev); 2027 2028 if (np->queue_mem) 2029 dma_free_coherent(&pdev->dev, np->queue_mem_size, 2030 np->queue_mem, np->queue_mem_dma); 2031 2032 2033 /* XXX: add wakeup code -- requires firmware for MagicPacket */ 2034 pci_set_power_state(pdev, PCI_D3hot); /* go to sleep in D3 mode */ 2035 pci_disable_device(pdev); 2036 2037 iounmap(np->base); 2038 pci_release_regions(pdev); 2039 2040 free_netdev(dev); /* Will also free np!! */ 2041} 2042 2043static SIMPLE_DEV_PM_OPS(starfire_pm_ops, starfire_suspend, starfire_resume); 2044 2045static struct pci_driver starfire_driver = { 2046 .name = DRV_NAME, 2047 .probe = starfire_init_one, 2048 .remove = starfire_remove_one, 2049 .driver.pm = &starfire_pm_ops, 2050 .id_table = starfire_pci_tbl, 2051}; 2052 2053 2054static int __init starfire_init (void) 2055{ 2056/* when a module, this is printed whether or not devices are found in probe */ 2057#ifdef MODULE 2058 printk(KERN_INFO DRV_NAME ": polling (NAPI) enabled\n"); 2059#endif 2060 2061 BUILD_BUG_ON(sizeof(dma_addr_t) != sizeof(netdrv_addr_t)); 2062 2063 return pci_register_driver(&starfire_driver); 2064} 2065 2066 2067static void __exit starfire_cleanup (void) 2068{ 2069 pci_unregister_driver (&starfire_driver); 2070} 2071 2072 2073module_init(starfire_init); 2074module_exit(starfire_cleanup);