162306a36Sopenharmony_ci/* starfire.c: Linux device driver for the Adaptec Starfire network adapter. */ 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci Written 1998-2000 by Donald Becker. 462306a36Sopenharmony_ci 562306a36Sopenharmony_ci Current maintainer is Ion Badulescu <ionut ta badula tod org>. Please 662306a36Sopenharmony_ci send all bug reports to me, and not to Donald Becker, as this code 762306a36Sopenharmony_ci has been heavily modified from Donald's original version. 862306a36Sopenharmony_ci 962306a36Sopenharmony_ci This software may be used and distributed according to the terms of 1062306a36Sopenharmony_ci the GNU General Public License (GPL), incorporated herein by reference. 1162306a36Sopenharmony_ci Drivers based on or derived from this code fall under the GPL and must 1262306a36Sopenharmony_ci retain the authorship, copyright and license notice. This file is not 1362306a36Sopenharmony_ci a complete program and may only be used when the entire operating 1462306a36Sopenharmony_ci system is licensed under the GPL. 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci The information below comes from Donald Becker's original driver: 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_ci The author may be reached as becker@scyld.com, or C/O 1962306a36Sopenharmony_ci Scyld Computing Corporation 2062306a36Sopenharmony_ci 410 Severn Ave., Suite 210 2162306a36Sopenharmony_ci Annapolis MD 21403 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_ci Support and updates available at 2462306a36Sopenharmony_ci http://www.scyld.com/network/starfire.html 2562306a36Sopenharmony_ci [link no longer provides useful info -jgarzik] 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_ci*/ 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_ci#define DRV_NAME "starfire" 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci#include <linux/interrupt.h> 3262306a36Sopenharmony_ci#include <linux/module.h> 3362306a36Sopenharmony_ci#include <linux/kernel.h> 3462306a36Sopenharmony_ci#include <linux/pci.h> 3562306a36Sopenharmony_ci#include <linux/netdevice.h> 3662306a36Sopenharmony_ci#include <linux/etherdevice.h> 3762306a36Sopenharmony_ci#include <linux/init.h> 3862306a36Sopenharmony_ci#include <linux/delay.h> 3962306a36Sopenharmony_ci#include <linux/crc32.h> 4062306a36Sopenharmony_ci#include <linux/ethtool.h> 4162306a36Sopenharmony_ci#include <linux/mii.h> 4262306a36Sopenharmony_ci#include <linux/if_vlan.h> 4362306a36Sopenharmony_ci#include <linux/mm.h> 4462306a36Sopenharmony_ci#include <linux/firmware.h> 4562306a36Sopenharmony_ci#include <asm/processor.h> /* Processor type for cache alignment. */ 4662306a36Sopenharmony_ci#include <linux/uaccess.h> 4762306a36Sopenharmony_ci#include <asm/io.h> 4862306a36Sopenharmony_ci 4962306a36Sopenharmony_ci/* 5062306a36Sopenharmony_ci * The current frame processor firmware fails to checksum a fragment 5162306a36Sopenharmony_ci * of length 1. If and when this is fixed, the #define below can be removed. 5262306a36Sopenharmony_ci */ 5362306a36Sopenharmony_ci#define HAS_BROKEN_FIRMWARE 5462306a36Sopenharmony_ci 5562306a36Sopenharmony_ci/* 5662306a36Sopenharmony_ci * If using the broken firmware, data must be padded to the next 32-bit boundary. 5762306a36Sopenharmony_ci */ 5862306a36Sopenharmony_ci#ifdef HAS_BROKEN_FIRMWARE 5962306a36Sopenharmony_ci#define PADDING_MASK 3 6062306a36Sopenharmony_ci#endif 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_ci/* 6362306a36Sopenharmony_ci * Define this if using the driver with the zero-copy patch 6462306a36Sopenharmony_ci */ 6562306a36Sopenharmony_ci#define ZEROCOPY 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ci#if IS_ENABLED(CONFIG_VLAN_8021Q) 6862306a36Sopenharmony_ci#define VLAN_SUPPORT 6962306a36Sopenharmony_ci#endif 7062306a36Sopenharmony_ci 7162306a36Sopenharmony_ci/* The user-configurable values. 7262306a36Sopenharmony_ci These may be modified when a driver module is loaded.*/ 7362306a36Sopenharmony_ci 7462306a36Sopenharmony_ci/* Used for tuning interrupt latency vs. overhead. */ 7562306a36Sopenharmony_cistatic int intr_latency; 7662306a36Sopenharmony_cistatic int small_frames; 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_cistatic int debug = 1; /* 1 normal messages, 0 quiet .. 7 verbose. */ 7962306a36Sopenharmony_cistatic int max_interrupt_work = 20; 8062306a36Sopenharmony_cistatic int mtu; 8162306a36Sopenharmony_ci/* Maximum number of multicast addresses to filter (vs. rx-all-multicast). 8262306a36Sopenharmony_ci The Starfire has a 512 element hash table based on the Ethernet CRC. */ 8362306a36Sopenharmony_cistatic const int multicast_filter_limit = 512; 8462306a36Sopenharmony_ci/* Whether to do TCP/UDP checksums in hardware */ 8562306a36Sopenharmony_cistatic int enable_hw_cksum = 1; 8662306a36Sopenharmony_ci 8762306a36Sopenharmony_ci#define PKT_BUF_SZ 1536 /* Size of each temporary Rx buffer.*/ 8862306a36Sopenharmony_ci/* 8962306a36Sopenharmony_ci * Set the copy breakpoint for the copy-only-tiny-frames scheme. 9062306a36Sopenharmony_ci * Setting to > 1518 effectively disables this feature. 9162306a36Sopenharmony_ci * 9262306a36Sopenharmony_ci * NOTE: 9362306a36Sopenharmony_ci * The ia64 doesn't allow for unaligned loads even of integers being 9462306a36Sopenharmony_ci * misaligned on a 2 byte boundary. Thus always force copying of 9562306a36Sopenharmony_ci * packets as the starfire doesn't allow for misaligned DMAs ;-( 9662306a36Sopenharmony_ci * 23/10/2000 - Jes 9762306a36Sopenharmony_ci * 9862306a36Sopenharmony_ci * The Alpha and the Sparc don't like unaligned loads, either. On Sparc64, 9962306a36Sopenharmony_ci * at least, having unaligned frames leads to a rather serious performance 10062306a36Sopenharmony_ci * penalty. -Ion 10162306a36Sopenharmony_ci */ 10262306a36Sopenharmony_ci#if defined(__ia64__) || defined(__alpha__) || defined(__sparc__) 10362306a36Sopenharmony_cistatic int rx_copybreak = PKT_BUF_SZ; 10462306a36Sopenharmony_ci#else 10562306a36Sopenharmony_cistatic int rx_copybreak /* = 0 */; 10662306a36Sopenharmony_ci#endif 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_ci/* PCI DMA burst size -- on sparc64 we want to force it to 64 bytes, on the others the default of 128 is fine. */ 10962306a36Sopenharmony_ci#ifdef __sparc__ 11062306a36Sopenharmony_ci#define DMA_BURST_SIZE 64 11162306a36Sopenharmony_ci#else 11262306a36Sopenharmony_ci#define DMA_BURST_SIZE 128 11362306a36Sopenharmony_ci#endif 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_ci/* Operational parameters that are set at compile time. */ 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_ci/* The "native" ring sizes are either 256 or 2048. 11862306a36Sopenharmony_ci However in some modes a descriptor may be marked to wrap the ring earlier. 11962306a36Sopenharmony_ci*/ 12062306a36Sopenharmony_ci#define RX_RING_SIZE 256 12162306a36Sopenharmony_ci#define TX_RING_SIZE 32 12262306a36Sopenharmony_ci/* The completion queues are fixed at 1024 entries i.e. 4K or 8KB. */ 12362306a36Sopenharmony_ci#define DONE_Q_SIZE 1024 12462306a36Sopenharmony_ci/* All queues must be aligned on a 256-byte boundary */ 12562306a36Sopenharmony_ci#define QUEUE_ALIGN 256 12662306a36Sopenharmony_ci 12762306a36Sopenharmony_ci#if RX_RING_SIZE > 256 12862306a36Sopenharmony_ci#define RX_Q_ENTRIES Rx2048QEntries 12962306a36Sopenharmony_ci#else 13062306a36Sopenharmony_ci#define RX_Q_ENTRIES Rx256QEntries 13162306a36Sopenharmony_ci#endif 13262306a36Sopenharmony_ci 13362306a36Sopenharmony_ci/* Operational parameters that usually are not changed. */ 13462306a36Sopenharmony_ci/* Time in jiffies before concluding the transmitter is hung. */ 13562306a36Sopenharmony_ci#define TX_TIMEOUT (2 * HZ) 13662306a36Sopenharmony_ci 13762306a36Sopenharmony_ci#ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT 13862306a36Sopenharmony_ci/* 64-bit dma_addr_t */ 13962306a36Sopenharmony_ci#define ADDR_64BITS /* This chip uses 64 bit addresses. */ 14062306a36Sopenharmony_ci#define netdrv_addr_t __le64 14162306a36Sopenharmony_ci#define cpu_to_dma(x) cpu_to_le64(x) 14262306a36Sopenharmony_ci#define dma_to_cpu(x) le64_to_cpu(x) 14362306a36Sopenharmony_ci#define RX_DESC_Q_ADDR_SIZE RxDescQAddr64bit 14462306a36Sopenharmony_ci#define TX_DESC_Q_ADDR_SIZE TxDescQAddr64bit 14562306a36Sopenharmony_ci#define RX_COMPL_Q_ADDR_SIZE RxComplQAddr64bit 14662306a36Sopenharmony_ci#define TX_COMPL_Q_ADDR_SIZE TxComplQAddr64bit 14762306a36Sopenharmony_ci#define RX_DESC_ADDR_SIZE RxDescAddr64bit 14862306a36Sopenharmony_ci#else /* 32-bit dma_addr_t */ 14962306a36Sopenharmony_ci#define netdrv_addr_t __le32 15062306a36Sopenharmony_ci#define cpu_to_dma(x) cpu_to_le32(x) 15162306a36Sopenharmony_ci#define dma_to_cpu(x) le32_to_cpu(x) 15262306a36Sopenharmony_ci#define RX_DESC_Q_ADDR_SIZE RxDescQAddr32bit 15362306a36Sopenharmony_ci#define TX_DESC_Q_ADDR_SIZE TxDescQAddr32bit 15462306a36Sopenharmony_ci#define RX_COMPL_Q_ADDR_SIZE RxComplQAddr32bit 15562306a36Sopenharmony_ci#define TX_COMPL_Q_ADDR_SIZE TxComplQAddr32bit 15662306a36Sopenharmony_ci#define RX_DESC_ADDR_SIZE RxDescAddr32bit 15762306a36Sopenharmony_ci#endif 15862306a36Sopenharmony_ci 15962306a36Sopenharmony_ci#define skb_first_frag_len(skb) skb_headlen(skb) 16062306a36Sopenharmony_ci#define skb_num_frags(skb) (skb_shinfo(skb)->nr_frags + 1) 16162306a36Sopenharmony_ci 16262306a36Sopenharmony_ci/* Firmware names */ 16362306a36Sopenharmony_ci#define FIRMWARE_RX "adaptec/starfire_rx.bin" 16462306a36Sopenharmony_ci#define FIRMWARE_TX "adaptec/starfire_tx.bin" 16562306a36Sopenharmony_ci 16662306a36Sopenharmony_ciMODULE_AUTHOR("Donald Becker <becker@scyld.com>"); 16762306a36Sopenharmony_ciMODULE_DESCRIPTION("Adaptec Starfire Ethernet driver"); 16862306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 16962306a36Sopenharmony_ciMODULE_FIRMWARE(FIRMWARE_RX); 17062306a36Sopenharmony_ciMODULE_FIRMWARE(FIRMWARE_TX); 17162306a36Sopenharmony_ci 17262306a36Sopenharmony_cimodule_param(max_interrupt_work, int, 0); 17362306a36Sopenharmony_cimodule_param(mtu, int, 0); 17462306a36Sopenharmony_cimodule_param(debug, int, 0); 17562306a36Sopenharmony_cimodule_param(rx_copybreak, int, 0); 17662306a36Sopenharmony_cimodule_param(intr_latency, int, 0); 17762306a36Sopenharmony_cimodule_param(small_frames, int, 0); 17862306a36Sopenharmony_cimodule_param(enable_hw_cksum, int, 0); 17962306a36Sopenharmony_ciMODULE_PARM_DESC(max_interrupt_work, "Maximum events handled per interrupt"); 18062306a36Sopenharmony_ciMODULE_PARM_DESC(mtu, "MTU (all boards)"); 18162306a36Sopenharmony_ciMODULE_PARM_DESC(debug, "Debug level (0-6)"); 18262306a36Sopenharmony_ciMODULE_PARM_DESC(rx_copybreak, "Copy breakpoint for copy-only-tiny-frames"); 18362306a36Sopenharmony_ciMODULE_PARM_DESC(intr_latency, "Maximum interrupt latency, in microseconds"); 18462306a36Sopenharmony_ciMODULE_PARM_DESC(small_frames, "Maximum size of receive frames that bypass interrupt latency (0,64,128,256,512)"); 18562306a36Sopenharmony_ciMODULE_PARM_DESC(enable_hw_cksum, "Enable/disable hardware cksum support (0/1)"); 18662306a36Sopenharmony_ci 18762306a36Sopenharmony_ci/* 18862306a36Sopenharmony_ci Theory of Operation 18962306a36Sopenharmony_ci 19062306a36Sopenharmony_ciI. Board Compatibility 19162306a36Sopenharmony_ci 19262306a36Sopenharmony_ciThis driver is for the Adaptec 6915 "Starfire" 64 bit PCI Ethernet adapter. 19362306a36Sopenharmony_ci 19462306a36Sopenharmony_ciII. Board-specific settings 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_ciIII. Driver operation 19762306a36Sopenharmony_ci 19862306a36Sopenharmony_ciIIIa. Ring buffers 19962306a36Sopenharmony_ci 20062306a36Sopenharmony_ciThe Starfire hardware uses multiple fixed-size descriptor queues/rings. The 20162306a36Sopenharmony_ciring sizes are set fixed by the hardware, but may optionally be wrapped 20262306a36Sopenharmony_ciearlier by the END bit in the descriptor. 20362306a36Sopenharmony_ciThis driver uses that hardware queue size for the Rx ring, where a large 20462306a36Sopenharmony_cinumber of entries has no ill effect beyond increases the potential backlog. 20562306a36Sopenharmony_ciThe Tx ring is wrapped with the END bit, since a large hardware Tx queue 20662306a36Sopenharmony_cidisables the queue layer priority ordering and we have no mechanism to 20762306a36Sopenharmony_ciutilize the hardware two-level priority queue. When modifying the 20862306a36Sopenharmony_ciRX/TX_RING_SIZE pay close attention to page sizes and the ring-empty warning 20962306a36Sopenharmony_cilevels. 21062306a36Sopenharmony_ci 21162306a36Sopenharmony_ciIIIb/c. Transmit/Receive Structure 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_ciSee the Adaptec manual for the many possible structures, and options for 21462306a36Sopenharmony_cieach structure. There are far too many to document all of them here. 21562306a36Sopenharmony_ci 21662306a36Sopenharmony_ciFor transmit this driver uses type 0/1 transmit descriptors (depending 21762306a36Sopenharmony_cion the 32/64 bitness of the architecture), and relies on automatic 21862306a36Sopenharmony_ciminimum-length padding. It does not use the completion queue 21962306a36Sopenharmony_ciconsumer index, but instead checks for non-zero status entries. 22062306a36Sopenharmony_ci 22162306a36Sopenharmony_ciFor receive this driver uses type 2/3 receive descriptors. The driver 22262306a36Sopenharmony_ciallocates full frame size skbuffs for the Rx ring buffers, so all frames 22362306a36Sopenharmony_cishould fit in a single descriptor. The driver does not use the completion 22462306a36Sopenharmony_ciqueue consumer index, but instead checks for non-zero status entries. 22562306a36Sopenharmony_ci 22662306a36Sopenharmony_ciWhen an incoming frame is less than RX_COPYBREAK bytes long, a fresh skbuff 22762306a36Sopenharmony_ciis allocated and the frame is copied to the new skbuff. When the incoming 22862306a36Sopenharmony_ciframe is larger, the skbuff is passed directly up the protocol stack. 22962306a36Sopenharmony_ciBuffers consumed this way are replaced by newly allocated skbuffs in a later 23062306a36Sopenharmony_ciphase of receive. 23162306a36Sopenharmony_ci 23262306a36Sopenharmony_ciA notable aspect of operation is that unaligned buffers are not permitted by 23362306a36Sopenharmony_cithe Starfire hardware. Thus the IP header at offset 14 in an ethernet frame 23462306a36Sopenharmony_ciisn't longword aligned, which may cause problems on some machine 23562306a36Sopenharmony_cie.g. Alphas and IA64. For these architectures, the driver is forced to copy 23662306a36Sopenharmony_cithe frame into a new skbuff unconditionally. Copied frames are put into the 23762306a36Sopenharmony_ciskbuff at an offset of "+2", thus 16-byte aligning the IP header. 23862306a36Sopenharmony_ci 23962306a36Sopenharmony_ciIIId. Synchronization 24062306a36Sopenharmony_ci 24162306a36Sopenharmony_ciThe driver runs as two independent, single-threaded flows of control. One 24262306a36Sopenharmony_ciis the send-packet routine, which enforces single-threaded use by the 24362306a36Sopenharmony_cidev->tbusy flag. The other thread is the interrupt handler, which is single 24462306a36Sopenharmony_cithreaded by the hardware and interrupt handling software. 24562306a36Sopenharmony_ci 24662306a36Sopenharmony_ciThe send packet thread has partial control over the Tx ring and the netif_queue 24762306a36Sopenharmony_cistatus. If the number of free Tx slots in the ring falls below a certain number 24862306a36Sopenharmony_ci(currently hardcoded to 4), it signals the upper layer to stop the queue. 24962306a36Sopenharmony_ci 25062306a36Sopenharmony_ciThe interrupt handler has exclusive control over the Rx ring and records stats 25162306a36Sopenharmony_cifrom the Tx ring. After reaping the stats, it marks the Tx queue entry as 25262306a36Sopenharmony_ciempty by incrementing the dirty_tx mark. Iff the netif_queue is stopped and the 25362306a36Sopenharmony_cinumber of free Tx slow is above the threshold, it signals the upper layer to 25462306a36Sopenharmony_cirestart the queue. 25562306a36Sopenharmony_ci 25662306a36Sopenharmony_ciIV. Notes 25762306a36Sopenharmony_ci 25862306a36Sopenharmony_ciIVb. References 25962306a36Sopenharmony_ci 26062306a36Sopenharmony_ciThe Adaptec Starfire manuals, available only from Adaptec. 26162306a36Sopenharmony_cihttp://www.scyld.com/expert/100mbps.html 26262306a36Sopenharmony_cihttp://www.scyld.com/expert/NWay.html 26362306a36Sopenharmony_ci 26462306a36Sopenharmony_ciIVc. Errata 26562306a36Sopenharmony_ci 26662306a36Sopenharmony_ci- StopOnPerr is broken, don't enable 26762306a36Sopenharmony_ci- Hardware ethernet padding exposes random data, perform software padding 26862306a36Sopenharmony_ci instead (unverified -- works correctly for all the hardware I have) 26962306a36Sopenharmony_ci 27062306a36Sopenharmony_ci*/ 27162306a36Sopenharmony_ci 27262306a36Sopenharmony_ci 27362306a36Sopenharmony_ci 27462306a36Sopenharmony_cienum chip_capability_flags {CanHaveMII=1, }; 27562306a36Sopenharmony_ci 27662306a36Sopenharmony_cienum chipset { 27762306a36Sopenharmony_ci CH_6915 = 0, 27862306a36Sopenharmony_ci}; 27962306a36Sopenharmony_ci 28062306a36Sopenharmony_cistatic const struct pci_device_id starfire_pci_tbl[] = { 28162306a36Sopenharmony_ci { PCI_VDEVICE(ADAPTEC, 0x6915), CH_6915 }, 28262306a36Sopenharmony_ci { 0, } 28362306a36Sopenharmony_ci}; 28462306a36Sopenharmony_ciMODULE_DEVICE_TABLE(pci, starfire_pci_tbl); 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_ci/* A chip capabilities table, matching the CH_xxx entries in xxx_pci_tbl[] above. */ 28762306a36Sopenharmony_cistatic const struct chip_info { 28862306a36Sopenharmony_ci const char *name; 28962306a36Sopenharmony_ci int drv_flags; 29062306a36Sopenharmony_ci} netdrv_tbl[] = { 29162306a36Sopenharmony_ci { "Adaptec Starfire 6915", CanHaveMII }, 29262306a36Sopenharmony_ci}; 29362306a36Sopenharmony_ci 29462306a36Sopenharmony_ci 29562306a36Sopenharmony_ci/* Offsets to the device registers. 29662306a36Sopenharmony_ci Unlike software-only systems, device drivers interact with complex hardware. 29762306a36Sopenharmony_ci It's not useful to define symbolic names for every register bit in the 29862306a36Sopenharmony_ci device. The name can only partially document the semantics and make 29962306a36Sopenharmony_ci the driver longer and more difficult to read. 30062306a36Sopenharmony_ci In general, only the important configuration values or bits changed 30162306a36Sopenharmony_ci multiple times should be defined symbolically. 30262306a36Sopenharmony_ci*/ 30362306a36Sopenharmony_cienum register_offsets { 30462306a36Sopenharmony_ci PCIDeviceConfig=0x50040, GenCtrl=0x50070, IntrTimerCtrl=0x50074, 30562306a36Sopenharmony_ci IntrClear=0x50080, IntrStatus=0x50084, IntrEnable=0x50088, 30662306a36Sopenharmony_ci MIICtrl=0x52000, TxStationAddr=0x50120, EEPROMCtrl=0x51000, 30762306a36Sopenharmony_ci GPIOCtrl=0x5008C, TxDescCtrl=0x50090, 30862306a36Sopenharmony_ci TxRingPtr=0x50098, HiPriTxRingPtr=0x50094, /* Low and High priority. */ 30962306a36Sopenharmony_ci TxRingHiAddr=0x5009C, /* 64 bit address extension. */ 31062306a36Sopenharmony_ci TxProducerIdx=0x500A0, TxConsumerIdx=0x500A4, 31162306a36Sopenharmony_ci TxThreshold=0x500B0, 31262306a36Sopenharmony_ci CompletionHiAddr=0x500B4, TxCompletionAddr=0x500B8, 31362306a36Sopenharmony_ci RxCompletionAddr=0x500BC, RxCompletionQ2Addr=0x500C0, 31462306a36Sopenharmony_ci CompletionQConsumerIdx=0x500C4, RxDMACtrl=0x500D0, 31562306a36Sopenharmony_ci RxDescQCtrl=0x500D4, RxDescQHiAddr=0x500DC, RxDescQAddr=0x500E0, 31662306a36Sopenharmony_ci RxDescQIdx=0x500E8, RxDMAStatus=0x500F0, RxFilterMode=0x500F4, 31762306a36Sopenharmony_ci TxMode=0x55000, VlanType=0x55064, 31862306a36Sopenharmony_ci PerfFilterTable=0x56000, HashTable=0x56100, 31962306a36Sopenharmony_ci TxGfpMem=0x58000, RxGfpMem=0x5a000, 32062306a36Sopenharmony_ci}; 32162306a36Sopenharmony_ci 32262306a36Sopenharmony_ci/* 32362306a36Sopenharmony_ci * Bits in the interrupt status/mask registers. 32462306a36Sopenharmony_ci * Warning: setting Intr[Ab]NormalSummary in the IntrEnable register 32562306a36Sopenharmony_ci * enables all the interrupt sources that are or'ed into those status bits. 32662306a36Sopenharmony_ci */ 32762306a36Sopenharmony_cienum intr_status_bits { 32862306a36Sopenharmony_ci IntrLinkChange=0xf0000000, IntrStatsMax=0x08000000, 32962306a36Sopenharmony_ci IntrAbnormalSummary=0x02000000, IntrGeneralTimer=0x01000000, 33062306a36Sopenharmony_ci IntrSoftware=0x800000, IntrRxComplQ1Low=0x400000, 33162306a36Sopenharmony_ci IntrTxComplQLow=0x200000, IntrPCI=0x100000, 33262306a36Sopenharmony_ci IntrDMAErr=0x080000, IntrTxDataLow=0x040000, 33362306a36Sopenharmony_ci IntrRxComplQ2Low=0x020000, IntrRxDescQ1Low=0x010000, 33462306a36Sopenharmony_ci IntrNormalSummary=0x8000, IntrTxDone=0x4000, 33562306a36Sopenharmony_ci IntrTxDMADone=0x2000, IntrTxEmpty=0x1000, 33662306a36Sopenharmony_ci IntrEarlyRxQ2=0x0800, IntrEarlyRxQ1=0x0400, 33762306a36Sopenharmony_ci IntrRxQ2Done=0x0200, IntrRxQ1Done=0x0100, 33862306a36Sopenharmony_ci IntrRxGFPDead=0x80, IntrRxDescQ2Low=0x40, 33962306a36Sopenharmony_ci IntrNoTxCsum=0x20, IntrTxBadID=0x10, 34062306a36Sopenharmony_ci IntrHiPriTxBadID=0x08, IntrRxGfp=0x04, 34162306a36Sopenharmony_ci IntrTxGfp=0x02, IntrPCIPad=0x01, 34262306a36Sopenharmony_ci /* not quite bits */ 34362306a36Sopenharmony_ci IntrRxDone=IntrRxQ2Done | IntrRxQ1Done, 34462306a36Sopenharmony_ci IntrRxEmpty=IntrRxDescQ1Low | IntrRxDescQ2Low, 34562306a36Sopenharmony_ci IntrNormalMask=0xff00, IntrAbnormalMask=0x3ff00fe, 34662306a36Sopenharmony_ci}; 34762306a36Sopenharmony_ci 34862306a36Sopenharmony_ci/* Bits in the RxFilterMode register. */ 34962306a36Sopenharmony_cienum rx_mode_bits { 35062306a36Sopenharmony_ci AcceptBroadcast=0x04, AcceptAllMulticast=0x02, AcceptAll=0x01, 35162306a36Sopenharmony_ci AcceptMulticast=0x10, PerfectFilter=0x40, HashFilter=0x30, 35262306a36Sopenharmony_ci PerfectFilterVlan=0x80, MinVLANPrio=0xE000, VlanMode=0x0200, 35362306a36Sopenharmony_ci WakeupOnGFP=0x0800, 35462306a36Sopenharmony_ci}; 35562306a36Sopenharmony_ci 35662306a36Sopenharmony_ci/* Bits in the TxMode register */ 35762306a36Sopenharmony_cienum tx_mode_bits { 35862306a36Sopenharmony_ci MiiSoftReset=0x8000, MIILoopback=0x4000, 35962306a36Sopenharmony_ci TxFlowEnable=0x0800, RxFlowEnable=0x0400, 36062306a36Sopenharmony_ci PadEnable=0x04, FullDuplex=0x02, HugeFrame=0x01, 36162306a36Sopenharmony_ci}; 36262306a36Sopenharmony_ci 36362306a36Sopenharmony_ci/* Bits in the TxDescCtrl register. */ 36462306a36Sopenharmony_cienum tx_ctrl_bits { 36562306a36Sopenharmony_ci TxDescSpaceUnlim=0x00, TxDescSpace32=0x10, TxDescSpace64=0x20, 36662306a36Sopenharmony_ci TxDescSpace128=0x30, TxDescSpace256=0x40, 36762306a36Sopenharmony_ci TxDescType0=0x00, TxDescType1=0x01, TxDescType2=0x02, 36862306a36Sopenharmony_ci TxDescType3=0x03, TxDescType4=0x04, 36962306a36Sopenharmony_ci TxNoDMACompletion=0x08, 37062306a36Sopenharmony_ci TxDescQAddr64bit=0x80, TxDescQAddr32bit=0, 37162306a36Sopenharmony_ci TxHiPriFIFOThreshShift=24, TxPadLenShift=16, 37262306a36Sopenharmony_ci TxDMABurstSizeShift=8, 37362306a36Sopenharmony_ci}; 37462306a36Sopenharmony_ci 37562306a36Sopenharmony_ci/* Bits in the RxDescQCtrl register. */ 37662306a36Sopenharmony_cienum rx_ctrl_bits { 37762306a36Sopenharmony_ci RxBufferLenShift=16, RxMinDescrThreshShift=0, 37862306a36Sopenharmony_ci RxPrefetchMode=0x8000, RxVariableQ=0x2000, 37962306a36Sopenharmony_ci Rx2048QEntries=0x4000, Rx256QEntries=0, 38062306a36Sopenharmony_ci RxDescAddr64bit=0x1000, RxDescAddr32bit=0, 38162306a36Sopenharmony_ci RxDescQAddr64bit=0x0100, RxDescQAddr32bit=0, 38262306a36Sopenharmony_ci RxDescSpace4=0x000, RxDescSpace8=0x100, 38362306a36Sopenharmony_ci RxDescSpace16=0x200, RxDescSpace32=0x300, 38462306a36Sopenharmony_ci RxDescSpace64=0x400, RxDescSpace128=0x500, 38562306a36Sopenharmony_ci RxConsumerWrEn=0x80, 38662306a36Sopenharmony_ci}; 38762306a36Sopenharmony_ci 38862306a36Sopenharmony_ci/* Bits in the RxDMACtrl register. */ 38962306a36Sopenharmony_cienum rx_dmactrl_bits { 39062306a36Sopenharmony_ci RxReportBadFrames=0x80000000, RxDMAShortFrames=0x40000000, 39162306a36Sopenharmony_ci RxDMABadFrames=0x20000000, RxDMACrcErrorFrames=0x10000000, 39262306a36Sopenharmony_ci RxDMAControlFrame=0x08000000, RxDMAPauseFrame=0x04000000, 39362306a36Sopenharmony_ci RxChecksumIgnore=0, RxChecksumRejectTCPUDP=0x02000000, 39462306a36Sopenharmony_ci RxChecksumRejectTCPOnly=0x01000000, 39562306a36Sopenharmony_ci RxCompletionQ2Enable=0x800000, 39662306a36Sopenharmony_ci RxDMAQ2Disable=0, RxDMAQ2FPOnly=0x100000, 39762306a36Sopenharmony_ci RxDMAQ2SmallPkt=0x200000, RxDMAQ2HighPrio=0x300000, 39862306a36Sopenharmony_ci RxDMAQ2NonIP=0x400000, 39962306a36Sopenharmony_ci RxUseBackupQueue=0x080000, RxDMACRC=0x040000, 40062306a36Sopenharmony_ci RxEarlyIntThreshShift=12, RxHighPrioThreshShift=8, 40162306a36Sopenharmony_ci RxBurstSizeShift=0, 40262306a36Sopenharmony_ci}; 40362306a36Sopenharmony_ci 40462306a36Sopenharmony_ci/* Bits in the RxCompletionAddr register */ 40562306a36Sopenharmony_cienum rx_compl_bits { 40662306a36Sopenharmony_ci RxComplQAddr64bit=0x80, RxComplQAddr32bit=0, 40762306a36Sopenharmony_ci RxComplProducerWrEn=0x40, 40862306a36Sopenharmony_ci RxComplType0=0x00, RxComplType1=0x10, 40962306a36Sopenharmony_ci RxComplType2=0x20, RxComplType3=0x30, 41062306a36Sopenharmony_ci RxComplThreshShift=0, 41162306a36Sopenharmony_ci}; 41262306a36Sopenharmony_ci 41362306a36Sopenharmony_ci/* Bits in the TxCompletionAddr register */ 41462306a36Sopenharmony_cienum tx_compl_bits { 41562306a36Sopenharmony_ci TxComplQAddr64bit=0x80, TxComplQAddr32bit=0, 41662306a36Sopenharmony_ci TxComplProducerWrEn=0x40, 41762306a36Sopenharmony_ci TxComplIntrStatus=0x20, 41862306a36Sopenharmony_ci CommonQueueMode=0x10, 41962306a36Sopenharmony_ci TxComplThreshShift=0, 42062306a36Sopenharmony_ci}; 42162306a36Sopenharmony_ci 42262306a36Sopenharmony_ci/* Bits in the GenCtrl register */ 42362306a36Sopenharmony_cienum gen_ctrl_bits { 42462306a36Sopenharmony_ci RxEnable=0x05, TxEnable=0x0a, 42562306a36Sopenharmony_ci RxGFPEnable=0x10, TxGFPEnable=0x20, 42662306a36Sopenharmony_ci}; 42762306a36Sopenharmony_ci 42862306a36Sopenharmony_ci/* Bits in the IntrTimerCtrl register */ 42962306a36Sopenharmony_cienum intr_ctrl_bits { 43062306a36Sopenharmony_ci Timer10X=0x800, EnableIntrMasking=0x60, SmallFrameBypass=0x100, 43162306a36Sopenharmony_ci SmallFrame64=0, SmallFrame128=0x200, SmallFrame256=0x400, SmallFrame512=0x600, 43262306a36Sopenharmony_ci IntrLatencyMask=0x1f, 43362306a36Sopenharmony_ci}; 43462306a36Sopenharmony_ci 43562306a36Sopenharmony_ci/* The Rx and Tx buffer descriptors. */ 43662306a36Sopenharmony_cistruct starfire_rx_desc { 43762306a36Sopenharmony_ci netdrv_addr_t rxaddr; 43862306a36Sopenharmony_ci}; 43962306a36Sopenharmony_cienum rx_desc_bits { 44062306a36Sopenharmony_ci RxDescValid=1, RxDescEndRing=2, 44162306a36Sopenharmony_ci}; 44262306a36Sopenharmony_ci 44362306a36Sopenharmony_ci/* Completion queue entry. */ 44462306a36Sopenharmony_cistruct short_rx_done_desc { 44562306a36Sopenharmony_ci __le32 status; /* Low 16 bits is length. */ 44662306a36Sopenharmony_ci}; 44762306a36Sopenharmony_cistruct basic_rx_done_desc { 44862306a36Sopenharmony_ci __le32 status; /* Low 16 bits is length. */ 44962306a36Sopenharmony_ci __le16 vlanid; 45062306a36Sopenharmony_ci __le16 status2; 45162306a36Sopenharmony_ci}; 45262306a36Sopenharmony_cistruct csum_rx_done_desc { 45362306a36Sopenharmony_ci __le32 status; /* Low 16 bits is length. */ 45462306a36Sopenharmony_ci __le16 csum; /* Partial checksum */ 45562306a36Sopenharmony_ci __le16 status2; 45662306a36Sopenharmony_ci}; 45762306a36Sopenharmony_cistruct full_rx_done_desc { 45862306a36Sopenharmony_ci __le32 status; /* Low 16 bits is length. */ 45962306a36Sopenharmony_ci __le16 status3; 46062306a36Sopenharmony_ci __le16 status2; 46162306a36Sopenharmony_ci __le16 vlanid; 46262306a36Sopenharmony_ci __le16 csum; /* partial checksum */ 46362306a36Sopenharmony_ci __le32 timestamp; 46462306a36Sopenharmony_ci}; 46562306a36Sopenharmony_ci/* XXX: this is ugly and I'm not sure it's worth the trouble -Ion */ 46662306a36Sopenharmony_ci#ifdef VLAN_SUPPORT 46762306a36Sopenharmony_citypedef struct full_rx_done_desc rx_done_desc; 46862306a36Sopenharmony_ci#define RxComplType RxComplType3 46962306a36Sopenharmony_ci#else /* not VLAN_SUPPORT */ 47062306a36Sopenharmony_citypedef struct csum_rx_done_desc rx_done_desc; 47162306a36Sopenharmony_ci#define RxComplType RxComplType2 47262306a36Sopenharmony_ci#endif /* not VLAN_SUPPORT */ 47362306a36Sopenharmony_ci 47462306a36Sopenharmony_cienum rx_done_bits { 47562306a36Sopenharmony_ci RxOK=0x20000000, RxFIFOErr=0x10000000, RxBufQ2=0x08000000, 47662306a36Sopenharmony_ci}; 47762306a36Sopenharmony_ci 47862306a36Sopenharmony_ci/* Type 1 Tx descriptor. */ 47962306a36Sopenharmony_cistruct starfire_tx_desc_1 { 48062306a36Sopenharmony_ci __le32 status; /* Upper bits are status, lower 16 length. */ 48162306a36Sopenharmony_ci __le32 addr; 48262306a36Sopenharmony_ci}; 48362306a36Sopenharmony_ci 48462306a36Sopenharmony_ci/* Type 2 Tx descriptor. */ 48562306a36Sopenharmony_cistruct starfire_tx_desc_2 { 48662306a36Sopenharmony_ci __le32 status; /* Upper bits are status, lower 16 length. */ 48762306a36Sopenharmony_ci __le32 reserved; 48862306a36Sopenharmony_ci __le64 addr; 48962306a36Sopenharmony_ci}; 49062306a36Sopenharmony_ci 49162306a36Sopenharmony_ci#ifdef ADDR_64BITS 49262306a36Sopenharmony_citypedef struct starfire_tx_desc_2 starfire_tx_desc; 49362306a36Sopenharmony_ci#define TX_DESC_TYPE TxDescType2 49462306a36Sopenharmony_ci#else /* not ADDR_64BITS */ 49562306a36Sopenharmony_citypedef struct starfire_tx_desc_1 starfire_tx_desc; 49662306a36Sopenharmony_ci#define TX_DESC_TYPE TxDescType1 49762306a36Sopenharmony_ci#endif /* not ADDR_64BITS */ 49862306a36Sopenharmony_ci#define TX_DESC_SPACING TxDescSpaceUnlim 49962306a36Sopenharmony_ci 50062306a36Sopenharmony_cienum tx_desc_bits { 50162306a36Sopenharmony_ci TxDescID=0xB0000000, 50262306a36Sopenharmony_ci TxCRCEn=0x01000000, TxDescIntr=0x08000000, 50362306a36Sopenharmony_ci TxRingWrap=0x04000000, TxCalTCP=0x02000000, 50462306a36Sopenharmony_ci}; 50562306a36Sopenharmony_cistruct tx_done_desc { 50662306a36Sopenharmony_ci __le32 status; /* timestamp, index. */ 50762306a36Sopenharmony_ci#if 0 50862306a36Sopenharmony_ci __le32 intrstatus; /* interrupt status */ 50962306a36Sopenharmony_ci#endif 51062306a36Sopenharmony_ci}; 51162306a36Sopenharmony_ci 51262306a36Sopenharmony_cistruct rx_ring_info { 51362306a36Sopenharmony_ci struct sk_buff *skb; 51462306a36Sopenharmony_ci dma_addr_t mapping; 51562306a36Sopenharmony_ci}; 51662306a36Sopenharmony_cistruct tx_ring_info { 51762306a36Sopenharmony_ci struct sk_buff *skb; 51862306a36Sopenharmony_ci dma_addr_t mapping; 51962306a36Sopenharmony_ci unsigned int used_slots; 52062306a36Sopenharmony_ci}; 52162306a36Sopenharmony_ci 52262306a36Sopenharmony_ci#define PHY_CNT 2 52362306a36Sopenharmony_cistruct netdev_private { 52462306a36Sopenharmony_ci /* Descriptor rings first for alignment. */ 52562306a36Sopenharmony_ci struct starfire_rx_desc *rx_ring; 52662306a36Sopenharmony_ci starfire_tx_desc *tx_ring; 52762306a36Sopenharmony_ci dma_addr_t rx_ring_dma; 52862306a36Sopenharmony_ci dma_addr_t tx_ring_dma; 52962306a36Sopenharmony_ci /* The addresses of rx/tx-in-place skbuffs. */ 53062306a36Sopenharmony_ci struct rx_ring_info rx_info[RX_RING_SIZE]; 53162306a36Sopenharmony_ci struct tx_ring_info tx_info[TX_RING_SIZE]; 53262306a36Sopenharmony_ci /* Pointers to completion queues (full pages). */ 53362306a36Sopenharmony_ci rx_done_desc *rx_done_q; 53462306a36Sopenharmony_ci dma_addr_t rx_done_q_dma; 53562306a36Sopenharmony_ci unsigned int rx_done; 53662306a36Sopenharmony_ci struct tx_done_desc *tx_done_q; 53762306a36Sopenharmony_ci dma_addr_t tx_done_q_dma; 53862306a36Sopenharmony_ci unsigned int tx_done; 53962306a36Sopenharmony_ci struct napi_struct napi; 54062306a36Sopenharmony_ci struct net_device *dev; 54162306a36Sopenharmony_ci struct pci_dev *pci_dev; 54262306a36Sopenharmony_ci#ifdef VLAN_SUPPORT 54362306a36Sopenharmony_ci unsigned long active_vlans[BITS_TO_LONGS(VLAN_N_VID)]; 54462306a36Sopenharmony_ci#endif 54562306a36Sopenharmony_ci void *queue_mem; 54662306a36Sopenharmony_ci dma_addr_t queue_mem_dma; 54762306a36Sopenharmony_ci size_t queue_mem_size; 54862306a36Sopenharmony_ci 54962306a36Sopenharmony_ci /* Frequently used values: keep some adjacent for cache effect. */ 55062306a36Sopenharmony_ci spinlock_t lock; 55162306a36Sopenharmony_ci unsigned int cur_rx, dirty_rx; /* Producer/consumer ring indices */ 55262306a36Sopenharmony_ci unsigned int cur_tx, dirty_tx, reap_tx; 55362306a36Sopenharmony_ci unsigned int rx_buf_sz; /* Based on MTU+slack. */ 55462306a36Sopenharmony_ci /* These values keep track of the transceiver/media in use. */ 55562306a36Sopenharmony_ci int speed100; /* Set if speed == 100MBit. */ 55662306a36Sopenharmony_ci u32 tx_mode; 55762306a36Sopenharmony_ci u32 intr_timer_ctrl; 55862306a36Sopenharmony_ci u8 tx_threshold; 55962306a36Sopenharmony_ci /* MII transceiver section. */ 56062306a36Sopenharmony_ci struct mii_if_info mii_if; /* MII lib hooks/info */ 56162306a36Sopenharmony_ci int phy_cnt; /* MII device addresses. */ 56262306a36Sopenharmony_ci unsigned char phys[PHY_CNT]; /* MII device addresses. */ 56362306a36Sopenharmony_ci void __iomem *base; 56462306a36Sopenharmony_ci}; 56562306a36Sopenharmony_ci 56662306a36Sopenharmony_ci 56762306a36Sopenharmony_cistatic int mdio_read(struct net_device *dev, int phy_id, int location); 56862306a36Sopenharmony_cistatic void mdio_write(struct net_device *dev, int phy_id, int location, int value); 56962306a36Sopenharmony_cistatic int netdev_open(struct net_device *dev); 57062306a36Sopenharmony_cistatic void check_duplex(struct net_device *dev); 57162306a36Sopenharmony_cistatic void tx_timeout(struct net_device *dev, unsigned int txqueue); 57262306a36Sopenharmony_cistatic void init_ring(struct net_device *dev); 57362306a36Sopenharmony_cistatic netdev_tx_t start_tx(struct sk_buff *skb, struct net_device *dev); 57462306a36Sopenharmony_cistatic irqreturn_t intr_handler(int irq, void *dev_instance); 57562306a36Sopenharmony_cistatic void netdev_error(struct net_device *dev, int intr_status); 57662306a36Sopenharmony_cistatic int __netdev_rx(struct net_device *dev, int *quota); 57762306a36Sopenharmony_cistatic int netdev_poll(struct napi_struct *napi, int budget); 57862306a36Sopenharmony_cistatic void refill_rx_ring(struct net_device *dev); 57962306a36Sopenharmony_cistatic void netdev_error(struct net_device *dev, int intr_status); 58062306a36Sopenharmony_cistatic void set_rx_mode(struct net_device *dev); 58162306a36Sopenharmony_cistatic struct net_device_stats *get_stats(struct net_device *dev); 58262306a36Sopenharmony_cistatic int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); 58362306a36Sopenharmony_cistatic int netdev_close(struct net_device *dev); 58462306a36Sopenharmony_cistatic void netdev_media_change(struct net_device *dev); 58562306a36Sopenharmony_cistatic const struct ethtool_ops ethtool_ops; 58662306a36Sopenharmony_ci 58762306a36Sopenharmony_ci 58862306a36Sopenharmony_ci#ifdef VLAN_SUPPORT 58962306a36Sopenharmony_cistatic int netdev_vlan_rx_add_vid(struct net_device *dev, 59062306a36Sopenharmony_ci __be16 proto, u16 vid) 59162306a36Sopenharmony_ci{ 59262306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 59362306a36Sopenharmony_ci 59462306a36Sopenharmony_ci spin_lock(&np->lock); 59562306a36Sopenharmony_ci if (debug > 1) 59662306a36Sopenharmony_ci printk("%s: Adding vlanid %d to vlan filter\n", dev->name, vid); 59762306a36Sopenharmony_ci set_bit(vid, np->active_vlans); 59862306a36Sopenharmony_ci set_rx_mode(dev); 59962306a36Sopenharmony_ci spin_unlock(&np->lock); 60062306a36Sopenharmony_ci 60162306a36Sopenharmony_ci return 0; 60262306a36Sopenharmony_ci} 60362306a36Sopenharmony_ci 60462306a36Sopenharmony_cistatic int netdev_vlan_rx_kill_vid(struct net_device *dev, 60562306a36Sopenharmony_ci __be16 proto, u16 vid) 60662306a36Sopenharmony_ci{ 60762306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 60862306a36Sopenharmony_ci 60962306a36Sopenharmony_ci spin_lock(&np->lock); 61062306a36Sopenharmony_ci if (debug > 1) 61162306a36Sopenharmony_ci printk("%s: removing vlanid %d from vlan filter\n", dev->name, vid); 61262306a36Sopenharmony_ci clear_bit(vid, np->active_vlans); 61362306a36Sopenharmony_ci set_rx_mode(dev); 61462306a36Sopenharmony_ci spin_unlock(&np->lock); 61562306a36Sopenharmony_ci 61662306a36Sopenharmony_ci return 0; 61762306a36Sopenharmony_ci} 61862306a36Sopenharmony_ci#endif /* VLAN_SUPPORT */ 61962306a36Sopenharmony_ci 62062306a36Sopenharmony_ci 62162306a36Sopenharmony_cistatic const struct net_device_ops netdev_ops = { 62262306a36Sopenharmony_ci .ndo_open = netdev_open, 62362306a36Sopenharmony_ci .ndo_stop = netdev_close, 62462306a36Sopenharmony_ci .ndo_start_xmit = start_tx, 62562306a36Sopenharmony_ci .ndo_tx_timeout = tx_timeout, 62662306a36Sopenharmony_ci .ndo_get_stats = get_stats, 62762306a36Sopenharmony_ci .ndo_set_rx_mode = set_rx_mode, 62862306a36Sopenharmony_ci .ndo_eth_ioctl = netdev_ioctl, 62962306a36Sopenharmony_ci .ndo_set_mac_address = eth_mac_addr, 63062306a36Sopenharmony_ci .ndo_validate_addr = eth_validate_addr, 63162306a36Sopenharmony_ci#ifdef VLAN_SUPPORT 63262306a36Sopenharmony_ci .ndo_vlan_rx_add_vid = netdev_vlan_rx_add_vid, 63362306a36Sopenharmony_ci .ndo_vlan_rx_kill_vid = netdev_vlan_rx_kill_vid, 63462306a36Sopenharmony_ci#endif 63562306a36Sopenharmony_ci}; 63662306a36Sopenharmony_ci 63762306a36Sopenharmony_cistatic int starfire_init_one(struct pci_dev *pdev, 63862306a36Sopenharmony_ci const struct pci_device_id *ent) 63962306a36Sopenharmony_ci{ 64062306a36Sopenharmony_ci struct device *d = &pdev->dev; 64162306a36Sopenharmony_ci struct netdev_private *np; 64262306a36Sopenharmony_ci int i, irq, chip_idx = ent->driver_data; 64362306a36Sopenharmony_ci struct net_device *dev; 64462306a36Sopenharmony_ci u8 addr[ETH_ALEN]; 64562306a36Sopenharmony_ci long ioaddr; 64662306a36Sopenharmony_ci void __iomem *base; 64762306a36Sopenharmony_ci int drv_flags, io_size; 64862306a36Sopenharmony_ci int boguscnt; 64962306a36Sopenharmony_ci 65062306a36Sopenharmony_ci if (pci_enable_device (pdev)) 65162306a36Sopenharmony_ci return -EIO; 65262306a36Sopenharmony_ci 65362306a36Sopenharmony_ci ioaddr = pci_resource_start(pdev, 0); 65462306a36Sopenharmony_ci io_size = pci_resource_len(pdev, 0); 65562306a36Sopenharmony_ci if (!ioaddr || ((pci_resource_flags(pdev, 0) & IORESOURCE_MEM) == 0)) { 65662306a36Sopenharmony_ci dev_err(d, "no PCI MEM resources, aborting\n"); 65762306a36Sopenharmony_ci return -ENODEV; 65862306a36Sopenharmony_ci } 65962306a36Sopenharmony_ci 66062306a36Sopenharmony_ci dev = alloc_etherdev(sizeof(*np)); 66162306a36Sopenharmony_ci if (!dev) 66262306a36Sopenharmony_ci return -ENOMEM; 66362306a36Sopenharmony_ci 66462306a36Sopenharmony_ci SET_NETDEV_DEV(dev, &pdev->dev); 66562306a36Sopenharmony_ci 66662306a36Sopenharmony_ci irq = pdev->irq; 66762306a36Sopenharmony_ci 66862306a36Sopenharmony_ci if (pci_request_regions (pdev, DRV_NAME)) { 66962306a36Sopenharmony_ci dev_err(d, "cannot reserve PCI resources, aborting\n"); 67062306a36Sopenharmony_ci goto err_out_free_netdev; 67162306a36Sopenharmony_ci } 67262306a36Sopenharmony_ci 67362306a36Sopenharmony_ci base = ioremap(ioaddr, io_size); 67462306a36Sopenharmony_ci if (!base) { 67562306a36Sopenharmony_ci dev_err(d, "cannot remap %#x @ %#lx, aborting\n", 67662306a36Sopenharmony_ci io_size, ioaddr); 67762306a36Sopenharmony_ci goto err_out_free_res; 67862306a36Sopenharmony_ci } 67962306a36Sopenharmony_ci 68062306a36Sopenharmony_ci pci_set_master(pdev); 68162306a36Sopenharmony_ci 68262306a36Sopenharmony_ci /* enable MWI -- it vastly improves Rx performance on sparc64 */ 68362306a36Sopenharmony_ci pci_try_set_mwi(pdev); 68462306a36Sopenharmony_ci 68562306a36Sopenharmony_ci#ifdef ZEROCOPY 68662306a36Sopenharmony_ci /* Starfire can do TCP/UDP checksumming */ 68762306a36Sopenharmony_ci if (enable_hw_cksum) 68862306a36Sopenharmony_ci dev->features |= NETIF_F_IP_CSUM | NETIF_F_SG; 68962306a36Sopenharmony_ci#endif /* ZEROCOPY */ 69062306a36Sopenharmony_ci 69162306a36Sopenharmony_ci#ifdef VLAN_SUPPORT 69262306a36Sopenharmony_ci dev->features |= NETIF_F_HW_VLAN_CTAG_RX | NETIF_F_HW_VLAN_CTAG_FILTER; 69362306a36Sopenharmony_ci#endif /* VLAN_RX_KILL_VID */ 69462306a36Sopenharmony_ci#ifdef ADDR_64BITS 69562306a36Sopenharmony_ci dev->features |= NETIF_F_HIGHDMA; 69662306a36Sopenharmony_ci#endif /* ADDR_64BITS */ 69762306a36Sopenharmony_ci 69862306a36Sopenharmony_ci /* Serial EEPROM reads are hidden by the hardware. */ 69962306a36Sopenharmony_ci for (i = 0; i < 6; i++) 70062306a36Sopenharmony_ci addr[i] = readb(base + EEPROMCtrl + 20 - i); 70162306a36Sopenharmony_ci eth_hw_addr_set(dev, addr); 70262306a36Sopenharmony_ci 70362306a36Sopenharmony_ci#if ! defined(final_version) /* Dump the EEPROM contents during development. */ 70462306a36Sopenharmony_ci if (debug > 4) 70562306a36Sopenharmony_ci for (i = 0; i < 0x20; i++) 70662306a36Sopenharmony_ci printk("%2.2x%s", 70762306a36Sopenharmony_ci (unsigned int)readb(base + EEPROMCtrl + i), 70862306a36Sopenharmony_ci i % 16 != 15 ? " " : "\n"); 70962306a36Sopenharmony_ci#endif 71062306a36Sopenharmony_ci 71162306a36Sopenharmony_ci /* Issue soft reset */ 71262306a36Sopenharmony_ci writel(MiiSoftReset, base + TxMode); 71362306a36Sopenharmony_ci udelay(1000); 71462306a36Sopenharmony_ci writel(0, base + TxMode); 71562306a36Sopenharmony_ci 71662306a36Sopenharmony_ci /* Reset the chip to erase previous misconfiguration. */ 71762306a36Sopenharmony_ci writel(1, base + PCIDeviceConfig); 71862306a36Sopenharmony_ci boguscnt = 1000; 71962306a36Sopenharmony_ci while (--boguscnt > 0) { 72062306a36Sopenharmony_ci udelay(10); 72162306a36Sopenharmony_ci if ((readl(base + PCIDeviceConfig) & 1) == 0) 72262306a36Sopenharmony_ci break; 72362306a36Sopenharmony_ci } 72462306a36Sopenharmony_ci if (boguscnt == 0) 72562306a36Sopenharmony_ci printk("%s: chipset reset never completed!\n", dev->name); 72662306a36Sopenharmony_ci /* wait a little longer */ 72762306a36Sopenharmony_ci udelay(1000); 72862306a36Sopenharmony_ci 72962306a36Sopenharmony_ci np = netdev_priv(dev); 73062306a36Sopenharmony_ci np->dev = dev; 73162306a36Sopenharmony_ci np->base = base; 73262306a36Sopenharmony_ci spin_lock_init(&np->lock); 73362306a36Sopenharmony_ci pci_set_drvdata(pdev, dev); 73462306a36Sopenharmony_ci 73562306a36Sopenharmony_ci np->pci_dev = pdev; 73662306a36Sopenharmony_ci 73762306a36Sopenharmony_ci np->mii_if.dev = dev; 73862306a36Sopenharmony_ci np->mii_if.mdio_read = mdio_read; 73962306a36Sopenharmony_ci np->mii_if.mdio_write = mdio_write; 74062306a36Sopenharmony_ci np->mii_if.phy_id_mask = 0x1f; 74162306a36Sopenharmony_ci np->mii_if.reg_num_mask = 0x1f; 74262306a36Sopenharmony_ci 74362306a36Sopenharmony_ci drv_flags = netdrv_tbl[chip_idx].drv_flags; 74462306a36Sopenharmony_ci 74562306a36Sopenharmony_ci np->speed100 = 1; 74662306a36Sopenharmony_ci 74762306a36Sopenharmony_ci /* timer resolution is 128 * 0.8us */ 74862306a36Sopenharmony_ci np->intr_timer_ctrl = (((intr_latency * 10) / 1024) & IntrLatencyMask) | 74962306a36Sopenharmony_ci Timer10X | EnableIntrMasking; 75062306a36Sopenharmony_ci 75162306a36Sopenharmony_ci if (small_frames > 0) { 75262306a36Sopenharmony_ci np->intr_timer_ctrl |= SmallFrameBypass; 75362306a36Sopenharmony_ci switch (small_frames) { 75462306a36Sopenharmony_ci case 1 ... 64: 75562306a36Sopenharmony_ci np->intr_timer_ctrl |= SmallFrame64; 75662306a36Sopenharmony_ci break; 75762306a36Sopenharmony_ci case 65 ... 128: 75862306a36Sopenharmony_ci np->intr_timer_ctrl |= SmallFrame128; 75962306a36Sopenharmony_ci break; 76062306a36Sopenharmony_ci case 129 ... 256: 76162306a36Sopenharmony_ci np->intr_timer_ctrl |= SmallFrame256; 76262306a36Sopenharmony_ci break; 76362306a36Sopenharmony_ci default: 76462306a36Sopenharmony_ci np->intr_timer_ctrl |= SmallFrame512; 76562306a36Sopenharmony_ci if (small_frames > 512) 76662306a36Sopenharmony_ci printk("Adjusting small_frames down to 512\n"); 76762306a36Sopenharmony_ci break; 76862306a36Sopenharmony_ci } 76962306a36Sopenharmony_ci } 77062306a36Sopenharmony_ci 77162306a36Sopenharmony_ci dev->netdev_ops = &netdev_ops; 77262306a36Sopenharmony_ci dev->watchdog_timeo = TX_TIMEOUT; 77362306a36Sopenharmony_ci dev->ethtool_ops = ðtool_ops; 77462306a36Sopenharmony_ci 77562306a36Sopenharmony_ci netif_napi_add_weight(dev, &np->napi, netdev_poll, max_interrupt_work); 77662306a36Sopenharmony_ci 77762306a36Sopenharmony_ci if (mtu) 77862306a36Sopenharmony_ci dev->mtu = mtu; 77962306a36Sopenharmony_ci 78062306a36Sopenharmony_ci if (register_netdev(dev)) 78162306a36Sopenharmony_ci goto err_out_cleardev; 78262306a36Sopenharmony_ci 78362306a36Sopenharmony_ci printk(KERN_INFO "%s: %s at %p, %pM, IRQ %d.\n", 78462306a36Sopenharmony_ci dev->name, netdrv_tbl[chip_idx].name, base, 78562306a36Sopenharmony_ci dev->dev_addr, irq); 78662306a36Sopenharmony_ci 78762306a36Sopenharmony_ci if (drv_flags & CanHaveMII) { 78862306a36Sopenharmony_ci int phy, phy_idx = 0; 78962306a36Sopenharmony_ci int mii_status; 79062306a36Sopenharmony_ci for (phy = 0; phy < 32 && phy_idx < PHY_CNT; phy++) { 79162306a36Sopenharmony_ci mdio_write(dev, phy, MII_BMCR, BMCR_RESET); 79262306a36Sopenharmony_ci msleep(100); 79362306a36Sopenharmony_ci boguscnt = 1000; 79462306a36Sopenharmony_ci while (--boguscnt > 0) 79562306a36Sopenharmony_ci if ((mdio_read(dev, phy, MII_BMCR) & BMCR_RESET) == 0) 79662306a36Sopenharmony_ci break; 79762306a36Sopenharmony_ci if (boguscnt == 0) { 79862306a36Sopenharmony_ci printk("%s: PHY#%d reset never completed!\n", dev->name, phy); 79962306a36Sopenharmony_ci continue; 80062306a36Sopenharmony_ci } 80162306a36Sopenharmony_ci mii_status = mdio_read(dev, phy, MII_BMSR); 80262306a36Sopenharmony_ci if (mii_status != 0) { 80362306a36Sopenharmony_ci np->phys[phy_idx++] = phy; 80462306a36Sopenharmony_ci np->mii_if.advertising = mdio_read(dev, phy, MII_ADVERTISE); 80562306a36Sopenharmony_ci printk(KERN_INFO "%s: MII PHY found at address %d, status " 80662306a36Sopenharmony_ci "%#4.4x advertising %#4.4x.\n", 80762306a36Sopenharmony_ci dev->name, phy, mii_status, np->mii_if.advertising); 80862306a36Sopenharmony_ci /* there can be only one PHY on-board */ 80962306a36Sopenharmony_ci break; 81062306a36Sopenharmony_ci } 81162306a36Sopenharmony_ci } 81262306a36Sopenharmony_ci np->phy_cnt = phy_idx; 81362306a36Sopenharmony_ci if (np->phy_cnt > 0) 81462306a36Sopenharmony_ci np->mii_if.phy_id = np->phys[0]; 81562306a36Sopenharmony_ci else 81662306a36Sopenharmony_ci memset(&np->mii_if, 0, sizeof(np->mii_if)); 81762306a36Sopenharmony_ci } 81862306a36Sopenharmony_ci 81962306a36Sopenharmony_ci printk(KERN_INFO "%s: scatter-gather and hardware TCP cksumming %s.\n", 82062306a36Sopenharmony_ci dev->name, enable_hw_cksum ? "enabled" : "disabled"); 82162306a36Sopenharmony_ci return 0; 82262306a36Sopenharmony_ci 82362306a36Sopenharmony_cierr_out_cleardev: 82462306a36Sopenharmony_ci iounmap(base); 82562306a36Sopenharmony_cierr_out_free_res: 82662306a36Sopenharmony_ci pci_release_regions (pdev); 82762306a36Sopenharmony_cierr_out_free_netdev: 82862306a36Sopenharmony_ci free_netdev(dev); 82962306a36Sopenharmony_ci return -ENODEV; 83062306a36Sopenharmony_ci} 83162306a36Sopenharmony_ci 83262306a36Sopenharmony_ci 83362306a36Sopenharmony_ci/* Read the MII Management Data I/O (MDIO) interfaces. */ 83462306a36Sopenharmony_cistatic int mdio_read(struct net_device *dev, int phy_id, int location) 83562306a36Sopenharmony_ci{ 83662306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 83762306a36Sopenharmony_ci void __iomem *mdio_addr = np->base + MIICtrl + (phy_id<<7) + (location<<2); 83862306a36Sopenharmony_ci int result, boguscnt=1000; 83962306a36Sopenharmony_ci /* ??? Should we add a busy-wait here? */ 84062306a36Sopenharmony_ci do { 84162306a36Sopenharmony_ci result = readl(mdio_addr); 84262306a36Sopenharmony_ci } while ((result & 0xC0000000) != 0x80000000 && --boguscnt > 0); 84362306a36Sopenharmony_ci if (boguscnt == 0) 84462306a36Sopenharmony_ci return 0; 84562306a36Sopenharmony_ci if ((result & 0xffff) == 0xffff) 84662306a36Sopenharmony_ci return 0; 84762306a36Sopenharmony_ci return result & 0xffff; 84862306a36Sopenharmony_ci} 84962306a36Sopenharmony_ci 85062306a36Sopenharmony_ci 85162306a36Sopenharmony_cistatic void mdio_write(struct net_device *dev, int phy_id, int location, int value) 85262306a36Sopenharmony_ci{ 85362306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 85462306a36Sopenharmony_ci void __iomem *mdio_addr = np->base + MIICtrl + (phy_id<<7) + (location<<2); 85562306a36Sopenharmony_ci writel(value, mdio_addr); 85662306a36Sopenharmony_ci /* The busy-wait will occur before a read. */ 85762306a36Sopenharmony_ci} 85862306a36Sopenharmony_ci 85962306a36Sopenharmony_ci 86062306a36Sopenharmony_cistatic int netdev_open(struct net_device *dev) 86162306a36Sopenharmony_ci{ 86262306a36Sopenharmony_ci const struct firmware *fw_rx, *fw_tx; 86362306a36Sopenharmony_ci const __be32 *fw_rx_data, *fw_tx_data; 86462306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 86562306a36Sopenharmony_ci void __iomem *ioaddr = np->base; 86662306a36Sopenharmony_ci const int irq = np->pci_dev->irq; 86762306a36Sopenharmony_ci int i, retval; 86862306a36Sopenharmony_ci size_t tx_size, rx_size; 86962306a36Sopenharmony_ci size_t tx_done_q_size, rx_done_q_size, tx_ring_size, rx_ring_size; 87062306a36Sopenharmony_ci 87162306a36Sopenharmony_ci /* Do we ever need to reset the chip??? */ 87262306a36Sopenharmony_ci 87362306a36Sopenharmony_ci retval = request_irq(irq, intr_handler, IRQF_SHARED, dev->name, dev); 87462306a36Sopenharmony_ci if (retval) 87562306a36Sopenharmony_ci return retval; 87662306a36Sopenharmony_ci 87762306a36Sopenharmony_ci /* Disable the Rx and Tx, and reset the chip. */ 87862306a36Sopenharmony_ci writel(0, ioaddr + GenCtrl); 87962306a36Sopenharmony_ci writel(1, ioaddr + PCIDeviceConfig); 88062306a36Sopenharmony_ci if (debug > 1) 88162306a36Sopenharmony_ci printk(KERN_DEBUG "%s: netdev_open() irq %d.\n", 88262306a36Sopenharmony_ci dev->name, irq); 88362306a36Sopenharmony_ci 88462306a36Sopenharmony_ci /* Allocate the various queues. */ 88562306a36Sopenharmony_ci if (!np->queue_mem) { 88662306a36Sopenharmony_ci tx_done_q_size = ((sizeof(struct tx_done_desc) * DONE_Q_SIZE + QUEUE_ALIGN - 1) / QUEUE_ALIGN) * QUEUE_ALIGN; 88762306a36Sopenharmony_ci rx_done_q_size = ((sizeof(rx_done_desc) * DONE_Q_SIZE + QUEUE_ALIGN - 1) / QUEUE_ALIGN) * QUEUE_ALIGN; 88862306a36Sopenharmony_ci tx_ring_size = ((sizeof(starfire_tx_desc) * TX_RING_SIZE + QUEUE_ALIGN - 1) / QUEUE_ALIGN) * QUEUE_ALIGN; 88962306a36Sopenharmony_ci rx_ring_size = sizeof(struct starfire_rx_desc) * RX_RING_SIZE; 89062306a36Sopenharmony_ci np->queue_mem_size = tx_done_q_size + rx_done_q_size + tx_ring_size + rx_ring_size; 89162306a36Sopenharmony_ci np->queue_mem = dma_alloc_coherent(&np->pci_dev->dev, 89262306a36Sopenharmony_ci np->queue_mem_size, 89362306a36Sopenharmony_ci &np->queue_mem_dma, GFP_ATOMIC); 89462306a36Sopenharmony_ci if (np->queue_mem == NULL) { 89562306a36Sopenharmony_ci free_irq(irq, dev); 89662306a36Sopenharmony_ci return -ENOMEM; 89762306a36Sopenharmony_ci } 89862306a36Sopenharmony_ci 89962306a36Sopenharmony_ci np->tx_done_q = np->queue_mem; 90062306a36Sopenharmony_ci np->tx_done_q_dma = np->queue_mem_dma; 90162306a36Sopenharmony_ci np->rx_done_q = (void *) np->tx_done_q + tx_done_q_size; 90262306a36Sopenharmony_ci np->rx_done_q_dma = np->tx_done_q_dma + tx_done_q_size; 90362306a36Sopenharmony_ci np->tx_ring = (void *) np->rx_done_q + rx_done_q_size; 90462306a36Sopenharmony_ci np->tx_ring_dma = np->rx_done_q_dma + rx_done_q_size; 90562306a36Sopenharmony_ci np->rx_ring = (void *) np->tx_ring + tx_ring_size; 90662306a36Sopenharmony_ci np->rx_ring_dma = np->tx_ring_dma + tx_ring_size; 90762306a36Sopenharmony_ci } 90862306a36Sopenharmony_ci 90962306a36Sopenharmony_ci /* Start with no carrier, it gets adjusted later */ 91062306a36Sopenharmony_ci netif_carrier_off(dev); 91162306a36Sopenharmony_ci init_ring(dev); 91262306a36Sopenharmony_ci /* Set the size of the Rx buffers. */ 91362306a36Sopenharmony_ci writel((np->rx_buf_sz << RxBufferLenShift) | 91462306a36Sopenharmony_ci (0 << RxMinDescrThreshShift) | 91562306a36Sopenharmony_ci RxPrefetchMode | RxVariableQ | 91662306a36Sopenharmony_ci RX_Q_ENTRIES | 91762306a36Sopenharmony_ci RX_DESC_Q_ADDR_SIZE | RX_DESC_ADDR_SIZE | 91862306a36Sopenharmony_ci RxDescSpace4, 91962306a36Sopenharmony_ci ioaddr + RxDescQCtrl); 92062306a36Sopenharmony_ci 92162306a36Sopenharmony_ci /* Set up the Rx DMA controller. */ 92262306a36Sopenharmony_ci writel(RxChecksumIgnore | 92362306a36Sopenharmony_ci (0 << RxEarlyIntThreshShift) | 92462306a36Sopenharmony_ci (6 << RxHighPrioThreshShift) | 92562306a36Sopenharmony_ci ((DMA_BURST_SIZE / 32) << RxBurstSizeShift), 92662306a36Sopenharmony_ci ioaddr + RxDMACtrl); 92762306a36Sopenharmony_ci 92862306a36Sopenharmony_ci /* Set Tx descriptor */ 92962306a36Sopenharmony_ci writel((2 << TxHiPriFIFOThreshShift) | 93062306a36Sopenharmony_ci (0 << TxPadLenShift) | 93162306a36Sopenharmony_ci ((DMA_BURST_SIZE / 32) << TxDMABurstSizeShift) | 93262306a36Sopenharmony_ci TX_DESC_Q_ADDR_SIZE | 93362306a36Sopenharmony_ci TX_DESC_SPACING | TX_DESC_TYPE, 93462306a36Sopenharmony_ci ioaddr + TxDescCtrl); 93562306a36Sopenharmony_ci 93662306a36Sopenharmony_ci writel( (np->queue_mem_dma >> 16) >> 16, ioaddr + RxDescQHiAddr); 93762306a36Sopenharmony_ci writel( (np->queue_mem_dma >> 16) >> 16, ioaddr + TxRingHiAddr); 93862306a36Sopenharmony_ci writel( (np->queue_mem_dma >> 16) >> 16, ioaddr + CompletionHiAddr); 93962306a36Sopenharmony_ci writel(np->rx_ring_dma, ioaddr + RxDescQAddr); 94062306a36Sopenharmony_ci writel(np->tx_ring_dma, ioaddr + TxRingPtr); 94162306a36Sopenharmony_ci 94262306a36Sopenharmony_ci writel(np->tx_done_q_dma, ioaddr + TxCompletionAddr); 94362306a36Sopenharmony_ci writel(np->rx_done_q_dma | 94462306a36Sopenharmony_ci RxComplType | 94562306a36Sopenharmony_ci (0 << RxComplThreshShift), 94662306a36Sopenharmony_ci ioaddr + RxCompletionAddr); 94762306a36Sopenharmony_ci 94862306a36Sopenharmony_ci if (debug > 1) 94962306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Filling in the station address.\n", dev->name); 95062306a36Sopenharmony_ci 95162306a36Sopenharmony_ci /* Fill both the Tx SA register and the Rx perfect filter. */ 95262306a36Sopenharmony_ci for (i = 0; i < 6; i++) 95362306a36Sopenharmony_ci writeb(dev->dev_addr[i], ioaddr + TxStationAddr + 5 - i); 95462306a36Sopenharmony_ci /* The first entry is special because it bypasses the VLAN filter. 95562306a36Sopenharmony_ci Don't use it. */ 95662306a36Sopenharmony_ci writew(0, ioaddr + PerfFilterTable); 95762306a36Sopenharmony_ci writew(0, ioaddr + PerfFilterTable + 4); 95862306a36Sopenharmony_ci writew(0, ioaddr + PerfFilterTable + 8); 95962306a36Sopenharmony_ci for (i = 1; i < 16; i++) { 96062306a36Sopenharmony_ci const __be16 *eaddrs = (const __be16 *)dev->dev_addr; 96162306a36Sopenharmony_ci void __iomem *setup_frm = ioaddr + PerfFilterTable + i * 16; 96262306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[2]), setup_frm); setup_frm += 4; 96362306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[1]), setup_frm); setup_frm += 4; 96462306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[0]), setup_frm); setup_frm += 8; 96562306a36Sopenharmony_ci } 96662306a36Sopenharmony_ci 96762306a36Sopenharmony_ci /* Initialize other registers. */ 96862306a36Sopenharmony_ci /* Configure the PCI bus bursts and FIFO thresholds. */ 96962306a36Sopenharmony_ci np->tx_mode = TxFlowEnable|RxFlowEnable|PadEnable; /* modified when link is up. */ 97062306a36Sopenharmony_ci writel(MiiSoftReset | np->tx_mode, ioaddr + TxMode); 97162306a36Sopenharmony_ci udelay(1000); 97262306a36Sopenharmony_ci writel(np->tx_mode, ioaddr + TxMode); 97362306a36Sopenharmony_ci np->tx_threshold = 4; 97462306a36Sopenharmony_ci writel(np->tx_threshold, ioaddr + TxThreshold); 97562306a36Sopenharmony_ci 97662306a36Sopenharmony_ci writel(np->intr_timer_ctrl, ioaddr + IntrTimerCtrl); 97762306a36Sopenharmony_ci 97862306a36Sopenharmony_ci napi_enable(&np->napi); 97962306a36Sopenharmony_ci 98062306a36Sopenharmony_ci netif_start_queue(dev); 98162306a36Sopenharmony_ci 98262306a36Sopenharmony_ci if (debug > 1) 98362306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Setting the Rx and Tx modes.\n", dev->name); 98462306a36Sopenharmony_ci set_rx_mode(dev); 98562306a36Sopenharmony_ci 98662306a36Sopenharmony_ci np->mii_if.advertising = mdio_read(dev, np->phys[0], MII_ADVERTISE); 98762306a36Sopenharmony_ci check_duplex(dev); 98862306a36Sopenharmony_ci 98962306a36Sopenharmony_ci /* Enable GPIO interrupts on link change */ 99062306a36Sopenharmony_ci writel(0x0f00ff00, ioaddr + GPIOCtrl); 99162306a36Sopenharmony_ci 99262306a36Sopenharmony_ci /* Set the interrupt mask */ 99362306a36Sopenharmony_ci writel(IntrRxDone | IntrRxEmpty | IntrDMAErr | 99462306a36Sopenharmony_ci IntrTxDMADone | IntrStatsMax | IntrLinkChange | 99562306a36Sopenharmony_ci IntrRxGFPDead | IntrNoTxCsum | IntrTxBadID, 99662306a36Sopenharmony_ci ioaddr + IntrEnable); 99762306a36Sopenharmony_ci /* Enable PCI interrupts. */ 99862306a36Sopenharmony_ci writel(0x00800000 | readl(ioaddr + PCIDeviceConfig), 99962306a36Sopenharmony_ci ioaddr + PCIDeviceConfig); 100062306a36Sopenharmony_ci 100162306a36Sopenharmony_ci#ifdef VLAN_SUPPORT 100262306a36Sopenharmony_ci /* Set VLAN type to 802.1q */ 100362306a36Sopenharmony_ci writel(ETH_P_8021Q, ioaddr + VlanType); 100462306a36Sopenharmony_ci#endif /* VLAN_SUPPORT */ 100562306a36Sopenharmony_ci 100662306a36Sopenharmony_ci retval = request_firmware(&fw_rx, FIRMWARE_RX, &np->pci_dev->dev); 100762306a36Sopenharmony_ci if (retval) { 100862306a36Sopenharmony_ci printk(KERN_ERR "starfire: Failed to load firmware \"%s\"\n", 100962306a36Sopenharmony_ci FIRMWARE_RX); 101062306a36Sopenharmony_ci goto out_init; 101162306a36Sopenharmony_ci } 101262306a36Sopenharmony_ci if (fw_rx->size % 4) { 101362306a36Sopenharmony_ci printk(KERN_ERR "starfire: bogus length %zu in \"%s\"\n", 101462306a36Sopenharmony_ci fw_rx->size, FIRMWARE_RX); 101562306a36Sopenharmony_ci retval = -EINVAL; 101662306a36Sopenharmony_ci goto out_rx; 101762306a36Sopenharmony_ci } 101862306a36Sopenharmony_ci retval = request_firmware(&fw_tx, FIRMWARE_TX, &np->pci_dev->dev); 101962306a36Sopenharmony_ci if (retval) { 102062306a36Sopenharmony_ci printk(KERN_ERR "starfire: Failed to load firmware \"%s\"\n", 102162306a36Sopenharmony_ci FIRMWARE_TX); 102262306a36Sopenharmony_ci goto out_rx; 102362306a36Sopenharmony_ci } 102462306a36Sopenharmony_ci if (fw_tx->size % 4) { 102562306a36Sopenharmony_ci printk(KERN_ERR "starfire: bogus length %zu in \"%s\"\n", 102662306a36Sopenharmony_ci fw_tx->size, FIRMWARE_TX); 102762306a36Sopenharmony_ci retval = -EINVAL; 102862306a36Sopenharmony_ci goto out_tx; 102962306a36Sopenharmony_ci } 103062306a36Sopenharmony_ci fw_rx_data = (const __be32 *)&fw_rx->data[0]; 103162306a36Sopenharmony_ci fw_tx_data = (const __be32 *)&fw_tx->data[0]; 103262306a36Sopenharmony_ci rx_size = fw_rx->size / 4; 103362306a36Sopenharmony_ci tx_size = fw_tx->size / 4; 103462306a36Sopenharmony_ci 103562306a36Sopenharmony_ci /* Load Rx/Tx firmware into the frame processors */ 103662306a36Sopenharmony_ci for (i = 0; i < rx_size; i++) 103762306a36Sopenharmony_ci writel(be32_to_cpup(&fw_rx_data[i]), ioaddr + RxGfpMem + i * 4); 103862306a36Sopenharmony_ci for (i = 0; i < tx_size; i++) 103962306a36Sopenharmony_ci writel(be32_to_cpup(&fw_tx_data[i]), ioaddr + TxGfpMem + i * 4); 104062306a36Sopenharmony_ci if (enable_hw_cksum) 104162306a36Sopenharmony_ci /* Enable the Rx and Tx units, and the Rx/Tx frame processors. */ 104262306a36Sopenharmony_ci writel(TxEnable|TxGFPEnable|RxEnable|RxGFPEnable, ioaddr + GenCtrl); 104362306a36Sopenharmony_ci else 104462306a36Sopenharmony_ci /* Enable the Rx and Tx units only. */ 104562306a36Sopenharmony_ci writel(TxEnable|RxEnable, ioaddr + GenCtrl); 104662306a36Sopenharmony_ci 104762306a36Sopenharmony_ci if (debug > 1) 104862306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Done netdev_open().\n", 104962306a36Sopenharmony_ci dev->name); 105062306a36Sopenharmony_ci 105162306a36Sopenharmony_ciout_tx: 105262306a36Sopenharmony_ci release_firmware(fw_tx); 105362306a36Sopenharmony_ciout_rx: 105462306a36Sopenharmony_ci release_firmware(fw_rx); 105562306a36Sopenharmony_ciout_init: 105662306a36Sopenharmony_ci if (retval) 105762306a36Sopenharmony_ci netdev_close(dev); 105862306a36Sopenharmony_ci return retval; 105962306a36Sopenharmony_ci} 106062306a36Sopenharmony_ci 106162306a36Sopenharmony_ci 106262306a36Sopenharmony_cistatic void check_duplex(struct net_device *dev) 106362306a36Sopenharmony_ci{ 106462306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 106562306a36Sopenharmony_ci u16 reg0; 106662306a36Sopenharmony_ci int silly_count = 1000; 106762306a36Sopenharmony_ci 106862306a36Sopenharmony_ci mdio_write(dev, np->phys[0], MII_ADVERTISE, np->mii_if.advertising); 106962306a36Sopenharmony_ci mdio_write(dev, np->phys[0], MII_BMCR, BMCR_RESET); 107062306a36Sopenharmony_ci udelay(500); 107162306a36Sopenharmony_ci while (--silly_count && mdio_read(dev, np->phys[0], MII_BMCR) & BMCR_RESET) 107262306a36Sopenharmony_ci /* do nothing */; 107362306a36Sopenharmony_ci if (!silly_count) { 107462306a36Sopenharmony_ci printk("%s: MII reset failed!\n", dev->name); 107562306a36Sopenharmony_ci return; 107662306a36Sopenharmony_ci } 107762306a36Sopenharmony_ci 107862306a36Sopenharmony_ci reg0 = mdio_read(dev, np->phys[0], MII_BMCR); 107962306a36Sopenharmony_ci 108062306a36Sopenharmony_ci if (!np->mii_if.force_media) { 108162306a36Sopenharmony_ci reg0 |= BMCR_ANENABLE | BMCR_ANRESTART; 108262306a36Sopenharmony_ci } else { 108362306a36Sopenharmony_ci reg0 &= ~(BMCR_ANENABLE | BMCR_ANRESTART); 108462306a36Sopenharmony_ci if (np->speed100) 108562306a36Sopenharmony_ci reg0 |= BMCR_SPEED100; 108662306a36Sopenharmony_ci if (np->mii_if.full_duplex) 108762306a36Sopenharmony_ci reg0 |= BMCR_FULLDPLX; 108862306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Link forced to %sMbit %s-duplex\n", 108962306a36Sopenharmony_ci dev->name, 109062306a36Sopenharmony_ci np->speed100 ? "100" : "10", 109162306a36Sopenharmony_ci np->mii_if.full_duplex ? "full" : "half"); 109262306a36Sopenharmony_ci } 109362306a36Sopenharmony_ci mdio_write(dev, np->phys[0], MII_BMCR, reg0); 109462306a36Sopenharmony_ci} 109562306a36Sopenharmony_ci 109662306a36Sopenharmony_ci 109762306a36Sopenharmony_cistatic void tx_timeout(struct net_device *dev, unsigned int txqueue) 109862306a36Sopenharmony_ci{ 109962306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 110062306a36Sopenharmony_ci void __iomem *ioaddr = np->base; 110162306a36Sopenharmony_ci int old_debug; 110262306a36Sopenharmony_ci 110362306a36Sopenharmony_ci printk(KERN_WARNING "%s: Transmit timed out, status %#8.8x, " 110462306a36Sopenharmony_ci "resetting...\n", dev->name, (int) readl(ioaddr + IntrStatus)); 110562306a36Sopenharmony_ci 110662306a36Sopenharmony_ci /* Perhaps we should reinitialize the hardware here. */ 110762306a36Sopenharmony_ci 110862306a36Sopenharmony_ci /* 110962306a36Sopenharmony_ci * Stop and restart the interface. 111062306a36Sopenharmony_ci * Cheat and increase the debug level temporarily. 111162306a36Sopenharmony_ci */ 111262306a36Sopenharmony_ci old_debug = debug; 111362306a36Sopenharmony_ci debug = 2; 111462306a36Sopenharmony_ci netdev_close(dev); 111562306a36Sopenharmony_ci netdev_open(dev); 111662306a36Sopenharmony_ci debug = old_debug; 111762306a36Sopenharmony_ci 111862306a36Sopenharmony_ci /* Trigger an immediate transmit demand. */ 111962306a36Sopenharmony_ci 112062306a36Sopenharmony_ci netif_trans_update(dev); /* prevent tx timeout */ 112162306a36Sopenharmony_ci dev->stats.tx_errors++; 112262306a36Sopenharmony_ci netif_wake_queue(dev); 112362306a36Sopenharmony_ci} 112462306a36Sopenharmony_ci 112562306a36Sopenharmony_ci 112662306a36Sopenharmony_ci/* Initialize the Rx and Tx rings, along with various 'dev' bits. */ 112762306a36Sopenharmony_cistatic void init_ring(struct net_device *dev) 112862306a36Sopenharmony_ci{ 112962306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 113062306a36Sopenharmony_ci int i; 113162306a36Sopenharmony_ci 113262306a36Sopenharmony_ci np->cur_rx = np->cur_tx = np->reap_tx = 0; 113362306a36Sopenharmony_ci np->dirty_rx = np->dirty_tx = np->rx_done = np->tx_done = 0; 113462306a36Sopenharmony_ci 113562306a36Sopenharmony_ci np->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32); 113662306a36Sopenharmony_ci 113762306a36Sopenharmony_ci /* Fill in the Rx buffers. Handle allocation failure gracefully. */ 113862306a36Sopenharmony_ci for (i = 0; i < RX_RING_SIZE; i++) { 113962306a36Sopenharmony_ci struct sk_buff *skb = netdev_alloc_skb(dev, np->rx_buf_sz); 114062306a36Sopenharmony_ci np->rx_info[i].skb = skb; 114162306a36Sopenharmony_ci if (skb == NULL) 114262306a36Sopenharmony_ci break; 114362306a36Sopenharmony_ci np->rx_info[i].mapping = dma_map_single(&np->pci_dev->dev, 114462306a36Sopenharmony_ci skb->data, 114562306a36Sopenharmony_ci np->rx_buf_sz, 114662306a36Sopenharmony_ci DMA_FROM_DEVICE); 114762306a36Sopenharmony_ci if (dma_mapping_error(&np->pci_dev->dev, np->rx_info[i].mapping)) { 114862306a36Sopenharmony_ci dev_kfree_skb(skb); 114962306a36Sopenharmony_ci np->rx_info[i].skb = NULL; 115062306a36Sopenharmony_ci break; 115162306a36Sopenharmony_ci } 115262306a36Sopenharmony_ci /* Grrr, we cannot offset to correctly align the IP header. */ 115362306a36Sopenharmony_ci np->rx_ring[i].rxaddr = cpu_to_dma(np->rx_info[i].mapping | RxDescValid); 115462306a36Sopenharmony_ci } 115562306a36Sopenharmony_ci writew(i - 1, np->base + RxDescQIdx); 115662306a36Sopenharmony_ci np->dirty_rx = (unsigned int)(i - RX_RING_SIZE); 115762306a36Sopenharmony_ci 115862306a36Sopenharmony_ci /* Clear the remainder of the Rx buffer ring. */ 115962306a36Sopenharmony_ci for ( ; i < RX_RING_SIZE; i++) { 116062306a36Sopenharmony_ci np->rx_ring[i].rxaddr = 0; 116162306a36Sopenharmony_ci np->rx_info[i].skb = NULL; 116262306a36Sopenharmony_ci np->rx_info[i].mapping = 0; 116362306a36Sopenharmony_ci } 116462306a36Sopenharmony_ci /* Mark the last entry as wrapping the ring. */ 116562306a36Sopenharmony_ci np->rx_ring[RX_RING_SIZE - 1].rxaddr |= cpu_to_dma(RxDescEndRing); 116662306a36Sopenharmony_ci 116762306a36Sopenharmony_ci /* Clear the completion rings. */ 116862306a36Sopenharmony_ci for (i = 0; i < DONE_Q_SIZE; i++) { 116962306a36Sopenharmony_ci np->rx_done_q[i].status = 0; 117062306a36Sopenharmony_ci np->tx_done_q[i].status = 0; 117162306a36Sopenharmony_ci } 117262306a36Sopenharmony_ci 117362306a36Sopenharmony_ci for (i = 0; i < TX_RING_SIZE; i++) 117462306a36Sopenharmony_ci memset(&np->tx_info[i], 0, sizeof(np->tx_info[i])); 117562306a36Sopenharmony_ci} 117662306a36Sopenharmony_ci 117762306a36Sopenharmony_ci 117862306a36Sopenharmony_cistatic netdev_tx_t start_tx(struct sk_buff *skb, struct net_device *dev) 117962306a36Sopenharmony_ci{ 118062306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 118162306a36Sopenharmony_ci unsigned int entry; 118262306a36Sopenharmony_ci unsigned int prev_tx; 118362306a36Sopenharmony_ci u32 status; 118462306a36Sopenharmony_ci int i, j; 118562306a36Sopenharmony_ci 118662306a36Sopenharmony_ci /* 118762306a36Sopenharmony_ci * be cautious here, wrapping the queue has weird semantics 118862306a36Sopenharmony_ci * and we may not have enough slots even when it seems we do. 118962306a36Sopenharmony_ci */ 119062306a36Sopenharmony_ci if ((np->cur_tx - np->dirty_tx) + skb_num_frags(skb) * 2 > TX_RING_SIZE) { 119162306a36Sopenharmony_ci netif_stop_queue(dev); 119262306a36Sopenharmony_ci return NETDEV_TX_BUSY; 119362306a36Sopenharmony_ci } 119462306a36Sopenharmony_ci 119562306a36Sopenharmony_ci#if defined(ZEROCOPY) && defined(HAS_BROKEN_FIRMWARE) 119662306a36Sopenharmony_ci if (skb->ip_summed == CHECKSUM_PARTIAL) { 119762306a36Sopenharmony_ci if (skb_padto(skb, (skb->len + PADDING_MASK) & ~PADDING_MASK)) 119862306a36Sopenharmony_ci return NETDEV_TX_OK; 119962306a36Sopenharmony_ci } 120062306a36Sopenharmony_ci#endif /* ZEROCOPY && HAS_BROKEN_FIRMWARE */ 120162306a36Sopenharmony_ci 120262306a36Sopenharmony_ci prev_tx = np->cur_tx; 120362306a36Sopenharmony_ci entry = np->cur_tx % TX_RING_SIZE; 120462306a36Sopenharmony_ci for (i = 0; i < skb_num_frags(skb); i++) { 120562306a36Sopenharmony_ci int wrap_ring = 0; 120662306a36Sopenharmony_ci status = TxDescID; 120762306a36Sopenharmony_ci 120862306a36Sopenharmony_ci if (i == 0) { 120962306a36Sopenharmony_ci np->tx_info[entry].skb = skb; 121062306a36Sopenharmony_ci status |= TxCRCEn; 121162306a36Sopenharmony_ci if (entry >= TX_RING_SIZE - skb_num_frags(skb)) { 121262306a36Sopenharmony_ci status |= TxRingWrap; 121362306a36Sopenharmony_ci wrap_ring = 1; 121462306a36Sopenharmony_ci } 121562306a36Sopenharmony_ci if (np->reap_tx) { 121662306a36Sopenharmony_ci status |= TxDescIntr; 121762306a36Sopenharmony_ci np->reap_tx = 0; 121862306a36Sopenharmony_ci } 121962306a36Sopenharmony_ci if (skb->ip_summed == CHECKSUM_PARTIAL) { 122062306a36Sopenharmony_ci status |= TxCalTCP; 122162306a36Sopenharmony_ci dev->stats.tx_compressed++; 122262306a36Sopenharmony_ci } 122362306a36Sopenharmony_ci status |= skb_first_frag_len(skb) | (skb_num_frags(skb) << 16); 122462306a36Sopenharmony_ci 122562306a36Sopenharmony_ci np->tx_info[entry].mapping = 122662306a36Sopenharmony_ci dma_map_single(&np->pci_dev->dev, skb->data, 122762306a36Sopenharmony_ci skb_first_frag_len(skb), 122862306a36Sopenharmony_ci DMA_TO_DEVICE); 122962306a36Sopenharmony_ci } else { 123062306a36Sopenharmony_ci const skb_frag_t *this_frag = &skb_shinfo(skb)->frags[i - 1]; 123162306a36Sopenharmony_ci status |= skb_frag_size(this_frag); 123262306a36Sopenharmony_ci np->tx_info[entry].mapping = 123362306a36Sopenharmony_ci dma_map_single(&np->pci_dev->dev, 123462306a36Sopenharmony_ci skb_frag_address(this_frag), 123562306a36Sopenharmony_ci skb_frag_size(this_frag), 123662306a36Sopenharmony_ci DMA_TO_DEVICE); 123762306a36Sopenharmony_ci } 123862306a36Sopenharmony_ci if (dma_mapping_error(&np->pci_dev->dev, np->tx_info[entry].mapping)) { 123962306a36Sopenharmony_ci dev->stats.tx_dropped++; 124062306a36Sopenharmony_ci goto err_out; 124162306a36Sopenharmony_ci } 124262306a36Sopenharmony_ci 124362306a36Sopenharmony_ci np->tx_ring[entry].addr = cpu_to_dma(np->tx_info[entry].mapping); 124462306a36Sopenharmony_ci np->tx_ring[entry].status = cpu_to_le32(status); 124562306a36Sopenharmony_ci if (debug > 3) 124662306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Tx #%d/#%d slot %d status %#8.8x.\n", 124762306a36Sopenharmony_ci dev->name, np->cur_tx, np->dirty_tx, 124862306a36Sopenharmony_ci entry, status); 124962306a36Sopenharmony_ci if (wrap_ring) { 125062306a36Sopenharmony_ci np->tx_info[entry].used_slots = TX_RING_SIZE - entry; 125162306a36Sopenharmony_ci np->cur_tx += np->tx_info[entry].used_slots; 125262306a36Sopenharmony_ci entry = 0; 125362306a36Sopenharmony_ci } else { 125462306a36Sopenharmony_ci np->tx_info[entry].used_slots = 1; 125562306a36Sopenharmony_ci np->cur_tx += np->tx_info[entry].used_slots; 125662306a36Sopenharmony_ci entry++; 125762306a36Sopenharmony_ci } 125862306a36Sopenharmony_ci /* scavenge the tx descriptors twice per TX_RING_SIZE */ 125962306a36Sopenharmony_ci if (np->cur_tx % (TX_RING_SIZE / 2) == 0) 126062306a36Sopenharmony_ci np->reap_tx = 1; 126162306a36Sopenharmony_ci } 126262306a36Sopenharmony_ci 126362306a36Sopenharmony_ci /* Non-x86: explicitly flush descriptor cache lines here. */ 126462306a36Sopenharmony_ci /* Ensure all descriptors are written back before the transmit is 126562306a36Sopenharmony_ci initiated. - Jes */ 126662306a36Sopenharmony_ci wmb(); 126762306a36Sopenharmony_ci 126862306a36Sopenharmony_ci /* Update the producer index. */ 126962306a36Sopenharmony_ci writel(entry * (sizeof(starfire_tx_desc) / 8), np->base + TxProducerIdx); 127062306a36Sopenharmony_ci 127162306a36Sopenharmony_ci /* 4 is arbitrary, but should be ok */ 127262306a36Sopenharmony_ci if ((np->cur_tx - np->dirty_tx) + 4 > TX_RING_SIZE) 127362306a36Sopenharmony_ci netif_stop_queue(dev); 127462306a36Sopenharmony_ci 127562306a36Sopenharmony_ci return NETDEV_TX_OK; 127662306a36Sopenharmony_ci 127762306a36Sopenharmony_cierr_out: 127862306a36Sopenharmony_ci entry = prev_tx % TX_RING_SIZE; 127962306a36Sopenharmony_ci np->tx_info[entry].skb = NULL; 128062306a36Sopenharmony_ci if (i > 0) { 128162306a36Sopenharmony_ci dma_unmap_single(&np->pci_dev->dev, 128262306a36Sopenharmony_ci np->tx_info[entry].mapping, 128362306a36Sopenharmony_ci skb_first_frag_len(skb), DMA_TO_DEVICE); 128462306a36Sopenharmony_ci np->tx_info[entry].mapping = 0; 128562306a36Sopenharmony_ci entry = (entry + np->tx_info[entry].used_slots) % TX_RING_SIZE; 128662306a36Sopenharmony_ci for (j = 1; j < i; j++) { 128762306a36Sopenharmony_ci dma_unmap_single(&np->pci_dev->dev, 128862306a36Sopenharmony_ci np->tx_info[entry].mapping, 128962306a36Sopenharmony_ci skb_frag_size(&skb_shinfo(skb)->frags[j - 1]), 129062306a36Sopenharmony_ci DMA_TO_DEVICE); 129162306a36Sopenharmony_ci entry++; 129262306a36Sopenharmony_ci } 129362306a36Sopenharmony_ci } 129462306a36Sopenharmony_ci dev_kfree_skb_any(skb); 129562306a36Sopenharmony_ci np->cur_tx = prev_tx; 129662306a36Sopenharmony_ci return NETDEV_TX_OK; 129762306a36Sopenharmony_ci} 129862306a36Sopenharmony_ci 129962306a36Sopenharmony_ci/* The interrupt handler does all of the Rx thread work and cleans up 130062306a36Sopenharmony_ci after the Tx thread. */ 130162306a36Sopenharmony_cistatic irqreturn_t intr_handler(int irq, void *dev_instance) 130262306a36Sopenharmony_ci{ 130362306a36Sopenharmony_ci struct net_device *dev = dev_instance; 130462306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 130562306a36Sopenharmony_ci void __iomem *ioaddr = np->base; 130662306a36Sopenharmony_ci int boguscnt = max_interrupt_work; 130762306a36Sopenharmony_ci int consumer; 130862306a36Sopenharmony_ci int tx_status; 130962306a36Sopenharmony_ci int handled = 0; 131062306a36Sopenharmony_ci 131162306a36Sopenharmony_ci do { 131262306a36Sopenharmony_ci u32 intr_status = readl(ioaddr + IntrClear); 131362306a36Sopenharmony_ci 131462306a36Sopenharmony_ci if (debug > 4) 131562306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Interrupt status %#8.8x.\n", 131662306a36Sopenharmony_ci dev->name, intr_status); 131762306a36Sopenharmony_ci 131862306a36Sopenharmony_ci if (intr_status == 0 || intr_status == (u32) -1) 131962306a36Sopenharmony_ci break; 132062306a36Sopenharmony_ci 132162306a36Sopenharmony_ci handled = 1; 132262306a36Sopenharmony_ci 132362306a36Sopenharmony_ci if (intr_status & (IntrRxDone | IntrRxEmpty)) { 132462306a36Sopenharmony_ci u32 enable; 132562306a36Sopenharmony_ci 132662306a36Sopenharmony_ci if (likely(napi_schedule_prep(&np->napi))) { 132762306a36Sopenharmony_ci __napi_schedule(&np->napi); 132862306a36Sopenharmony_ci enable = readl(ioaddr + IntrEnable); 132962306a36Sopenharmony_ci enable &= ~(IntrRxDone | IntrRxEmpty); 133062306a36Sopenharmony_ci writel(enable, ioaddr + IntrEnable); 133162306a36Sopenharmony_ci /* flush PCI posting buffers */ 133262306a36Sopenharmony_ci readl(ioaddr + IntrEnable); 133362306a36Sopenharmony_ci } else { 133462306a36Sopenharmony_ci /* Paranoia check */ 133562306a36Sopenharmony_ci enable = readl(ioaddr + IntrEnable); 133662306a36Sopenharmony_ci if (enable & (IntrRxDone | IntrRxEmpty)) { 133762306a36Sopenharmony_ci printk(KERN_INFO 133862306a36Sopenharmony_ci "%s: interrupt while in poll!\n", 133962306a36Sopenharmony_ci dev->name); 134062306a36Sopenharmony_ci enable &= ~(IntrRxDone | IntrRxEmpty); 134162306a36Sopenharmony_ci writel(enable, ioaddr + IntrEnable); 134262306a36Sopenharmony_ci } 134362306a36Sopenharmony_ci } 134462306a36Sopenharmony_ci } 134562306a36Sopenharmony_ci 134662306a36Sopenharmony_ci /* Scavenge the skbuff list based on the Tx-done queue. 134762306a36Sopenharmony_ci There are redundant checks here that may be cleaned up 134862306a36Sopenharmony_ci after the driver has proven to be reliable. */ 134962306a36Sopenharmony_ci consumer = readl(ioaddr + TxConsumerIdx); 135062306a36Sopenharmony_ci if (debug > 3) 135162306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Tx Consumer index is %d.\n", 135262306a36Sopenharmony_ci dev->name, consumer); 135362306a36Sopenharmony_ci 135462306a36Sopenharmony_ci while ((tx_status = le32_to_cpu(np->tx_done_q[np->tx_done].status)) != 0) { 135562306a36Sopenharmony_ci if (debug > 3) 135662306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Tx completion #%d entry %d is %#8.8x.\n", 135762306a36Sopenharmony_ci dev->name, np->dirty_tx, np->tx_done, tx_status); 135862306a36Sopenharmony_ci if ((tx_status & 0xe0000000) == 0xa0000000) { 135962306a36Sopenharmony_ci dev->stats.tx_packets++; 136062306a36Sopenharmony_ci } else if ((tx_status & 0xe0000000) == 0x80000000) { 136162306a36Sopenharmony_ci u16 entry = (tx_status & 0x7fff) / sizeof(starfire_tx_desc); 136262306a36Sopenharmony_ci struct sk_buff *skb = np->tx_info[entry].skb; 136362306a36Sopenharmony_ci np->tx_info[entry].skb = NULL; 136462306a36Sopenharmony_ci dma_unmap_single(&np->pci_dev->dev, 136562306a36Sopenharmony_ci np->tx_info[entry].mapping, 136662306a36Sopenharmony_ci skb_first_frag_len(skb), 136762306a36Sopenharmony_ci DMA_TO_DEVICE); 136862306a36Sopenharmony_ci np->tx_info[entry].mapping = 0; 136962306a36Sopenharmony_ci np->dirty_tx += np->tx_info[entry].used_slots; 137062306a36Sopenharmony_ci entry = (entry + np->tx_info[entry].used_slots) % TX_RING_SIZE; 137162306a36Sopenharmony_ci { 137262306a36Sopenharmony_ci int i; 137362306a36Sopenharmony_ci for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) { 137462306a36Sopenharmony_ci dma_unmap_single(&np->pci_dev->dev, 137562306a36Sopenharmony_ci np->tx_info[entry].mapping, 137662306a36Sopenharmony_ci skb_frag_size(&skb_shinfo(skb)->frags[i]), 137762306a36Sopenharmony_ci DMA_TO_DEVICE); 137862306a36Sopenharmony_ci np->dirty_tx++; 137962306a36Sopenharmony_ci entry++; 138062306a36Sopenharmony_ci } 138162306a36Sopenharmony_ci } 138262306a36Sopenharmony_ci 138362306a36Sopenharmony_ci dev_consume_skb_irq(skb); 138462306a36Sopenharmony_ci } 138562306a36Sopenharmony_ci np->tx_done_q[np->tx_done].status = 0; 138662306a36Sopenharmony_ci np->tx_done = (np->tx_done + 1) % DONE_Q_SIZE; 138762306a36Sopenharmony_ci } 138862306a36Sopenharmony_ci writew(np->tx_done, ioaddr + CompletionQConsumerIdx + 2); 138962306a36Sopenharmony_ci 139062306a36Sopenharmony_ci if (netif_queue_stopped(dev) && 139162306a36Sopenharmony_ci (np->cur_tx - np->dirty_tx + 4 < TX_RING_SIZE)) { 139262306a36Sopenharmony_ci /* The ring is no longer full, wake the queue. */ 139362306a36Sopenharmony_ci netif_wake_queue(dev); 139462306a36Sopenharmony_ci } 139562306a36Sopenharmony_ci 139662306a36Sopenharmony_ci /* Stats overflow */ 139762306a36Sopenharmony_ci if (intr_status & IntrStatsMax) 139862306a36Sopenharmony_ci get_stats(dev); 139962306a36Sopenharmony_ci 140062306a36Sopenharmony_ci /* Media change interrupt. */ 140162306a36Sopenharmony_ci if (intr_status & IntrLinkChange) 140262306a36Sopenharmony_ci netdev_media_change(dev); 140362306a36Sopenharmony_ci 140462306a36Sopenharmony_ci /* Abnormal error summary/uncommon events handlers. */ 140562306a36Sopenharmony_ci if (intr_status & IntrAbnormalSummary) 140662306a36Sopenharmony_ci netdev_error(dev, intr_status); 140762306a36Sopenharmony_ci 140862306a36Sopenharmony_ci if (--boguscnt < 0) { 140962306a36Sopenharmony_ci if (debug > 1) 141062306a36Sopenharmony_ci printk(KERN_WARNING "%s: Too much work at interrupt, " 141162306a36Sopenharmony_ci "status=%#8.8x.\n", 141262306a36Sopenharmony_ci dev->name, intr_status); 141362306a36Sopenharmony_ci break; 141462306a36Sopenharmony_ci } 141562306a36Sopenharmony_ci } while (1); 141662306a36Sopenharmony_ci 141762306a36Sopenharmony_ci if (debug > 4) 141862306a36Sopenharmony_ci printk(KERN_DEBUG "%s: exiting interrupt, status=%#8.8x.\n", 141962306a36Sopenharmony_ci dev->name, (int) readl(ioaddr + IntrStatus)); 142062306a36Sopenharmony_ci return IRQ_RETVAL(handled); 142162306a36Sopenharmony_ci} 142262306a36Sopenharmony_ci 142362306a36Sopenharmony_ci 142462306a36Sopenharmony_ci/* 142562306a36Sopenharmony_ci * This routine is logically part of the interrupt/poll handler, but separated 142662306a36Sopenharmony_ci * for clarity and better register allocation. 142762306a36Sopenharmony_ci */ 142862306a36Sopenharmony_cistatic int __netdev_rx(struct net_device *dev, int *quota) 142962306a36Sopenharmony_ci{ 143062306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 143162306a36Sopenharmony_ci u32 desc_status; 143262306a36Sopenharmony_ci int retcode = 0; 143362306a36Sopenharmony_ci 143462306a36Sopenharmony_ci /* If EOP is set on the next entry, it's a new packet. Send it up. */ 143562306a36Sopenharmony_ci while ((desc_status = le32_to_cpu(np->rx_done_q[np->rx_done].status)) != 0) { 143662306a36Sopenharmony_ci struct sk_buff *skb; 143762306a36Sopenharmony_ci u16 pkt_len; 143862306a36Sopenharmony_ci int entry; 143962306a36Sopenharmony_ci rx_done_desc *desc = &np->rx_done_q[np->rx_done]; 144062306a36Sopenharmony_ci 144162306a36Sopenharmony_ci if (debug > 4) 144262306a36Sopenharmony_ci printk(KERN_DEBUG " netdev_rx() status of %d was %#8.8x.\n", np->rx_done, desc_status); 144362306a36Sopenharmony_ci if (!(desc_status & RxOK)) { 144462306a36Sopenharmony_ci /* There was an error. */ 144562306a36Sopenharmony_ci if (debug > 2) 144662306a36Sopenharmony_ci printk(KERN_DEBUG " netdev_rx() Rx error was %#8.8x.\n", desc_status); 144762306a36Sopenharmony_ci dev->stats.rx_errors++; 144862306a36Sopenharmony_ci if (desc_status & RxFIFOErr) 144962306a36Sopenharmony_ci dev->stats.rx_fifo_errors++; 145062306a36Sopenharmony_ci goto next_rx; 145162306a36Sopenharmony_ci } 145262306a36Sopenharmony_ci 145362306a36Sopenharmony_ci if (*quota <= 0) { /* out of rx quota */ 145462306a36Sopenharmony_ci retcode = 1; 145562306a36Sopenharmony_ci goto out; 145662306a36Sopenharmony_ci } 145762306a36Sopenharmony_ci (*quota)--; 145862306a36Sopenharmony_ci 145962306a36Sopenharmony_ci pkt_len = desc_status; /* Implicitly Truncate */ 146062306a36Sopenharmony_ci entry = (desc_status >> 16) & 0x7ff; 146162306a36Sopenharmony_ci 146262306a36Sopenharmony_ci if (debug > 4) 146362306a36Sopenharmony_ci printk(KERN_DEBUG " netdev_rx() normal Rx pkt length %d, quota %d.\n", pkt_len, *quota); 146462306a36Sopenharmony_ci /* Check if the packet is long enough to accept without copying 146562306a36Sopenharmony_ci to a minimally-sized skbuff. */ 146662306a36Sopenharmony_ci if (pkt_len < rx_copybreak && 146762306a36Sopenharmony_ci (skb = netdev_alloc_skb(dev, pkt_len + 2)) != NULL) { 146862306a36Sopenharmony_ci skb_reserve(skb, 2); /* 16 byte align the IP header */ 146962306a36Sopenharmony_ci dma_sync_single_for_cpu(&np->pci_dev->dev, 147062306a36Sopenharmony_ci np->rx_info[entry].mapping, 147162306a36Sopenharmony_ci pkt_len, DMA_FROM_DEVICE); 147262306a36Sopenharmony_ci skb_copy_to_linear_data(skb, np->rx_info[entry].skb->data, pkt_len); 147362306a36Sopenharmony_ci dma_sync_single_for_device(&np->pci_dev->dev, 147462306a36Sopenharmony_ci np->rx_info[entry].mapping, 147562306a36Sopenharmony_ci pkt_len, DMA_FROM_DEVICE); 147662306a36Sopenharmony_ci skb_put(skb, pkt_len); 147762306a36Sopenharmony_ci } else { 147862306a36Sopenharmony_ci dma_unmap_single(&np->pci_dev->dev, 147962306a36Sopenharmony_ci np->rx_info[entry].mapping, 148062306a36Sopenharmony_ci np->rx_buf_sz, DMA_FROM_DEVICE); 148162306a36Sopenharmony_ci skb = np->rx_info[entry].skb; 148262306a36Sopenharmony_ci skb_put(skb, pkt_len); 148362306a36Sopenharmony_ci np->rx_info[entry].skb = NULL; 148462306a36Sopenharmony_ci np->rx_info[entry].mapping = 0; 148562306a36Sopenharmony_ci } 148662306a36Sopenharmony_ci#ifndef final_version /* Remove after testing. */ 148762306a36Sopenharmony_ci /* You will want this info for the initial debug. */ 148862306a36Sopenharmony_ci if (debug > 5) { 148962306a36Sopenharmony_ci printk(KERN_DEBUG " Rx data %pM %pM %2.2x%2.2x.\n", 149062306a36Sopenharmony_ci skb->data, skb->data + 6, 149162306a36Sopenharmony_ci skb->data[12], skb->data[13]); 149262306a36Sopenharmony_ci } 149362306a36Sopenharmony_ci#endif 149462306a36Sopenharmony_ci 149562306a36Sopenharmony_ci skb->protocol = eth_type_trans(skb, dev); 149662306a36Sopenharmony_ci#ifdef VLAN_SUPPORT 149762306a36Sopenharmony_ci if (debug > 4) 149862306a36Sopenharmony_ci printk(KERN_DEBUG " netdev_rx() status2 of %d was %#4.4x.\n", np->rx_done, le16_to_cpu(desc->status2)); 149962306a36Sopenharmony_ci#endif 150062306a36Sopenharmony_ci if (le16_to_cpu(desc->status2) & 0x0100) { 150162306a36Sopenharmony_ci skb->ip_summed = CHECKSUM_UNNECESSARY; 150262306a36Sopenharmony_ci dev->stats.rx_compressed++; 150362306a36Sopenharmony_ci } 150462306a36Sopenharmony_ci /* 150562306a36Sopenharmony_ci * This feature doesn't seem to be working, at least 150662306a36Sopenharmony_ci * with the two firmware versions I have. If the GFP sees 150762306a36Sopenharmony_ci * an IP fragment, it either ignores it completely, or reports 150862306a36Sopenharmony_ci * "bad checksum" on it. 150962306a36Sopenharmony_ci * 151062306a36Sopenharmony_ci * Maybe I missed something -- corrections are welcome. 151162306a36Sopenharmony_ci * Until then, the printk stays. :-) -Ion 151262306a36Sopenharmony_ci */ 151362306a36Sopenharmony_ci else if (le16_to_cpu(desc->status2) & 0x0040) { 151462306a36Sopenharmony_ci skb->ip_summed = CHECKSUM_COMPLETE; 151562306a36Sopenharmony_ci skb->csum = le16_to_cpu(desc->csum); 151662306a36Sopenharmony_ci printk(KERN_DEBUG "%s: checksum_hw, status2 = %#x\n", dev->name, le16_to_cpu(desc->status2)); 151762306a36Sopenharmony_ci } 151862306a36Sopenharmony_ci#ifdef VLAN_SUPPORT 151962306a36Sopenharmony_ci if (le16_to_cpu(desc->status2) & 0x0200) { 152062306a36Sopenharmony_ci u16 vlid = le16_to_cpu(desc->vlanid); 152162306a36Sopenharmony_ci 152262306a36Sopenharmony_ci if (debug > 4) { 152362306a36Sopenharmony_ci printk(KERN_DEBUG " netdev_rx() vlanid = %d\n", 152462306a36Sopenharmony_ci vlid); 152562306a36Sopenharmony_ci } 152662306a36Sopenharmony_ci __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vlid); 152762306a36Sopenharmony_ci } 152862306a36Sopenharmony_ci#endif /* VLAN_SUPPORT */ 152962306a36Sopenharmony_ci netif_receive_skb(skb); 153062306a36Sopenharmony_ci dev->stats.rx_packets++; 153162306a36Sopenharmony_ci 153262306a36Sopenharmony_ci next_rx: 153362306a36Sopenharmony_ci np->cur_rx++; 153462306a36Sopenharmony_ci desc->status = 0; 153562306a36Sopenharmony_ci np->rx_done = (np->rx_done + 1) % DONE_Q_SIZE; 153662306a36Sopenharmony_ci } 153762306a36Sopenharmony_ci 153862306a36Sopenharmony_ci if (*quota == 0) { /* out of rx quota */ 153962306a36Sopenharmony_ci retcode = 1; 154062306a36Sopenharmony_ci goto out; 154162306a36Sopenharmony_ci } 154262306a36Sopenharmony_ci writew(np->rx_done, np->base + CompletionQConsumerIdx); 154362306a36Sopenharmony_ci 154462306a36Sopenharmony_ci out: 154562306a36Sopenharmony_ci refill_rx_ring(dev); 154662306a36Sopenharmony_ci if (debug > 5) 154762306a36Sopenharmony_ci printk(KERN_DEBUG " exiting netdev_rx(): %d, status of %d was %#8.8x.\n", 154862306a36Sopenharmony_ci retcode, np->rx_done, desc_status); 154962306a36Sopenharmony_ci return retcode; 155062306a36Sopenharmony_ci} 155162306a36Sopenharmony_ci 155262306a36Sopenharmony_cistatic int netdev_poll(struct napi_struct *napi, int budget) 155362306a36Sopenharmony_ci{ 155462306a36Sopenharmony_ci struct netdev_private *np = container_of(napi, struct netdev_private, napi); 155562306a36Sopenharmony_ci struct net_device *dev = np->dev; 155662306a36Sopenharmony_ci u32 intr_status; 155762306a36Sopenharmony_ci void __iomem *ioaddr = np->base; 155862306a36Sopenharmony_ci int quota = budget; 155962306a36Sopenharmony_ci 156062306a36Sopenharmony_ci do { 156162306a36Sopenharmony_ci writel(IntrRxDone | IntrRxEmpty, ioaddr + IntrClear); 156262306a36Sopenharmony_ci 156362306a36Sopenharmony_ci if (__netdev_rx(dev, "a)) 156462306a36Sopenharmony_ci goto out; 156562306a36Sopenharmony_ci 156662306a36Sopenharmony_ci intr_status = readl(ioaddr + IntrStatus); 156762306a36Sopenharmony_ci } while (intr_status & (IntrRxDone | IntrRxEmpty)); 156862306a36Sopenharmony_ci 156962306a36Sopenharmony_ci napi_complete(napi); 157062306a36Sopenharmony_ci intr_status = readl(ioaddr + IntrEnable); 157162306a36Sopenharmony_ci intr_status |= IntrRxDone | IntrRxEmpty; 157262306a36Sopenharmony_ci writel(intr_status, ioaddr + IntrEnable); 157362306a36Sopenharmony_ci 157462306a36Sopenharmony_ci out: 157562306a36Sopenharmony_ci if (debug > 5) 157662306a36Sopenharmony_ci printk(KERN_DEBUG " exiting netdev_poll(): %d.\n", 157762306a36Sopenharmony_ci budget - quota); 157862306a36Sopenharmony_ci 157962306a36Sopenharmony_ci /* Restart Rx engine if stopped. */ 158062306a36Sopenharmony_ci return budget - quota; 158162306a36Sopenharmony_ci} 158262306a36Sopenharmony_ci 158362306a36Sopenharmony_cistatic void refill_rx_ring(struct net_device *dev) 158462306a36Sopenharmony_ci{ 158562306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 158662306a36Sopenharmony_ci struct sk_buff *skb; 158762306a36Sopenharmony_ci int entry = -1; 158862306a36Sopenharmony_ci 158962306a36Sopenharmony_ci /* Refill the Rx ring buffers. */ 159062306a36Sopenharmony_ci for (; np->cur_rx - np->dirty_rx > 0; np->dirty_rx++) { 159162306a36Sopenharmony_ci entry = np->dirty_rx % RX_RING_SIZE; 159262306a36Sopenharmony_ci if (np->rx_info[entry].skb == NULL) { 159362306a36Sopenharmony_ci skb = netdev_alloc_skb(dev, np->rx_buf_sz); 159462306a36Sopenharmony_ci np->rx_info[entry].skb = skb; 159562306a36Sopenharmony_ci if (skb == NULL) 159662306a36Sopenharmony_ci break; /* Better luck next round. */ 159762306a36Sopenharmony_ci np->rx_info[entry].mapping = 159862306a36Sopenharmony_ci dma_map_single(&np->pci_dev->dev, skb->data, 159962306a36Sopenharmony_ci np->rx_buf_sz, DMA_FROM_DEVICE); 160062306a36Sopenharmony_ci if (dma_mapping_error(&np->pci_dev->dev, np->rx_info[entry].mapping)) { 160162306a36Sopenharmony_ci dev_kfree_skb(skb); 160262306a36Sopenharmony_ci np->rx_info[entry].skb = NULL; 160362306a36Sopenharmony_ci break; 160462306a36Sopenharmony_ci } 160562306a36Sopenharmony_ci np->rx_ring[entry].rxaddr = 160662306a36Sopenharmony_ci cpu_to_dma(np->rx_info[entry].mapping | RxDescValid); 160762306a36Sopenharmony_ci } 160862306a36Sopenharmony_ci if (entry == RX_RING_SIZE - 1) 160962306a36Sopenharmony_ci np->rx_ring[entry].rxaddr |= cpu_to_dma(RxDescEndRing); 161062306a36Sopenharmony_ci } 161162306a36Sopenharmony_ci if (entry >= 0) 161262306a36Sopenharmony_ci writew(entry, np->base + RxDescQIdx); 161362306a36Sopenharmony_ci} 161462306a36Sopenharmony_ci 161562306a36Sopenharmony_ci 161662306a36Sopenharmony_cistatic void netdev_media_change(struct net_device *dev) 161762306a36Sopenharmony_ci{ 161862306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 161962306a36Sopenharmony_ci void __iomem *ioaddr = np->base; 162062306a36Sopenharmony_ci u16 reg0, reg1, reg4, reg5; 162162306a36Sopenharmony_ci u32 new_tx_mode; 162262306a36Sopenharmony_ci u32 new_intr_timer_ctrl; 162362306a36Sopenharmony_ci 162462306a36Sopenharmony_ci /* reset status first */ 162562306a36Sopenharmony_ci mdio_read(dev, np->phys[0], MII_BMCR); 162662306a36Sopenharmony_ci mdio_read(dev, np->phys[0], MII_BMSR); 162762306a36Sopenharmony_ci 162862306a36Sopenharmony_ci reg0 = mdio_read(dev, np->phys[0], MII_BMCR); 162962306a36Sopenharmony_ci reg1 = mdio_read(dev, np->phys[0], MII_BMSR); 163062306a36Sopenharmony_ci 163162306a36Sopenharmony_ci if (reg1 & BMSR_LSTATUS) { 163262306a36Sopenharmony_ci /* link is up */ 163362306a36Sopenharmony_ci if (reg0 & BMCR_ANENABLE) { 163462306a36Sopenharmony_ci /* autonegotiation is enabled */ 163562306a36Sopenharmony_ci reg4 = mdio_read(dev, np->phys[0], MII_ADVERTISE); 163662306a36Sopenharmony_ci reg5 = mdio_read(dev, np->phys[0], MII_LPA); 163762306a36Sopenharmony_ci if (reg4 & ADVERTISE_100FULL && reg5 & LPA_100FULL) { 163862306a36Sopenharmony_ci np->speed100 = 1; 163962306a36Sopenharmony_ci np->mii_if.full_duplex = 1; 164062306a36Sopenharmony_ci } else if (reg4 & ADVERTISE_100HALF && reg5 & LPA_100HALF) { 164162306a36Sopenharmony_ci np->speed100 = 1; 164262306a36Sopenharmony_ci np->mii_if.full_duplex = 0; 164362306a36Sopenharmony_ci } else if (reg4 & ADVERTISE_10FULL && reg5 & LPA_10FULL) { 164462306a36Sopenharmony_ci np->speed100 = 0; 164562306a36Sopenharmony_ci np->mii_if.full_duplex = 1; 164662306a36Sopenharmony_ci } else { 164762306a36Sopenharmony_ci np->speed100 = 0; 164862306a36Sopenharmony_ci np->mii_if.full_duplex = 0; 164962306a36Sopenharmony_ci } 165062306a36Sopenharmony_ci } else { 165162306a36Sopenharmony_ci /* autonegotiation is disabled */ 165262306a36Sopenharmony_ci if (reg0 & BMCR_SPEED100) 165362306a36Sopenharmony_ci np->speed100 = 1; 165462306a36Sopenharmony_ci else 165562306a36Sopenharmony_ci np->speed100 = 0; 165662306a36Sopenharmony_ci if (reg0 & BMCR_FULLDPLX) 165762306a36Sopenharmony_ci np->mii_if.full_duplex = 1; 165862306a36Sopenharmony_ci else 165962306a36Sopenharmony_ci np->mii_if.full_duplex = 0; 166062306a36Sopenharmony_ci } 166162306a36Sopenharmony_ci netif_carrier_on(dev); 166262306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Link is up, running at %sMbit %s-duplex\n", 166362306a36Sopenharmony_ci dev->name, 166462306a36Sopenharmony_ci np->speed100 ? "100" : "10", 166562306a36Sopenharmony_ci np->mii_if.full_duplex ? "full" : "half"); 166662306a36Sopenharmony_ci 166762306a36Sopenharmony_ci new_tx_mode = np->tx_mode & ~FullDuplex; /* duplex setting */ 166862306a36Sopenharmony_ci if (np->mii_if.full_duplex) 166962306a36Sopenharmony_ci new_tx_mode |= FullDuplex; 167062306a36Sopenharmony_ci if (np->tx_mode != new_tx_mode) { 167162306a36Sopenharmony_ci np->tx_mode = new_tx_mode; 167262306a36Sopenharmony_ci writel(np->tx_mode | MiiSoftReset, ioaddr + TxMode); 167362306a36Sopenharmony_ci udelay(1000); 167462306a36Sopenharmony_ci writel(np->tx_mode, ioaddr + TxMode); 167562306a36Sopenharmony_ci } 167662306a36Sopenharmony_ci 167762306a36Sopenharmony_ci new_intr_timer_ctrl = np->intr_timer_ctrl & ~Timer10X; 167862306a36Sopenharmony_ci if (np->speed100) 167962306a36Sopenharmony_ci new_intr_timer_ctrl |= Timer10X; 168062306a36Sopenharmony_ci if (np->intr_timer_ctrl != new_intr_timer_ctrl) { 168162306a36Sopenharmony_ci np->intr_timer_ctrl = new_intr_timer_ctrl; 168262306a36Sopenharmony_ci writel(new_intr_timer_ctrl, ioaddr + IntrTimerCtrl); 168362306a36Sopenharmony_ci } 168462306a36Sopenharmony_ci } else { 168562306a36Sopenharmony_ci netif_carrier_off(dev); 168662306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Link is down\n", dev->name); 168762306a36Sopenharmony_ci } 168862306a36Sopenharmony_ci} 168962306a36Sopenharmony_ci 169062306a36Sopenharmony_ci 169162306a36Sopenharmony_cistatic void netdev_error(struct net_device *dev, int intr_status) 169262306a36Sopenharmony_ci{ 169362306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 169462306a36Sopenharmony_ci 169562306a36Sopenharmony_ci /* Came close to underrunning the Tx FIFO, increase threshold. */ 169662306a36Sopenharmony_ci if (intr_status & IntrTxDataLow) { 169762306a36Sopenharmony_ci if (np->tx_threshold <= PKT_BUF_SZ / 16) { 169862306a36Sopenharmony_ci writel(++np->tx_threshold, np->base + TxThreshold); 169962306a36Sopenharmony_ci printk(KERN_NOTICE "%s: PCI bus congestion, increasing Tx FIFO threshold to %d bytes\n", 170062306a36Sopenharmony_ci dev->name, np->tx_threshold * 16); 170162306a36Sopenharmony_ci } else 170262306a36Sopenharmony_ci printk(KERN_WARNING "%s: PCI Tx underflow -- adapter is probably malfunctioning\n", dev->name); 170362306a36Sopenharmony_ci } 170462306a36Sopenharmony_ci if (intr_status & IntrRxGFPDead) { 170562306a36Sopenharmony_ci dev->stats.rx_fifo_errors++; 170662306a36Sopenharmony_ci dev->stats.rx_errors++; 170762306a36Sopenharmony_ci } 170862306a36Sopenharmony_ci if (intr_status & (IntrNoTxCsum | IntrDMAErr)) { 170962306a36Sopenharmony_ci dev->stats.tx_fifo_errors++; 171062306a36Sopenharmony_ci dev->stats.tx_errors++; 171162306a36Sopenharmony_ci } 171262306a36Sopenharmony_ci if ((intr_status & ~(IntrNormalMask | IntrAbnormalSummary | IntrLinkChange | IntrStatsMax | IntrTxDataLow | IntrRxGFPDead | IntrNoTxCsum | IntrPCIPad)) && debug) 171362306a36Sopenharmony_ci printk(KERN_ERR "%s: Something Wicked happened! %#8.8x.\n", 171462306a36Sopenharmony_ci dev->name, intr_status); 171562306a36Sopenharmony_ci} 171662306a36Sopenharmony_ci 171762306a36Sopenharmony_ci 171862306a36Sopenharmony_cistatic struct net_device_stats *get_stats(struct net_device *dev) 171962306a36Sopenharmony_ci{ 172062306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 172162306a36Sopenharmony_ci void __iomem *ioaddr = np->base; 172262306a36Sopenharmony_ci 172362306a36Sopenharmony_ci /* This adapter architecture needs no SMP locks. */ 172462306a36Sopenharmony_ci dev->stats.tx_bytes = readl(ioaddr + 0x57010); 172562306a36Sopenharmony_ci dev->stats.rx_bytes = readl(ioaddr + 0x57044); 172662306a36Sopenharmony_ci dev->stats.tx_packets = readl(ioaddr + 0x57000); 172762306a36Sopenharmony_ci dev->stats.tx_aborted_errors = 172862306a36Sopenharmony_ci readl(ioaddr + 0x57024) + readl(ioaddr + 0x57028); 172962306a36Sopenharmony_ci dev->stats.tx_window_errors = readl(ioaddr + 0x57018); 173062306a36Sopenharmony_ci dev->stats.collisions = 173162306a36Sopenharmony_ci readl(ioaddr + 0x57004) + readl(ioaddr + 0x57008); 173262306a36Sopenharmony_ci 173362306a36Sopenharmony_ci /* The chip only need report frame silently dropped. */ 173462306a36Sopenharmony_ci dev->stats.rx_dropped += readw(ioaddr + RxDMAStatus); 173562306a36Sopenharmony_ci writew(0, ioaddr + RxDMAStatus); 173662306a36Sopenharmony_ci dev->stats.rx_crc_errors = readl(ioaddr + 0x5703C); 173762306a36Sopenharmony_ci dev->stats.rx_frame_errors = readl(ioaddr + 0x57040); 173862306a36Sopenharmony_ci dev->stats.rx_length_errors = readl(ioaddr + 0x57058); 173962306a36Sopenharmony_ci dev->stats.rx_missed_errors = readl(ioaddr + 0x5707C); 174062306a36Sopenharmony_ci 174162306a36Sopenharmony_ci return &dev->stats; 174262306a36Sopenharmony_ci} 174362306a36Sopenharmony_ci 174462306a36Sopenharmony_ci#ifdef VLAN_SUPPORT 174562306a36Sopenharmony_cistatic u32 set_vlan_mode(struct netdev_private *np) 174662306a36Sopenharmony_ci{ 174762306a36Sopenharmony_ci u32 ret = VlanMode; 174862306a36Sopenharmony_ci u16 vid; 174962306a36Sopenharmony_ci void __iomem *filter_addr = np->base + HashTable + 8; 175062306a36Sopenharmony_ci int vlan_count = 0; 175162306a36Sopenharmony_ci 175262306a36Sopenharmony_ci for_each_set_bit(vid, np->active_vlans, VLAN_N_VID) { 175362306a36Sopenharmony_ci if (vlan_count == 32) 175462306a36Sopenharmony_ci break; 175562306a36Sopenharmony_ci writew(vid, filter_addr); 175662306a36Sopenharmony_ci filter_addr += 16; 175762306a36Sopenharmony_ci vlan_count++; 175862306a36Sopenharmony_ci } 175962306a36Sopenharmony_ci if (vlan_count == 32) { 176062306a36Sopenharmony_ci ret |= PerfectFilterVlan; 176162306a36Sopenharmony_ci while (vlan_count < 32) { 176262306a36Sopenharmony_ci writew(0, filter_addr); 176362306a36Sopenharmony_ci filter_addr += 16; 176462306a36Sopenharmony_ci vlan_count++; 176562306a36Sopenharmony_ci } 176662306a36Sopenharmony_ci } 176762306a36Sopenharmony_ci return ret; 176862306a36Sopenharmony_ci} 176962306a36Sopenharmony_ci#endif /* VLAN_SUPPORT */ 177062306a36Sopenharmony_ci 177162306a36Sopenharmony_cistatic void set_rx_mode(struct net_device *dev) 177262306a36Sopenharmony_ci{ 177362306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 177462306a36Sopenharmony_ci void __iomem *ioaddr = np->base; 177562306a36Sopenharmony_ci u32 rx_mode = MinVLANPrio; 177662306a36Sopenharmony_ci struct netdev_hw_addr *ha; 177762306a36Sopenharmony_ci int i; 177862306a36Sopenharmony_ci 177962306a36Sopenharmony_ci#ifdef VLAN_SUPPORT 178062306a36Sopenharmony_ci rx_mode |= set_vlan_mode(np); 178162306a36Sopenharmony_ci#endif /* VLAN_SUPPORT */ 178262306a36Sopenharmony_ci 178362306a36Sopenharmony_ci if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */ 178462306a36Sopenharmony_ci rx_mode |= AcceptAll; 178562306a36Sopenharmony_ci } else if ((netdev_mc_count(dev) > multicast_filter_limit) || 178662306a36Sopenharmony_ci (dev->flags & IFF_ALLMULTI)) { 178762306a36Sopenharmony_ci /* Too many to match, or accept all multicasts. */ 178862306a36Sopenharmony_ci rx_mode |= AcceptBroadcast|AcceptAllMulticast|PerfectFilter; 178962306a36Sopenharmony_ci } else if (netdev_mc_count(dev) <= 14) { 179062306a36Sopenharmony_ci /* Use the 16 element perfect filter, skip first two entries. */ 179162306a36Sopenharmony_ci void __iomem *filter_addr = ioaddr + PerfFilterTable + 2 * 16; 179262306a36Sopenharmony_ci const __be16 *eaddrs; 179362306a36Sopenharmony_ci netdev_for_each_mc_addr(ha, dev) { 179462306a36Sopenharmony_ci eaddrs = (__be16 *) ha->addr; 179562306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[2]), filter_addr); filter_addr += 4; 179662306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[1]), filter_addr); filter_addr += 4; 179762306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[0]), filter_addr); filter_addr += 8; 179862306a36Sopenharmony_ci } 179962306a36Sopenharmony_ci eaddrs = (const __be16 *)dev->dev_addr; 180062306a36Sopenharmony_ci i = netdev_mc_count(dev) + 2; 180162306a36Sopenharmony_ci while (i++ < 16) { 180262306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[0]), filter_addr); filter_addr += 4; 180362306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[1]), filter_addr); filter_addr += 4; 180462306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[2]), filter_addr); filter_addr += 8; 180562306a36Sopenharmony_ci } 180662306a36Sopenharmony_ci rx_mode |= AcceptBroadcast|PerfectFilter; 180762306a36Sopenharmony_ci } else { 180862306a36Sopenharmony_ci /* Must use a multicast hash table. */ 180962306a36Sopenharmony_ci void __iomem *filter_addr; 181062306a36Sopenharmony_ci const __be16 *eaddrs; 181162306a36Sopenharmony_ci __le16 mc_filter[32] __attribute__ ((aligned(sizeof(long)))); /* Multicast hash filter */ 181262306a36Sopenharmony_ci 181362306a36Sopenharmony_ci memset(mc_filter, 0, sizeof(mc_filter)); 181462306a36Sopenharmony_ci netdev_for_each_mc_addr(ha, dev) { 181562306a36Sopenharmony_ci /* The chip uses the upper 9 CRC bits 181662306a36Sopenharmony_ci as index into the hash table */ 181762306a36Sopenharmony_ci int bit_nr = ether_crc_le(ETH_ALEN, ha->addr) >> 23; 181862306a36Sopenharmony_ci __le32 *fptr = (__le32 *) &mc_filter[(bit_nr >> 4) & ~1]; 181962306a36Sopenharmony_ci 182062306a36Sopenharmony_ci *fptr |= cpu_to_le32(1 << (bit_nr & 31)); 182162306a36Sopenharmony_ci } 182262306a36Sopenharmony_ci /* Clear the perfect filter list, skip first two entries. */ 182362306a36Sopenharmony_ci filter_addr = ioaddr + PerfFilterTable + 2 * 16; 182462306a36Sopenharmony_ci eaddrs = (const __be16 *)dev->dev_addr; 182562306a36Sopenharmony_ci for (i = 2; i < 16; i++) { 182662306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[0]), filter_addr); filter_addr += 4; 182762306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[1]), filter_addr); filter_addr += 4; 182862306a36Sopenharmony_ci writew(be16_to_cpu(eaddrs[2]), filter_addr); filter_addr += 8; 182962306a36Sopenharmony_ci } 183062306a36Sopenharmony_ci for (filter_addr = ioaddr + HashTable, i = 0; i < 32; filter_addr+= 16, i++) 183162306a36Sopenharmony_ci writew(mc_filter[i], filter_addr); 183262306a36Sopenharmony_ci rx_mode |= AcceptBroadcast|PerfectFilter|HashFilter; 183362306a36Sopenharmony_ci } 183462306a36Sopenharmony_ci writel(rx_mode, ioaddr + RxFilterMode); 183562306a36Sopenharmony_ci} 183662306a36Sopenharmony_ci 183762306a36Sopenharmony_cistatic int check_if_running(struct net_device *dev) 183862306a36Sopenharmony_ci{ 183962306a36Sopenharmony_ci if (!netif_running(dev)) 184062306a36Sopenharmony_ci return -EINVAL; 184162306a36Sopenharmony_ci return 0; 184262306a36Sopenharmony_ci} 184362306a36Sopenharmony_ci 184462306a36Sopenharmony_cistatic void get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) 184562306a36Sopenharmony_ci{ 184662306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 184762306a36Sopenharmony_ci strscpy(info->driver, DRV_NAME, sizeof(info->driver)); 184862306a36Sopenharmony_ci strscpy(info->bus_info, pci_name(np->pci_dev), sizeof(info->bus_info)); 184962306a36Sopenharmony_ci} 185062306a36Sopenharmony_ci 185162306a36Sopenharmony_cistatic int get_link_ksettings(struct net_device *dev, 185262306a36Sopenharmony_ci struct ethtool_link_ksettings *cmd) 185362306a36Sopenharmony_ci{ 185462306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 185562306a36Sopenharmony_ci spin_lock_irq(&np->lock); 185662306a36Sopenharmony_ci mii_ethtool_get_link_ksettings(&np->mii_if, cmd); 185762306a36Sopenharmony_ci spin_unlock_irq(&np->lock); 185862306a36Sopenharmony_ci return 0; 185962306a36Sopenharmony_ci} 186062306a36Sopenharmony_ci 186162306a36Sopenharmony_cistatic int set_link_ksettings(struct net_device *dev, 186262306a36Sopenharmony_ci const struct ethtool_link_ksettings *cmd) 186362306a36Sopenharmony_ci{ 186462306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 186562306a36Sopenharmony_ci int res; 186662306a36Sopenharmony_ci spin_lock_irq(&np->lock); 186762306a36Sopenharmony_ci res = mii_ethtool_set_link_ksettings(&np->mii_if, cmd); 186862306a36Sopenharmony_ci spin_unlock_irq(&np->lock); 186962306a36Sopenharmony_ci check_duplex(dev); 187062306a36Sopenharmony_ci return res; 187162306a36Sopenharmony_ci} 187262306a36Sopenharmony_ci 187362306a36Sopenharmony_cistatic int nway_reset(struct net_device *dev) 187462306a36Sopenharmony_ci{ 187562306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 187662306a36Sopenharmony_ci return mii_nway_restart(&np->mii_if); 187762306a36Sopenharmony_ci} 187862306a36Sopenharmony_ci 187962306a36Sopenharmony_cistatic u32 get_link(struct net_device *dev) 188062306a36Sopenharmony_ci{ 188162306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 188262306a36Sopenharmony_ci return mii_link_ok(&np->mii_if); 188362306a36Sopenharmony_ci} 188462306a36Sopenharmony_ci 188562306a36Sopenharmony_cistatic u32 get_msglevel(struct net_device *dev) 188662306a36Sopenharmony_ci{ 188762306a36Sopenharmony_ci return debug; 188862306a36Sopenharmony_ci} 188962306a36Sopenharmony_ci 189062306a36Sopenharmony_cistatic void set_msglevel(struct net_device *dev, u32 val) 189162306a36Sopenharmony_ci{ 189262306a36Sopenharmony_ci debug = val; 189362306a36Sopenharmony_ci} 189462306a36Sopenharmony_ci 189562306a36Sopenharmony_cistatic const struct ethtool_ops ethtool_ops = { 189662306a36Sopenharmony_ci .begin = check_if_running, 189762306a36Sopenharmony_ci .get_drvinfo = get_drvinfo, 189862306a36Sopenharmony_ci .nway_reset = nway_reset, 189962306a36Sopenharmony_ci .get_link = get_link, 190062306a36Sopenharmony_ci .get_msglevel = get_msglevel, 190162306a36Sopenharmony_ci .set_msglevel = set_msglevel, 190262306a36Sopenharmony_ci .get_link_ksettings = get_link_ksettings, 190362306a36Sopenharmony_ci .set_link_ksettings = set_link_ksettings, 190462306a36Sopenharmony_ci}; 190562306a36Sopenharmony_ci 190662306a36Sopenharmony_cistatic int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) 190762306a36Sopenharmony_ci{ 190862306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 190962306a36Sopenharmony_ci struct mii_ioctl_data *data = if_mii(rq); 191062306a36Sopenharmony_ci int rc; 191162306a36Sopenharmony_ci 191262306a36Sopenharmony_ci if (!netif_running(dev)) 191362306a36Sopenharmony_ci return -EINVAL; 191462306a36Sopenharmony_ci 191562306a36Sopenharmony_ci spin_lock_irq(&np->lock); 191662306a36Sopenharmony_ci rc = generic_mii_ioctl(&np->mii_if, data, cmd, NULL); 191762306a36Sopenharmony_ci spin_unlock_irq(&np->lock); 191862306a36Sopenharmony_ci 191962306a36Sopenharmony_ci if ((cmd == SIOCSMIIREG) && (data->phy_id == np->phys[0])) 192062306a36Sopenharmony_ci check_duplex(dev); 192162306a36Sopenharmony_ci 192262306a36Sopenharmony_ci return rc; 192362306a36Sopenharmony_ci} 192462306a36Sopenharmony_ci 192562306a36Sopenharmony_cistatic int netdev_close(struct net_device *dev) 192662306a36Sopenharmony_ci{ 192762306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 192862306a36Sopenharmony_ci void __iomem *ioaddr = np->base; 192962306a36Sopenharmony_ci int i; 193062306a36Sopenharmony_ci 193162306a36Sopenharmony_ci netif_stop_queue(dev); 193262306a36Sopenharmony_ci 193362306a36Sopenharmony_ci napi_disable(&np->napi); 193462306a36Sopenharmony_ci 193562306a36Sopenharmony_ci if (debug > 1) { 193662306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Shutting down ethercard, Intr status %#8.8x.\n", 193762306a36Sopenharmony_ci dev->name, (int) readl(ioaddr + IntrStatus)); 193862306a36Sopenharmony_ci printk(KERN_DEBUG "%s: Queue pointers were Tx %d / %d, Rx %d / %d.\n", 193962306a36Sopenharmony_ci dev->name, np->cur_tx, np->dirty_tx, 194062306a36Sopenharmony_ci np->cur_rx, np->dirty_rx); 194162306a36Sopenharmony_ci } 194262306a36Sopenharmony_ci 194362306a36Sopenharmony_ci /* Disable interrupts by clearing the interrupt mask. */ 194462306a36Sopenharmony_ci writel(0, ioaddr + IntrEnable); 194562306a36Sopenharmony_ci 194662306a36Sopenharmony_ci /* Stop the chip's Tx and Rx processes. */ 194762306a36Sopenharmony_ci writel(0, ioaddr + GenCtrl); 194862306a36Sopenharmony_ci readl(ioaddr + GenCtrl); 194962306a36Sopenharmony_ci 195062306a36Sopenharmony_ci if (debug > 5) { 195162306a36Sopenharmony_ci printk(KERN_DEBUG" Tx ring at %#llx:\n", 195262306a36Sopenharmony_ci (long long) np->tx_ring_dma); 195362306a36Sopenharmony_ci for (i = 0; i < 8 /* TX_RING_SIZE is huge! */; i++) 195462306a36Sopenharmony_ci printk(KERN_DEBUG " #%d desc. %#8.8x %#llx -> %#8.8x.\n", 195562306a36Sopenharmony_ci i, le32_to_cpu(np->tx_ring[i].status), 195662306a36Sopenharmony_ci (long long) dma_to_cpu(np->tx_ring[i].addr), 195762306a36Sopenharmony_ci le32_to_cpu(np->tx_done_q[i].status)); 195862306a36Sopenharmony_ci printk(KERN_DEBUG " Rx ring at %#llx -> %p:\n", 195962306a36Sopenharmony_ci (long long) np->rx_ring_dma, np->rx_done_q); 196062306a36Sopenharmony_ci if (np->rx_done_q) 196162306a36Sopenharmony_ci for (i = 0; i < 8 /* RX_RING_SIZE */; i++) { 196262306a36Sopenharmony_ci printk(KERN_DEBUG " #%d desc. %#llx -> %#8.8x\n", 196362306a36Sopenharmony_ci i, (long long) dma_to_cpu(np->rx_ring[i].rxaddr), le32_to_cpu(np->rx_done_q[i].status)); 196462306a36Sopenharmony_ci } 196562306a36Sopenharmony_ci } 196662306a36Sopenharmony_ci 196762306a36Sopenharmony_ci free_irq(np->pci_dev->irq, dev); 196862306a36Sopenharmony_ci 196962306a36Sopenharmony_ci /* Free all the skbuffs in the Rx queue. */ 197062306a36Sopenharmony_ci for (i = 0; i < RX_RING_SIZE; i++) { 197162306a36Sopenharmony_ci np->rx_ring[i].rxaddr = cpu_to_dma(0xBADF00D0); /* An invalid address. */ 197262306a36Sopenharmony_ci if (np->rx_info[i].skb != NULL) { 197362306a36Sopenharmony_ci dma_unmap_single(&np->pci_dev->dev, 197462306a36Sopenharmony_ci np->rx_info[i].mapping, 197562306a36Sopenharmony_ci np->rx_buf_sz, DMA_FROM_DEVICE); 197662306a36Sopenharmony_ci dev_kfree_skb(np->rx_info[i].skb); 197762306a36Sopenharmony_ci } 197862306a36Sopenharmony_ci np->rx_info[i].skb = NULL; 197962306a36Sopenharmony_ci np->rx_info[i].mapping = 0; 198062306a36Sopenharmony_ci } 198162306a36Sopenharmony_ci for (i = 0; i < TX_RING_SIZE; i++) { 198262306a36Sopenharmony_ci struct sk_buff *skb = np->tx_info[i].skb; 198362306a36Sopenharmony_ci if (skb == NULL) 198462306a36Sopenharmony_ci continue; 198562306a36Sopenharmony_ci dma_unmap_single(&np->pci_dev->dev, np->tx_info[i].mapping, 198662306a36Sopenharmony_ci skb_first_frag_len(skb), DMA_TO_DEVICE); 198762306a36Sopenharmony_ci np->tx_info[i].mapping = 0; 198862306a36Sopenharmony_ci dev_kfree_skb(skb); 198962306a36Sopenharmony_ci np->tx_info[i].skb = NULL; 199062306a36Sopenharmony_ci } 199162306a36Sopenharmony_ci 199262306a36Sopenharmony_ci return 0; 199362306a36Sopenharmony_ci} 199462306a36Sopenharmony_ci 199562306a36Sopenharmony_cistatic int __maybe_unused starfire_suspend(struct device *dev_d) 199662306a36Sopenharmony_ci{ 199762306a36Sopenharmony_ci struct net_device *dev = dev_get_drvdata(dev_d); 199862306a36Sopenharmony_ci 199962306a36Sopenharmony_ci if (netif_running(dev)) { 200062306a36Sopenharmony_ci netif_device_detach(dev); 200162306a36Sopenharmony_ci netdev_close(dev); 200262306a36Sopenharmony_ci } 200362306a36Sopenharmony_ci 200462306a36Sopenharmony_ci return 0; 200562306a36Sopenharmony_ci} 200662306a36Sopenharmony_ci 200762306a36Sopenharmony_cistatic int __maybe_unused starfire_resume(struct device *dev_d) 200862306a36Sopenharmony_ci{ 200962306a36Sopenharmony_ci struct net_device *dev = dev_get_drvdata(dev_d); 201062306a36Sopenharmony_ci 201162306a36Sopenharmony_ci if (netif_running(dev)) { 201262306a36Sopenharmony_ci netdev_open(dev); 201362306a36Sopenharmony_ci netif_device_attach(dev); 201462306a36Sopenharmony_ci } 201562306a36Sopenharmony_ci 201662306a36Sopenharmony_ci return 0; 201762306a36Sopenharmony_ci} 201862306a36Sopenharmony_ci 201962306a36Sopenharmony_cistatic void starfire_remove_one(struct pci_dev *pdev) 202062306a36Sopenharmony_ci{ 202162306a36Sopenharmony_ci struct net_device *dev = pci_get_drvdata(pdev); 202262306a36Sopenharmony_ci struct netdev_private *np = netdev_priv(dev); 202362306a36Sopenharmony_ci 202462306a36Sopenharmony_ci BUG_ON(!dev); 202562306a36Sopenharmony_ci 202662306a36Sopenharmony_ci unregister_netdev(dev); 202762306a36Sopenharmony_ci 202862306a36Sopenharmony_ci if (np->queue_mem) 202962306a36Sopenharmony_ci dma_free_coherent(&pdev->dev, np->queue_mem_size, 203062306a36Sopenharmony_ci np->queue_mem, np->queue_mem_dma); 203162306a36Sopenharmony_ci 203262306a36Sopenharmony_ci 203362306a36Sopenharmony_ci /* XXX: add wakeup code -- requires firmware for MagicPacket */ 203462306a36Sopenharmony_ci pci_set_power_state(pdev, PCI_D3hot); /* go to sleep in D3 mode */ 203562306a36Sopenharmony_ci pci_disable_device(pdev); 203662306a36Sopenharmony_ci 203762306a36Sopenharmony_ci iounmap(np->base); 203862306a36Sopenharmony_ci pci_release_regions(pdev); 203962306a36Sopenharmony_ci 204062306a36Sopenharmony_ci free_netdev(dev); /* Will also free np!! */ 204162306a36Sopenharmony_ci} 204262306a36Sopenharmony_ci 204362306a36Sopenharmony_cistatic SIMPLE_DEV_PM_OPS(starfire_pm_ops, starfire_suspend, starfire_resume); 204462306a36Sopenharmony_ci 204562306a36Sopenharmony_cistatic struct pci_driver starfire_driver = { 204662306a36Sopenharmony_ci .name = DRV_NAME, 204762306a36Sopenharmony_ci .probe = starfire_init_one, 204862306a36Sopenharmony_ci .remove = starfire_remove_one, 204962306a36Sopenharmony_ci .driver.pm = &starfire_pm_ops, 205062306a36Sopenharmony_ci .id_table = starfire_pci_tbl, 205162306a36Sopenharmony_ci}; 205262306a36Sopenharmony_ci 205362306a36Sopenharmony_ci 205462306a36Sopenharmony_cistatic int __init starfire_init (void) 205562306a36Sopenharmony_ci{ 205662306a36Sopenharmony_ci/* when a module, this is printed whether or not devices are found in probe */ 205762306a36Sopenharmony_ci#ifdef MODULE 205862306a36Sopenharmony_ci printk(KERN_INFO DRV_NAME ": polling (NAPI) enabled\n"); 205962306a36Sopenharmony_ci#endif 206062306a36Sopenharmony_ci 206162306a36Sopenharmony_ci BUILD_BUG_ON(sizeof(dma_addr_t) != sizeof(netdrv_addr_t)); 206262306a36Sopenharmony_ci 206362306a36Sopenharmony_ci return pci_register_driver(&starfire_driver); 206462306a36Sopenharmony_ci} 206562306a36Sopenharmony_ci 206662306a36Sopenharmony_ci 206762306a36Sopenharmony_cistatic void __exit starfire_cleanup (void) 206862306a36Sopenharmony_ci{ 206962306a36Sopenharmony_ci pci_unregister_driver (&starfire_driver); 207062306a36Sopenharmony_ci} 207162306a36Sopenharmony_ci 207262306a36Sopenharmony_ci 207362306a36Sopenharmony_cimodule_init(starfire_init); 207462306a36Sopenharmony_cimodule_exit(starfire_cleanup); 2075