| /* drivers/net/eepro100.c: An Intel i82557-559 Ethernet driver for Linux. */ | |
| /* | |
| Written 1996-1999 by Donald Becker. | |
| The driver also contains updates by different kernel developers | |
| (see incomplete list below). | |
| Current maintainer is Andrey V. Savochkin <saw@saw.sw.com.sg>. | |
| Please use this email address and linux-kernel mailing list for bug reports. | |
| This software may be used and distributed according to the terms | |
| of the GNU General Public License, incorporated herein by reference. | |
| This driver is for the Intel EtherExpress Pro100 (Speedo3) design. | |
| It should work with all i82557/558/559 boards. | |
| Version history: | |
| 1998 Apr - 2000 Feb Andrey V. Savochkin <saw@saw.sw.com.sg> | |
| Serious fixes for multicast filter list setting, TX timeout routine; | |
| RX ring refilling logic; other stuff | |
| 2000 Feb Jeff Garzik <jgarzik@pobox.com> | |
| Convert to new PCI driver interface | |
| 2000 Mar 24 Dragan Stancevic <visitor@valinux.com> | |
| Disabled FC and ER, to avoid lockups when when we get FCP interrupts. | |
| 2000 Jul 17 Goutham Rao <goutham.rao@intel.com> | |
| PCI DMA API fixes, adding pci_dma_sync_single calls where neccesary | |
| 2000 Aug 31 David Mosberger <davidm@hpl.hp.com> | |
| rx_align support: enables rx DMA without causing unaligned accesses. | |
| */ | |
| static const char * const version = | |
| "eepro100.c:v1.09j-t 9/29/99 Donald Becker\n" | |
| "eepro100.c: $Revision: 1.36 $ 2000/11/17 Modified by Andrey V. Savochkin <saw@saw.sw.com.sg> and others\n"; | |
| /* A few user-configurable values that apply to all boards. | |
| First set is undocumented and spelled per Intel recommendations. */ | |
| static int congenb /* = 0 */; /* Enable congestion control in the DP83840. */ | |
| static int txfifo = 8; /* Tx FIFO threshold in 4 byte units, 0-15 */ | |
| static int rxfifo = 8; /* Rx FIFO threshold, default 32 bytes. */ | |
| /* Tx/Rx DMA burst length, 0-127, 0 == no preemption, tx==128 -> disabled. */ | |
| static int txdmacount = 128; | |
| static int rxdmacount /* = 0 */; | |
| #if defined(__ia64__) || defined(__alpha__) || defined(__sparc__) || defined(__mips__) || \ | |
| defined(__arm__) | |
| /* align rx buffers to 2 bytes so that IP header is aligned */ | |
| # define rx_align(skb) skb_reserve((skb), 2) | |
| # define RxFD_ALIGNMENT __attribute__ ((aligned (2), packed)) | |
| #else | |
| # define rx_align(skb) | |
| # define RxFD_ALIGNMENT | |
| #endif | |
| /* Set the copy breakpoint for the copy-only-tiny-buffer Rx method. | |
| Lower values use more memory, but are faster. */ | |
| static int rx_copybreak = 200; | |
| /* Maximum events (Rx packets, etc.) to handle at each interrupt. */ | |
| static int max_interrupt_work = 20; | |
| /* Maximum number of multicast addresses to filter (vs. rx-all-multicast) */ | |
| static int multicast_filter_limit = 64; | |
| /* 'options' is used to pass a transceiver override or full-duplex flag | |
| e.g. "options=16" for FD, "options=32" for 100mbps-only. */ | |
| static int full_duplex[] = {-1, -1, -1, -1, -1, -1, -1, -1}; | |
| static int options[] = {-1, -1, -1, -1, -1, -1, -1, -1}; | |
| /* A few values that may be tweaked. */ | |
| /* The ring sizes should be a power of two for efficiency. */ | |
| #define TX_RING_SIZE 64 | |
| #define RX_RING_SIZE 64 | |
| /* How much slots multicast filter setup may take. | |
| Do not descrease without changing set_rx_mode() implementaion. */ | |
| #define TX_MULTICAST_SIZE 2 | |
| #define TX_MULTICAST_RESERV (TX_MULTICAST_SIZE*2) | |
| /* Actual number of TX packets queued, must be | |
| <= TX_RING_SIZE-TX_MULTICAST_RESERV. */ | |
| #define TX_QUEUE_LIMIT (TX_RING_SIZE-TX_MULTICAST_RESERV) | |
| /* Hysteresis marking queue as no longer full. */ | |
| #define TX_QUEUE_UNFULL (TX_QUEUE_LIMIT-4) | |
| /* Operational parameters that usually are not changed. */ | |
| /* Time in jiffies before concluding the transmitter is hung. */ | |
| #define TX_TIMEOUT (2*HZ) | |
| /* Size of an pre-allocated Rx buffer: <Ethernet MTU> + slack.*/ | |
| #define PKT_BUF_SZ 1536 | |
| #include <linux/module.h> | |
| #include <linux/kernel.h> | |
| #include <linux/string.h> | |
| #include <linux/errno.h> | |
| #include <linux/ioport.h> | |
| #include <linux/slab.h> | |
| #include <linux/interrupt.h> | |
| #include <linux/timer.h> | |
| #include <linux/pci.h> | |
| #include <linux/spinlock.h> | |
| #include <linux/init.h> | |
| #include <linux/mii.h> | |
| #include <linux/delay.h> | |
| #include <linux/bitops.h> | |
| #include <asm/io.h> | |
| #include <asm/uaccess.h> | |
| #include <asm/irq.h> | |
| #include <linux/netdevice.h> | |
| #include <linux/etherdevice.h> | |
| #include <linux/rtnetlink.h> | |
| #include <linux/skbuff.h> | |
| #include <linux/ethtool.h> | |
| static int use_io; | |
| static int debug = -1; | |
| #define DEBUG_DEFAULT (NETIF_MSG_DRV | \ | |
| NETIF_MSG_HW | \ | |
| NETIF_MSG_RX_ERR | \ | |
| NETIF_MSG_TX_ERR) | |
| #define DEBUG ((debug >= 0) ? (1<<debug)-1 : DEBUG_DEFAULT) | |
| MODULE_AUTHOR("Maintainer: Andrey V. Savochkin <saw@saw.sw.com.sg>"); | |
| MODULE_DESCRIPTION("Intel i82557/i82558/i82559 PCI EtherExpressPro driver"); | |
| MODULE_LICENSE("GPL"); | |
| module_param(use_io, int, 0); | |
| module_param(debug, int, 0); | |
| module_param_array(options, int, NULL, 0); | |
| module_param_array(full_duplex, int, NULL, 0); | |
| module_param(congenb, int, 0); | |
| module_param(txfifo, int, 0); | |
| module_param(rxfifo, int, 0); | |
| module_param(txdmacount, int, 0); | |
| module_param(rxdmacount, int, 0); | |
| module_param(rx_copybreak, int, 0); | |
| module_param(max_interrupt_work, int, 0); | |
| module_param(multicast_filter_limit, int, 0); | |
| MODULE_PARM_DESC(debug, "debug level (0-6)"); | |
| MODULE_PARM_DESC(options, "Bits 0-3: transceiver type, bit 4: full duplex, bit 5: 100Mbps"); | |
| MODULE_PARM_DESC(full_duplex, "full duplex setting(s) (1)"); | |
| MODULE_PARM_DESC(congenb, "Enable congestion control (1)"); | |
| MODULE_PARM_DESC(txfifo, "Tx FIFO threshold in 4 byte units, (0-15)"); | |
| MODULE_PARM_DESC(rxfifo, "Rx FIFO threshold in 4 byte units, (0-15)"); | |
| MODULE_PARM_DESC(txdmacount, "Tx DMA burst length; 128 - disable (0-128)"); | |
| MODULE_PARM_DESC(rxdmacount, "Rx DMA burst length; 128 - disable (0-128)"); | |
| MODULE_PARM_DESC(rx_copybreak, "copy breakpoint for copy-only-tiny-frames"); | |
| MODULE_PARM_DESC(max_interrupt_work, "maximum events handled per interrupt"); | |
| MODULE_PARM_DESC(multicast_filter_limit, "maximum number of filtered multicast addresses"); | |
| #define RUN_AT(x) (jiffies + (x)) | |
| #define netdevice_start(dev) | |
| #define netdevice_stop(dev) | |
| #define netif_set_tx_timeout(dev, tf, tm) \ | |
| do { \ | |
| (dev)->tx_timeout = (tf); \ | |
| (dev)->watchdog_timeo = (tm); \ | |
| } while(0) | |
| /* | |
| Theory of Operation | |
| I. Board Compatibility | |
| This device driver is designed for the Intel i82557 "Speedo3" chip, Intel's | |
| single-chip fast Ethernet controller for PCI, as used on the Intel | |
| EtherExpress Pro 100 adapter. | |
| II. Board-specific settings | |
| PCI bus devices are configured by the system at boot time, so no jumpers | |
| need to be set on the board. The system BIOS should be set to assign the | |
| PCI INTA signal to an otherwise unused system IRQ line. While it's | |
| possible to share PCI interrupt lines, it negatively impacts performance and | |
| only recent kernels support it. | |
| III. Driver operation | |
| IIIA. General | |
| The Speedo3 is very similar to other Intel network chips, that is to say | |
| "apparently designed on a different planet". This chips retains the complex | |
| Rx and Tx descriptors and multiple buffers pointers as previous chips, but | |
| also has simplified Tx and Rx buffer modes. This driver uses the "flexible" | |
| Tx mode, but in a simplified lower-overhead manner: it associates only a | |
| single buffer descriptor with each frame descriptor. | |
| Despite the extra space overhead in each receive skbuff, the driver must use | |
| the simplified Rx buffer mode to assure that only a single data buffer is | |
| associated with each RxFD. The driver implements this by reserving space | |
| for the Rx descriptor at the head of each Rx skbuff. | |
| The Speedo-3 has receive and command unit base addresses that are added to | |
| almost all descriptor pointers. The driver sets these to zero, so that all | |
| pointer fields are absolute addresses. | |
| The System Control Block (SCB) of some previous Intel chips exists on the | |
| chip in both PCI I/O and memory space. This driver uses the I/O space | |
| registers, but might switch to memory mapped mode to better support non-x86 | |
| processors. | |
| IIIB. Transmit structure | |
| The driver must use the complex Tx command+descriptor mode in order to | |
| have a indirect pointer to the skbuff data section. Each Tx command block | |
| (TxCB) is associated with two immediately appended Tx Buffer Descriptor | |
| (TxBD). A fixed ring of these TxCB+TxBD pairs are kept as part of the | |
| speedo_private data structure for each adapter instance. | |
| The newer i82558 explicitly supports this structure, and can read the two | |
| TxBDs in the same PCI burst as the TxCB. | |
| This ring structure is used for all normal transmit packets, but the | |
| transmit packet descriptors aren't long enough for most non-Tx commands such | |
| as CmdConfigure. This is complicated by the possibility that the chip has | |
| already loaded the link address in the previous descriptor. So for these | |
| commands we convert the next free descriptor on the ring to a NoOp, and point | |
| that descriptor's link to the complex command. | |
| An additional complexity of these non-transmit commands are that they may be | |
| added asynchronous to the normal transmit queue, so we disable interrupts | |
| whenever the Tx descriptor ring is manipulated. | |
| A notable aspect of these special configure commands is that they do | |
| work with the normal Tx ring entry scavenge method. The Tx ring scavenge | |
| is done at interrupt time using the 'dirty_tx' index, and checking for the | |
| command-complete bit. While the setup frames may have the NoOp command on the | |
| Tx ring marked as complete, but not have completed the setup command, this | |
| is not a problem. The tx_ring entry can be still safely reused, as the | |
| tx_skbuff[] entry is always empty for config_cmd and mc_setup frames. | |
| Commands may have bits set e.g. CmdSuspend in the command word to either | |
| suspend or stop the transmit/command unit. This driver always flags the last | |
| command with CmdSuspend, erases the CmdSuspend in the previous command, and | |
| then issues a CU_RESUME. | |
| Note: Watch out for the potential race condition here: imagine | |
| erasing the previous suspend | |
| the chip processes the previous command | |
| the chip processes the final command, and suspends | |
| doing the CU_RESUME | |
| the chip processes the next-yet-valid post-final-command. | |
| So blindly sending a CU_RESUME is only safe if we do it immediately after | |
| after erasing the previous CmdSuspend, without the possibility of an | |
| intervening delay. Thus the resume command is always within the | |
| interrupts-disabled region. This is a timing dependence, but handling this | |
| condition in a timing-independent way would considerably complicate the code. | |
| Note: In previous generation Intel chips, restarting the command unit was a | |
| notoriously slow process. This is presumably no longer true. | |
| IIIC. Receive structure | |
| Because of the bus-master support on the Speedo3 this driver uses the new | |
| SKBUFF_RX_COPYBREAK scheme, rather than a fixed intermediate receive buffer. | |
| This scheme allocates full-sized skbuffs as receive buffers. The value | |
| SKBUFF_RX_COPYBREAK is used as the copying breakpoint: it is chosen to | |
| trade-off the memory wasted by passing the full-sized skbuff to the queue | |
| layer for all frames vs. the copying cost of copying a frame to a | |
| correctly-sized skbuff. | |
| For small frames the copying cost is negligible (esp. considering that we | |
| are pre-loading the cache with immediately useful header information), so we | |
| allocate a new, minimally-sized skbuff. For large frames the copying cost | |
| is non-trivial, and the larger copy might flush the cache of useful data, so | |
| we pass up the skbuff the packet was received into. | |
| IV. Notes | |
| Thanks to Steve Williams of Intel for arranging the non-disclosure agreement | |
| that stated that I could disclose the information. But I still resent | |
| having to sign an Intel NDA when I'm helping Intel sell their own product! | |
| */ | |
| static int speedo_found1(struct pci_dev *pdev, void __iomem *ioaddr, int fnd_cnt, int acpi_idle_state); | |
| /* Offsets to the various registers. | |
| All accesses need not be longword aligned. */ | |
| enum speedo_offsets { | |
| SCBStatus = 0, SCBCmd = 2, /* Rx/Command Unit command and status. */ | |
| SCBIntmask = 3, | |
| SCBPointer = 4, /* General purpose pointer. */ | |
| SCBPort = 8, /* Misc. commands and operands. */ | |
| SCBflash = 12, SCBeeprom = 14, /* EEPROM and flash memory control. */ | |
| SCBCtrlMDI = 16, /* MDI interface control. */ | |
| SCBEarlyRx = 20, /* Early receive byte count. */ | |
| }; | |
| /* Commands that can be put in a command list entry. */ | |
| enum commands { | |
| CmdNOp = 0, CmdIASetup = 0x10000, CmdConfigure = 0x20000, | |
| CmdMulticastList = 0x30000, CmdTx = 0x40000, CmdTDR = 0x50000, | |
| CmdDump = 0x60000, CmdDiagnose = 0x70000, | |
| CmdSuspend = 0x40000000, /* Suspend after completion. */ | |
| CmdIntr = 0x20000000, /* Interrupt after completion. */ | |
| CmdTxFlex = 0x00080000, /* Use "Flexible mode" for CmdTx command. */ | |
| }; | |
| /* Clear CmdSuspend (1<<30) avoiding interference with the card access to the | |
| status bits. Previous driver versions used separate 16 bit fields for | |
| commands and statuses. --SAW | |
| */ | |
| #if defined(__alpha__) | |
| # define clear_suspend(cmd) clear_bit(30, &(cmd)->cmd_status); | |
| #else | |
| # define clear_suspend(cmd) ((__le16 *)&(cmd)->cmd_status)[1] &= ~cpu_to_le16(1<<14) | |
| #endif | |
| enum SCBCmdBits { | |
| SCBMaskCmdDone=0x8000, SCBMaskRxDone=0x4000, SCBMaskCmdIdle=0x2000, | |
| SCBMaskRxSuspend=0x1000, SCBMaskEarlyRx=0x0800, SCBMaskFlowCtl=0x0400, | |
| SCBTriggerIntr=0x0200, SCBMaskAll=0x0100, | |
| /* The rest are Rx and Tx commands. */ | |
| CUStart=0x0010, CUResume=0x0020, CUStatsAddr=0x0040, CUShowStats=0x0050, | |
| CUCmdBase=0x0060, /* CU Base address (set to zero) . */ | |
| CUDumpStats=0x0070, /* Dump then reset stats counters. */ | |
| RxStart=0x0001, RxResume=0x0002, RxAbort=0x0004, RxAddrLoad=0x0006, | |
| RxResumeNoResources=0x0007, | |
| }; | |
| enum SCBPort_cmds { | |
| PortReset=0, PortSelfTest=1, PortPartialReset=2, PortDump=3, | |
| }; | |
| /* The Speedo3 Rx and Tx frame/buffer descriptors. */ | |
| struct descriptor { /* A generic descriptor. */ | |
| volatile __le32 cmd_status; /* All command and status fields. */ | |
| __le32 link; /* struct descriptor * */ | |
| unsigned char params[0]; | |
| }; | |
| /* The Speedo3 Rx and Tx buffer descriptors. */ | |
| struct RxFD { /* Receive frame descriptor. */ | |
| volatile __le32 status; | |
| __le32 link; /* struct RxFD * */ | |
| __le32 rx_buf_addr; /* void * */ | |
| __le32 count; | |
| } RxFD_ALIGNMENT; | |
| /* Selected elements of the Tx/RxFD.status word. */ | |
| enum RxFD_bits { | |
| RxComplete=0x8000, RxOK=0x2000, | |
| RxErrCRC=0x0800, RxErrAlign=0x0400, RxErrTooBig=0x0200, RxErrSymbol=0x0010, | |
| RxEth2Type=0x0020, RxNoMatch=0x0004, RxNoIAMatch=0x0002, | |
| TxUnderrun=0x1000, StatusComplete=0x8000, | |
| }; | |
| #define CONFIG_DATA_SIZE 22 | |
| struct TxFD { /* Transmit frame descriptor set. */ | |
| __le32 status; | |
| __le32 link; /* void * */ | |
| __le32 tx_desc_addr; /* Always points to the tx_buf_addr element. */ | |
| __le32 count; /* # of TBD (=1), Tx start thresh., etc. */ | |
| /* This constitutes two "TBD" entries -- we only use one. */ | |
| #define TX_DESCR_BUF_OFFSET 16 | |
| __le32 tx_buf_addr0; /* void *, frame to be transmitted. */ | |
| __le32 tx_buf_size0; /* Length of Tx frame. */ | |
| __le32 tx_buf_addr1; /* void *, frame to be transmitted. */ | |
| __le32 tx_buf_size1; /* Length of Tx frame. */ | |
| /* the structure must have space for at least CONFIG_DATA_SIZE starting | |
| * from tx_desc_addr field */ | |
| }; | |
| /* Multicast filter setting block. --SAW */ | |
| struct speedo_mc_block { | |
| struct speedo_mc_block *next; | |
| unsigned int tx; | |
| dma_addr_t frame_dma; | |
| unsigned int len; | |
| struct descriptor frame __attribute__ ((__aligned__(16))); | |
| }; | |
| /* Elements of the dump_statistics block. This block must be lword aligned. */ | |
| struct speedo_stats { | |
| __le32 tx_good_frames; | |
| __le32 tx_coll16_errs; | |
| __le32 tx_late_colls; | |
| __le32 tx_underruns; | |
| __le32 tx_lost_carrier; | |
| __le32 tx_deferred; | |
| __le32 tx_one_colls; | |
| __le32 tx_multi_colls; | |
| __le32 tx_total_colls; | |
| __le32 rx_good_frames; | |
| __le32 rx_crc_errs; | |
| __le32 rx_align_errs; | |
| __le32 rx_resource_errs; | |
| __le32 rx_overrun_errs; | |
| __le32 rx_colls_errs; | |
| __le32 rx_runt_errs; | |
| __le32 done_marker; | |
| }; | |
| enum Rx_ring_state_bits { | |
| RrNoMem=1, RrPostponed=2, RrNoResources=4, RrOOMReported=8, | |
| }; | |
| /* Do not change the position (alignment) of the first few elements! | |
| The later elements are grouped for cache locality. | |
| Unfortunately, all the positions have been shifted since there. | |
| A new re-alignment is required. 2000/03/06 SAW */ | |
| struct speedo_private { | |
| void __iomem *regs; | |
| struct TxFD *tx_ring; /* Commands (usually CmdTxPacket). */ | |
| struct RxFD *rx_ringp[RX_RING_SIZE]; /* Rx descriptor, used as ring. */ | |
| /* The addresses of a Tx/Rx-in-place packets/buffers. */ | |
| struct sk_buff *tx_skbuff[TX_RING_SIZE]; | |
| struct sk_buff *rx_skbuff[RX_RING_SIZE]; | |
| /* Mapped addresses of the rings. */ | |
| dma_addr_t tx_ring_dma; | |
| #define TX_RING_ELEM_DMA(sp, n) ((sp)->tx_ring_dma + (n)*sizeof(struct TxFD)) | |
| dma_addr_t rx_ring_dma[RX_RING_SIZE]; | |
| struct descriptor *last_cmd; /* Last command sent. */ | |
| unsigned int cur_tx, dirty_tx; /* The ring entries to be free()ed. */ | |
| spinlock_t lock; /* Group with Tx control cache line. */ | |
| u32 tx_threshold; /* The value for txdesc.count. */ | |
| struct RxFD *last_rxf; /* Last filled RX buffer. */ | |
| dma_addr_t last_rxf_dma; | |
| unsigned int cur_rx, dirty_rx; /* The next free ring entry */ | |
| long last_rx_time; /* Last Rx, in jiffies, to handle Rx hang. */ | |
| struct net_device_stats stats; | |
| struct speedo_stats *lstats; | |
| dma_addr_t lstats_dma; | |
| int chip_id; | |
| struct pci_dev *pdev; | |
| struct timer_list timer; /* Media selection timer. */ | |
| struct speedo_mc_block *mc_setup_head; /* Multicast setup frame list head. */ | |
| struct speedo_mc_block *mc_setup_tail; /* Multicast setup frame list tail. */ | |
| long in_interrupt; /* Word-aligned dev->interrupt */ | |
| unsigned char acpi_pwr; | |
| signed char rx_mode; /* Current PROMISC/ALLMULTI setting. */ | |
| unsigned int tx_full:1; /* The Tx queue is full. */ | |
| unsigned int flow_ctrl:1; /* Use 802.3x flow control. */ | |
| unsigned int rx_bug:1; /* Work around receiver hang errata. */ | |
| unsigned char default_port:8; /* Last dev->if_port value. */ | |
| unsigned char rx_ring_state; /* RX ring status flags. */ | |
| unsigned short phy[2]; /* PHY media interfaces available. */ | |
| unsigned short partner; /* Link partner caps. */ | |
| struct mii_if_info mii_if; /* MII API hooks, info */ | |
| u32 msg_enable; /* debug message level */ | |
| }; | |
| /* The parameters for a CmdConfigure operation. | |
| There are so many options that it would be difficult to document each bit. | |
| We mostly use the default or recommended settings. */ | |
| static const char i82557_config_cmd[CONFIG_DATA_SIZE] = { | |
| 22, 0x08, 0, 0, 0, 0, 0x32, 0x03, 1, /* 1=Use MII 0=Use AUI */ | |
| 0, 0x2E, 0, 0x60, 0, | |
| 0xf2, 0x48, 0, 0x40, 0xf2, 0x80, /* 0x40=Force full-duplex */ | |
| 0x3f, 0x05, }; | |
| static const char i82558_config_cmd[CONFIG_DATA_SIZE] = { | |
| 22, 0x08, 0, 1, 0, 0, 0x22, 0x03, 1, /* 1=Use MII 0=Use AUI */ | |
| 0, 0x2E, 0, 0x60, 0x08, 0x88, | |
| 0x68, 0, 0x40, 0xf2, 0x84, /* Disable FC */ | |
| 0x31, 0x05, }; | |
| /* PHY media interface chips. */ | |
| static const char * const phys[] = { | |
| "None", "i82553-A/B", "i82553-C", "i82503", | |
| "DP83840", "80c240", "80c24", "i82555", | |
| "unknown-8", "unknown-9", "DP83840A", "unknown-11", | |
| "unknown-12", "unknown-13", "unknown-14", "unknown-15", }; | |
| enum phy_chips { NonSuchPhy=0, I82553AB, I82553C, I82503, DP83840, S80C240, | |
| S80C24, I82555, DP83840A=10, }; | |
| static const char is_mii[] = { 0, 1, 1, 0, 1, 1, 0, 1 }; | |
| #define EE_READ_CMD (6) | |
| static int eepro100_init_one(struct pci_dev *pdev, | |
| const struct pci_device_id *ent); | |
| static int do_eeprom_cmd(void __iomem *ioaddr, int cmd, int cmd_len); | |
| static int mdio_read(struct net_device *dev, int phy_id, int location); | |
| static void mdio_write(struct net_device *dev, int phy_id, int location, int value); | |
| static int speedo_open(struct net_device *dev); | |
| static void speedo_resume(struct net_device *dev); | |
| static void speedo_timer(unsigned long data); | |
| static void speedo_init_rx_ring(struct net_device *dev); | |
| static void speedo_tx_timeout(struct net_device *dev); | |
| static int speedo_start_xmit(struct sk_buff *skb, struct net_device *dev); | |
| static void speedo_refill_rx_buffers(struct net_device *dev, int force); | |
| static int speedo_rx(struct net_device *dev); | |
| static void speedo_tx_buffer_gc(struct net_device *dev); | |
| static irqreturn_t speedo_interrupt(int irq, void *dev_instance); | |
| static int speedo_close(struct net_device *dev); | |
| static struct net_device_stats *speedo_get_stats(struct net_device *dev); | |
| static int speedo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); | |
| static void set_rx_mode(struct net_device *dev); | |
| static void speedo_show_state(struct net_device *dev); | |
| static const struct ethtool_ops ethtool_ops; | |
| #ifdef honor_default_port | |
| /* Optional driver feature to allow forcing the transceiver setting. | |
| Not recommended. */ | |
| static int mii_ctrl[8] = { 0x3300, 0x3100, 0x0000, 0x0100, | |
| 0x2000, 0x2100, 0x0400, 0x3100}; | |
| #endif | |
| /* How to wait for the command unit to accept a command. | |
| Typically this takes 0 ticks. */ | |
| static inline unsigned char wait_for_cmd_done(struct net_device *dev, | |
| struct speedo_private *sp) | |
| { | |
| int wait = 1000; | |
| void __iomem *cmd_ioaddr = sp->regs + SCBCmd; | |
| unsigned char r; | |
| do { | |
| udelay(1); | |
| r = ioread8(cmd_ioaddr); | |
| } while(r && --wait >= 0); | |
| if (wait < 0) | |
| printk(KERN_ALERT "%s: wait_for_cmd_done timeout!\n", dev->name); | |
| return r; | |
| } | |
| static int __devinit eepro100_init_one (struct pci_dev *pdev, | |
| const struct pci_device_id *ent) | |
| { | |
| void __iomem *ioaddr; | |
| int irq, pci_bar; | |
| int acpi_idle_state = 0, pm; | |
| static int cards_found /* = 0 */; | |
| unsigned long pci_base; | |
| #ifndef MODULE | |
| /* when built-in, we only print version if device is found */ | |
| static int did_version; | |
| if (did_version++ == 0) | |
| printk(version); | |
| #endif | |
| /* save power state before pci_enable_device overwrites it */ | |
| pm = pci_find_capability(pdev, PCI_CAP_ID_PM); | |
| if (pm) { | |
| u16 pwr_command; | |
| pci_read_config_word(pdev, pm + PCI_PM_CTRL, &pwr_command); | |
| acpi_idle_state = pwr_command & PCI_PM_CTRL_STATE_MASK; | |
| } | |
| if (pci_enable_device(pdev)) | |
| goto err_out_free_mmio_region; | |
| pci_set_master(pdev); | |
| if (!request_region(pci_resource_start(pdev, 1), | |
| pci_resource_len(pdev, 1), "eepro100")) { | |
| dev_err(&pdev->dev, "eepro100: cannot reserve I/O ports\n"); | |
| goto err_out_none; | |
| } | |
| if (!request_mem_region(pci_resource_start(pdev, 0), | |
| pci_resource_len(pdev, 0), "eepro100")) { | |
| dev_err(&pdev->dev, "eepro100: cannot reserve MMIO region\n"); | |
| goto err_out_free_pio_region; | |
| } | |
| irq = pdev->irq; | |
| pci_bar = use_io ? 1 : 0; | |
| pci_base = pci_resource_start(pdev, pci_bar); | |
| if (DEBUG & NETIF_MSG_PROBE) | |
| printk("Found Intel i82557 PCI Speedo at %#lx, IRQ %d.\n", | |
| pci_base, irq); | |
| ioaddr = pci_iomap(pdev, pci_bar, 0); | |
| if (!ioaddr) { | |
| dev_err(&pdev->dev, "eepro100: cannot remap IO\n"); | |
| goto err_out_free_mmio_region; | |
| } | |
| if (speedo_found1(pdev, ioaddr, cards_found, acpi_idle_state) == 0) | |
| cards_found++; | |
| else | |
| goto err_out_iounmap; | |
| return 0; | |
| err_out_iounmap: ; | |
| pci_iounmap(pdev, ioaddr); | |
| err_out_free_mmio_region: | |
| release_mem_region(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0)); | |
| err_out_free_pio_region: | |
| release_region(pci_resource_start(pdev, 1), pci_resource_len(pdev, 1)); | |
| err_out_none: | |
| return -ENODEV; | |
| } | |
| #ifdef CONFIG_NET_POLL_CONTROLLER | |
| /* | |
| * Polling 'interrupt' - used by things like netconsole to send skbs | |
| * without having to re-enable interrupts. It's not called while | |
| * the interrupt routine is executing. | |
| */ | |
| static void poll_speedo (struct net_device *dev) | |
| { | |
| /* disable_irq is not very nice, but with the funny lockless design | |
| we have no other choice. */ | |
| disable_irq(dev->irq); | |
| speedo_interrupt (dev->irq, dev); | |
| enable_irq(dev->irq); | |
| } | |
| #endif | |
| static int __devinit speedo_found1(struct pci_dev *pdev, | |
| void __iomem *ioaddr, int card_idx, int acpi_idle_state) | |
| { | |
| struct net_device *dev; | |
| struct speedo_private *sp; | |
| const char *product; | |
| int i, option; | |
| u16 eeprom[0x100]; | |
| int size; | |
| void *tx_ring_space; | |
| dma_addr_t tx_ring_dma; | |
| DECLARE_MAC_BUF(mac); | |
| size = TX_RING_SIZE * sizeof(struct TxFD) + sizeof(struct speedo_stats); | |
| tx_ring_space = pci_alloc_consistent(pdev, size, &tx_ring_dma); | |
| if (tx_ring_space == NULL) | |
| return -1; | |
| dev = alloc_etherdev(sizeof(struct speedo_private)); | |
| if (dev == NULL) { | |
| printk(KERN_ERR "eepro100: Could not allocate ethernet device.\n"); | |
| pci_free_consistent(pdev, size, tx_ring_space, tx_ring_dma); | |
| return -1; | |
| } | |
| SET_NETDEV_DEV(dev, &pdev->dev); | |
| if (dev->mem_start > 0) | |
| option = dev->mem_start; | |
| else if (card_idx >= 0 && options[card_idx] >= 0) | |
| option = options[card_idx]; | |
| else | |
| option = 0; | |
| rtnl_lock(); | |
| if (dev_alloc_name(dev, dev->name) < 0) | |
| goto err_free_unlock; | |
| /* Read the station address EEPROM before doing the reset. | |
| Nominally his should even be done before accepting the device, but | |
| then we wouldn't have a device name with which to report the error. | |
| The size test is for 6 bit vs. 8 bit address serial EEPROMs. | |
| */ | |
| { | |
| void __iomem *iobase; | |
| int read_cmd, ee_size; | |
| u16 sum; | |
| int j; | |
| /* Use IO only to avoid postponed writes and satisfy EEPROM timing | |
| requirements. */ | |
| iobase = pci_iomap(pdev, 1, pci_resource_len(pdev, 1)); | |
| if (!iobase) | |
| goto err_free_unlock; | |
| if ((do_eeprom_cmd(iobase, EE_READ_CMD << 24, 27) & 0xffe0000) | |
| == 0xffe0000) { | |
| ee_size = 0x100; | |
| read_cmd = EE_READ_CMD << 24; | |
| } else { | |
| ee_size = 0x40; | |
| read_cmd = EE_READ_CMD << 22; | |
| } | |
| for (j = 0, i = 0, sum = 0; i < ee_size; i++) { | |
| u16 value = do_eeprom_cmd(iobase, read_cmd | (i << 16), 27); | |
| eeprom[i] = value; | |
| sum += value; | |
| if (i < 3) { | |
| dev->dev_addr[j++] = value; | |
| dev->dev_addr[j++] = value >> 8; | |
| } | |
| } | |
| if (sum != 0xBABA) | |
| printk(KERN_WARNING "%s: Invalid EEPROM checksum %#4.4x, " | |
| "check settings before activating this device!\n", | |
| dev->name, sum); | |
| /* Don't unregister_netdev(dev); as the EEPro may actually be | |
| usable, especially if the MAC address is set later. | |
| On the other hand, it may be unusable if MDI data is corrupted. */ | |
| pci_iounmap(pdev, iobase); | |
| } | |
| /* Reset the chip: stop Tx and Rx processes and clear counters. | |
| This takes less than 10usec and will easily finish before the next | |
| action. */ | |
| iowrite32(PortReset, ioaddr + SCBPort); | |
| ioread32(ioaddr + SCBPort); | |
| udelay(10); | |
| if (eeprom[3] & 0x0100) | |
| product = "OEM i82557/i82558 10/100 Ethernet"; | |
| else | |
| product = pci_name(pdev); | |
| printk(KERN_INFO "%s: %s, %s, IRQ %d.\n", dev->name, product, | |
| print_mac(mac, dev->dev_addr), pdev->irq); | |
| sp = netdev_priv(dev); | |
| /* we must initialize this early, for mdio_{read,write} */ | |
| sp->regs = ioaddr; | |
| #if 1 || defined(kernel_bloat) | |
| /* OK, this is pure kernel bloat. I don't like it when other drivers | |
| waste non-pageable kernel space to emit similar messages, but I need | |
| them for bug reports. */ | |
| { | |
| const char *connectors[] = {" RJ45", " BNC", " AUI", " MII"}; | |
| /* The self-test results must be paragraph aligned. */ | |
| volatile s32 *self_test_results; | |
| int boguscnt = 16000; /* Timeout for set-test. */ | |
| if ((eeprom[3] & 0x03) != 0x03) | |
| printk(KERN_INFO " Receiver lock-up bug exists -- enabling" | |
| " work-around.\n"); | |
| printk(KERN_INFO " Board assembly %4.4x%2.2x-%3.3d, Physical" | |
| " connectors present:", | |
| eeprom[8], eeprom[9]>>8, eeprom[9] & 0xff); | |
| for (i = 0; i < 4; i++) | |
| if (eeprom[5] & (1<<i)) | |
| printk(connectors[i]); | |
| printk("\n"KERN_INFO" Primary interface chip %s PHY #%d.\n", | |
| phys[(eeprom[6]>>8)&15], eeprom[6] & 0x1f); | |
| if (eeprom[7] & 0x0700) | |
| printk(KERN_INFO " Secondary interface chip %s.\n", | |
| phys[(eeprom[7]>>8)&7]); | |
| if (((eeprom[6]>>8) & 0x3f) == DP83840 | |
| || ((eeprom[6]>>8) & 0x3f) == DP83840A) { | |
| int mdi_reg23 = mdio_read(dev, eeprom[6] & 0x1f, 23) | 0x0422; | |
| if (congenb) | |
| mdi_reg23 |= 0x0100; | |
| printk(KERN_INFO" DP83840 specific setup, setting register 23 to %4.4x.\n", | |
| mdi_reg23); | |
| mdio_write(dev, eeprom[6] & 0x1f, 23, mdi_reg23); | |
| } | |
| if ((option >= 0) && (option & 0x70)) { | |
| printk(KERN_INFO " Forcing %dMbs %s-duplex operation.\n", | |
| (option & 0x20 ? 100 : 10), | |
| (option & 0x10 ? "full" : "half")); | |
| mdio_write(dev, eeprom[6] & 0x1f, MII_BMCR, | |
| ((option & 0x20) ? 0x2000 : 0) | /* 100mbps? */ | |
| ((option & 0x10) ? 0x0100 : 0)); /* Full duplex? */ | |
| } | |
| /* Perform a system self-test. */ | |
| self_test_results = (s32*) ((((long) tx_ring_space) + 15) & ~0xf); | |
| self_test_results[0] = 0; | |
| self_test_results[1] = -1; | |
| iowrite32(tx_ring_dma | PortSelfTest, ioaddr + SCBPort); | |
| do { | |
| udelay(10); | |
| } while (self_test_results[1] == -1 && --boguscnt >= 0); | |
| if (boguscnt < 0) { /* Test optimized out. */ | |
| printk(KERN_ERR "Self test failed, status %8.8x:\n" | |
| KERN_ERR " Failure to initialize the i82557.\n" | |
| KERN_ERR " Verify that the card is a bus-master" | |
| " capable slot.\n", | |
| self_test_results[1]); | |
| } else | |
| printk(KERN_INFO " General self-test: %s.\n" | |
| KERN_INFO " Serial sub-system self-test: %s.\n" | |
| KERN_INFO " Internal registers self-test: %s.\n" | |
| KERN_INFO " ROM checksum self-test: %s (%#8.8x).\n", | |
| self_test_results[1] & 0x1000 ? "failed" : "passed", | |
| self_test_results[1] & 0x0020 ? "failed" : "passed", | |
| self_test_results[1] & 0x0008 ? "failed" : "passed", | |
| self_test_results[1] & 0x0004 ? "failed" : "passed", | |
| self_test_results[0]); | |
| } | |
| #endif /* kernel_bloat */ | |
| iowrite32(PortReset, ioaddr + SCBPort); | |
| ioread32(ioaddr + SCBPort); | |
| udelay(10); | |
| /* Return the chip to its original power state. */ | |
| pci_set_power_state(pdev, acpi_idle_state); | |
| pci_set_drvdata (pdev, dev); | |
| SET_NETDEV_DEV(dev, &pdev->dev); | |
| dev->irq = pdev->irq; | |
| sp->pdev = pdev; | |
| sp->msg_enable = DEBUG; | |
| sp->acpi_pwr = acpi_idle_state; | |
| sp->tx_ring = tx_ring_space; | |
| sp->tx_ring_dma = tx_ring_dma; | |
| sp->lstats = (struct speedo_stats *)(sp->tx_ring + TX_RING_SIZE); | |
| sp->lstats_dma = TX_RING_ELEM_DMA(sp, TX_RING_SIZE); | |
| init_timer(&sp->timer); /* used in ioctl() */ | |
| spin_lock_init(&sp->lock); | |
| sp->mii_if.full_duplex = option >= 0 && (option & 0x10) ? 1 : 0; | |
| if (card_idx >= 0) { | |
| if (full_duplex[card_idx] >= 0) | |
| sp->mii_if.full_duplex = full_duplex[card_idx]; | |
| } | |
| sp->default_port = option >= 0 ? (option & 0x0f) : 0; | |
| sp->phy[0] = eeprom[6]; | |
| sp->phy[1] = eeprom[7]; | |
| sp->mii_if.phy_id = eeprom[6] & 0x1f; | |
| sp->mii_if.phy_id_mask = 0x1f; | |
| sp->mii_if.reg_num_mask = 0x1f; | |
| sp->mii_if.dev = dev; | |
| sp->mii_if.mdio_read = mdio_read; | |
| sp->mii_if.mdio_write = mdio_write; | |
| sp->rx_bug = (eeprom[3] & 0x03) == 3 ? 0 : 1; | |
| if (((pdev->device > 0x1030 && (pdev->device < 0x103F))) | |
| || (pdev->device == 0x2449) || (pdev->device == 0x2459) | |
| || (pdev->device == 0x245D)) { | |
| sp->chip_id = 1; | |
| } | |
| if (sp->rx_bug) | |
| printk(KERN_INFO " Receiver lock-up workaround activated.\n"); | |
| /* The Speedo-specific entries in the device structure. */ | |
| dev->open = &speedo_open; | |
| dev->hard_start_xmit = &speedo_start_xmit; | |
| netif_set_tx_timeout(dev, &speedo_tx_timeout, TX_TIMEOUT); | |
| dev->stop = &speedo_close; | |
| dev->get_stats = &speedo_get_stats; | |
| dev->set_multicast_list = &set_rx_mode; | |
| dev->do_ioctl = &speedo_ioctl; | |
| SET_ETHTOOL_OPS(dev, ðtool_ops); | |
| #ifdef CONFIG_NET_POLL_CONTROLLER | |
| dev->poll_controller = &poll_speedo; | |
| #endif | |
| if (register_netdevice(dev)) | |
| goto err_free_unlock; | |
| rtnl_unlock(); | |
| return 0; | |
| err_free_unlock: | |
| rtnl_unlock(); | |
| free_netdev(dev); | |
| return -1; | |
| } | |
| static void do_slow_command(struct net_device *dev, struct speedo_private *sp, int cmd) | |
| { | |
| void __iomem *cmd_ioaddr = sp->regs + SCBCmd; | |
| int wait = 0; | |
| do | |
| if (ioread8(cmd_ioaddr) == 0) break; | |
| while(++wait <= 200); | |
| if (wait > 100) | |
| printk(KERN_ERR "Command %4.4x never accepted (%d polls)!\n", | |
| ioread8(cmd_ioaddr), wait); | |
| iowrite8(cmd, cmd_ioaddr); | |
| for (wait = 0; wait <= 100; wait++) | |
| if (ioread8(cmd_ioaddr) == 0) return; | |
| for (; wait <= 20000; wait++) | |
| if (ioread8(cmd_ioaddr) == 0) return; | |
| else udelay(1); | |
| printk(KERN_ERR "Command %4.4x was not accepted after %d polls!" | |
| " Current status %8.8x.\n", | |
| cmd, wait, ioread32(sp->regs + SCBStatus)); | |
| } | |
| /* Serial EEPROM section. | |
| A "bit" grungy, but we work our way through bit-by-bit :->. */ | |
| /* EEPROM_Ctrl bits. */ | |
| #define EE_SHIFT_CLK 0x01 /* EEPROM shift clock. */ | |
| #define EE_CS 0x02 /* EEPROM chip select. */ | |
| #define EE_DATA_WRITE 0x04 /* EEPROM chip data in. */ | |
| #define EE_DATA_READ 0x08 /* EEPROM chip data out. */ | |
| #define EE_ENB (0x4800 | EE_CS) | |
| #define EE_WRITE_0 0x4802 | |
| #define EE_WRITE_1 0x4806 | |
| #define EE_OFFSET SCBeeprom | |
| /* The fixes for the code were kindly provided by Dragan Stancevic | |
| <visitor@valinux.com> to strictly follow Intel specifications of EEPROM | |
| access timing. | |
| The publicly available sheet 64486302 (sec. 3.1) specifies 1us access | |
| interval for serial EEPROM. However, it looks like that there is an | |
| additional requirement dictating larger udelay's in the code below. | |
| 2000/05/24 SAW */ | |
| static int __devinit do_eeprom_cmd(void __iomem *ioaddr, int cmd, int cmd_len) | |
| { | |
| unsigned retval = 0; | |
| void __iomem *ee_addr = ioaddr + SCBeeprom; | |
| iowrite16(EE_ENB, ee_addr); udelay(2); | |
| iowrite16(EE_ENB | EE_SHIFT_CLK, ee_addr); udelay(2); | |
| /* Shift the command bits out. */ | |
| do { | |
| short dataval = (cmd & (1 << cmd_len)) ? EE_WRITE_1 : EE_WRITE_0; | |
| iowrite16(dataval, ee_addr); udelay(2); | |
| iowrite16(dataval | EE_SHIFT_CLK, ee_addr); udelay(2); | |
| retval = (retval << 1) | ((ioread16(ee_addr) & EE_DATA_READ) ? 1 : 0); | |
| } while (--cmd_len >= 0); | |
| iowrite16(EE_ENB, ee_addr); udelay(2); | |
| /* Terminate the EEPROM access. */ | |
| iowrite16(EE_ENB & ~EE_CS, ee_addr); | |
| return retval; | |
| } | |
| static int mdio_read(struct net_device *dev, int phy_id, int location) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| int val, boguscnt = 64*10; /* <64 usec. to complete, typ 27 ticks */ | |
| iowrite32(0x08000000 | (location<<16) | (phy_id<<21), ioaddr + SCBCtrlMDI); | |
| do { | |
| val = ioread32(ioaddr + SCBCtrlMDI); | |
| if (--boguscnt < 0) { | |
| printk(KERN_ERR " mdio_read() timed out with val = %8.8x.\n", val); | |
| break; | |
| } | |
| } while (! (val & 0x10000000)); | |
| return val & 0xffff; | |
| } | |
| static void mdio_write(struct net_device *dev, int phy_id, int location, int value) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| int val, boguscnt = 64*10; /* <64 usec. to complete, typ 27 ticks */ | |
| iowrite32(0x04000000 | (location<<16) | (phy_id<<21) | value, | |
| ioaddr + SCBCtrlMDI); | |
| do { | |
| val = ioread32(ioaddr + SCBCtrlMDI); | |
| if (--boguscnt < 0) { | |
| printk(KERN_ERR" mdio_write() timed out with val = %8.8x.\n", val); | |
| break; | |
| } | |
| } while (! (val & 0x10000000)); | |
| } | |
| static int | |
| speedo_open(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| int retval; | |
| if (netif_msg_ifup(sp)) | |
| printk(KERN_DEBUG "%s: speedo_open() irq %d.\n", dev->name, dev->irq); | |
| pci_set_power_state(sp->pdev, PCI_D0); | |
| /* Set up the Tx queue early.. */ | |
| sp->cur_tx = 0; | |
| sp->dirty_tx = 0; | |
| sp->last_cmd = NULL; | |
| sp->tx_full = 0; | |
| sp->in_interrupt = 0; | |
| /* .. we can safely take handler calls during init. */ | |
| retval = request_irq(dev->irq, &speedo_interrupt, IRQF_SHARED, dev->name, dev); | |
| if (retval) { | |
| return retval; | |
| } | |
| dev->if_port = sp->default_port; | |
| #ifdef oh_no_you_dont_unless_you_honour_the_options_passed_in_to_us | |
| /* Retrigger negotiation to reset previous errors. */ | |
| if ((sp->phy[0] & 0x8000) == 0) { | |
| int phy_addr = sp->phy[0] & 0x1f ; | |
| /* Use 0x3300 for restarting NWay, other values to force xcvr: | |
| 0x0000 10-HD | |
| 0x0100 10-FD | |
| 0x2000 100-HD | |
| 0x2100 100-FD | |
| */ | |
| #ifdef honor_default_port | |
| mdio_write(dev, phy_addr, MII_BMCR, mii_ctrl[dev->default_port & 7]); | |
| #else | |
| mdio_write(dev, phy_addr, MII_BMCR, 0x3300); | |
| #endif | |
| } | |
| #endif | |
| speedo_init_rx_ring(dev); | |
| /* Fire up the hardware. */ | |
| iowrite16(SCBMaskAll, ioaddr + SCBCmd); | |
| speedo_resume(dev); | |
| netdevice_start(dev); | |
| netif_start_queue(dev); | |
| /* Setup the chip and configure the multicast list. */ | |
| sp->mc_setup_head = NULL; | |
| sp->mc_setup_tail = NULL; | |
| sp->flow_ctrl = sp->partner = 0; | |
| sp->rx_mode = -1; /* Invalid -> always reset the mode. */ | |
| set_rx_mode(dev); | |
| if ((sp->phy[0] & 0x8000) == 0) | |
| sp->mii_if.advertising = mdio_read(dev, sp->phy[0] & 0x1f, MII_ADVERTISE); | |
| mii_check_link(&sp->mii_if); | |
| if (netif_msg_ifup(sp)) { | |
| printk(KERN_DEBUG "%s: Done speedo_open(), status %8.8x.\n", | |
| dev->name, ioread16(ioaddr + SCBStatus)); | |
| } | |
| /* Set the timer. The timer serves a dual purpose: | |
| 1) to monitor the media interface (e.g. link beat) and perhaps switch | |
| to an alternate media type | |
| 2) to monitor Rx activity, and restart the Rx process if the receiver | |
| hangs. */ | |
| sp->timer.expires = RUN_AT((24*HZ)/10); /* 2.4 sec. */ | |
| sp->timer.data = (unsigned long)dev; | |
| sp->timer.function = &speedo_timer; /* timer handler */ | |
| add_timer(&sp->timer); | |
| /* No need to wait for the command unit to accept here. */ | |
| if ((sp->phy[0] & 0x8000) == 0) | |
| mdio_read(dev, sp->phy[0] & 0x1f, MII_BMCR); | |
| return 0; | |
| } | |
| /* Start the chip hardware after a full reset. */ | |
| static void speedo_resume(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| /* Start with a Tx threshold of 256 (0x..20.... 8 byte units). */ | |
| sp->tx_threshold = 0x01208000; | |
| /* Set the segment registers to '0'. */ | |
| if (wait_for_cmd_done(dev, sp) != 0) { | |
| iowrite32(PortPartialReset, ioaddr + SCBPort); | |
| udelay(10); | |
| } | |
| iowrite32(0, ioaddr + SCBPointer); | |
| ioread32(ioaddr + SCBPointer); /* Flush to PCI. */ | |
| udelay(10); /* Bogus, but it avoids the bug. */ | |
| /* Note: these next two operations can take a while. */ | |
| do_slow_command(dev, sp, RxAddrLoad); | |
| do_slow_command(dev, sp, CUCmdBase); | |
| /* Load the statistics block and rx ring addresses. */ | |
| iowrite32(sp->lstats_dma, ioaddr + SCBPointer); | |
| ioread32(ioaddr + SCBPointer); /* Flush to PCI */ | |
| iowrite8(CUStatsAddr, ioaddr + SCBCmd); | |
| sp->lstats->done_marker = 0; | |
| wait_for_cmd_done(dev, sp); | |
| if (sp->rx_ringp[sp->cur_rx % RX_RING_SIZE] == NULL) { | |
| if (netif_msg_rx_err(sp)) | |
| printk(KERN_DEBUG "%s: NULL cur_rx in speedo_resume().\n", | |
| dev->name); | |
| } else { | |
| iowrite32(sp->rx_ring_dma[sp->cur_rx % RX_RING_SIZE], | |
| ioaddr + SCBPointer); | |
| ioread32(ioaddr + SCBPointer); /* Flush to PCI */ | |
| } | |
| /* Note: RxStart should complete instantly. */ | |
| do_slow_command(dev, sp, RxStart); | |
| do_slow_command(dev, sp, CUDumpStats); | |
| /* Fill the first command with our physical address. */ | |
| { | |
| struct descriptor *ias_cmd; | |
| ias_cmd = | |
| (struct descriptor *)&sp->tx_ring[sp->cur_tx++ % TX_RING_SIZE]; | |
| /* Avoid a bug(?!) here by marking the command already completed. */ | |
| ias_cmd->cmd_status = cpu_to_le32((CmdSuspend | CmdIASetup) | 0xa000); | |
| ias_cmd->link = | |
| cpu_to_le32(TX_RING_ELEM_DMA(sp, sp->cur_tx % TX_RING_SIZE)); | |
| memcpy(ias_cmd->params, dev->dev_addr, 6); | |
| if (sp->last_cmd) | |
| clear_suspend(sp->last_cmd); | |
| sp->last_cmd = ias_cmd; | |
| } | |
| /* Start the chip's Tx process and unmask interrupts. */ | |
| iowrite32(TX_RING_ELEM_DMA(sp, sp->dirty_tx % TX_RING_SIZE), | |
| ioaddr + SCBPointer); | |
| /* We are not ACK-ing FCP and ER in the interrupt handler yet so they should | |
| remain masked --Dragan */ | |
| iowrite16(CUStart | SCBMaskEarlyRx | SCBMaskFlowCtl, ioaddr + SCBCmd); | |
| } | |
| /* | |
| * Sometimes the receiver stops making progress. This routine knows how to | |
| * get it going again, without losing packets or being otherwise nasty like | |
| * a chip reset would be. Previously the driver had a whole sequence | |
| * of if RxSuspended, if it's no buffers do one thing, if it's no resources, | |
| * do another, etc. But those things don't really matter. Separate logic | |
| * in the ISR provides for allocating buffers--the other half of operation | |
| * is just making sure the receiver is active. speedo_rx_soft_reset does that. | |
| * This problem with the old, more involved algorithm is shown up under | |
| * ping floods on the order of 60K packets/second on a 100Mbps fdx network. | |
| */ | |
| static void | |
| speedo_rx_soft_reset(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| struct RxFD *rfd; | |
| void __iomem *ioaddr; | |
| ioaddr = sp->regs; | |
| if (wait_for_cmd_done(dev, sp) != 0) { | |
| printk("%s: previous command stalled\n", dev->name); | |
| return; | |
| } | |
| /* | |
| * Put the hardware into a known state. | |
| */ | |
| iowrite8(RxAbort, ioaddr + SCBCmd); | |
| rfd = sp->rx_ringp[sp->cur_rx % RX_RING_SIZE]; | |
| rfd->rx_buf_addr = cpu_to_le32(0xffffffff); | |
| if (wait_for_cmd_done(dev, sp) != 0) { | |
| printk("%s: RxAbort command stalled\n", dev->name); | |
| return; | |
| } | |
| iowrite32(sp->rx_ring_dma[sp->cur_rx % RX_RING_SIZE], | |
| ioaddr + SCBPointer); | |
| iowrite8(RxStart, ioaddr + SCBCmd); | |
| } | |
| /* Media monitoring and control. */ | |
| static void speedo_timer(unsigned long data) | |
| { | |
| struct net_device *dev = (struct net_device *)data; | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| int phy_num = sp->phy[0] & 0x1f; | |
| /* We have MII and lost link beat. */ | |
| if ((sp->phy[0] & 0x8000) == 0) { | |
| int partner = mdio_read(dev, phy_num, MII_LPA); | |
| if (partner != sp->partner) { | |
| int flow_ctrl = sp->mii_if.advertising & partner & 0x0400 ? 1 : 0; | |
| if (netif_msg_link(sp)) { | |
| printk(KERN_DEBUG "%s: Link status change.\n", dev->name); | |
| printk(KERN_DEBUG "%s: Old partner %x, new %x, adv %x.\n", | |
| dev->name, sp->partner, partner, sp->mii_if.advertising); | |
| } | |
| sp->partner = partner; | |
| if (flow_ctrl != sp->flow_ctrl) { | |
| sp->flow_ctrl = flow_ctrl; | |
| sp->rx_mode = -1; /* Trigger a reload. */ | |
| } | |
| } | |
| } | |
| mii_check_link(&sp->mii_if); | |
| if (netif_msg_timer(sp)) { | |
| printk(KERN_DEBUG "%s: Media control tick, status %4.4x.\n", | |
| dev->name, ioread16(ioaddr + SCBStatus)); | |
| } | |
| if (sp->rx_mode < 0 || | |
| (sp->rx_bug && jiffies - sp->last_rx_time > 2*HZ)) { | |
| /* We haven't received a packet in a Long Time. We might have been | |
| bitten by the receiver hang bug. This can be cleared by sending | |
| a set multicast list command. */ | |
| if (netif_msg_timer(sp)) | |
| printk(KERN_DEBUG "%s: Sending a multicast list set command" | |
| " from a timer routine," | |
| " m=%d, j=%ld, l=%ld.\n", | |
| dev->name, sp->rx_mode, jiffies, sp->last_rx_time); | |
| set_rx_mode(dev); | |
| } | |
| /* We must continue to monitor the media. */ | |
| sp->timer.expires = RUN_AT(2*HZ); /* 2.0 sec. */ | |
| add_timer(&sp->timer); | |
| } | |
| static void speedo_show_state(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| int i; | |
| if (netif_msg_pktdata(sp)) { | |
| printk(KERN_DEBUG "%s: Tx ring dump, Tx queue %u / %u:\n", | |
| dev->name, sp->cur_tx, sp->dirty_tx); | |
| for (i = 0; i < TX_RING_SIZE; i++) | |
| printk(KERN_DEBUG "%s: %c%c%2d %8.8x.\n", dev->name, | |
| i == sp->dirty_tx % TX_RING_SIZE ? '*' : ' ', | |
| i == sp->cur_tx % TX_RING_SIZE ? '=' : ' ', | |
| i, sp->tx_ring[i].status); | |
| printk(KERN_DEBUG "%s: Printing Rx ring" | |
| " (next to receive into %u, dirty index %u).\n", | |
| dev->name, sp->cur_rx, sp->dirty_rx); | |
| for (i = 0; i < RX_RING_SIZE; i++) | |
| printk(KERN_DEBUG "%s: %c%c%c%2d %8.8x.\n", dev->name, | |
| sp->rx_ringp[i] == sp->last_rxf ? 'l' : ' ', | |
| i == sp->dirty_rx % RX_RING_SIZE ? '*' : ' ', | |
| i == sp->cur_rx % RX_RING_SIZE ? '=' : ' ', | |
| i, (sp->rx_ringp[i] != NULL) ? | |
| (unsigned)sp->rx_ringp[i]->status : 0); | |
| } | |
| #if 0 | |
| { | |
| void __iomem *ioaddr = sp->regs; | |
| int phy_num = sp->phy[0] & 0x1f; | |
| for (i = 0; i < 16; i++) { | |
| /* FIXME: what does it mean? --SAW */ | |
| if (i == 6) i = 21; | |
| printk(KERN_DEBUG "%s: PHY index %d register %d is %4.4x.\n", | |
| dev->name, phy_num, i, mdio_read(dev, phy_num, i)); | |
| } | |
| } | |
| #endif | |
| } | |
| /* Initialize the Rx and Tx rings, along with various 'dev' bits. */ | |
| static void | |
| speedo_init_rx_ring(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| struct RxFD *rxf, *last_rxf = NULL; | |
| dma_addr_t last_rxf_dma = 0 /* to shut up the compiler */; | |
| int i; | |
| sp->cur_rx = 0; | |
| for (i = 0; i < RX_RING_SIZE; i++) { | |
| struct sk_buff *skb; | |
| skb = dev_alloc_skb(PKT_BUF_SZ + sizeof(struct RxFD)); | |
| if (skb) | |
| rx_align(skb); /* Align IP on 16 byte boundary */ | |
| sp->rx_skbuff[i] = skb; | |
| if (skb == NULL) | |
| break; /* OK. Just initially short of Rx bufs. */ | |
| skb->dev = dev; /* Mark as being used by this device. */ | |
| rxf = (struct RxFD *)skb->data; | |
| sp->rx_ringp[i] = rxf; | |
| sp->rx_ring_dma[i] = | |
| pci_map_single(sp->pdev, rxf, | |
| PKT_BUF_SZ + sizeof(struct RxFD), PCI_DMA_BIDIRECTIONAL); | |
| skb_reserve(skb, sizeof(struct RxFD)); | |
| if (last_rxf) { | |
| last_rxf->link = cpu_to_le32(sp->rx_ring_dma[i]); | |
| pci_dma_sync_single_for_device(sp->pdev, last_rxf_dma, | |
| sizeof(struct RxFD), PCI_DMA_TODEVICE); | |
| } | |
| last_rxf = rxf; | |
| last_rxf_dma = sp->rx_ring_dma[i]; | |
| rxf->status = cpu_to_le32(0x00000001); /* '1' is flag value only. */ | |
| rxf->link = 0; /* None yet. */ | |
| /* This field unused by i82557. */ | |
| rxf->rx_buf_addr = cpu_to_le32(0xffffffff); | |
| rxf->count = cpu_to_le32(PKT_BUF_SZ << 16); | |
| pci_dma_sync_single_for_device(sp->pdev, sp->rx_ring_dma[i], | |
| sizeof(struct RxFD), PCI_DMA_TODEVICE); | |
| } | |
| sp->dirty_rx = (unsigned int)(i - RX_RING_SIZE); | |
| /* Mark the last entry as end-of-list. */ | |
| last_rxf->status = cpu_to_le32(0xC0000002); /* '2' is flag value only. */ | |
| pci_dma_sync_single_for_device(sp->pdev, sp->rx_ring_dma[RX_RING_SIZE-1], | |
| sizeof(struct RxFD), PCI_DMA_TODEVICE); | |
| sp->last_rxf = last_rxf; | |
| sp->last_rxf_dma = last_rxf_dma; | |
| } | |
| static void speedo_purge_tx(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| int entry; | |
| while ((int)(sp->cur_tx - sp->dirty_tx) > 0) { | |
| entry = sp->dirty_tx % TX_RING_SIZE; | |
| if (sp->tx_skbuff[entry]) { | |
| sp->stats.tx_errors++; | |
| pci_unmap_single(sp->pdev, | |
| le32_to_cpu(sp->tx_ring[entry].tx_buf_addr0), | |
| sp->tx_skbuff[entry]->len, PCI_DMA_TODEVICE); | |
| dev_kfree_skb_irq(sp->tx_skbuff[entry]); | |
| sp->tx_skbuff[entry] = NULL; | |
| } | |
| sp->dirty_tx++; | |
| } | |
| while (sp->mc_setup_head != NULL) { | |
| struct speedo_mc_block *t; | |
| if (netif_msg_tx_err(sp)) | |
| printk(KERN_DEBUG "%s: freeing mc frame.\n", dev->name); | |
| pci_unmap_single(sp->pdev, sp->mc_setup_head->frame_dma, | |
| sp->mc_setup_head->len, PCI_DMA_TODEVICE); | |
| t = sp->mc_setup_head->next; | |
| kfree(sp->mc_setup_head); | |
| sp->mc_setup_head = t; | |
| } | |
| sp->mc_setup_tail = NULL; | |
| sp->tx_full = 0; | |
| netif_wake_queue(dev); | |
| } | |
| static void reset_mii(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| /* Reset the MII transceiver, suggested by Fred Young @ scalable.com. */ | |
| if ((sp->phy[0] & 0x8000) == 0) { | |
| int phy_addr = sp->phy[0] & 0x1f; | |
| int advertising = mdio_read(dev, phy_addr, MII_ADVERTISE); | |
| int mii_bmcr = mdio_read(dev, phy_addr, MII_BMCR); | |
| mdio_write(dev, phy_addr, MII_BMCR, 0x0400); | |
| mdio_write(dev, phy_addr, MII_BMSR, 0x0000); | |
| mdio_write(dev, phy_addr, MII_ADVERTISE, 0x0000); | |
| mdio_write(dev, phy_addr, MII_BMCR, 0x8000); | |
| #ifdef honor_default_port | |
| mdio_write(dev, phy_addr, MII_BMCR, mii_ctrl[dev->default_port & 7]); | |
| #else | |
| mdio_read(dev, phy_addr, MII_BMCR); | |
| mdio_write(dev, phy_addr, MII_BMCR, mii_bmcr); | |
| mdio_write(dev, phy_addr, MII_ADVERTISE, advertising); | |
| #endif | |
| } | |
| } | |
| static void speedo_tx_timeout(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| int status = ioread16(ioaddr + SCBStatus); | |
| unsigned long flags; | |
| if (netif_msg_tx_err(sp)) { | |
| printk(KERN_WARNING "%s: Transmit timed out: status %4.4x " | |
| " %4.4x at %d/%d command %8.8x.\n", | |
| dev->name, status, ioread16(ioaddr + SCBCmd), | |
| sp->dirty_tx, sp->cur_tx, | |
| sp->tx_ring[sp->dirty_tx % TX_RING_SIZE].status); | |
| } | |
| speedo_show_state(dev); | |
| #if 0 | |
| if ((status & 0x00C0) != 0x0080 | |
| && (status & 0x003C) == 0x0010) { | |
| /* Only the command unit has stopped. */ | |
| printk(KERN_WARNING "%s: Trying to restart the transmitter...\n", | |
| dev->name); | |
| iowrite32(TX_RING_ELEM_DMA(sp, dirty_tx % TX_RING_SIZE]), | |
| ioaddr + SCBPointer); | |
| iowrite16(CUStart, ioaddr + SCBCmd); | |
| reset_mii(dev); | |
| } else { | |
| #else | |
| { | |
| #endif | |
| del_timer_sync(&sp->timer); | |
| /* Reset the Tx and Rx units. */ | |
| iowrite32(PortReset, ioaddr + SCBPort); | |
| /* We may get spurious interrupts here. But I don't think that they | |
| may do much harm. 1999/12/09 SAW */ | |
| udelay(10); | |
| /* Disable interrupts. */ | |
| iowrite16(SCBMaskAll, ioaddr + SCBCmd); | |
| synchronize_irq(dev->irq); | |
| speedo_tx_buffer_gc(dev); | |
| /* Free as much as possible. | |
| It helps to recover from a hang because of out-of-memory. | |
| It also simplifies speedo_resume() in case TX ring is full or | |
| close-to-be full. */ | |
| speedo_purge_tx(dev); | |
| speedo_refill_rx_buffers(dev, 1); | |
| spin_lock_irqsave(&sp->lock, flags); | |
| speedo_resume(dev); | |
| sp->rx_mode = -1; | |
| dev->trans_start = jiffies; | |
| spin_unlock_irqrestore(&sp->lock, flags); | |
| set_rx_mode(dev); /* it takes the spinlock itself --SAW */ | |
| /* Reset MII transceiver. Do it before starting the timer to serialize | |
| mdio_xxx operations. Yes, it's a paranoya :-) 2000/05/09 SAW */ | |
| reset_mii(dev); | |
| sp->timer.expires = RUN_AT(2*HZ); | |
| add_timer(&sp->timer); | |
| } | |
| return; | |
| } | |
| static int | |
| speedo_start_xmit(struct sk_buff *skb, struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| int entry; | |
| /* Prevent interrupts from changing the Tx ring from underneath us. */ | |
| unsigned long flags; | |
| spin_lock_irqsave(&sp->lock, flags); | |
| /* Check if there are enough space. */ | |
| if ((int)(sp->cur_tx - sp->dirty_tx) >= TX_QUEUE_LIMIT) { | |
| printk(KERN_ERR "%s: incorrect tbusy state, fixed.\n", dev->name); | |
| netif_stop_queue(dev); | |
| sp->tx_full = 1; | |
| spin_unlock_irqrestore(&sp->lock, flags); | |
| return 1; | |
| } | |
| /* Calculate the Tx descriptor entry. */ | |
| entry = sp->cur_tx++ % TX_RING_SIZE; | |
| sp->tx_skbuff[entry] = skb; | |
| sp->tx_ring[entry].status = | |
| cpu_to_le32(CmdSuspend | CmdTx | CmdTxFlex); | |
| if (!(entry & ((TX_RING_SIZE>>2)-1))) | |
| sp->tx_ring[entry].status |= cpu_to_le32(CmdIntr); | |
| sp->tx_ring[entry].link = | |
| cpu_to_le32(TX_RING_ELEM_DMA(sp, sp->cur_tx % TX_RING_SIZE)); | |
| sp->tx_ring[entry].tx_desc_addr = | |
| cpu_to_le32(TX_RING_ELEM_DMA(sp, entry) + TX_DESCR_BUF_OFFSET); | |
| /* The data region is always in one buffer descriptor. */ | |
| sp->tx_ring[entry].count = cpu_to_le32(sp->tx_threshold); | |
| sp->tx_ring[entry].tx_buf_addr0 = | |
| cpu_to_le32(pci_map_single(sp->pdev, skb->data, | |
| skb->len, PCI_DMA_TODEVICE)); | |
| sp->tx_ring[entry].tx_buf_size0 = cpu_to_le32(skb->len); | |
| /* workaround for hardware bug on 10 mbit half duplex */ | |
| if ((sp->partner == 0) && (sp->chip_id == 1)) { | |
| wait_for_cmd_done(dev, sp); | |
| iowrite8(0 , ioaddr + SCBCmd); | |
| udelay(1); | |
| } | |
| /* Trigger the command unit resume. */ | |
| wait_for_cmd_done(dev, sp); | |
| clear_suspend(sp->last_cmd); | |
| /* We want the time window between clearing suspend flag on the previous | |
| command and resuming CU to be as small as possible. | |
| Interrupts in between are very undesired. --SAW */ | |
| iowrite8(CUResume, ioaddr + SCBCmd); | |
| sp->last_cmd = (struct descriptor *)&sp->tx_ring[entry]; | |
| /* Leave room for set_rx_mode(). If there is no more space than reserved | |
| for multicast filter mark the ring as full. */ | |
| if ((int)(sp->cur_tx - sp->dirty_tx) >= TX_QUEUE_LIMIT) { | |
| netif_stop_queue(dev); | |
| sp->tx_full = 1; | |
| } | |
| spin_unlock_irqrestore(&sp->lock, flags); | |
| dev->trans_start = jiffies; | |
| return 0; | |
| } | |
| static void speedo_tx_buffer_gc(struct net_device *dev) | |
| { | |
| unsigned int dirty_tx; | |
| struct speedo_private *sp = netdev_priv(dev); | |
| dirty_tx = sp->dirty_tx; | |
| while ((int)(sp->cur_tx - dirty_tx) > 0) { | |
| int entry = dirty_tx % TX_RING_SIZE; | |
| int status = le32_to_cpu(sp->tx_ring[entry].status); | |
| if (netif_msg_tx_done(sp)) | |
| printk(KERN_DEBUG " scavenge candidate %d status %4.4x.\n", | |
| entry, status); | |
| if ((status & StatusComplete) == 0) | |
| break; /* It still hasn't been processed. */ | |
| if (status & TxUnderrun) | |
| if (sp->tx_threshold < 0x01e08000) { | |
| if (netif_msg_tx_err(sp)) | |
| printk(KERN_DEBUG "%s: TX underrun, threshold adjusted.\n", | |
| dev->name); | |
| sp->tx_threshold += 0x00040000; | |
| } | |
| /* Free the original skb. */ | |
| if (sp->tx_skbuff[entry]) { | |
| sp->stats.tx_packets++; /* Count only user packets. */ | |
| sp->stats.tx_bytes += sp->tx_skbuff[entry]->len; | |
| pci_unmap_single(sp->pdev, | |
| le32_to_cpu(sp->tx_ring[entry].tx_buf_addr0), | |
| sp->tx_skbuff[entry]->len, PCI_DMA_TODEVICE); | |
| dev_kfree_skb_irq(sp->tx_skbuff[entry]); | |
| sp->tx_skbuff[entry] = NULL; | |
| } | |
| dirty_tx++; | |
| } | |
| if (netif_msg_tx_err(sp) && (int)(sp->cur_tx - dirty_tx) > TX_RING_SIZE) { | |
| printk(KERN_ERR "out-of-sync dirty pointer, %d vs. %d," | |
| " full=%d.\n", | |
| dirty_tx, sp->cur_tx, sp->tx_full); | |
| dirty_tx += TX_RING_SIZE; | |
| } | |
| while (sp->mc_setup_head != NULL | |
| && (int)(dirty_tx - sp->mc_setup_head->tx - 1) > 0) { | |
| struct speedo_mc_block *t; | |
| if (netif_msg_tx_err(sp)) | |
| printk(KERN_DEBUG "%s: freeing mc frame.\n", dev->name); | |
| pci_unmap_single(sp->pdev, sp->mc_setup_head->frame_dma, | |
| sp->mc_setup_head->len, PCI_DMA_TODEVICE); | |
| t = sp->mc_setup_head->next; | |
| kfree(sp->mc_setup_head); | |
| sp->mc_setup_head = t; | |
| } | |
| if (sp->mc_setup_head == NULL) | |
| sp->mc_setup_tail = NULL; | |
| sp->dirty_tx = dirty_tx; | |
| } | |
| /* The interrupt handler does all of the Rx thread work and cleans up | |
| after the Tx thread. */ | |
| static irqreturn_t speedo_interrupt(int irq, void *dev_instance) | |
| { | |
| struct net_device *dev = (struct net_device *)dev_instance; | |
| struct speedo_private *sp; | |
| void __iomem *ioaddr; | |
| long boguscnt = max_interrupt_work; | |
| unsigned short status; | |
| unsigned int handled = 0; | |
| sp = netdev_priv(dev); | |
| ioaddr = sp->regs; | |
| #ifndef final_version | |
| /* A lock to prevent simultaneous entry on SMP machines. */ | |
| if (test_and_set_bit(0, (void*)&sp->in_interrupt)) { | |
| printk(KERN_ERR"%s: SMP simultaneous entry of an interrupt handler.\n", | |
| dev->name); | |
| sp->in_interrupt = 0; /* Avoid halting machine. */ | |
| return IRQ_NONE; | |
| } | |
| #endif | |
| do { | |
| status = ioread16(ioaddr + SCBStatus); | |
| /* Acknowledge all of the current interrupt sources ASAP. */ | |
| /* Will change from 0xfc00 to 0xff00 when we start handling | |
| FCP and ER interrupts --Dragan */ | |
| iowrite16(status & 0xfc00, ioaddr + SCBStatus); | |
| if (netif_msg_intr(sp)) | |
| printk(KERN_DEBUG "%s: interrupt status=%#4.4x.\n", | |
| dev->name, status); | |
| if ((status & 0xfc00) == 0) | |
| break; | |
| handled = 1; | |
| if ((status & 0x5000) || /* Packet received, or Rx error. */ | |
| (sp->rx_ring_state&(RrNoMem|RrPostponed)) == RrPostponed) | |
| /* Need to gather the postponed packet. */ | |
| speedo_rx(dev); | |
| /* Always check if all rx buffers are allocated. --SAW */ | |
| speedo_refill_rx_buffers(dev, 0); | |
| spin_lock(&sp->lock); | |
| /* | |
| * The chip may have suspended reception for various reasons. | |
| * Check for that, and re-prime it should this be the case. | |
| */ | |
| switch ((status >> 2) & 0xf) { | |
| case 0: /* Idle */ | |
| break; | |
| case 1: /* Suspended */ | |
| case 2: /* No resources (RxFDs) */ | |
| case 9: /* Suspended with no more RBDs */ | |
| case 10: /* No resources due to no RBDs */ | |
| case 12: /* Ready with no RBDs */ | |
| speedo_rx_soft_reset(dev); | |
| break; | |
| case 3: case 5: case 6: case 7: case 8: | |
| case 11: case 13: case 14: case 15: | |
| /* these are all reserved values */ | |
| break; | |
| } | |
| /* User interrupt, Command/Tx unit interrupt or CU not active. */ | |
| if (status & 0xA400) { | |
| speedo_tx_buffer_gc(dev); | |
| if (sp->tx_full | |
| && (int)(sp->cur_tx - sp->dirty_tx) < TX_QUEUE_UNFULL) { | |
| /* The ring is no longer full. */ | |
| sp->tx_full = 0; | |
| netif_wake_queue(dev); /* Attention: under a spinlock. --SAW */ | |
| } | |
| } | |
| spin_unlock(&sp->lock); | |
| if (--boguscnt < 0) { | |
| printk(KERN_ERR "%s: Too much work at interrupt, status=0x%4.4x.\n", | |
| dev->name, status); | |
| /* Clear all interrupt sources. */ | |
| /* Will change from 0xfc00 to 0xff00 when we start handling | |
| FCP and ER interrupts --Dragan */ | |
| iowrite16(0xfc00, ioaddr + SCBStatus); | |
| break; | |
| } | |
| } while (1); | |
| if (netif_msg_intr(sp)) | |
| printk(KERN_DEBUG "%s: exiting interrupt, status=%#4.4x.\n", | |
| dev->name, ioread16(ioaddr + SCBStatus)); | |
| clear_bit(0, (void*)&sp->in_interrupt); | |
| return IRQ_RETVAL(handled); | |
| } | |
| static inline struct RxFD *speedo_rx_alloc(struct net_device *dev, int entry) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| struct RxFD *rxf; | |
| struct sk_buff *skb; | |
| /* Get a fresh skbuff to replace the consumed one. */ | |
| skb = dev_alloc_skb(PKT_BUF_SZ + sizeof(struct RxFD)); | |
| if (skb) | |
| rx_align(skb); /* Align IP on 16 byte boundary */ | |
| sp->rx_skbuff[entry] = skb; | |
| if (skb == NULL) { | |
| sp->rx_ringp[entry] = NULL; | |
| return NULL; | |
| } | |
| rxf = sp->rx_ringp[entry] = (struct RxFD *)skb->data; | |
| sp->rx_ring_dma[entry] = | |
| pci_map_single(sp->pdev, rxf, | |
| PKT_BUF_SZ + sizeof(struct RxFD), PCI_DMA_FROMDEVICE); | |
| skb->dev = dev; | |
| skb_reserve(skb, sizeof(struct RxFD)); | |
| rxf->rx_buf_addr = cpu_to_le32(0xffffffff); | |
| pci_dma_sync_single_for_device(sp->pdev, sp->rx_ring_dma[entry], | |
| sizeof(struct RxFD), PCI_DMA_TODEVICE); | |
| return rxf; | |
| } | |
| static inline void speedo_rx_link(struct net_device *dev, int entry, | |
| struct RxFD *rxf, dma_addr_t rxf_dma) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| rxf->status = cpu_to_le32(0xC0000001); /* '1' for driver use only. */ | |
| rxf->link = 0; /* None yet. */ | |
| rxf->count = cpu_to_le32(PKT_BUF_SZ << 16); | |
| sp->last_rxf->link = cpu_to_le32(rxf_dma); | |
| sp->last_rxf->status &= cpu_to_le32(~0xC0000000); | |
| pci_dma_sync_single_for_device(sp->pdev, sp->last_rxf_dma, | |
| sizeof(struct RxFD), PCI_DMA_TODEVICE); | |
| sp->last_rxf = rxf; | |
| sp->last_rxf_dma = rxf_dma; | |
| } | |
| static int speedo_refill_rx_buf(struct net_device *dev, int force) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| int entry; | |
| struct RxFD *rxf; | |
| entry = sp->dirty_rx % RX_RING_SIZE; | |
| if (sp->rx_skbuff[entry] == NULL) { | |
| rxf = speedo_rx_alloc(dev, entry); | |
| if (rxf == NULL) { | |
| unsigned int forw; | |
| int forw_entry; | |
| if (netif_msg_rx_err(sp) || !(sp->rx_ring_state & RrOOMReported)) { | |
| printk(KERN_WARNING "%s: can't fill rx buffer (force %d)!\n", | |
| dev->name, force); | |
| sp->rx_ring_state |= RrOOMReported; | |
| } | |
| speedo_show_state(dev); | |
| if (!force) | |
| return -1; /* Better luck next time! */ | |
| /* Borrow an skb from one of next entries. */ | |
| for (forw = sp->dirty_rx + 1; forw != sp->cur_rx; forw++) | |
| if (sp->rx_skbuff[forw % RX_RING_SIZE] != NULL) | |
| break; | |
| if (forw == sp->cur_rx) | |
| return -1; | |
| forw_entry = forw % RX_RING_SIZE; | |
| sp->rx_skbuff[entry] = sp->rx_skbuff[forw_entry]; | |
| sp->rx_skbuff[forw_entry] = NULL; | |
| rxf = sp->rx_ringp[forw_entry]; | |
| sp->rx_ringp[forw_entry] = NULL; | |
| sp->rx_ringp[entry] = rxf; | |
| } | |
| } else { | |
| rxf = sp->rx_ringp[entry]; | |
| } | |
| speedo_rx_link(dev, entry, rxf, sp->rx_ring_dma[entry]); | |
| sp->dirty_rx++; | |
| sp->rx_ring_state &= ~(RrNoMem|RrOOMReported); /* Mark the progress. */ | |
| return 0; | |
| } | |
| static void speedo_refill_rx_buffers(struct net_device *dev, int force) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| /* Refill the RX ring. */ | |
| while ((int)(sp->cur_rx - sp->dirty_rx) > 0 && | |
| speedo_refill_rx_buf(dev, force) != -1); | |
| } | |
| static int | |
| speedo_rx(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| int entry = sp->cur_rx % RX_RING_SIZE; | |
| int rx_work_limit = sp->dirty_rx + RX_RING_SIZE - sp->cur_rx; | |
| int alloc_ok = 1; | |
| int npkts = 0; | |
| if (netif_msg_intr(sp)) | |
| printk(KERN_DEBUG " In speedo_rx().\n"); | |
| /* If we own the next entry, it's a new packet. Send it up. */ | |
| while (sp->rx_ringp[entry] != NULL) { | |
| int status; | |
| int pkt_len; | |
| pci_dma_sync_single_for_cpu(sp->pdev, sp->rx_ring_dma[entry], | |
| sizeof(struct RxFD), PCI_DMA_FROMDEVICE); | |
| status = le32_to_cpu(sp->rx_ringp[entry]->status); | |
| pkt_len = le32_to_cpu(sp->rx_ringp[entry]->count) & 0x3fff; | |
| if (!(status & RxComplete)) | |
| break; | |
| if (--rx_work_limit < 0) | |
| break; | |
| /* Check for a rare out-of-memory case: the current buffer is | |
| the last buffer allocated in the RX ring. --SAW */ | |
| if (sp->last_rxf == sp->rx_ringp[entry]) { | |
| /* Postpone the packet. It'll be reaped at an interrupt when this | |
| packet is no longer the last packet in the ring. */ | |
| if (netif_msg_rx_err(sp)) | |
| printk(KERN_DEBUG "%s: RX packet postponed!\n", | |
| dev->name); | |
| sp->rx_ring_state |= RrPostponed; | |
| break; | |
| } | |
| if (netif_msg_rx_status(sp)) | |
| printk(KERN_DEBUG " speedo_rx() status %8.8x len %d.\n", status, | |
| pkt_len); | |
| if ((status & (RxErrTooBig|RxOK|0x0f90)) != RxOK) { | |
| if (status & RxErrTooBig) | |
| printk(KERN_ERR "%s: Ethernet frame overran the Rx buffer, " | |
| "status %8.8x!\n", dev->name, status); | |
| else if (! (status & RxOK)) { | |
| /* There was a fatal error. This *should* be impossible. */ | |
| sp->stats.rx_errors++; | |
| printk(KERN_ERR "%s: Anomalous event in speedo_rx(), " | |
| "status %8.8x.\n", | |
| dev->name, status); | |
| } | |
| } else { | |
| struct sk_buff *skb; | |
| /* Check if the packet is long enough to just accept without | |
| copying to a properly sized skbuff. */ | |
| if (pkt_len < rx_copybreak | |
| && (skb = dev_alloc_skb(pkt_len + 2)) != NULL) { | |
| skb_reserve(skb, 2); /* Align IP on 16 byte boundaries */ | |
| /* 'skb_put()' points to the start of sk_buff data area. */ | |
| pci_dma_sync_single_for_cpu(sp->pdev, sp->rx_ring_dma[entry], | |
| sizeof(struct RxFD) + pkt_len, | |
| PCI_DMA_FROMDEVICE); | |
| #if 1 || USE_IP_CSUM | |
| /* Packet is in one chunk -- we can copy + cksum. */ | |
| skb_copy_to_linear_data(skb, sp->rx_skbuff[entry]->data, pkt_len); | |
| skb_put(skb, pkt_len); | |
| #else | |
| skb_copy_from_linear_data(sp->rx_skbuff[entry], | |
| skb_put(skb, pkt_len), | |
| pkt_len); | |
| #endif | |
| pci_dma_sync_single_for_device(sp->pdev, sp->rx_ring_dma[entry], | |
| sizeof(struct RxFD) + pkt_len, | |
| PCI_DMA_FROMDEVICE); | |
| npkts++; | |
| } else { | |
| /* Pass up the already-filled skbuff. */ | |
| skb = sp->rx_skbuff[entry]; | |
| if (skb == NULL) { | |
| printk(KERN_ERR "%s: Inconsistent Rx descriptor chain.\n", | |
| dev->name); | |
| break; | |
| } | |
| sp->rx_skbuff[entry] = NULL; | |
| skb_put(skb, pkt_len); | |
| npkts++; | |
| sp->rx_ringp[entry] = NULL; | |
| pci_unmap_single(sp->pdev, sp->rx_ring_dma[entry], | |
| PKT_BUF_SZ + sizeof(struct RxFD), | |
| PCI_DMA_FROMDEVICE); | |
| } | |
| skb->protocol = eth_type_trans(skb, dev); | |
| netif_rx(skb); | |
| dev->last_rx = jiffies; | |
| sp->stats.rx_packets++; | |
| sp->stats.rx_bytes += pkt_len; | |
| } | |
| entry = (++sp->cur_rx) % RX_RING_SIZE; | |
| sp->rx_ring_state &= ~RrPostponed; | |
| /* Refill the recently taken buffers. | |
| Do it one-by-one to handle traffic bursts better. */ | |
| if (alloc_ok && speedo_refill_rx_buf(dev, 0) == -1) | |
| alloc_ok = 0; | |
| } | |
| /* Try hard to refill the recently taken buffers. */ | |
| speedo_refill_rx_buffers(dev, 1); | |
| if (npkts) | |
| sp->last_rx_time = jiffies; | |
| return 0; | |
| } | |
| static int | |
| speedo_close(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| int i; | |
| netdevice_stop(dev); | |
| netif_stop_queue(dev); | |
| if (netif_msg_ifdown(sp)) | |
| printk(KERN_DEBUG "%s: Shutting down ethercard, status was %4.4x.\n", | |
| dev->name, ioread16(ioaddr + SCBStatus)); | |
| /* Shut off the media monitoring timer. */ | |
| del_timer_sync(&sp->timer); | |
| iowrite16(SCBMaskAll, ioaddr + SCBCmd); | |
| /* Shutting down the chip nicely fails to disable flow control. So.. */ | |
| iowrite32(PortPartialReset, ioaddr + SCBPort); | |
| ioread32(ioaddr + SCBPort); /* flush posted write */ | |
| /* | |
| * The chip requires a 10 microsecond quiet period. Wait here! | |
| */ | |
| udelay(10); | |
| free_irq(dev->irq, dev); | |
| speedo_show_state(dev); | |
| /* Free all the skbuffs in the Rx and Tx queues. */ | |
| for (i = 0; i < RX_RING_SIZE; i++) { | |
| struct sk_buff *skb = sp->rx_skbuff[i]; | |
| sp->rx_skbuff[i] = NULL; | |
| /* Clear the Rx descriptors. */ | |
| if (skb) { | |
| pci_unmap_single(sp->pdev, | |
| sp->rx_ring_dma[i], | |
| PKT_BUF_SZ + sizeof(struct RxFD), PCI_DMA_FROMDEVICE); | |
| dev_kfree_skb(skb); | |
| } | |
| } | |
| for (i = 0; i < TX_RING_SIZE; i++) { | |
| struct sk_buff *skb = sp->tx_skbuff[i]; | |
| sp->tx_skbuff[i] = NULL; | |
| /* Clear the Tx descriptors. */ | |
| if (skb) { | |
| pci_unmap_single(sp->pdev, | |
| le32_to_cpu(sp->tx_ring[i].tx_buf_addr0), | |
| skb->len, PCI_DMA_TODEVICE); | |
| dev_kfree_skb(skb); | |
| } | |
| } | |
| /* Free multicast setting blocks. */ | |
| for (i = 0; sp->mc_setup_head != NULL; i++) { | |
| struct speedo_mc_block *t; | |
| t = sp->mc_setup_head->next; | |
| kfree(sp->mc_setup_head); | |
| sp->mc_setup_head = t; | |
| } | |
| sp->mc_setup_tail = NULL; | |
| if (netif_msg_ifdown(sp)) | |
| printk(KERN_DEBUG "%s: %d multicast blocks dropped.\n", dev->name, i); | |
| pci_set_power_state(sp->pdev, PCI_D2); | |
| return 0; | |
| } | |
| /* The Speedo-3 has an especially awkward and unusable method of getting | |
| statistics out of the chip. It takes an unpredictable length of time | |
| for the dump-stats command to complete. To avoid a busy-wait loop we | |
| update the stats with the previous dump results, and then trigger a | |
| new dump. | |
| Oh, and incoming frames are dropped while executing dump-stats! | |
| */ | |
| static struct net_device_stats * | |
| speedo_get_stats(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| /* Update only if the previous dump finished. */ | |
| if (sp->lstats->done_marker == cpu_to_le32(0xA007)) { | |
| sp->stats.tx_aborted_errors += le32_to_cpu(sp->lstats->tx_coll16_errs); | |
| sp->stats.tx_window_errors += le32_to_cpu(sp->lstats->tx_late_colls); | |
| sp->stats.tx_fifo_errors += le32_to_cpu(sp->lstats->tx_underruns); | |
| sp->stats.tx_fifo_errors += le32_to_cpu(sp->lstats->tx_lost_carrier); | |
| /*sp->stats.tx_deferred += le32_to_cpu(sp->lstats->tx_deferred);*/ | |
| sp->stats.collisions += le32_to_cpu(sp->lstats->tx_total_colls); | |
| sp->stats.rx_crc_errors += le32_to_cpu(sp->lstats->rx_crc_errs); | |
| sp->stats.rx_frame_errors += le32_to_cpu(sp->lstats->rx_align_errs); | |
| sp->stats.rx_over_errors += le32_to_cpu(sp->lstats->rx_resource_errs); | |
| sp->stats.rx_fifo_errors += le32_to_cpu(sp->lstats->rx_overrun_errs); | |
| sp->stats.rx_length_errors += le32_to_cpu(sp->lstats->rx_runt_errs); | |
| sp->lstats->done_marker = 0x0000; | |
| if (netif_running(dev)) { | |
| unsigned long flags; | |
| /* Take a spinlock to make wait_for_cmd_done and sending the | |
| command atomic. --SAW */ | |
| spin_lock_irqsave(&sp->lock, flags); | |
| wait_for_cmd_done(dev, sp); | |
| iowrite8(CUDumpStats, ioaddr + SCBCmd); | |
| spin_unlock_irqrestore(&sp->lock, flags); | |
| } | |
| } | |
| return &sp->stats; | |
| } | |
| static void speedo_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| strncpy(info->driver, "eepro100", sizeof(info->driver)-1); | |
| strncpy(info->version, version, sizeof(info->version)-1); | |
| if (sp->pdev) | |
| strcpy(info->bus_info, pci_name(sp->pdev)); | |
| } | |
| static int speedo_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| spin_lock_irq(&sp->lock); | |
| mii_ethtool_gset(&sp->mii_if, ecmd); | |
| spin_unlock_irq(&sp->lock); | |
| return 0; | |
| } | |
| static int speedo_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| int res; | |
| spin_lock_irq(&sp->lock); | |
| res = mii_ethtool_sset(&sp->mii_if, ecmd); | |
| spin_unlock_irq(&sp->lock); | |
| return res; | |
| } | |
| static int speedo_nway_reset(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| return mii_nway_restart(&sp->mii_if); | |
| } | |
| static u32 speedo_get_link(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| return mii_link_ok(&sp->mii_if); | |
| } | |
| static u32 speedo_get_msglevel(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| return sp->msg_enable; | |
| } | |
| static void speedo_set_msglevel(struct net_device *dev, u32 v) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| sp->msg_enable = v; | |
| } | |
| static const struct ethtool_ops ethtool_ops = { | |
| .get_drvinfo = speedo_get_drvinfo, | |
| .get_settings = speedo_get_settings, | |
| .set_settings = speedo_set_settings, | |
| .nway_reset = speedo_nway_reset, | |
| .get_link = speedo_get_link, | |
| .get_msglevel = speedo_get_msglevel, | |
| .set_msglevel = speedo_set_msglevel, | |
| }; | |
| static int speedo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| struct mii_ioctl_data *data = if_mii(rq); | |
| int phy = sp->phy[0] & 0x1f; | |
| int saved_acpi; | |
| int t; | |
| switch(cmd) { | |
| case SIOCGMIIPHY: /* Get address of MII PHY in use. */ | |
| data->phy_id = phy; | |
| case SIOCGMIIREG: /* Read MII PHY register. */ | |
| /* FIXME: these operations need to be serialized with MDIO | |
| access from the timeout handler. | |
| They are currently serialized only with MDIO access from the | |
| timer routine. 2000/05/09 SAW */ | |
| saved_acpi = pci_set_power_state(sp->pdev, PCI_D0); | |
| t = del_timer_sync(&sp->timer); | |
| data->val_out = mdio_read(dev, data->phy_id & 0x1f, data->reg_num & 0x1f); | |
| if (t) | |
| add_timer(&sp->timer); /* may be set to the past --SAW */ | |
| pci_set_power_state(sp->pdev, saved_acpi); | |
| return 0; | |
| case SIOCSMIIREG: /* Write MII PHY register. */ | |
| if (!capable(CAP_NET_ADMIN)) | |
| return -EPERM; | |
| saved_acpi = pci_set_power_state(sp->pdev, PCI_D0); | |
| t = del_timer_sync(&sp->timer); | |
| mdio_write(dev, data->phy_id, data->reg_num, data->val_in); | |
| if (t) | |
| add_timer(&sp->timer); /* may be set to the past --SAW */ | |
| pci_set_power_state(sp->pdev, saved_acpi); | |
| return 0; | |
| default: | |
| return -EOPNOTSUPP; | |
| } | |
| } | |
| /* Set or clear the multicast filter for this adaptor. | |
| This is very ugly with Intel chips -- we usually have to execute an | |
| entire configuration command, plus process a multicast command. | |
| This is complicated. We must put a large configuration command and | |
| an arbitrarily-sized multicast command in the transmit list. | |
| To minimize the disruption -- the previous command might have already | |
| loaded the link -- we convert the current command block, normally a Tx | |
| command, into a no-op and link it to the new command. | |
| */ | |
| static void set_rx_mode(struct net_device *dev) | |
| { | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| struct descriptor *last_cmd; | |
| char new_rx_mode; | |
| unsigned long flags; | |
| int entry, i; | |
| if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */ | |
| new_rx_mode = 3; | |
| } else if ((dev->flags & IFF_ALLMULTI) || | |
| dev->mc_count > multicast_filter_limit) { | |
| new_rx_mode = 1; | |
| } else | |
| new_rx_mode = 0; | |
| if (netif_msg_rx_status(sp)) | |
| printk(KERN_DEBUG "%s: set_rx_mode %d -> %d\n", dev->name, | |
| sp->rx_mode, new_rx_mode); | |
| if ((int)(sp->cur_tx - sp->dirty_tx) > TX_RING_SIZE - TX_MULTICAST_SIZE) { | |
| /* The Tx ring is full -- don't add anything! Hope the mode will be | |
| * set again later. */ | |
| sp->rx_mode = -1; | |
| return; | |
| } | |
| if (new_rx_mode != sp->rx_mode) { | |
| u8 *config_cmd_data; | |
| spin_lock_irqsave(&sp->lock, flags); | |
| entry = sp->cur_tx++ % TX_RING_SIZE; | |
| last_cmd = sp->last_cmd; | |
| sp->last_cmd = (struct descriptor *)&sp->tx_ring[entry]; | |
| sp->tx_skbuff[entry] = NULL; /* Redundant. */ | |
| sp->tx_ring[entry].status = cpu_to_le32(CmdSuspend | CmdConfigure); | |
| sp->tx_ring[entry].link = | |
| cpu_to_le32(TX_RING_ELEM_DMA(sp, (entry + 1) % TX_RING_SIZE)); | |
| config_cmd_data = (void *)&sp->tx_ring[entry].tx_desc_addr; | |
| /* Construct a full CmdConfig frame. */ | |
| memcpy(config_cmd_data, i82558_config_cmd, CONFIG_DATA_SIZE); | |
| config_cmd_data[1] = (txfifo << 4) | rxfifo; | |
| config_cmd_data[4] = rxdmacount; | |
| config_cmd_data[5] = txdmacount + 0x80; | |
| config_cmd_data[15] |= (new_rx_mode & 2) ? 1 : 0; | |
| /* 0x80 doesn't disable FC 0x84 does. | |
| Disable Flow control since we are not ACK-ing any FC interrupts | |
| for now. --Dragan */ | |
| config_cmd_data[19] = 0x84; | |
| config_cmd_data[19] |= sp->mii_if.full_duplex ? 0x40 : 0; | |
| config_cmd_data[21] = (new_rx_mode & 1) ? 0x0D : 0x05; | |
| if (sp->phy[0] & 0x8000) { /* Use the AUI port instead. */ | |
| config_cmd_data[15] |= 0x80; | |
| config_cmd_data[8] = 0; | |
| } | |
| /* Trigger the command unit resume. */ | |
| wait_for_cmd_done(dev, sp); | |
| clear_suspend(last_cmd); | |
| iowrite8(CUResume, ioaddr + SCBCmd); | |
| if ((int)(sp->cur_tx - sp->dirty_tx) >= TX_QUEUE_LIMIT) { | |
| netif_stop_queue(dev); | |
| sp->tx_full = 1; | |
| } | |
| spin_unlock_irqrestore(&sp->lock, flags); | |
| } | |
| if (new_rx_mode == 0 && dev->mc_count < 4) { | |
| /* The simple case of 0-3 multicast list entries occurs often, and | |
| fits within one tx_ring[] entry. */ | |
| struct dev_mc_list *mclist; | |
| __le16 *setup_params, *eaddrs; | |
| spin_lock_irqsave(&sp->lock, flags); | |
| entry = sp->cur_tx++ % TX_RING_SIZE; | |
| last_cmd = sp->last_cmd; | |
| sp->last_cmd = (struct descriptor *)&sp->tx_ring[entry]; | |
| sp->tx_skbuff[entry] = NULL; | |
| sp->tx_ring[entry].status = cpu_to_le32(CmdSuspend | CmdMulticastList); | |
| sp->tx_ring[entry].link = | |
| cpu_to_le32(TX_RING_ELEM_DMA(sp, (entry + 1) % TX_RING_SIZE)); | |
| sp->tx_ring[entry].tx_desc_addr = 0; /* Really MC list count. */ | |
| setup_params = (__le16 *)&sp->tx_ring[entry].tx_desc_addr; | |
| *setup_params++ = cpu_to_le16(dev->mc_count*6); | |
| /* Fill in the multicast addresses. */ | |
| for (i = 0, mclist = dev->mc_list; i < dev->mc_count; | |
| i++, mclist = mclist->next) { | |
| eaddrs = (__le16 *)mclist->dmi_addr; | |
| *setup_params++ = *eaddrs++; | |
| *setup_params++ = *eaddrs++; | |
| *setup_params++ = *eaddrs++; | |
| } | |
| wait_for_cmd_done(dev, sp); | |
| clear_suspend(last_cmd); | |
| /* Immediately trigger the command unit resume. */ | |
| iowrite8(CUResume, ioaddr + SCBCmd); | |
| if ((int)(sp->cur_tx - sp->dirty_tx) >= TX_QUEUE_LIMIT) { | |
| netif_stop_queue(dev); | |
| sp->tx_full = 1; | |
| } | |
| spin_unlock_irqrestore(&sp->lock, flags); | |
| } else if (new_rx_mode == 0) { | |
| struct dev_mc_list *mclist; | |
| __le16 *setup_params, *eaddrs; | |
| struct speedo_mc_block *mc_blk; | |
| struct descriptor *mc_setup_frm; | |
| int i; | |
| mc_blk = kmalloc(sizeof(*mc_blk) + 2 + multicast_filter_limit*6, | |
| GFP_ATOMIC); | |
| if (mc_blk == NULL) { | |
| printk(KERN_ERR "%s: Failed to allocate a setup frame.\n", | |
| dev->name); | |
| sp->rx_mode = -1; /* We failed, try again. */ | |
| return; | |
| } | |
| mc_blk->next = NULL; | |
| mc_blk->len = 2 + multicast_filter_limit*6; | |
| mc_blk->frame_dma = | |
| pci_map_single(sp->pdev, &mc_blk->frame, mc_blk->len, | |
| PCI_DMA_TODEVICE); | |
| mc_setup_frm = &mc_blk->frame; | |
| /* Fill the setup frame. */ | |
| if (netif_msg_ifup(sp)) | |
| printk(KERN_DEBUG "%s: Constructing a setup frame at %p.\n", | |
| dev->name, mc_setup_frm); | |
| mc_setup_frm->cmd_status = | |
| cpu_to_le32(CmdSuspend | CmdIntr | CmdMulticastList); | |
| /* Link set below. */ | |
| setup_params = (__le16 *)&mc_setup_frm->params; | |
| *setup_params++ = cpu_to_le16(dev->mc_count*6); | |
| /* Fill in the multicast addresses. */ | |
| for (i = 0, mclist = dev->mc_list; i < dev->mc_count; | |
| i++, mclist = mclist->next) { | |
| eaddrs = (__le16 *)mclist->dmi_addr; | |
| *setup_params++ = *eaddrs++; | |
| *setup_params++ = *eaddrs++; | |
| *setup_params++ = *eaddrs++; | |
| } | |
| /* Disable interrupts while playing with the Tx Cmd list. */ | |
| spin_lock_irqsave(&sp->lock, flags); | |
| if (sp->mc_setup_tail) | |
| sp->mc_setup_tail->next = mc_blk; | |
| else | |
| sp->mc_setup_head = mc_blk; | |
| sp->mc_setup_tail = mc_blk; | |
| mc_blk->tx = sp->cur_tx; | |
| entry = sp->cur_tx++ % TX_RING_SIZE; | |
| last_cmd = sp->last_cmd; | |
| sp->last_cmd = mc_setup_frm; | |
| /* Change the command to a NoOp, pointing to the CmdMulti command. */ | |
| sp->tx_skbuff[entry] = NULL; | |
| sp->tx_ring[entry].status = cpu_to_le32(CmdNOp); | |
| sp->tx_ring[entry].link = cpu_to_le32(mc_blk->frame_dma); | |
| /* Set the link in the setup frame. */ | |
| mc_setup_frm->link = | |
| cpu_to_le32(TX_RING_ELEM_DMA(sp, (entry + 1) % TX_RING_SIZE)); | |
| pci_dma_sync_single_for_device(sp->pdev, mc_blk->frame_dma, | |
| mc_blk->len, PCI_DMA_TODEVICE); | |
| wait_for_cmd_done(dev, sp); | |
| clear_suspend(last_cmd); | |
| /* Immediately trigger the command unit resume. */ | |
| iowrite8(CUResume, ioaddr + SCBCmd); | |
| if ((int)(sp->cur_tx - sp->dirty_tx) >= TX_QUEUE_LIMIT) { | |
| netif_stop_queue(dev); | |
| sp->tx_full = 1; | |
| } | |
| spin_unlock_irqrestore(&sp->lock, flags); | |
| if (netif_msg_rx_status(sp)) | |
| printk(" CmdMCSetup frame length %d in entry %d.\n", | |
| dev->mc_count, entry); | |
| } | |
| sp->rx_mode = new_rx_mode; | |
| } | |
| #ifdef CONFIG_PM | |
| static int eepro100_suspend(struct pci_dev *pdev, pm_message_t state) | |
| { | |
| struct net_device *dev = pci_get_drvdata (pdev); | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| pci_save_state(pdev); | |
| if (!netif_running(dev)) | |
| return 0; | |
| del_timer_sync(&sp->timer); | |
| netif_device_detach(dev); | |
| iowrite32(PortPartialReset, ioaddr + SCBPort); | |
| /* XXX call pci_set_power_state ()? */ | |
| pci_disable_device(pdev); | |
| pci_set_power_state (pdev, PCI_D3hot); | |
| return 0; | |
| } | |
| static int eepro100_resume(struct pci_dev *pdev) | |
| { | |
| struct net_device *dev = pci_get_drvdata (pdev); | |
| struct speedo_private *sp = netdev_priv(dev); | |
| void __iomem *ioaddr = sp->regs; | |
| int rc; | |
| pci_set_power_state(pdev, PCI_D0); | |
| pci_restore_state(pdev); | |
| rc = pci_enable_device(pdev); | |
| if (rc) | |
| return rc; | |
| pci_set_master(pdev); | |
| if (!netif_running(dev)) | |
| return 0; | |
| /* I'm absolutely uncertain if this part of code may work. | |
| The problems are: | |
| - correct hardware reinitialization; | |
| - correct driver behavior between different steps of the | |
| reinitialization; | |
| - serialization with other driver calls. | |
| 2000/03/08 SAW */ | |
| iowrite16(SCBMaskAll, ioaddr + SCBCmd); | |
| speedo_resume(dev); | |
| netif_device_attach(dev); | |
| sp->rx_mode = -1; | |
| sp->flow_ctrl = sp->partner = 0; | |
| set_rx_mode(dev); | |
| sp->timer.expires = RUN_AT(2*HZ); | |
| add_timer(&sp->timer); | |
| return 0; | |
| } | |
| #endif /* CONFIG_PM */ | |
| static void __devexit eepro100_remove_one (struct pci_dev *pdev) | |
| { | |
| struct net_device *dev = pci_get_drvdata (pdev); | |
| struct speedo_private *sp = netdev_priv(dev); | |
| unregister_netdev(dev); | |
| release_region(pci_resource_start(pdev, 1), pci_resource_len(pdev, 1)); | |
| release_mem_region(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0)); | |
| pci_iounmap(pdev, sp->regs); | |
| pci_free_consistent(pdev, TX_RING_SIZE * sizeof(struct TxFD) | |
| + sizeof(struct speedo_stats), | |
| sp->tx_ring, sp->tx_ring_dma); | |
| pci_disable_device(pdev); | |
| free_netdev(dev); | |
| } | |
| static struct pci_device_id eepro100_pci_tbl[] = { | |
| { PCI_VENDOR_ID_INTEL, 0x1229, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1209, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1029, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1030, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1031, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1032, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1033, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1034, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1035, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1036, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1037, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1038, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1039, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x103A, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x103B, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x103C, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x103D, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x103E, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1050, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1059, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x1227, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x2449, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x2459, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x245D, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x5200, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { PCI_VENDOR_ID_INTEL, 0x5201, PCI_ANY_ID, PCI_ANY_ID, }, | |
| { 0,} | |
| }; | |
| MODULE_DEVICE_TABLE(pci, eepro100_pci_tbl); | |
| static struct pci_driver eepro100_driver = { | |
| .name = "eepro100", | |
| .id_table = eepro100_pci_tbl, | |
| .probe = eepro100_init_one, | |
| .remove = __devexit_p(eepro100_remove_one), | |
| #ifdef CONFIG_PM | |
| .suspend = eepro100_suspend, | |
| .resume = eepro100_resume, | |
| #endif /* CONFIG_PM */ | |
| }; | |
| static int __init eepro100_init_module(void) | |
| { | |
| #ifdef MODULE | |
| printk(version); | |
| #endif | |
| return pci_register_driver(&eepro100_driver); | |
| } | |
| static void __exit eepro100_cleanup_module(void) | |
| { | |
| pci_unregister_driver(&eepro100_driver); | |
| } | |
| module_init(eepro100_init_module); | |
| module_exit(eepro100_cleanup_module); | |
| /* | |
| * Local variables: | |
| * compile-command: "gcc -DMODULE -D__KERNEL__ -I/usr/src/linux/net/inet -Wall -Wstrict-prototypes -O6 -c eepro100.c `[ -f /usr/include/linux/modversions.h ] && echo -DMODVERSIONS`" | |
| * c-indent-level: 4 | |
| * c-basic-offset: 4 | |
| * tab-width: 4 | |
| * End: | |
| */ |