Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* drivers/net/eepro100.c: An Intel i82557-559 Ethernet driver for Linux. */ |
| 2 | /* |
| 3 | Written 1996-1999 by Donald Becker. |
| 4 | |
| 5 | The driver also contains updates by different kernel developers |
| 6 | (see incomplete list below). |
| 7 | Current maintainer is Andrey V. Savochkin <saw@saw.sw.com.sg>. |
| 8 | Please use this email address and linux-kernel mailing list for bug reports. |
| 9 | |
| 10 | This software may be used and distributed according to the terms |
| 11 | of the GNU General Public License, incorporated herein by reference. |
| 12 | |
| 13 | This driver is for the Intel EtherExpress Pro100 (Speedo3) design. |
| 14 | It should work with all i82557/558/559 boards. |
| 15 | |
| 16 | Version history: |
| 17 | 1998 Apr - 2000 Feb Andrey V. Savochkin <saw@saw.sw.com.sg> |
| 18 | Serious fixes for multicast filter list setting, TX timeout routine; |
| 19 | RX ring refilling logic; other stuff |
| 20 | 2000 Feb Jeff Garzik <jgarzik@pobox.com> |
| 21 | Convert to new PCI driver interface |
| 22 | 2000 Mar 24 Dragan Stancevic <visitor@valinux.com> |
| 23 | Disabled FC and ER, to avoid lockups when when we get FCP interrupts. |
| 24 | 2000 Jul 17 Goutham Rao <goutham.rao@intel.com> |
| 25 | PCI DMA API fixes, adding pci_dma_sync_single calls where neccesary |
| 26 | 2000 Aug 31 David Mosberger <davidm@hpl.hp.com> |
| 27 | rx_align support: enables rx DMA without causing unaligned accesses. |
| 28 | */ |
| 29 | |
Arjan van de Ven | f71e130 | 2006-03-03 21:33:57 -0500 | [diff] [blame] | 30 | static const char * const version = |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | "eepro100.c:v1.09j-t 9/29/99 Donald Becker http://www.scyld.com/network/eepro100.html\n" |
| 32 | "eepro100.c: $Revision: 1.36 $ 2000/11/17 Modified by Andrey V. Savochkin <saw@saw.sw.com.sg> and others\n"; |
| 33 | |
| 34 | /* A few user-configurable values that apply to all boards. |
| 35 | First set is undocumented and spelled per Intel recommendations. */ |
| 36 | |
| 37 | static int congenb /* = 0 */; /* Enable congestion control in the DP83840. */ |
| 38 | static int txfifo = 8; /* Tx FIFO threshold in 4 byte units, 0-15 */ |
| 39 | static int rxfifo = 8; /* Rx FIFO threshold, default 32 bytes. */ |
| 40 | /* Tx/Rx DMA burst length, 0-127, 0 == no preemption, tx==128 -> disabled. */ |
| 41 | static int txdmacount = 128; |
| 42 | static int rxdmacount /* = 0 */; |
| 43 | |
| 44 | #if defined(__ia64__) || defined(__alpha__) || defined(__sparc__) || defined(__mips__) || \ |
| 45 | defined(__arm__) |
| 46 | /* align rx buffers to 2 bytes so that IP header is aligned */ |
| 47 | # define rx_align(skb) skb_reserve((skb), 2) |
| 48 | # define RxFD_ALIGNMENT __attribute__ ((aligned (2), packed)) |
| 49 | #else |
| 50 | # define rx_align(skb) |
| 51 | # define RxFD_ALIGNMENT |
| 52 | #endif |
| 53 | |
| 54 | /* Set the copy breakpoint for the copy-only-tiny-buffer Rx method. |
| 55 | Lower values use more memory, but are faster. */ |
| 56 | static int rx_copybreak = 200; |
| 57 | |
| 58 | /* Maximum events (Rx packets, etc.) to handle at each interrupt. */ |
| 59 | static int max_interrupt_work = 20; |
| 60 | |
| 61 | /* Maximum number of multicast addresses to filter (vs. rx-all-multicast) */ |
| 62 | static int multicast_filter_limit = 64; |
| 63 | |
| 64 | /* 'options' is used to pass a transceiver override or full-duplex flag |
| 65 | e.g. "options=16" for FD, "options=32" for 100mbps-only. */ |
| 66 | static int full_duplex[] = {-1, -1, -1, -1, -1, -1, -1, -1}; |
| 67 | static int options[] = {-1, -1, -1, -1, -1, -1, -1, -1}; |
| 68 | |
| 69 | /* A few values that may be tweaked. */ |
| 70 | /* The ring sizes should be a power of two for efficiency. */ |
| 71 | #define TX_RING_SIZE 64 |
| 72 | #define RX_RING_SIZE 64 |
| 73 | /* How much slots multicast filter setup may take. |
| 74 | Do not descrease without changing set_rx_mode() implementaion. */ |
| 75 | #define TX_MULTICAST_SIZE 2 |
| 76 | #define TX_MULTICAST_RESERV (TX_MULTICAST_SIZE*2) |
| 77 | /* Actual number of TX packets queued, must be |
| 78 | <= TX_RING_SIZE-TX_MULTICAST_RESERV. */ |
| 79 | #define TX_QUEUE_LIMIT (TX_RING_SIZE-TX_MULTICAST_RESERV) |
| 80 | /* Hysteresis marking queue as no longer full. */ |
| 81 | #define TX_QUEUE_UNFULL (TX_QUEUE_LIMIT-4) |
| 82 | |
| 83 | /* Operational parameters that usually are not changed. */ |
| 84 | |
| 85 | /* Time in jiffies before concluding the transmitter is hung. */ |
| 86 | #define TX_TIMEOUT (2*HZ) |
| 87 | /* Size of an pre-allocated Rx buffer: <Ethernet MTU> + slack.*/ |
| 88 | #define PKT_BUF_SZ 1536 |
| 89 | |
| 90 | #include <linux/config.h> |
| 91 | #include <linux/module.h> |
| 92 | |
| 93 | #include <linux/kernel.h> |
| 94 | #include <linux/string.h> |
| 95 | #include <linux/errno.h> |
| 96 | #include <linux/ioport.h> |
| 97 | #include <linux/slab.h> |
| 98 | #include <linux/interrupt.h> |
| 99 | #include <linux/timer.h> |
| 100 | #include <linux/pci.h> |
| 101 | #include <linux/spinlock.h> |
| 102 | #include <linux/init.h> |
| 103 | #include <linux/mii.h> |
| 104 | #include <linux/delay.h> |
| 105 | #include <linux/bitops.h> |
| 106 | |
| 107 | #include <asm/io.h> |
| 108 | #include <asm/uaccess.h> |
| 109 | #include <asm/irq.h> |
| 110 | |
| 111 | #include <linux/netdevice.h> |
| 112 | #include <linux/etherdevice.h> |
| 113 | #include <linux/rtnetlink.h> |
| 114 | #include <linux/skbuff.h> |
| 115 | #include <linux/ethtool.h> |
| 116 | |
| 117 | static int use_io; |
| 118 | static int debug = -1; |
| 119 | #define DEBUG_DEFAULT (NETIF_MSG_DRV | \ |
| 120 | NETIF_MSG_HW | \ |
| 121 | NETIF_MSG_RX_ERR | \ |
| 122 | NETIF_MSG_TX_ERR) |
| 123 | #define DEBUG ((debug >= 0) ? (1<<debug)-1 : DEBUG_DEFAULT) |
| 124 | |
| 125 | |
| 126 | MODULE_AUTHOR("Maintainer: Andrey V. Savochkin <saw@saw.sw.com.sg>"); |
| 127 | MODULE_DESCRIPTION("Intel i82557/i82558/i82559 PCI EtherExpressPro driver"); |
| 128 | MODULE_LICENSE("GPL"); |
| 129 | module_param(use_io, int, 0); |
| 130 | module_param(debug, int, 0); |
| 131 | module_param_array(options, int, NULL, 0); |
| 132 | module_param_array(full_duplex, int, NULL, 0); |
| 133 | module_param(congenb, int, 0); |
| 134 | module_param(txfifo, int, 0); |
| 135 | module_param(rxfifo, int, 0); |
| 136 | module_param(txdmacount, int, 0); |
| 137 | module_param(rxdmacount, int, 0); |
| 138 | module_param(rx_copybreak, int, 0); |
| 139 | module_param(max_interrupt_work, int, 0); |
| 140 | module_param(multicast_filter_limit, int, 0); |
| 141 | MODULE_PARM_DESC(debug, "debug level (0-6)"); |
| 142 | MODULE_PARM_DESC(options, "Bits 0-3: transceiver type, bit 4: full duplex, bit 5: 100Mbps"); |
| 143 | MODULE_PARM_DESC(full_duplex, "full duplex setting(s) (1)"); |
| 144 | MODULE_PARM_DESC(congenb, "Enable congestion control (1)"); |
| 145 | MODULE_PARM_DESC(txfifo, "Tx FIFO threshold in 4 byte units, (0-15)"); |
| 146 | MODULE_PARM_DESC(rxfifo, "Rx FIFO threshold in 4 byte units, (0-15)"); |
| 147 | MODULE_PARM_DESC(txdmacount, "Tx DMA burst length; 128 - disable (0-128)"); |
| 148 | MODULE_PARM_DESC(rxdmacount, "Rx DMA burst length; 128 - disable (0-128)"); |
| 149 | MODULE_PARM_DESC(rx_copybreak, "copy breakpoint for copy-only-tiny-frames"); |
| 150 | MODULE_PARM_DESC(max_interrupt_work, "maximum events handled per interrupt"); |
| 151 | MODULE_PARM_DESC(multicast_filter_limit, "maximum number of filtered multicast addresses"); |
| 152 | |
| 153 | #define RUN_AT(x) (jiffies + (x)) |
| 154 | |
| 155 | #define netdevice_start(dev) |
| 156 | #define netdevice_stop(dev) |
| 157 | #define netif_set_tx_timeout(dev, tf, tm) \ |
| 158 | do { \ |
| 159 | (dev)->tx_timeout = (tf); \ |
| 160 | (dev)->watchdog_timeo = (tm); \ |
| 161 | } while(0) |
| 162 | |
| 163 | |
| 164 | |
| 165 | /* |
| 166 | Theory of Operation |
| 167 | |
| 168 | I. Board Compatibility |
| 169 | |
| 170 | This device driver is designed for the Intel i82557 "Speedo3" chip, Intel's |
| 171 | single-chip fast Ethernet controller for PCI, as used on the Intel |
| 172 | EtherExpress Pro 100 adapter. |
| 173 | |
| 174 | II. Board-specific settings |
| 175 | |
| 176 | PCI bus devices are configured by the system at boot time, so no jumpers |
| 177 | need to be set on the board. The system BIOS should be set to assign the |
| 178 | PCI INTA signal to an otherwise unused system IRQ line. While it's |
| 179 | possible to share PCI interrupt lines, it negatively impacts performance and |
| 180 | only recent kernels support it. |
| 181 | |
| 182 | III. Driver operation |
| 183 | |
| 184 | IIIA. General |
| 185 | The Speedo3 is very similar to other Intel network chips, that is to say |
| 186 | "apparently designed on a different planet". This chips retains the complex |
| 187 | Rx and Tx descriptors and multiple buffers pointers as previous chips, but |
| 188 | also has simplified Tx and Rx buffer modes. This driver uses the "flexible" |
| 189 | Tx mode, but in a simplified lower-overhead manner: it associates only a |
| 190 | single buffer descriptor with each frame descriptor. |
| 191 | |
| 192 | Despite the extra space overhead in each receive skbuff, the driver must use |
| 193 | the simplified Rx buffer mode to assure that only a single data buffer is |
| 194 | associated with each RxFD. The driver implements this by reserving space |
| 195 | for the Rx descriptor at the head of each Rx skbuff. |
| 196 | |
| 197 | The Speedo-3 has receive and command unit base addresses that are added to |
| 198 | almost all descriptor pointers. The driver sets these to zero, so that all |
| 199 | pointer fields are absolute addresses. |
| 200 | |
| 201 | The System Control Block (SCB) of some previous Intel chips exists on the |
| 202 | chip in both PCI I/O and memory space. This driver uses the I/O space |
| 203 | registers, but might switch to memory mapped mode to better support non-x86 |
| 204 | processors. |
| 205 | |
| 206 | IIIB. Transmit structure |
| 207 | |
| 208 | The driver must use the complex Tx command+descriptor mode in order to |
| 209 | have a indirect pointer to the skbuff data section. Each Tx command block |
| 210 | (TxCB) is associated with two immediately appended Tx Buffer Descriptor |
| 211 | (TxBD). A fixed ring of these TxCB+TxBD pairs are kept as part of the |
| 212 | speedo_private data structure for each adapter instance. |
| 213 | |
| 214 | The newer i82558 explicitly supports this structure, and can read the two |
| 215 | TxBDs in the same PCI burst as the TxCB. |
| 216 | |
| 217 | This ring structure is used for all normal transmit packets, but the |
| 218 | transmit packet descriptors aren't long enough for most non-Tx commands such |
| 219 | as CmdConfigure. This is complicated by the possibility that the chip has |
| 220 | already loaded the link address in the previous descriptor. So for these |
| 221 | commands we convert the next free descriptor on the ring to a NoOp, and point |
| 222 | that descriptor's link to the complex command. |
| 223 | |
| 224 | An additional complexity of these non-transmit commands are that they may be |
| 225 | added asynchronous to the normal transmit queue, so we disable interrupts |
| 226 | whenever the Tx descriptor ring is manipulated. |
| 227 | |
| 228 | A notable aspect of these special configure commands is that they do |
| 229 | work with the normal Tx ring entry scavenge method. The Tx ring scavenge |
| 230 | is done at interrupt time using the 'dirty_tx' index, and checking for the |
| 231 | command-complete bit. While the setup frames may have the NoOp command on the |
| 232 | Tx ring marked as complete, but not have completed the setup command, this |
| 233 | is not a problem. The tx_ring entry can be still safely reused, as the |
| 234 | tx_skbuff[] entry is always empty for config_cmd and mc_setup frames. |
| 235 | |
| 236 | Commands may have bits set e.g. CmdSuspend in the command word to either |
| 237 | suspend or stop the transmit/command unit. This driver always flags the last |
| 238 | command with CmdSuspend, erases the CmdSuspend in the previous command, and |
| 239 | then issues a CU_RESUME. |
| 240 | Note: Watch out for the potential race condition here: imagine |
| 241 | erasing the previous suspend |
| 242 | the chip processes the previous command |
| 243 | the chip processes the final command, and suspends |
| 244 | doing the CU_RESUME |
| 245 | the chip processes the next-yet-valid post-final-command. |
| 246 | So blindly sending a CU_RESUME is only safe if we do it immediately after |
| 247 | after erasing the previous CmdSuspend, without the possibility of an |
| 248 | intervening delay. Thus the resume command is always within the |
| 249 | interrupts-disabled region. This is a timing dependence, but handling this |
| 250 | condition in a timing-independent way would considerably complicate the code. |
| 251 | |
| 252 | Note: In previous generation Intel chips, restarting the command unit was a |
| 253 | notoriously slow process. This is presumably no longer true. |
| 254 | |
| 255 | IIIC. Receive structure |
| 256 | |
| 257 | Because of the bus-master support on the Speedo3 this driver uses the new |
| 258 | SKBUFF_RX_COPYBREAK scheme, rather than a fixed intermediate receive buffer. |
| 259 | This scheme allocates full-sized skbuffs as receive buffers. The value |
| 260 | SKBUFF_RX_COPYBREAK is used as the copying breakpoint: it is chosen to |
| 261 | trade-off the memory wasted by passing the full-sized skbuff to the queue |
| 262 | layer for all frames vs. the copying cost of copying a frame to a |
| 263 | correctly-sized skbuff. |
| 264 | |
| 265 | For small frames the copying cost is negligible (esp. considering that we |
| 266 | are pre-loading the cache with immediately useful header information), so we |
| 267 | allocate a new, minimally-sized skbuff. For large frames the copying cost |
| 268 | is non-trivial, and the larger copy might flush the cache of useful data, so |
| 269 | we pass up the skbuff the packet was received into. |
| 270 | |
| 271 | IV. Notes |
| 272 | |
| 273 | Thanks to Steve Williams of Intel for arranging the non-disclosure agreement |
| 274 | that stated that I could disclose the information. But I still resent |
| 275 | having to sign an Intel NDA when I'm helping Intel sell their own product! |
| 276 | |
| 277 | */ |
| 278 | |
| 279 | static int speedo_found1(struct pci_dev *pdev, void __iomem *ioaddr, int fnd_cnt, int acpi_idle_state); |
| 280 | |
| 281 | enum pci_flags_bit { |
| 282 | PCI_USES_IO=1, PCI_USES_MEM=2, PCI_USES_MASTER=4, |
| 283 | PCI_ADDR0=0x10<<0, PCI_ADDR1=0x10<<1, PCI_ADDR2=0x10<<2, PCI_ADDR3=0x10<<3, |
| 284 | }; |
| 285 | |
| 286 | /* Offsets to the various registers. |
| 287 | All accesses need not be longword aligned. */ |
| 288 | enum speedo_offsets { |
| 289 | SCBStatus = 0, SCBCmd = 2, /* Rx/Command Unit command and status. */ |
| 290 | SCBIntmask = 3, |
| 291 | SCBPointer = 4, /* General purpose pointer. */ |
| 292 | SCBPort = 8, /* Misc. commands and operands. */ |
| 293 | SCBflash = 12, SCBeeprom = 14, /* EEPROM and flash memory control. */ |
| 294 | SCBCtrlMDI = 16, /* MDI interface control. */ |
| 295 | SCBEarlyRx = 20, /* Early receive byte count. */ |
| 296 | }; |
| 297 | /* Commands that can be put in a command list entry. */ |
| 298 | enum commands { |
| 299 | CmdNOp = 0, CmdIASetup = 0x10000, CmdConfigure = 0x20000, |
| 300 | CmdMulticastList = 0x30000, CmdTx = 0x40000, CmdTDR = 0x50000, |
| 301 | CmdDump = 0x60000, CmdDiagnose = 0x70000, |
| 302 | CmdSuspend = 0x40000000, /* Suspend after completion. */ |
| 303 | CmdIntr = 0x20000000, /* Interrupt after completion. */ |
| 304 | CmdTxFlex = 0x00080000, /* Use "Flexible mode" for CmdTx command. */ |
| 305 | }; |
| 306 | /* Clear CmdSuspend (1<<30) avoiding interference with the card access to the |
| 307 | status bits. Previous driver versions used separate 16 bit fields for |
| 308 | commands and statuses. --SAW |
| 309 | */ |
| 310 | #if defined(__alpha__) |
| 311 | # define clear_suspend(cmd) clear_bit(30, &(cmd)->cmd_status); |
| 312 | #else |
| 313 | # if defined(__LITTLE_ENDIAN) |
| 314 | # define clear_suspend(cmd) ((__u16 *)&(cmd)->cmd_status)[1] &= ~0x4000 |
| 315 | # elif defined(__BIG_ENDIAN) |
| 316 | # define clear_suspend(cmd) ((__u16 *)&(cmd)->cmd_status)[1] &= ~0x0040 |
| 317 | # else |
| 318 | # error Unsupported byteorder |
| 319 | # endif |
| 320 | #endif |
| 321 | |
| 322 | enum SCBCmdBits { |
| 323 | SCBMaskCmdDone=0x8000, SCBMaskRxDone=0x4000, SCBMaskCmdIdle=0x2000, |
| 324 | SCBMaskRxSuspend=0x1000, SCBMaskEarlyRx=0x0800, SCBMaskFlowCtl=0x0400, |
| 325 | SCBTriggerIntr=0x0200, SCBMaskAll=0x0100, |
| 326 | /* The rest are Rx and Tx commands. */ |
| 327 | CUStart=0x0010, CUResume=0x0020, CUStatsAddr=0x0040, CUShowStats=0x0050, |
| 328 | CUCmdBase=0x0060, /* CU Base address (set to zero) . */ |
| 329 | CUDumpStats=0x0070, /* Dump then reset stats counters. */ |
| 330 | RxStart=0x0001, RxResume=0x0002, RxAbort=0x0004, RxAddrLoad=0x0006, |
| 331 | RxResumeNoResources=0x0007, |
| 332 | }; |
| 333 | |
| 334 | enum SCBPort_cmds { |
| 335 | PortReset=0, PortSelfTest=1, PortPartialReset=2, PortDump=3, |
| 336 | }; |
| 337 | |
| 338 | /* The Speedo3 Rx and Tx frame/buffer descriptors. */ |
| 339 | struct descriptor { /* A generic descriptor. */ |
| 340 | volatile s32 cmd_status; /* All command and status fields. */ |
| 341 | u32 link; /* struct descriptor * */ |
| 342 | unsigned char params[0]; |
| 343 | }; |
| 344 | |
| 345 | /* The Speedo3 Rx and Tx buffer descriptors. */ |
| 346 | struct RxFD { /* Receive frame descriptor. */ |
| 347 | volatile s32 status; |
| 348 | u32 link; /* struct RxFD * */ |
| 349 | u32 rx_buf_addr; /* void * */ |
| 350 | u32 count; |
| 351 | } RxFD_ALIGNMENT; |
| 352 | |
| 353 | /* Selected elements of the Tx/RxFD.status word. */ |
| 354 | enum RxFD_bits { |
| 355 | RxComplete=0x8000, RxOK=0x2000, |
| 356 | RxErrCRC=0x0800, RxErrAlign=0x0400, RxErrTooBig=0x0200, RxErrSymbol=0x0010, |
| 357 | RxEth2Type=0x0020, RxNoMatch=0x0004, RxNoIAMatch=0x0002, |
| 358 | TxUnderrun=0x1000, StatusComplete=0x8000, |
| 359 | }; |
| 360 | |
| 361 | #define CONFIG_DATA_SIZE 22 |
| 362 | struct TxFD { /* Transmit frame descriptor set. */ |
| 363 | s32 status; |
| 364 | u32 link; /* void * */ |
| 365 | u32 tx_desc_addr; /* Always points to the tx_buf_addr element. */ |
| 366 | s32 count; /* # of TBD (=1), Tx start thresh., etc. */ |
| 367 | /* This constitutes two "TBD" entries -- we only use one. */ |
| 368 | #define TX_DESCR_BUF_OFFSET 16 |
| 369 | u32 tx_buf_addr0; /* void *, frame to be transmitted. */ |
| 370 | s32 tx_buf_size0; /* Length of Tx frame. */ |
| 371 | u32 tx_buf_addr1; /* void *, frame to be transmitted. */ |
| 372 | s32 tx_buf_size1; /* Length of Tx frame. */ |
| 373 | /* the structure must have space for at least CONFIG_DATA_SIZE starting |
| 374 | * from tx_desc_addr field */ |
| 375 | }; |
| 376 | |
| 377 | /* Multicast filter setting block. --SAW */ |
| 378 | struct speedo_mc_block { |
| 379 | struct speedo_mc_block *next; |
| 380 | unsigned int tx; |
| 381 | dma_addr_t frame_dma; |
| 382 | unsigned int len; |
| 383 | struct descriptor frame __attribute__ ((__aligned__(16))); |
| 384 | }; |
| 385 | |
| 386 | /* Elements of the dump_statistics block. This block must be lword aligned. */ |
| 387 | struct speedo_stats { |
| 388 | u32 tx_good_frames; |
| 389 | u32 tx_coll16_errs; |
| 390 | u32 tx_late_colls; |
| 391 | u32 tx_underruns; |
| 392 | u32 tx_lost_carrier; |
| 393 | u32 tx_deferred; |
| 394 | u32 tx_one_colls; |
| 395 | u32 tx_multi_colls; |
| 396 | u32 tx_total_colls; |
| 397 | u32 rx_good_frames; |
| 398 | u32 rx_crc_errs; |
| 399 | u32 rx_align_errs; |
| 400 | u32 rx_resource_errs; |
| 401 | u32 rx_overrun_errs; |
| 402 | u32 rx_colls_errs; |
| 403 | u32 rx_runt_errs; |
| 404 | u32 done_marker; |
| 405 | }; |
| 406 | |
| 407 | enum Rx_ring_state_bits { |
| 408 | RrNoMem=1, RrPostponed=2, RrNoResources=4, RrOOMReported=8, |
| 409 | }; |
| 410 | |
| 411 | /* Do not change the position (alignment) of the first few elements! |
| 412 | The later elements are grouped for cache locality. |
| 413 | |
| 414 | Unfortunately, all the positions have been shifted since there. |
| 415 | A new re-alignment is required. 2000/03/06 SAW */ |
| 416 | struct speedo_private { |
| 417 | void __iomem *regs; |
| 418 | struct TxFD *tx_ring; /* Commands (usually CmdTxPacket). */ |
| 419 | struct RxFD *rx_ringp[RX_RING_SIZE]; /* Rx descriptor, used as ring. */ |
| 420 | /* The addresses of a Tx/Rx-in-place packets/buffers. */ |
| 421 | struct sk_buff *tx_skbuff[TX_RING_SIZE]; |
| 422 | struct sk_buff *rx_skbuff[RX_RING_SIZE]; |
| 423 | /* Mapped addresses of the rings. */ |
| 424 | dma_addr_t tx_ring_dma; |
| 425 | #define TX_RING_ELEM_DMA(sp, n) ((sp)->tx_ring_dma + (n)*sizeof(struct TxFD)) |
| 426 | dma_addr_t rx_ring_dma[RX_RING_SIZE]; |
| 427 | struct descriptor *last_cmd; /* Last command sent. */ |
| 428 | unsigned int cur_tx, dirty_tx; /* The ring entries to be free()ed. */ |
| 429 | spinlock_t lock; /* Group with Tx control cache line. */ |
| 430 | u32 tx_threshold; /* The value for txdesc.count. */ |
| 431 | struct RxFD *last_rxf; /* Last filled RX buffer. */ |
| 432 | dma_addr_t last_rxf_dma; |
| 433 | unsigned int cur_rx, dirty_rx; /* The next free ring entry */ |
| 434 | long last_rx_time; /* Last Rx, in jiffies, to handle Rx hang. */ |
| 435 | struct net_device_stats stats; |
| 436 | struct speedo_stats *lstats; |
| 437 | dma_addr_t lstats_dma; |
| 438 | int chip_id; |
| 439 | struct pci_dev *pdev; |
| 440 | struct timer_list timer; /* Media selection timer. */ |
| 441 | struct speedo_mc_block *mc_setup_head; /* Multicast setup frame list head. */ |
| 442 | struct speedo_mc_block *mc_setup_tail; /* Multicast setup frame list tail. */ |
| 443 | long in_interrupt; /* Word-aligned dev->interrupt */ |
| 444 | unsigned char acpi_pwr; |
| 445 | signed char rx_mode; /* Current PROMISC/ALLMULTI setting. */ |
| 446 | unsigned int tx_full:1; /* The Tx queue is full. */ |
| 447 | unsigned int flow_ctrl:1; /* Use 802.3x flow control. */ |
| 448 | unsigned int rx_bug:1; /* Work around receiver hang errata. */ |
| 449 | unsigned char default_port:8; /* Last dev->if_port value. */ |
| 450 | unsigned char rx_ring_state; /* RX ring status flags. */ |
| 451 | unsigned short phy[2]; /* PHY media interfaces available. */ |
| 452 | unsigned short partner; /* Link partner caps. */ |
| 453 | struct mii_if_info mii_if; /* MII API hooks, info */ |
| 454 | u32 msg_enable; /* debug message level */ |
| 455 | }; |
| 456 | |
| 457 | /* The parameters for a CmdConfigure operation. |
| 458 | There are so many options that it would be difficult to document each bit. |
| 459 | We mostly use the default or recommended settings. */ |
| 460 | static const char i82557_config_cmd[CONFIG_DATA_SIZE] = { |
| 461 | 22, 0x08, 0, 0, 0, 0, 0x32, 0x03, 1, /* 1=Use MII 0=Use AUI */ |
| 462 | 0, 0x2E, 0, 0x60, 0, |
| 463 | 0xf2, 0x48, 0, 0x40, 0xf2, 0x80, /* 0x40=Force full-duplex */ |
| 464 | 0x3f, 0x05, }; |
| 465 | static const char i82558_config_cmd[CONFIG_DATA_SIZE] = { |
| 466 | 22, 0x08, 0, 1, 0, 0, 0x22, 0x03, 1, /* 1=Use MII 0=Use AUI */ |
| 467 | 0, 0x2E, 0, 0x60, 0x08, 0x88, |
| 468 | 0x68, 0, 0x40, 0xf2, 0x84, /* Disable FC */ |
| 469 | 0x31, 0x05, }; |
| 470 | |
| 471 | /* PHY media interface chips. */ |
Arjan van de Ven | f71e130 | 2006-03-03 21:33:57 -0500 | [diff] [blame] | 472 | static const char * const phys[] = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 473 | "None", "i82553-A/B", "i82553-C", "i82503", |
| 474 | "DP83840", "80c240", "80c24", "i82555", |
| 475 | "unknown-8", "unknown-9", "DP83840A", "unknown-11", |
| 476 | "unknown-12", "unknown-13", "unknown-14", "unknown-15", }; |
| 477 | enum phy_chips { NonSuchPhy=0, I82553AB, I82553C, I82503, DP83840, S80C240, |
| 478 | S80C24, I82555, DP83840A=10, }; |
| 479 | static const char is_mii[] = { 0, 1, 1, 0, 1, 1, 0, 1 }; |
| 480 | #define EE_READ_CMD (6) |
| 481 | |
| 482 | static int eepro100_init_one(struct pci_dev *pdev, |
| 483 | const struct pci_device_id *ent); |
| 484 | |
| 485 | static int do_eeprom_cmd(void __iomem *ioaddr, int cmd, int cmd_len); |
| 486 | static int mdio_read(struct net_device *dev, int phy_id, int location); |
| 487 | static void mdio_write(struct net_device *dev, int phy_id, int location, int value); |
| 488 | static int speedo_open(struct net_device *dev); |
| 489 | static void speedo_resume(struct net_device *dev); |
| 490 | static void speedo_timer(unsigned long data); |
| 491 | static void speedo_init_rx_ring(struct net_device *dev); |
| 492 | static void speedo_tx_timeout(struct net_device *dev); |
| 493 | static int speedo_start_xmit(struct sk_buff *skb, struct net_device *dev); |
| 494 | static void speedo_refill_rx_buffers(struct net_device *dev, int force); |
| 495 | static int speedo_rx(struct net_device *dev); |
| 496 | static void speedo_tx_buffer_gc(struct net_device *dev); |
| 497 | static irqreturn_t speedo_interrupt(int irq, void *dev_instance, struct pt_regs *regs); |
| 498 | static int speedo_close(struct net_device *dev); |
| 499 | static struct net_device_stats *speedo_get_stats(struct net_device *dev); |
| 500 | static int speedo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); |
| 501 | static void set_rx_mode(struct net_device *dev); |
| 502 | static void speedo_show_state(struct net_device *dev); |
| 503 | static struct ethtool_ops ethtool_ops; |
| 504 | |
| 505 | |
| 506 | |
| 507 | #ifdef honor_default_port |
| 508 | /* Optional driver feature to allow forcing the transceiver setting. |
| 509 | Not recommended. */ |
| 510 | static int mii_ctrl[8] = { 0x3300, 0x3100, 0x0000, 0x0100, |
| 511 | 0x2000, 0x2100, 0x0400, 0x3100}; |
| 512 | #endif |
| 513 | |
| 514 | /* How to wait for the command unit to accept a command. |
| 515 | Typically this takes 0 ticks. */ |
| 516 | static inline unsigned char wait_for_cmd_done(struct net_device *dev, |
| 517 | struct speedo_private *sp) |
| 518 | { |
| 519 | int wait = 1000; |
| 520 | void __iomem *cmd_ioaddr = sp->regs + SCBCmd; |
| 521 | unsigned char r; |
| 522 | |
| 523 | do { |
| 524 | udelay(1); |
| 525 | r = ioread8(cmd_ioaddr); |
| 526 | } while(r && --wait >= 0); |
| 527 | |
| 528 | if (wait < 0) |
| 529 | printk(KERN_ALERT "%s: wait_for_cmd_done timeout!\n", dev->name); |
| 530 | return r; |
| 531 | } |
| 532 | |
| 533 | static int __devinit eepro100_init_one (struct pci_dev *pdev, |
| 534 | const struct pci_device_id *ent) |
| 535 | { |
| 536 | void __iomem *ioaddr; |
| 537 | int irq, pci_bar; |
| 538 | int acpi_idle_state = 0, pm; |
| 539 | static int cards_found /* = 0 */; |
| 540 | unsigned long pci_base; |
| 541 | |
| 542 | #ifndef MODULE |
| 543 | /* when built-in, we only print version if device is found */ |
| 544 | static int did_version; |
| 545 | if (did_version++ == 0) |
| 546 | printk(version); |
| 547 | #endif |
| 548 | |
| 549 | /* save power state before pci_enable_device overwrites it */ |
| 550 | pm = pci_find_capability(pdev, PCI_CAP_ID_PM); |
| 551 | if (pm) { |
| 552 | u16 pwr_command; |
| 553 | pci_read_config_word(pdev, pm + PCI_PM_CTRL, &pwr_command); |
| 554 | acpi_idle_state = pwr_command & PCI_PM_CTRL_STATE_MASK; |
| 555 | } |
| 556 | |
| 557 | if (pci_enable_device(pdev)) |
| 558 | goto err_out_free_mmio_region; |
| 559 | |
| 560 | pci_set_master(pdev); |
| 561 | |
| 562 | if (!request_region(pci_resource_start(pdev, 1), |
| 563 | pci_resource_len(pdev, 1), "eepro100")) { |
| 564 | printk (KERN_ERR "eepro100: cannot reserve I/O ports\n"); |
| 565 | goto err_out_none; |
| 566 | } |
| 567 | if (!request_mem_region(pci_resource_start(pdev, 0), |
| 568 | pci_resource_len(pdev, 0), "eepro100")) { |
| 569 | printk (KERN_ERR "eepro100: cannot reserve MMIO region\n"); |
| 570 | goto err_out_free_pio_region; |
| 571 | } |
| 572 | |
| 573 | irq = pdev->irq; |
| 574 | pci_bar = use_io ? 1 : 0; |
| 575 | pci_base = pci_resource_start(pdev, pci_bar); |
| 576 | if (DEBUG & NETIF_MSG_PROBE) |
| 577 | printk("Found Intel i82557 PCI Speedo at %#lx, IRQ %d.\n", |
| 578 | pci_base, irq); |
| 579 | |
| 580 | ioaddr = pci_iomap(pdev, pci_bar, 0); |
| 581 | if (!ioaddr) { |
| 582 | printk (KERN_ERR "eepro100: cannot remap IO\n"); |
| 583 | goto err_out_free_mmio_region; |
| 584 | } |
| 585 | |
| 586 | if (speedo_found1(pdev, ioaddr, cards_found, acpi_idle_state) == 0) |
| 587 | cards_found++; |
| 588 | else |
| 589 | goto err_out_iounmap; |
| 590 | |
| 591 | return 0; |
| 592 | |
| 593 | err_out_iounmap: ; |
| 594 | pci_iounmap(pdev, ioaddr); |
| 595 | err_out_free_mmio_region: |
| 596 | release_mem_region(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0)); |
| 597 | err_out_free_pio_region: |
| 598 | release_region(pci_resource_start(pdev, 1), pci_resource_len(pdev, 1)); |
| 599 | err_out_none: |
| 600 | return -ENODEV; |
| 601 | } |
| 602 | |
| 603 | #ifdef CONFIG_NET_POLL_CONTROLLER |
| 604 | /* |
| 605 | * Polling 'interrupt' - used by things like netconsole to send skbs |
| 606 | * without having to re-enable interrupts. It's not called while |
| 607 | * the interrupt routine is executing. |
| 608 | */ |
| 609 | |
| 610 | static void poll_speedo (struct net_device *dev) |
| 611 | { |
| 612 | /* disable_irq is not very nice, but with the funny lockless design |
| 613 | we have no other choice. */ |
| 614 | disable_irq(dev->irq); |
| 615 | speedo_interrupt (dev->irq, dev, NULL); |
| 616 | enable_irq(dev->irq); |
| 617 | } |
| 618 | #endif |
| 619 | |
| 620 | static int __devinit speedo_found1(struct pci_dev *pdev, |
| 621 | void __iomem *ioaddr, int card_idx, int acpi_idle_state) |
| 622 | { |
| 623 | struct net_device *dev; |
| 624 | struct speedo_private *sp; |
| 625 | const char *product; |
| 626 | int i, option; |
| 627 | u16 eeprom[0x100]; |
| 628 | int size; |
| 629 | void *tx_ring_space; |
| 630 | dma_addr_t tx_ring_dma; |
| 631 | |
| 632 | size = TX_RING_SIZE * sizeof(struct TxFD) + sizeof(struct speedo_stats); |
| 633 | tx_ring_space = pci_alloc_consistent(pdev, size, &tx_ring_dma); |
| 634 | if (tx_ring_space == NULL) |
| 635 | return -1; |
| 636 | |
| 637 | dev = alloc_etherdev(sizeof(struct speedo_private)); |
| 638 | if (dev == NULL) { |
| 639 | printk(KERN_ERR "eepro100: Could not allocate ethernet device.\n"); |
| 640 | pci_free_consistent(pdev, size, tx_ring_space, tx_ring_dma); |
| 641 | return -1; |
| 642 | } |
| 643 | |
| 644 | SET_MODULE_OWNER(dev); |
| 645 | SET_NETDEV_DEV(dev, &pdev->dev); |
| 646 | |
| 647 | if (dev->mem_start > 0) |
| 648 | option = dev->mem_start; |
| 649 | else if (card_idx >= 0 && options[card_idx] >= 0) |
| 650 | option = options[card_idx]; |
| 651 | else |
| 652 | option = 0; |
| 653 | |
| 654 | rtnl_lock(); |
| 655 | if (dev_alloc_name(dev, dev->name) < 0) |
| 656 | goto err_free_unlock; |
| 657 | |
| 658 | /* Read the station address EEPROM before doing the reset. |
| 659 | Nominally his should even be done before accepting the device, but |
| 660 | then we wouldn't have a device name with which to report the error. |
| 661 | The size test is for 6 bit vs. 8 bit address serial EEPROMs. |
| 662 | */ |
| 663 | { |
| 664 | void __iomem *iobase; |
| 665 | int read_cmd, ee_size; |
| 666 | u16 sum; |
| 667 | int j; |
| 668 | |
| 669 | /* Use IO only to avoid postponed writes and satisfy EEPROM timing |
| 670 | requirements. */ |
| 671 | iobase = pci_iomap(pdev, 1, pci_resource_len(pdev, 1)); |
| 672 | if (!iobase) |
| 673 | goto err_free_unlock; |
| 674 | if ((do_eeprom_cmd(iobase, EE_READ_CMD << 24, 27) & 0xffe0000) |
| 675 | == 0xffe0000) { |
| 676 | ee_size = 0x100; |
| 677 | read_cmd = EE_READ_CMD << 24; |
| 678 | } else { |
| 679 | ee_size = 0x40; |
| 680 | read_cmd = EE_READ_CMD << 22; |
| 681 | } |
| 682 | |
| 683 | for (j = 0, i = 0, sum = 0; i < ee_size; i++) { |
| 684 | u16 value = do_eeprom_cmd(iobase, read_cmd | (i << 16), 27); |
| 685 | eeprom[i] = value; |
| 686 | sum += value; |
| 687 | if (i < 3) { |
| 688 | dev->dev_addr[j++] = value; |
| 689 | dev->dev_addr[j++] = value >> 8; |
| 690 | } |
| 691 | } |
| 692 | if (sum != 0xBABA) |
| 693 | printk(KERN_WARNING "%s: Invalid EEPROM checksum %#4.4x, " |
| 694 | "check settings before activating this device!\n", |
| 695 | dev->name, sum); |
| 696 | /* Don't unregister_netdev(dev); as the EEPro may actually be |
| 697 | usable, especially if the MAC address is set later. |
| 698 | On the other hand, it may be unusable if MDI data is corrupted. */ |
| 699 | |
| 700 | pci_iounmap(pdev, iobase); |
| 701 | } |
| 702 | |
| 703 | /* Reset the chip: stop Tx and Rx processes and clear counters. |
| 704 | This takes less than 10usec and will easily finish before the next |
| 705 | action. */ |
| 706 | iowrite32(PortReset, ioaddr + SCBPort); |
| 707 | ioread32(ioaddr + SCBPort); |
| 708 | udelay(10); |
| 709 | |
| 710 | if (eeprom[3] & 0x0100) |
| 711 | product = "OEM i82557/i82558 10/100 Ethernet"; |
| 712 | else |
| 713 | product = pci_name(pdev); |
| 714 | |
| 715 | printk(KERN_INFO "%s: %s, ", dev->name, product); |
| 716 | |
| 717 | for (i = 0; i < 5; i++) |
| 718 | printk("%2.2X:", dev->dev_addr[i]); |
| 719 | printk("%2.2X, ", dev->dev_addr[i]); |
| 720 | printk("IRQ %d.\n", pdev->irq); |
| 721 | |
| 722 | sp = netdev_priv(dev); |
| 723 | |
| 724 | /* we must initialize this early, for mdio_{read,write} */ |
| 725 | sp->regs = ioaddr; |
| 726 | |
| 727 | #if 1 || defined(kernel_bloat) |
| 728 | /* OK, this is pure kernel bloat. I don't like it when other drivers |
| 729 | waste non-pageable kernel space to emit similar messages, but I need |
| 730 | them for bug reports. */ |
| 731 | { |
| 732 | const char *connectors[] = {" RJ45", " BNC", " AUI", " MII"}; |
| 733 | /* The self-test results must be paragraph aligned. */ |
| 734 | volatile s32 *self_test_results; |
| 735 | int boguscnt = 16000; /* Timeout for set-test. */ |
| 736 | if ((eeprom[3] & 0x03) != 0x03) |
| 737 | printk(KERN_INFO " Receiver lock-up bug exists -- enabling" |
| 738 | " work-around.\n"); |
| 739 | printk(KERN_INFO " Board assembly %4.4x%2.2x-%3.3d, Physical" |
| 740 | " connectors present:", |
| 741 | eeprom[8], eeprom[9]>>8, eeprom[9] & 0xff); |
| 742 | for (i = 0; i < 4; i++) |
| 743 | if (eeprom[5] & (1<<i)) |
| 744 | printk(connectors[i]); |
| 745 | printk("\n"KERN_INFO" Primary interface chip %s PHY #%d.\n", |
| 746 | phys[(eeprom[6]>>8)&15], eeprom[6] & 0x1f); |
| 747 | if (eeprom[7] & 0x0700) |
| 748 | printk(KERN_INFO " Secondary interface chip %s.\n", |
| 749 | phys[(eeprom[7]>>8)&7]); |
| 750 | if (((eeprom[6]>>8) & 0x3f) == DP83840 |
| 751 | || ((eeprom[6]>>8) & 0x3f) == DP83840A) { |
| 752 | int mdi_reg23 = mdio_read(dev, eeprom[6] & 0x1f, 23) | 0x0422; |
| 753 | if (congenb) |
| 754 | mdi_reg23 |= 0x0100; |
| 755 | printk(KERN_INFO" DP83840 specific setup, setting register 23 to %4.4x.\n", |
| 756 | mdi_reg23); |
| 757 | mdio_write(dev, eeprom[6] & 0x1f, 23, mdi_reg23); |
| 758 | } |
| 759 | if ((option >= 0) && (option & 0x70)) { |
| 760 | printk(KERN_INFO " Forcing %dMbs %s-duplex operation.\n", |
| 761 | (option & 0x20 ? 100 : 10), |
| 762 | (option & 0x10 ? "full" : "half")); |
| 763 | mdio_write(dev, eeprom[6] & 0x1f, MII_BMCR, |
| 764 | ((option & 0x20) ? 0x2000 : 0) | /* 100mbps? */ |
| 765 | ((option & 0x10) ? 0x0100 : 0)); /* Full duplex? */ |
| 766 | } |
| 767 | |
| 768 | /* Perform a system self-test. */ |
| 769 | self_test_results = (s32*) ((((long) tx_ring_space) + 15) & ~0xf); |
| 770 | self_test_results[0] = 0; |
| 771 | self_test_results[1] = -1; |
| 772 | iowrite32(tx_ring_dma | PortSelfTest, ioaddr + SCBPort); |
| 773 | do { |
| 774 | udelay(10); |
| 775 | } while (self_test_results[1] == -1 && --boguscnt >= 0); |
| 776 | |
| 777 | if (boguscnt < 0) { /* Test optimized out. */ |
| 778 | printk(KERN_ERR "Self test failed, status %8.8x:\n" |
| 779 | KERN_ERR " Failure to initialize the i82557.\n" |
| 780 | KERN_ERR " Verify that the card is a bus-master" |
| 781 | " capable slot.\n", |
| 782 | self_test_results[1]); |
| 783 | } else |
| 784 | printk(KERN_INFO " General self-test: %s.\n" |
| 785 | KERN_INFO " Serial sub-system self-test: %s.\n" |
| 786 | KERN_INFO " Internal registers self-test: %s.\n" |
| 787 | KERN_INFO " ROM checksum self-test: %s (%#8.8x).\n", |
| 788 | self_test_results[1] & 0x1000 ? "failed" : "passed", |
| 789 | self_test_results[1] & 0x0020 ? "failed" : "passed", |
| 790 | self_test_results[1] & 0x0008 ? "failed" : "passed", |
| 791 | self_test_results[1] & 0x0004 ? "failed" : "passed", |
| 792 | self_test_results[0]); |
| 793 | } |
| 794 | #endif /* kernel_bloat */ |
| 795 | |
| 796 | iowrite32(PortReset, ioaddr + SCBPort); |
| 797 | ioread32(ioaddr + SCBPort); |
| 798 | udelay(10); |
| 799 | |
| 800 | /* Return the chip to its original power state. */ |
| 801 | pci_set_power_state(pdev, acpi_idle_state); |
| 802 | |
| 803 | pci_set_drvdata (pdev, dev); |
| 804 | SET_NETDEV_DEV(dev, &pdev->dev); |
| 805 | |
| 806 | dev->irq = pdev->irq; |
| 807 | |
| 808 | sp->pdev = pdev; |
| 809 | sp->msg_enable = DEBUG; |
| 810 | sp->acpi_pwr = acpi_idle_state; |
| 811 | sp->tx_ring = tx_ring_space; |
| 812 | sp->tx_ring_dma = tx_ring_dma; |
| 813 | sp->lstats = (struct speedo_stats *)(sp->tx_ring + TX_RING_SIZE); |
| 814 | sp->lstats_dma = TX_RING_ELEM_DMA(sp, TX_RING_SIZE); |
| 815 | init_timer(&sp->timer); /* used in ioctl() */ |
| 816 | spin_lock_init(&sp->lock); |
| 817 | |
| 818 | sp->mii_if.full_duplex = option >= 0 && (option & 0x10) ? 1 : 0; |
| 819 | if (card_idx >= 0) { |
| 820 | if (full_duplex[card_idx] >= 0) |
| 821 | sp->mii_if.full_duplex = full_duplex[card_idx]; |
| 822 | } |
| 823 | sp->default_port = option >= 0 ? (option & 0x0f) : 0; |
| 824 | |
| 825 | sp->phy[0] = eeprom[6]; |
| 826 | sp->phy[1] = eeprom[7]; |
| 827 | |
| 828 | sp->mii_if.phy_id = eeprom[6] & 0x1f; |
| 829 | sp->mii_if.phy_id_mask = 0x1f; |
| 830 | sp->mii_if.reg_num_mask = 0x1f; |
| 831 | sp->mii_if.dev = dev; |
| 832 | sp->mii_if.mdio_read = mdio_read; |
| 833 | sp->mii_if.mdio_write = mdio_write; |
| 834 | |
| 835 | sp->rx_bug = (eeprom[3] & 0x03) == 3 ? 0 : 1; |
| 836 | if (((pdev->device > 0x1030 && (pdev->device < 0x103F))) |
| 837 | || (pdev->device == 0x2449) || (pdev->device == 0x2459) |
| 838 | || (pdev->device == 0x245D)) { |
| 839 | sp->chip_id = 1; |
| 840 | } |
| 841 | |
| 842 | if (sp->rx_bug) |
| 843 | printk(KERN_INFO " Receiver lock-up workaround activated.\n"); |
| 844 | |
| 845 | /* The Speedo-specific entries in the device structure. */ |
| 846 | dev->open = &speedo_open; |
| 847 | dev->hard_start_xmit = &speedo_start_xmit; |
| 848 | netif_set_tx_timeout(dev, &speedo_tx_timeout, TX_TIMEOUT); |
| 849 | dev->stop = &speedo_close; |
| 850 | dev->get_stats = &speedo_get_stats; |
| 851 | dev->set_multicast_list = &set_rx_mode; |
| 852 | dev->do_ioctl = &speedo_ioctl; |
| 853 | SET_ETHTOOL_OPS(dev, ðtool_ops); |
| 854 | #ifdef CONFIG_NET_POLL_CONTROLLER |
| 855 | dev->poll_controller = &poll_speedo; |
| 856 | #endif |
| 857 | |
| 858 | if (register_netdevice(dev)) |
| 859 | goto err_free_unlock; |
| 860 | rtnl_unlock(); |
| 861 | |
| 862 | return 0; |
| 863 | |
| 864 | err_free_unlock: |
| 865 | rtnl_unlock(); |
| 866 | free_netdev(dev); |
| 867 | return -1; |
| 868 | } |
| 869 | |
| 870 | static void do_slow_command(struct net_device *dev, struct speedo_private *sp, int cmd) |
| 871 | { |
| 872 | void __iomem *cmd_ioaddr = sp->regs + SCBCmd; |
| 873 | int wait = 0; |
| 874 | do |
| 875 | if (ioread8(cmd_ioaddr) == 0) break; |
| 876 | while(++wait <= 200); |
| 877 | if (wait > 100) |
| 878 | printk(KERN_ERR "Command %4.4x never accepted (%d polls)!\n", |
| 879 | ioread8(cmd_ioaddr), wait); |
| 880 | |
| 881 | iowrite8(cmd, cmd_ioaddr); |
| 882 | |
| 883 | for (wait = 0; wait <= 100; wait++) |
| 884 | if (ioread8(cmd_ioaddr) == 0) return; |
| 885 | for (; wait <= 20000; wait++) |
| 886 | if (ioread8(cmd_ioaddr) == 0) return; |
| 887 | else udelay(1); |
| 888 | printk(KERN_ERR "Command %4.4x was not accepted after %d polls!" |
| 889 | " Current status %8.8x.\n", |
| 890 | cmd, wait, ioread32(sp->regs + SCBStatus)); |
| 891 | } |
| 892 | |
| 893 | /* Serial EEPROM section. |
| 894 | A "bit" grungy, but we work our way through bit-by-bit :->. */ |
| 895 | /* EEPROM_Ctrl bits. */ |
| 896 | #define EE_SHIFT_CLK 0x01 /* EEPROM shift clock. */ |
| 897 | #define EE_CS 0x02 /* EEPROM chip select. */ |
| 898 | #define EE_DATA_WRITE 0x04 /* EEPROM chip data in. */ |
| 899 | #define EE_DATA_READ 0x08 /* EEPROM chip data out. */ |
| 900 | #define EE_ENB (0x4800 | EE_CS) |
| 901 | #define EE_WRITE_0 0x4802 |
| 902 | #define EE_WRITE_1 0x4806 |
| 903 | #define EE_OFFSET SCBeeprom |
| 904 | |
| 905 | /* The fixes for the code were kindly provided by Dragan Stancevic |
| 906 | <visitor@valinux.com> to strictly follow Intel specifications of EEPROM |
| 907 | access timing. |
| 908 | The publicly available sheet 64486302 (sec. 3.1) specifies 1us access |
| 909 | interval for serial EEPROM. However, it looks like that there is an |
| 910 | additional requirement dictating larger udelay's in the code below. |
| 911 | 2000/05/24 SAW */ |
| 912 | static int __devinit do_eeprom_cmd(void __iomem *ioaddr, int cmd, int cmd_len) |
| 913 | { |
| 914 | unsigned retval = 0; |
| 915 | void __iomem *ee_addr = ioaddr + SCBeeprom; |
| 916 | |
| 917 | iowrite16(EE_ENB, ee_addr); udelay(2); |
| 918 | iowrite16(EE_ENB | EE_SHIFT_CLK, ee_addr); udelay(2); |
| 919 | |
| 920 | /* Shift the command bits out. */ |
| 921 | do { |
| 922 | short dataval = (cmd & (1 << cmd_len)) ? EE_WRITE_1 : EE_WRITE_0; |
| 923 | iowrite16(dataval, ee_addr); udelay(2); |
| 924 | iowrite16(dataval | EE_SHIFT_CLK, ee_addr); udelay(2); |
| 925 | retval = (retval << 1) | ((ioread16(ee_addr) & EE_DATA_READ) ? 1 : 0); |
| 926 | } while (--cmd_len >= 0); |
| 927 | iowrite16(EE_ENB, ee_addr); udelay(2); |
| 928 | |
| 929 | /* Terminate the EEPROM access. */ |
| 930 | iowrite16(EE_ENB & ~EE_CS, ee_addr); |
| 931 | return retval; |
| 932 | } |
| 933 | |
| 934 | static int mdio_read(struct net_device *dev, int phy_id, int location) |
| 935 | { |
| 936 | struct speedo_private *sp = netdev_priv(dev); |
| 937 | void __iomem *ioaddr = sp->regs; |
| 938 | int val, boguscnt = 64*10; /* <64 usec. to complete, typ 27 ticks */ |
| 939 | iowrite32(0x08000000 | (location<<16) | (phy_id<<21), ioaddr + SCBCtrlMDI); |
| 940 | do { |
| 941 | val = ioread32(ioaddr + SCBCtrlMDI); |
| 942 | if (--boguscnt < 0) { |
| 943 | printk(KERN_ERR " mdio_read() timed out with val = %8.8x.\n", val); |
| 944 | break; |
| 945 | } |
| 946 | } while (! (val & 0x10000000)); |
| 947 | return val & 0xffff; |
| 948 | } |
| 949 | |
| 950 | static void mdio_write(struct net_device *dev, int phy_id, int location, int value) |
| 951 | { |
| 952 | struct speedo_private *sp = netdev_priv(dev); |
| 953 | void __iomem *ioaddr = sp->regs; |
| 954 | int val, boguscnt = 64*10; /* <64 usec. to complete, typ 27 ticks */ |
| 955 | iowrite32(0x04000000 | (location<<16) | (phy_id<<21) | value, |
| 956 | ioaddr + SCBCtrlMDI); |
| 957 | do { |
| 958 | val = ioread32(ioaddr + SCBCtrlMDI); |
| 959 | if (--boguscnt < 0) { |
| 960 | printk(KERN_ERR" mdio_write() timed out with val = %8.8x.\n", val); |
| 961 | break; |
| 962 | } |
| 963 | } while (! (val & 0x10000000)); |
| 964 | } |
| 965 | |
| 966 | static int |
| 967 | speedo_open(struct net_device *dev) |
| 968 | { |
| 969 | struct speedo_private *sp = netdev_priv(dev); |
| 970 | void __iomem *ioaddr = sp->regs; |
| 971 | int retval; |
| 972 | |
| 973 | if (netif_msg_ifup(sp)) |
| 974 | printk(KERN_DEBUG "%s: speedo_open() irq %d.\n", dev->name, dev->irq); |
| 975 | |
| 976 | pci_set_power_state(sp->pdev, PCI_D0); |
| 977 | |
| 978 | /* Set up the Tx queue early.. */ |
| 979 | sp->cur_tx = 0; |
| 980 | sp->dirty_tx = 0; |
| 981 | sp->last_cmd = NULL; |
| 982 | sp->tx_full = 0; |
| 983 | sp->in_interrupt = 0; |
| 984 | |
| 985 | /* .. we can safely take handler calls during init. */ |
| 986 | retval = request_irq(dev->irq, &speedo_interrupt, SA_SHIRQ, dev->name, dev); |
| 987 | if (retval) { |
| 988 | return retval; |
| 989 | } |
| 990 | |
| 991 | dev->if_port = sp->default_port; |
| 992 | |
| 993 | #ifdef oh_no_you_dont_unless_you_honour_the_options_passed_in_to_us |
| 994 | /* Retrigger negotiation to reset previous errors. */ |
| 995 | if ((sp->phy[0] & 0x8000) == 0) { |
| 996 | int phy_addr = sp->phy[0] & 0x1f ; |
| 997 | /* Use 0x3300 for restarting NWay, other values to force xcvr: |
| 998 | 0x0000 10-HD |
| 999 | 0x0100 10-FD |
| 1000 | 0x2000 100-HD |
| 1001 | 0x2100 100-FD |
| 1002 | */ |
| 1003 | #ifdef honor_default_port |
| 1004 | mdio_write(dev, phy_addr, MII_BMCR, mii_ctrl[dev->default_port & 7]); |
| 1005 | #else |
| 1006 | mdio_write(dev, phy_addr, MII_BMCR, 0x3300); |
| 1007 | #endif |
| 1008 | } |
| 1009 | #endif |
| 1010 | |
| 1011 | speedo_init_rx_ring(dev); |
| 1012 | |
| 1013 | /* Fire up the hardware. */ |
| 1014 | iowrite16(SCBMaskAll, ioaddr + SCBCmd); |
| 1015 | speedo_resume(dev); |
| 1016 | |
| 1017 | netdevice_start(dev); |
| 1018 | netif_start_queue(dev); |
| 1019 | |
| 1020 | /* Setup the chip and configure the multicast list. */ |
| 1021 | sp->mc_setup_head = NULL; |
| 1022 | sp->mc_setup_tail = NULL; |
| 1023 | sp->flow_ctrl = sp->partner = 0; |
| 1024 | sp->rx_mode = -1; /* Invalid -> always reset the mode. */ |
| 1025 | set_rx_mode(dev); |
| 1026 | if ((sp->phy[0] & 0x8000) == 0) |
| 1027 | sp->mii_if.advertising = mdio_read(dev, sp->phy[0] & 0x1f, MII_ADVERTISE); |
| 1028 | |
| 1029 | mii_check_link(&sp->mii_if); |
| 1030 | |
| 1031 | if (netif_msg_ifup(sp)) { |
| 1032 | printk(KERN_DEBUG "%s: Done speedo_open(), status %8.8x.\n", |
| 1033 | dev->name, ioread16(ioaddr + SCBStatus)); |
| 1034 | } |
| 1035 | |
| 1036 | /* Set the timer. The timer serves a dual purpose: |
| 1037 | 1) to monitor the media interface (e.g. link beat) and perhaps switch |
| 1038 | to an alternate media type |
| 1039 | 2) to monitor Rx activity, and restart the Rx process if the receiver |
| 1040 | hangs. */ |
| 1041 | sp->timer.expires = RUN_AT((24*HZ)/10); /* 2.4 sec. */ |
| 1042 | sp->timer.data = (unsigned long)dev; |
| 1043 | sp->timer.function = &speedo_timer; /* timer handler */ |
| 1044 | add_timer(&sp->timer); |
| 1045 | |
| 1046 | /* No need to wait for the command unit to accept here. */ |
| 1047 | if ((sp->phy[0] & 0x8000) == 0) |
| 1048 | mdio_read(dev, sp->phy[0] & 0x1f, MII_BMCR); |
| 1049 | |
| 1050 | return 0; |
| 1051 | } |
| 1052 | |
| 1053 | /* Start the chip hardware after a full reset. */ |
| 1054 | static void speedo_resume(struct net_device *dev) |
| 1055 | { |
| 1056 | struct speedo_private *sp = netdev_priv(dev); |
| 1057 | void __iomem *ioaddr = sp->regs; |
| 1058 | |
| 1059 | /* Start with a Tx threshold of 256 (0x..20.... 8 byte units). */ |
| 1060 | sp->tx_threshold = 0x01208000; |
| 1061 | |
| 1062 | /* Set the segment registers to '0'. */ |
| 1063 | if (wait_for_cmd_done(dev, sp) != 0) { |
| 1064 | iowrite32(PortPartialReset, ioaddr + SCBPort); |
| 1065 | udelay(10); |
| 1066 | } |
| 1067 | |
| 1068 | iowrite32(0, ioaddr + SCBPointer); |
| 1069 | ioread32(ioaddr + SCBPointer); /* Flush to PCI. */ |
| 1070 | udelay(10); /* Bogus, but it avoids the bug. */ |
| 1071 | |
| 1072 | /* Note: these next two operations can take a while. */ |
| 1073 | do_slow_command(dev, sp, RxAddrLoad); |
| 1074 | do_slow_command(dev, sp, CUCmdBase); |
| 1075 | |
| 1076 | /* Load the statistics block and rx ring addresses. */ |
| 1077 | iowrite32(sp->lstats_dma, ioaddr + SCBPointer); |
| 1078 | ioread32(ioaddr + SCBPointer); /* Flush to PCI */ |
| 1079 | |
| 1080 | iowrite8(CUStatsAddr, ioaddr + SCBCmd); |
| 1081 | sp->lstats->done_marker = 0; |
| 1082 | wait_for_cmd_done(dev, sp); |
| 1083 | |
| 1084 | if (sp->rx_ringp[sp->cur_rx % RX_RING_SIZE] == NULL) { |
| 1085 | if (netif_msg_rx_err(sp)) |
| 1086 | printk(KERN_DEBUG "%s: NULL cur_rx in speedo_resume().\n", |
| 1087 | dev->name); |
| 1088 | } else { |
| 1089 | iowrite32(sp->rx_ring_dma[sp->cur_rx % RX_RING_SIZE], |
| 1090 | ioaddr + SCBPointer); |
| 1091 | ioread32(ioaddr + SCBPointer); /* Flush to PCI */ |
| 1092 | } |
| 1093 | |
| 1094 | /* Note: RxStart should complete instantly. */ |
| 1095 | do_slow_command(dev, sp, RxStart); |
| 1096 | do_slow_command(dev, sp, CUDumpStats); |
| 1097 | |
| 1098 | /* Fill the first command with our physical address. */ |
| 1099 | { |
| 1100 | struct descriptor *ias_cmd; |
| 1101 | |
| 1102 | ias_cmd = |
| 1103 | (struct descriptor *)&sp->tx_ring[sp->cur_tx++ % TX_RING_SIZE]; |
| 1104 | /* Avoid a bug(?!) here by marking the command already completed. */ |
| 1105 | ias_cmd->cmd_status = cpu_to_le32((CmdSuspend | CmdIASetup) | 0xa000); |
| 1106 | ias_cmd->link = |
| 1107 | cpu_to_le32(TX_RING_ELEM_DMA(sp, sp->cur_tx % TX_RING_SIZE)); |
| 1108 | memcpy(ias_cmd->params, dev->dev_addr, 6); |
| 1109 | if (sp->last_cmd) |
| 1110 | clear_suspend(sp->last_cmd); |
| 1111 | sp->last_cmd = ias_cmd; |
| 1112 | } |
| 1113 | |
| 1114 | /* Start the chip's Tx process and unmask interrupts. */ |
| 1115 | iowrite32(TX_RING_ELEM_DMA(sp, sp->dirty_tx % TX_RING_SIZE), |
| 1116 | ioaddr + SCBPointer); |
| 1117 | /* We are not ACK-ing FCP and ER in the interrupt handler yet so they should |
| 1118 | remain masked --Dragan */ |
| 1119 | iowrite16(CUStart | SCBMaskEarlyRx | SCBMaskFlowCtl, ioaddr + SCBCmd); |
| 1120 | } |
| 1121 | |
| 1122 | /* |
| 1123 | * Sometimes the receiver stops making progress. This routine knows how to |
| 1124 | * get it going again, without losing packets or being otherwise nasty like |
| 1125 | * a chip reset would be. Previously the driver had a whole sequence |
| 1126 | * of if RxSuspended, if it's no buffers do one thing, if it's no resources, |
| 1127 | * do another, etc. But those things don't really matter. Separate logic |
| 1128 | * in the ISR provides for allocating buffers--the other half of operation |
| 1129 | * is just making sure the receiver is active. speedo_rx_soft_reset does that. |
| 1130 | * This problem with the old, more involved algorithm is shown up under |
| 1131 | * ping floods on the order of 60K packets/second on a 100Mbps fdx network. |
| 1132 | */ |
| 1133 | static void |
| 1134 | speedo_rx_soft_reset(struct net_device *dev) |
| 1135 | { |
| 1136 | struct speedo_private *sp = netdev_priv(dev); |
| 1137 | struct RxFD *rfd; |
| 1138 | void __iomem *ioaddr; |
| 1139 | |
| 1140 | ioaddr = sp->regs; |
| 1141 | if (wait_for_cmd_done(dev, sp) != 0) { |
| 1142 | printk("%s: previous command stalled\n", dev->name); |
| 1143 | return; |
| 1144 | } |
| 1145 | /* |
| 1146 | * Put the hardware into a known state. |
| 1147 | */ |
| 1148 | iowrite8(RxAbort, ioaddr + SCBCmd); |
| 1149 | |
| 1150 | rfd = sp->rx_ringp[sp->cur_rx % RX_RING_SIZE]; |
| 1151 | |
| 1152 | rfd->rx_buf_addr = 0xffffffff; |
| 1153 | |
| 1154 | if (wait_for_cmd_done(dev, sp) != 0) { |
| 1155 | printk("%s: RxAbort command stalled\n", dev->name); |
| 1156 | return; |
| 1157 | } |
| 1158 | iowrite32(sp->rx_ring_dma[sp->cur_rx % RX_RING_SIZE], |
| 1159 | ioaddr + SCBPointer); |
| 1160 | iowrite8(RxStart, ioaddr + SCBCmd); |
| 1161 | } |
| 1162 | |
| 1163 | |
| 1164 | /* Media monitoring and control. */ |
| 1165 | static void speedo_timer(unsigned long data) |
| 1166 | { |
| 1167 | struct net_device *dev = (struct net_device *)data; |
| 1168 | struct speedo_private *sp = netdev_priv(dev); |
| 1169 | void __iomem *ioaddr = sp->regs; |
| 1170 | int phy_num = sp->phy[0] & 0x1f; |
| 1171 | |
| 1172 | /* We have MII and lost link beat. */ |
| 1173 | if ((sp->phy[0] & 0x8000) == 0) { |
| 1174 | int partner = mdio_read(dev, phy_num, MII_LPA); |
| 1175 | if (partner != sp->partner) { |
| 1176 | int flow_ctrl = sp->mii_if.advertising & partner & 0x0400 ? 1 : 0; |
| 1177 | if (netif_msg_link(sp)) { |
| 1178 | printk(KERN_DEBUG "%s: Link status change.\n", dev->name); |
| 1179 | printk(KERN_DEBUG "%s: Old partner %x, new %x, adv %x.\n", |
| 1180 | dev->name, sp->partner, partner, sp->mii_if.advertising); |
| 1181 | } |
| 1182 | sp->partner = partner; |
| 1183 | if (flow_ctrl != sp->flow_ctrl) { |
| 1184 | sp->flow_ctrl = flow_ctrl; |
| 1185 | sp->rx_mode = -1; /* Trigger a reload. */ |
| 1186 | } |
| 1187 | } |
| 1188 | } |
| 1189 | mii_check_link(&sp->mii_if); |
| 1190 | if (netif_msg_timer(sp)) { |
| 1191 | printk(KERN_DEBUG "%s: Media control tick, status %4.4x.\n", |
| 1192 | dev->name, ioread16(ioaddr + SCBStatus)); |
| 1193 | } |
| 1194 | if (sp->rx_mode < 0 || |
| 1195 | (sp->rx_bug && jiffies - sp->last_rx_time > 2*HZ)) { |
| 1196 | /* We haven't received a packet in a Long Time. We might have been |
| 1197 | bitten by the receiver hang bug. This can be cleared by sending |
| 1198 | a set multicast list command. */ |
| 1199 | if (netif_msg_timer(sp)) |
| 1200 | printk(KERN_DEBUG "%s: Sending a multicast list set command" |
| 1201 | " from a timer routine," |
| 1202 | " m=%d, j=%ld, l=%ld.\n", |
| 1203 | dev->name, sp->rx_mode, jiffies, sp->last_rx_time); |
| 1204 | set_rx_mode(dev); |
| 1205 | } |
| 1206 | /* We must continue to monitor the media. */ |
| 1207 | sp->timer.expires = RUN_AT(2*HZ); /* 2.0 sec. */ |
| 1208 | add_timer(&sp->timer); |
| 1209 | } |
| 1210 | |
| 1211 | static void speedo_show_state(struct net_device *dev) |
| 1212 | { |
| 1213 | struct speedo_private *sp = netdev_priv(dev); |
| 1214 | int i; |
| 1215 | |
| 1216 | if (netif_msg_pktdata(sp)) { |
| 1217 | printk(KERN_DEBUG "%s: Tx ring dump, Tx queue %u / %u:\n", |
| 1218 | dev->name, sp->cur_tx, sp->dirty_tx); |
| 1219 | for (i = 0; i < TX_RING_SIZE; i++) |
| 1220 | printk(KERN_DEBUG "%s: %c%c%2d %8.8x.\n", dev->name, |
| 1221 | i == sp->dirty_tx % TX_RING_SIZE ? '*' : ' ', |
| 1222 | i == sp->cur_tx % TX_RING_SIZE ? '=' : ' ', |
| 1223 | i, sp->tx_ring[i].status); |
| 1224 | |
| 1225 | printk(KERN_DEBUG "%s: Printing Rx ring" |
| 1226 | " (next to receive into %u, dirty index %u).\n", |
| 1227 | dev->name, sp->cur_rx, sp->dirty_rx); |
| 1228 | for (i = 0; i < RX_RING_SIZE; i++) |
| 1229 | printk(KERN_DEBUG "%s: %c%c%c%2d %8.8x.\n", dev->name, |
| 1230 | sp->rx_ringp[i] == sp->last_rxf ? 'l' : ' ', |
| 1231 | i == sp->dirty_rx % RX_RING_SIZE ? '*' : ' ', |
| 1232 | i == sp->cur_rx % RX_RING_SIZE ? '=' : ' ', |
| 1233 | i, (sp->rx_ringp[i] != NULL) ? |
| 1234 | (unsigned)sp->rx_ringp[i]->status : 0); |
| 1235 | } |
| 1236 | |
| 1237 | #if 0 |
| 1238 | { |
| 1239 | void __iomem *ioaddr = sp->regs; |
| 1240 | int phy_num = sp->phy[0] & 0x1f; |
| 1241 | for (i = 0; i < 16; i++) { |
| 1242 | /* FIXME: what does it mean? --SAW */ |
| 1243 | if (i == 6) i = 21; |
| 1244 | printk(KERN_DEBUG "%s: PHY index %d register %d is %4.4x.\n", |
| 1245 | dev->name, phy_num, i, mdio_read(dev, phy_num, i)); |
| 1246 | } |
| 1247 | } |
| 1248 | #endif |
| 1249 | |
| 1250 | } |
| 1251 | |
| 1252 | /* Initialize the Rx and Tx rings, along with various 'dev' bits. */ |
| 1253 | static void |
| 1254 | speedo_init_rx_ring(struct net_device *dev) |
| 1255 | { |
| 1256 | struct speedo_private *sp = netdev_priv(dev); |
| 1257 | struct RxFD *rxf, *last_rxf = NULL; |
| 1258 | dma_addr_t last_rxf_dma = 0 /* to shut up the compiler */; |
| 1259 | int i; |
| 1260 | |
| 1261 | sp->cur_rx = 0; |
| 1262 | |
| 1263 | for (i = 0; i < RX_RING_SIZE; i++) { |
| 1264 | struct sk_buff *skb; |
| 1265 | skb = dev_alloc_skb(PKT_BUF_SZ + sizeof(struct RxFD)); |
Jeff Garzik | 9f7f009 | 2005-08-19 03:52:49 -0400 | [diff] [blame] | 1266 | if (skb) |
| 1267 | rx_align(skb); /* Align IP on 16 byte boundary */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1268 | sp->rx_skbuff[i] = skb; |
| 1269 | if (skb == NULL) |
| 1270 | break; /* OK. Just initially short of Rx bufs. */ |
| 1271 | skb->dev = dev; /* Mark as being used by this device. */ |
David S. Miller | 689be43 | 2005-06-28 15:25:31 -0700 | [diff] [blame] | 1272 | rxf = (struct RxFD *)skb->data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1273 | sp->rx_ringp[i] = rxf; |
| 1274 | sp->rx_ring_dma[i] = |
| 1275 | pci_map_single(sp->pdev, rxf, |
| 1276 | PKT_BUF_SZ + sizeof(struct RxFD), PCI_DMA_BIDIRECTIONAL); |
| 1277 | skb_reserve(skb, sizeof(struct RxFD)); |
| 1278 | if (last_rxf) { |
| 1279 | last_rxf->link = cpu_to_le32(sp->rx_ring_dma[i]); |
| 1280 | pci_dma_sync_single_for_device(sp->pdev, last_rxf_dma, |
| 1281 | sizeof(struct RxFD), PCI_DMA_TODEVICE); |
| 1282 | } |
| 1283 | last_rxf = rxf; |
| 1284 | last_rxf_dma = sp->rx_ring_dma[i]; |
| 1285 | rxf->status = cpu_to_le32(0x00000001); /* '1' is flag value only. */ |
| 1286 | rxf->link = 0; /* None yet. */ |
| 1287 | /* This field unused by i82557. */ |
| 1288 | rxf->rx_buf_addr = 0xffffffff; |
| 1289 | rxf->count = cpu_to_le32(PKT_BUF_SZ << 16); |
| 1290 | pci_dma_sync_single_for_device(sp->pdev, sp->rx_ring_dma[i], |
| 1291 | sizeof(struct RxFD), PCI_DMA_TODEVICE); |
| 1292 | } |
| 1293 | sp->dirty_rx = (unsigned int)(i - RX_RING_SIZE); |
| 1294 | /* Mark the last entry as end-of-list. */ |
| 1295 | last_rxf->status = cpu_to_le32(0xC0000002); /* '2' is flag value only. */ |
| 1296 | pci_dma_sync_single_for_device(sp->pdev, sp->rx_ring_dma[RX_RING_SIZE-1], |
| 1297 | sizeof(struct RxFD), PCI_DMA_TODEVICE); |
| 1298 | sp->last_rxf = last_rxf; |
| 1299 | sp->last_rxf_dma = last_rxf_dma; |
| 1300 | } |
| 1301 | |
| 1302 | static void speedo_purge_tx(struct net_device *dev) |
| 1303 | { |
| 1304 | struct speedo_private *sp = netdev_priv(dev); |
| 1305 | int entry; |
| 1306 | |
| 1307 | while ((int)(sp->cur_tx - sp->dirty_tx) > 0) { |
| 1308 | entry = sp->dirty_tx % TX_RING_SIZE; |
| 1309 | if (sp->tx_skbuff[entry]) { |
| 1310 | sp->stats.tx_errors++; |
| 1311 | pci_unmap_single(sp->pdev, |
| 1312 | le32_to_cpu(sp->tx_ring[entry].tx_buf_addr0), |
| 1313 | sp->tx_skbuff[entry]->len, PCI_DMA_TODEVICE); |
| 1314 | dev_kfree_skb_irq(sp->tx_skbuff[entry]); |
| 1315 | sp->tx_skbuff[entry] = NULL; |
| 1316 | } |
| 1317 | sp->dirty_tx++; |
| 1318 | } |
| 1319 | while (sp->mc_setup_head != NULL) { |
| 1320 | struct speedo_mc_block *t; |
| 1321 | if (netif_msg_tx_err(sp)) |
| 1322 | printk(KERN_DEBUG "%s: freeing mc frame.\n", dev->name); |
| 1323 | pci_unmap_single(sp->pdev, sp->mc_setup_head->frame_dma, |
| 1324 | sp->mc_setup_head->len, PCI_DMA_TODEVICE); |
| 1325 | t = sp->mc_setup_head->next; |
| 1326 | kfree(sp->mc_setup_head); |
| 1327 | sp->mc_setup_head = t; |
| 1328 | } |
| 1329 | sp->mc_setup_tail = NULL; |
| 1330 | sp->tx_full = 0; |
| 1331 | netif_wake_queue(dev); |
| 1332 | } |
| 1333 | |
| 1334 | static void reset_mii(struct net_device *dev) |
| 1335 | { |
| 1336 | struct speedo_private *sp = netdev_priv(dev); |
| 1337 | |
| 1338 | /* Reset the MII transceiver, suggested by Fred Young @ scalable.com. */ |
| 1339 | if ((sp->phy[0] & 0x8000) == 0) { |
| 1340 | int phy_addr = sp->phy[0] & 0x1f; |
| 1341 | int advertising = mdio_read(dev, phy_addr, MII_ADVERTISE); |
| 1342 | int mii_bmcr = mdio_read(dev, phy_addr, MII_BMCR); |
| 1343 | mdio_write(dev, phy_addr, MII_BMCR, 0x0400); |
| 1344 | mdio_write(dev, phy_addr, MII_BMSR, 0x0000); |
| 1345 | mdio_write(dev, phy_addr, MII_ADVERTISE, 0x0000); |
| 1346 | mdio_write(dev, phy_addr, MII_BMCR, 0x8000); |
| 1347 | #ifdef honor_default_port |
| 1348 | mdio_write(dev, phy_addr, MII_BMCR, mii_ctrl[dev->default_port & 7]); |
| 1349 | #else |
| 1350 | mdio_read(dev, phy_addr, MII_BMCR); |
| 1351 | mdio_write(dev, phy_addr, MII_BMCR, mii_bmcr); |
| 1352 | mdio_write(dev, phy_addr, MII_ADVERTISE, advertising); |
| 1353 | #endif |
| 1354 | } |
| 1355 | } |
| 1356 | |
| 1357 | static void speedo_tx_timeout(struct net_device *dev) |
| 1358 | { |
| 1359 | struct speedo_private *sp = netdev_priv(dev); |
| 1360 | void __iomem *ioaddr = sp->regs; |
| 1361 | int status = ioread16(ioaddr + SCBStatus); |
| 1362 | unsigned long flags; |
| 1363 | |
| 1364 | if (netif_msg_tx_err(sp)) { |
| 1365 | printk(KERN_WARNING "%s: Transmit timed out: status %4.4x " |
| 1366 | " %4.4x at %d/%d command %8.8x.\n", |
| 1367 | dev->name, status, ioread16(ioaddr + SCBCmd), |
| 1368 | sp->dirty_tx, sp->cur_tx, |
| 1369 | sp->tx_ring[sp->dirty_tx % TX_RING_SIZE].status); |
| 1370 | |
| 1371 | } |
| 1372 | speedo_show_state(dev); |
| 1373 | #if 0 |
| 1374 | if ((status & 0x00C0) != 0x0080 |
| 1375 | && (status & 0x003C) == 0x0010) { |
| 1376 | /* Only the command unit has stopped. */ |
| 1377 | printk(KERN_WARNING "%s: Trying to restart the transmitter...\n", |
| 1378 | dev->name); |
| 1379 | iowrite32(TX_RING_ELEM_DMA(sp, dirty_tx % TX_RING_SIZE]), |
| 1380 | ioaddr + SCBPointer); |
| 1381 | iowrite16(CUStart, ioaddr + SCBCmd); |
| 1382 | reset_mii(dev); |
| 1383 | } else { |
| 1384 | #else |
| 1385 | { |
| 1386 | #endif |
| 1387 | del_timer_sync(&sp->timer); |
| 1388 | /* Reset the Tx and Rx units. */ |
| 1389 | iowrite32(PortReset, ioaddr + SCBPort); |
| 1390 | /* We may get spurious interrupts here. But I don't think that they |
| 1391 | may do much harm. 1999/12/09 SAW */ |
| 1392 | udelay(10); |
| 1393 | /* Disable interrupts. */ |
| 1394 | iowrite16(SCBMaskAll, ioaddr + SCBCmd); |
| 1395 | synchronize_irq(dev->irq); |
| 1396 | speedo_tx_buffer_gc(dev); |
| 1397 | /* Free as much as possible. |
| 1398 | It helps to recover from a hang because of out-of-memory. |
| 1399 | It also simplifies speedo_resume() in case TX ring is full or |
| 1400 | close-to-be full. */ |
| 1401 | speedo_purge_tx(dev); |
| 1402 | speedo_refill_rx_buffers(dev, 1); |
| 1403 | spin_lock_irqsave(&sp->lock, flags); |
| 1404 | speedo_resume(dev); |
| 1405 | sp->rx_mode = -1; |
| 1406 | dev->trans_start = jiffies; |
| 1407 | spin_unlock_irqrestore(&sp->lock, flags); |
| 1408 | set_rx_mode(dev); /* it takes the spinlock itself --SAW */ |
| 1409 | /* Reset MII transceiver. Do it before starting the timer to serialize |
| 1410 | mdio_xxx operations. Yes, it's a paranoya :-) 2000/05/09 SAW */ |
| 1411 | reset_mii(dev); |
| 1412 | sp->timer.expires = RUN_AT(2*HZ); |
| 1413 | add_timer(&sp->timer); |
| 1414 | } |
| 1415 | return; |
| 1416 | } |
| 1417 | |
| 1418 | static int |
| 1419 | speedo_start_xmit(struct sk_buff *skb, struct net_device *dev) |
| 1420 | { |
| 1421 | struct speedo_private *sp = netdev_priv(dev); |
| 1422 | void __iomem *ioaddr = sp->regs; |
| 1423 | int entry; |
| 1424 | |
| 1425 | /* Prevent interrupts from changing the Tx ring from underneath us. */ |
| 1426 | unsigned long flags; |
| 1427 | |
| 1428 | spin_lock_irqsave(&sp->lock, flags); |
| 1429 | |
| 1430 | /* Check if there are enough space. */ |
| 1431 | if ((int)(sp->cur_tx - sp->dirty_tx) >= TX_QUEUE_LIMIT) { |
| 1432 | printk(KERN_ERR "%s: incorrect tbusy state, fixed.\n", dev->name); |
| 1433 | netif_stop_queue(dev); |
| 1434 | sp->tx_full = 1; |
| 1435 | spin_unlock_irqrestore(&sp->lock, flags); |
| 1436 | return 1; |
| 1437 | } |
| 1438 | |
| 1439 | /* Calculate the Tx descriptor entry. */ |
| 1440 | entry = sp->cur_tx++ % TX_RING_SIZE; |
| 1441 | |
| 1442 | sp->tx_skbuff[entry] = skb; |
| 1443 | sp->tx_ring[entry].status = |
| 1444 | cpu_to_le32(CmdSuspend | CmdTx | CmdTxFlex); |
| 1445 | if (!(entry & ((TX_RING_SIZE>>2)-1))) |
| 1446 | sp->tx_ring[entry].status |= cpu_to_le32(CmdIntr); |
| 1447 | sp->tx_ring[entry].link = |
| 1448 | cpu_to_le32(TX_RING_ELEM_DMA(sp, sp->cur_tx % TX_RING_SIZE)); |
| 1449 | sp->tx_ring[entry].tx_desc_addr = |
| 1450 | cpu_to_le32(TX_RING_ELEM_DMA(sp, entry) + TX_DESCR_BUF_OFFSET); |
| 1451 | /* The data region is always in one buffer descriptor. */ |
| 1452 | sp->tx_ring[entry].count = cpu_to_le32(sp->tx_threshold); |
| 1453 | sp->tx_ring[entry].tx_buf_addr0 = |
| 1454 | cpu_to_le32(pci_map_single(sp->pdev, skb->data, |
| 1455 | skb->len, PCI_DMA_TODEVICE)); |
| 1456 | sp->tx_ring[entry].tx_buf_size0 = cpu_to_le32(skb->len); |
| 1457 | |
| 1458 | /* workaround for hardware bug on 10 mbit half duplex */ |
| 1459 | |
| 1460 | if ((sp->partner == 0) && (sp->chip_id == 1)) { |
| 1461 | wait_for_cmd_done(dev, sp); |
| 1462 | iowrite8(0 , ioaddr + SCBCmd); |
| 1463 | udelay(1); |
| 1464 | } |
| 1465 | |
| 1466 | /* Trigger the command unit resume. */ |
| 1467 | wait_for_cmd_done(dev, sp); |
| 1468 | clear_suspend(sp->last_cmd); |
| 1469 | /* We want the time window between clearing suspend flag on the previous |
| 1470 | command and resuming CU to be as small as possible. |
| 1471 | Interrupts in between are very undesired. --SAW */ |
| 1472 | iowrite8(CUResume, ioaddr + SCBCmd); |
| 1473 | sp->last_cmd = (struct descriptor *)&sp->tx_ring[entry]; |
| 1474 | |
| 1475 | /* Leave room for set_rx_mode(). If there is no more space than reserved |
| 1476 | for multicast filter mark the ring as full. */ |
| 1477 | if ((int)(sp->cur_tx - sp->dirty_tx) >= TX_QUEUE_LIMIT) { |
| 1478 | netif_stop_queue(dev); |
| 1479 | sp->tx_full = 1; |
| 1480 | } |
| 1481 | |
| 1482 | spin_unlock_irqrestore(&sp->lock, flags); |
| 1483 | |
| 1484 | dev->trans_start = jiffies; |
| 1485 | |
| 1486 | return 0; |
| 1487 | } |
| 1488 | |
| 1489 | static void speedo_tx_buffer_gc(struct net_device *dev) |
| 1490 | { |
| 1491 | unsigned int dirty_tx; |
| 1492 | struct speedo_private *sp = netdev_priv(dev); |
| 1493 | |
| 1494 | dirty_tx = sp->dirty_tx; |
| 1495 | while ((int)(sp->cur_tx - dirty_tx) > 0) { |
| 1496 | int entry = dirty_tx % TX_RING_SIZE; |
| 1497 | int status = le32_to_cpu(sp->tx_ring[entry].status); |
| 1498 | |
| 1499 | if (netif_msg_tx_done(sp)) |
| 1500 | printk(KERN_DEBUG " scavenge candidate %d status %4.4x.\n", |
| 1501 | entry, status); |
| 1502 | if ((status & StatusComplete) == 0) |
| 1503 | break; /* It still hasn't been processed. */ |
| 1504 | if (status & TxUnderrun) |
| 1505 | if (sp->tx_threshold < 0x01e08000) { |
| 1506 | if (netif_msg_tx_err(sp)) |
| 1507 | printk(KERN_DEBUG "%s: TX underrun, threshold adjusted.\n", |
| 1508 | dev->name); |
| 1509 | sp->tx_threshold += 0x00040000; |
| 1510 | } |
| 1511 | /* Free the original skb. */ |
| 1512 | if (sp->tx_skbuff[entry]) { |
| 1513 | sp->stats.tx_packets++; /* Count only user packets. */ |
| 1514 | sp->stats.tx_bytes += sp->tx_skbuff[entry]->len; |
| 1515 | pci_unmap_single(sp->pdev, |
| 1516 | le32_to_cpu(sp->tx_ring[entry].tx_buf_addr0), |
| 1517 | sp->tx_skbuff[entry]->len, PCI_DMA_TODEVICE); |
| 1518 | dev_kfree_skb_irq(sp->tx_skbuff[entry]); |
| 1519 | sp->tx_skbuff[entry] = NULL; |
| 1520 | } |
| 1521 | dirty_tx++; |
| 1522 | } |
| 1523 | |
| 1524 | if (netif_msg_tx_err(sp) && (int)(sp->cur_tx - dirty_tx) > TX_RING_SIZE) { |
| 1525 | printk(KERN_ERR "out-of-sync dirty pointer, %d vs. %d," |
| 1526 | " full=%d.\n", |
| 1527 | dirty_tx, sp->cur_tx, sp->tx_full); |
| 1528 | dirty_tx += TX_RING_SIZE; |
| 1529 | } |
| 1530 | |
| 1531 | while (sp->mc_setup_head != NULL |
| 1532 | && (int)(dirty_tx - sp->mc_setup_head->tx - 1) > 0) { |
| 1533 | struct speedo_mc_block *t; |
| 1534 | if (netif_msg_tx_err(sp)) |
| 1535 | printk(KERN_DEBUG "%s: freeing mc frame.\n", dev->name); |
| 1536 | pci_unmap_single(sp->pdev, sp->mc_setup_head->frame_dma, |
| 1537 | sp->mc_setup_head->len, PCI_DMA_TODEVICE); |
| 1538 | t = sp->mc_setup_head->next; |
| 1539 | kfree(sp->mc_setup_head); |
| 1540 | sp->mc_setup_head = t; |
| 1541 | } |
| 1542 | if (sp->mc_setup_head == NULL) |
| 1543 | sp->mc_setup_tail = NULL; |
| 1544 | |
| 1545 | sp->dirty_tx = dirty_tx; |
| 1546 | } |
| 1547 | |
| 1548 | /* The interrupt handler does all of the Rx thread work and cleans up |
| 1549 | after the Tx thread. */ |
| 1550 | static irqreturn_t speedo_interrupt(int irq, void *dev_instance, struct pt_regs *regs) |
| 1551 | { |
| 1552 | struct net_device *dev = (struct net_device *)dev_instance; |
| 1553 | struct speedo_private *sp; |
| 1554 | void __iomem *ioaddr; |
| 1555 | long boguscnt = max_interrupt_work; |
| 1556 | unsigned short status; |
| 1557 | unsigned int handled = 0; |
| 1558 | |
| 1559 | sp = netdev_priv(dev); |
| 1560 | ioaddr = sp->regs; |
| 1561 | |
| 1562 | #ifndef final_version |
| 1563 | /* A lock to prevent simultaneous entry on SMP machines. */ |
| 1564 | if (test_and_set_bit(0, (void*)&sp->in_interrupt)) { |
| 1565 | printk(KERN_ERR"%s: SMP simultaneous entry of an interrupt handler.\n", |
| 1566 | dev->name); |
| 1567 | sp->in_interrupt = 0; /* Avoid halting machine. */ |
| 1568 | return IRQ_NONE; |
| 1569 | } |
| 1570 | #endif |
| 1571 | |
| 1572 | do { |
| 1573 | status = ioread16(ioaddr + SCBStatus); |
| 1574 | /* Acknowledge all of the current interrupt sources ASAP. */ |
| 1575 | /* Will change from 0xfc00 to 0xff00 when we start handling |
| 1576 | FCP and ER interrupts --Dragan */ |
| 1577 | iowrite16(status & 0xfc00, ioaddr + SCBStatus); |
| 1578 | |
| 1579 | if (netif_msg_intr(sp)) |
| 1580 | printk(KERN_DEBUG "%s: interrupt status=%#4.4x.\n", |
| 1581 | dev->name, status); |
| 1582 | |
| 1583 | if ((status & 0xfc00) == 0) |
| 1584 | break; |
| 1585 | handled = 1; |
| 1586 | |
| 1587 | |
| 1588 | if ((status & 0x5000) || /* Packet received, or Rx error. */ |
| 1589 | (sp->rx_ring_state&(RrNoMem|RrPostponed)) == RrPostponed) |
| 1590 | /* Need to gather the postponed packet. */ |
| 1591 | speedo_rx(dev); |
| 1592 | |
| 1593 | /* Always check if all rx buffers are allocated. --SAW */ |
| 1594 | speedo_refill_rx_buffers(dev, 0); |
| 1595 | |
| 1596 | spin_lock(&sp->lock); |
| 1597 | /* |
| 1598 | * The chip may have suspended reception for various reasons. |
| 1599 | * Check for that, and re-prime it should this be the case. |
| 1600 | */ |
| 1601 | switch ((status >> 2) & 0xf) { |
| 1602 | case 0: /* Idle */ |
| 1603 | break; |
| 1604 | case 1: /* Suspended */ |
| 1605 | case 2: /* No resources (RxFDs) */ |
| 1606 | case 9: /* Suspended with no more RBDs */ |
| 1607 | case 10: /* No resources due to no RBDs */ |
| 1608 | case 12: /* Ready with no RBDs */ |
| 1609 | speedo_rx_soft_reset(dev); |
| 1610 | break; |
| 1611 | case 3: case 5: case 6: case 7: case 8: |
| 1612 | case 11: case 13: case 14: case 15: |
| 1613 | /* these are all reserved values */ |
| 1614 | break; |
| 1615 | } |
| 1616 | |
| 1617 | |
| 1618 | /* User interrupt, Command/Tx unit interrupt or CU not active. */ |
| 1619 | if (status & 0xA400) { |
| 1620 | speedo_tx_buffer_gc(dev); |
| 1621 | if (sp->tx_full |
| 1622 | && (int)(sp->cur_tx - sp->dirty_tx) < TX_QUEUE_UNFULL) { |
| 1623 | /* The ring is no longer full. */ |
| 1624 | sp->tx_full = 0; |
| 1625 | netif_wake_queue(dev); /* Attention: under a spinlock. --SAW */ |
| 1626 | } |
| 1627 | } |
| 1628 | |
| 1629 | spin_unlock(&sp->lock); |
| 1630 | |
| 1631 | if (--boguscnt < 0) { |
| 1632 | printk(KERN_ERR "%s: Too much work at interrupt, status=0x%4.4x.\n", |
| 1633 | dev->name, status); |
| 1634 | /* Clear all interrupt sources. */ |
| 1635 | /* Will change from 0xfc00 to 0xff00 when we start handling |
| 1636 | FCP and ER interrupts --Dragan */ |
| 1637 | iowrite16(0xfc00, ioaddr + SCBStatus); |
| 1638 | break; |
| 1639 | } |
| 1640 | } while (1); |
| 1641 | |
| 1642 | if (netif_msg_intr(sp)) |
| 1643 | printk(KERN_DEBUG "%s: exiting interrupt, status=%#4.4x.\n", |
| 1644 | dev->name, ioread16(ioaddr + SCBStatus)); |
| 1645 | |
| 1646 | clear_bit(0, (void*)&sp->in_interrupt); |
| 1647 | return IRQ_RETVAL(handled); |
| 1648 | } |
| 1649 | |
| 1650 | static inline struct RxFD *speedo_rx_alloc(struct net_device *dev, int entry) |
| 1651 | { |
| 1652 | struct speedo_private *sp = netdev_priv(dev); |
| 1653 | struct RxFD *rxf; |
| 1654 | struct sk_buff *skb; |
| 1655 | /* Get a fresh skbuff to replace the consumed one. */ |
| 1656 | skb = dev_alloc_skb(PKT_BUF_SZ + sizeof(struct RxFD)); |
Jeff Garzik | 9f7f009 | 2005-08-19 03:52:49 -0400 | [diff] [blame] | 1657 | if (skb) |
| 1658 | rx_align(skb); /* Align IP on 16 byte boundary */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1659 | sp->rx_skbuff[entry] = skb; |
| 1660 | if (skb == NULL) { |
| 1661 | sp->rx_ringp[entry] = NULL; |
| 1662 | return NULL; |
| 1663 | } |
David S. Miller | 689be43 | 2005-06-28 15:25:31 -0700 | [diff] [blame] | 1664 | rxf = sp->rx_ringp[entry] = (struct RxFD *)skb->data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1665 | sp->rx_ring_dma[entry] = |
| 1666 | pci_map_single(sp->pdev, rxf, |
| 1667 | PKT_BUF_SZ + sizeof(struct RxFD), PCI_DMA_FROMDEVICE); |
| 1668 | skb->dev = dev; |
| 1669 | skb_reserve(skb, sizeof(struct RxFD)); |
| 1670 | rxf->rx_buf_addr = 0xffffffff; |
| 1671 | pci_dma_sync_single_for_device(sp->pdev, sp->rx_ring_dma[entry], |
| 1672 | sizeof(struct RxFD), PCI_DMA_TODEVICE); |
| 1673 | return rxf; |
| 1674 | } |
| 1675 | |
| 1676 | static inline void speedo_rx_link(struct net_device *dev, int entry, |
| 1677 | struct RxFD *rxf, dma_addr_t rxf_dma) |
| 1678 | { |
| 1679 | struct speedo_private *sp = netdev_priv(dev); |
| 1680 | rxf->status = cpu_to_le32(0xC0000001); /* '1' for driver use only. */ |
| 1681 | rxf->link = 0; /* None yet. */ |
| 1682 | rxf->count = cpu_to_le32(PKT_BUF_SZ << 16); |
| 1683 | sp->last_rxf->link = cpu_to_le32(rxf_dma); |
| 1684 | sp->last_rxf->status &= cpu_to_le32(~0xC0000000); |
| 1685 | pci_dma_sync_single_for_device(sp->pdev, sp->last_rxf_dma, |
| 1686 | sizeof(struct RxFD), PCI_DMA_TODEVICE); |
| 1687 | sp->last_rxf = rxf; |
| 1688 | sp->last_rxf_dma = rxf_dma; |
| 1689 | } |
| 1690 | |
| 1691 | static int speedo_refill_rx_buf(struct net_device *dev, int force) |
| 1692 | { |
| 1693 | struct speedo_private *sp = netdev_priv(dev); |
| 1694 | int entry; |
| 1695 | struct RxFD *rxf; |
| 1696 | |
| 1697 | entry = sp->dirty_rx % RX_RING_SIZE; |
| 1698 | if (sp->rx_skbuff[entry] == NULL) { |
| 1699 | rxf = speedo_rx_alloc(dev, entry); |
| 1700 | if (rxf == NULL) { |
| 1701 | unsigned int forw; |
| 1702 | int forw_entry; |
| 1703 | if (netif_msg_rx_err(sp) || !(sp->rx_ring_state & RrOOMReported)) { |
| 1704 | printk(KERN_WARNING "%s: can't fill rx buffer (force %d)!\n", |
| 1705 | dev->name, force); |
| 1706 | sp->rx_ring_state |= RrOOMReported; |
| 1707 | } |
| 1708 | speedo_show_state(dev); |
| 1709 | if (!force) |
| 1710 | return -1; /* Better luck next time! */ |
| 1711 | /* Borrow an skb from one of next entries. */ |
| 1712 | for (forw = sp->dirty_rx + 1; forw != sp->cur_rx; forw++) |
| 1713 | if (sp->rx_skbuff[forw % RX_RING_SIZE] != NULL) |
| 1714 | break; |
| 1715 | if (forw == sp->cur_rx) |
| 1716 | return -1; |
| 1717 | forw_entry = forw % RX_RING_SIZE; |
| 1718 | sp->rx_skbuff[entry] = sp->rx_skbuff[forw_entry]; |
| 1719 | sp->rx_skbuff[forw_entry] = NULL; |
| 1720 | rxf = sp->rx_ringp[forw_entry]; |
| 1721 | sp->rx_ringp[forw_entry] = NULL; |
| 1722 | sp->rx_ringp[entry] = rxf; |
| 1723 | } |
| 1724 | } else { |
| 1725 | rxf = sp->rx_ringp[entry]; |
| 1726 | } |
| 1727 | speedo_rx_link(dev, entry, rxf, sp->rx_ring_dma[entry]); |
| 1728 | sp->dirty_rx++; |
| 1729 | sp->rx_ring_state &= ~(RrNoMem|RrOOMReported); /* Mark the progress. */ |
| 1730 | return 0; |
| 1731 | } |
| 1732 | |
| 1733 | static void speedo_refill_rx_buffers(struct net_device *dev, int force) |
| 1734 | { |
| 1735 | struct speedo_private *sp = netdev_priv(dev); |
| 1736 | |
| 1737 | /* Refill the RX ring. */ |
| 1738 | while ((int)(sp->cur_rx - sp->dirty_rx) > 0 && |
| 1739 | speedo_refill_rx_buf(dev, force) != -1); |
| 1740 | } |
| 1741 | |
| 1742 | static int |
| 1743 | speedo_rx(struct net_device *dev) |
| 1744 | { |
| 1745 | struct speedo_private *sp = netdev_priv(dev); |
| 1746 | int entry = sp->cur_rx % RX_RING_SIZE; |
| 1747 | int rx_work_limit = sp->dirty_rx + RX_RING_SIZE - sp->cur_rx; |
| 1748 | int alloc_ok = 1; |
| 1749 | int npkts = 0; |
| 1750 | |
| 1751 | if (netif_msg_intr(sp)) |
| 1752 | printk(KERN_DEBUG " In speedo_rx().\n"); |
| 1753 | /* If we own the next entry, it's a new packet. Send it up. */ |
| 1754 | while (sp->rx_ringp[entry] != NULL) { |
| 1755 | int status; |
| 1756 | int pkt_len; |
| 1757 | |
| 1758 | pci_dma_sync_single_for_cpu(sp->pdev, sp->rx_ring_dma[entry], |
| 1759 | sizeof(struct RxFD), PCI_DMA_FROMDEVICE); |
| 1760 | status = le32_to_cpu(sp->rx_ringp[entry]->status); |
| 1761 | pkt_len = le32_to_cpu(sp->rx_ringp[entry]->count) & 0x3fff; |
| 1762 | |
| 1763 | if (!(status & RxComplete)) |
| 1764 | break; |
| 1765 | |
| 1766 | if (--rx_work_limit < 0) |
| 1767 | break; |
| 1768 | |
| 1769 | /* Check for a rare out-of-memory case: the current buffer is |
| 1770 | the last buffer allocated in the RX ring. --SAW */ |
| 1771 | if (sp->last_rxf == sp->rx_ringp[entry]) { |
| 1772 | /* Postpone the packet. It'll be reaped at an interrupt when this |
| 1773 | packet is no longer the last packet in the ring. */ |
| 1774 | if (netif_msg_rx_err(sp)) |
| 1775 | printk(KERN_DEBUG "%s: RX packet postponed!\n", |
| 1776 | dev->name); |
| 1777 | sp->rx_ring_state |= RrPostponed; |
| 1778 | break; |
| 1779 | } |
| 1780 | |
| 1781 | if (netif_msg_rx_status(sp)) |
| 1782 | printk(KERN_DEBUG " speedo_rx() status %8.8x len %d.\n", status, |
| 1783 | pkt_len); |
| 1784 | if ((status & (RxErrTooBig|RxOK|0x0f90)) != RxOK) { |
| 1785 | if (status & RxErrTooBig) |
| 1786 | printk(KERN_ERR "%s: Ethernet frame overran the Rx buffer, " |
| 1787 | "status %8.8x!\n", dev->name, status); |
| 1788 | else if (! (status & RxOK)) { |
| 1789 | /* There was a fatal error. This *should* be impossible. */ |
| 1790 | sp->stats.rx_errors++; |
| 1791 | printk(KERN_ERR "%s: Anomalous event in speedo_rx(), " |
| 1792 | "status %8.8x.\n", |
| 1793 | dev->name, status); |
| 1794 | } |
| 1795 | } else { |
| 1796 | struct sk_buff *skb; |
| 1797 | |
| 1798 | /* Check if the packet is long enough to just accept without |
| 1799 | copying to a properly sized skbuff. */ |
| 1800 | if (pkt_len < rx_copybreak |
| 1801 | && (skb = dev_alloc_skb(pkt_len + 2)) != 0) { |
| 1802 | skb->dev = dev; |
| 1803 | skb_reserve(skb, 2); /* Align IP on 16 byte boundaries */ |
| 1804 | /* 'skb_put()' points to the start of sk_buff data area. */ |
| 1805 | pci_dma_sync_single_for_cpu(sp->pdev, sp->rx_ring_dma[entry], |
| 1806 | sizeof(struct RxFD) + pkt_len, |
| 1807 | PCI_DMA_FROMDEVICE); |
| 1808 | |
| 1809 | #if 1 || USE_IP_CSUM |
| 1810 | /* Packet is in one chunk -- we can copy + cksum. */ |
David S. Miller | 689be43 | 2005-06-28 15:25:31 -0700 | [diff] [blame] | 1811 | eth_copy_and_sum(skb, sp->rx_skbuff[entry]->data, pkt_len, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1812 | skb_put(skb, pkt_len); |
| 1813 | #else |
David S. Miller | 689be43 | 2005-06-28 15:25:31 -0700 | [diff] [blame] | 1814 | memcpy(skb_put(skb, pkt_len), sp->rx_skbuff[entry]->data, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1815 | pkt_len); |
| 1816 | #endif |
| 1817 | pci_dma_sync_single_for_device(sp->pdev, sp->rx_ring_dma[entry], |
| 1818 | sizeof(struct RxFD) + pkt_len, |
| 1819 | PCI_DMA_FROMDEVICE); |
| 1820 | npkts++; |
| 1821 | } else { |
| 1822 | /* Pass up the already-filled skbuff. */ |
| 1823 | skb = sp->rx_skbuff[entry]; |
| 1824 | if (skb == NULL) { |
| 1825 | printk(KERN_ERR "%s: Inconsistent Rx descriptor chain.\n", |
| 1826 | dev->name); |
| 1827 | break; |
| 1828 | } |
| 1829 | sp->rx_skbuff[entry] = NULL; |
| 1830 | skb_put(skb, pkt_len); |
| 1831 | npkts++; |
| 1832 | sp->rx_ringp[entry] = NULL; |
| 1833 | pci_unmap_single(sp->pdev, sp->rx_ring_dma[entry], |
| 1834 | PKT_BUF_SZ + sizeof(struct RxFD), |
| 1835 | PCI_DMA_FROMDEVICE); |
| 1836 | } |
| 1837 | skb->protocol = eth_type_trans(skb, dev); |
| 1838 | netif_rx(skb); |
| 1839 | dev->last_rx = jiffies; |
| 1840 | sp->stats.rx_packets++; |
| 1841 | sp->stats.rx_bytes += pkt_len; |
| 1842 | } |
| 1843 | entry = (++sp->cur_rx) % RX_RING_SIZE; |
| 1844 | sp->rx_ring_state &= ~RrPostponed; |
| 1845 | /* Refill the recently taken buffers. |
| 1846 | Do it one-by-one to handle traffic bursts better. */ |
| 1847 | if (alloc_ok && speedo_refill_rx_buf(dev, 0) == -1) |
| 1848 | alloc_ok = 0; |
| 1849 | } |
| 1850 | |
| 1851 | /* Try hard to refill the recently taken buffers. */ |
| 1852 | speedo_refill_rx_buffers(dev, 1); |
| 1853 | |
| 1854 | if (npkts) |
| 1855 | sp->last_rx_time = jiffies; |
| 1856 | |
| 1857 | return 0; |
| 1858 | } |
| 1859 | |
| 1860 | static int |
| 1861 | speedo_close(struct net_device *dev) |
| 1862 | { |
| 1863 | struct speedo_private *sp = netdev_priv(dev); |
| 1864 | void __iomem *ioaddr = sp->regs; |
| 1865 | int i; |
| 1866 | |
| 1867 | netdevice_stop(dev); |
| 1868 | netif_stop_queue(dev); |
| 1869 | |
| 1870 | if (netif_msg_ifdown(sp)) |
| 1871 | printk(KERN_DEBUG "%s: Shutting down ethercard, status was %4.4x.\n", |
| 1872 | dev->name, ioread16(ioaddr + SCBStatus)); |
| 1873 | |
| 1874 | /* Shut off the media monitoring timer. */ |
| 1875 | del_timer_sync(&sp->timer); |
| 1876 | |
| 1877 | iowrite16(SCBMaskAll, ioaddr + SCBCmd); |
| 1878 | |
| 1879 | /* Shutting down the chip nicely fails to disable flow control. So.. */ |
| 1880 | iowrite32(PortPartialReset, ioaddr + SCBPort); |
| 1881 | ioread32(ioaddr + SCBPort); /* flush posted write */ |
| 1882 | /* |
| 1883 | * The chip requires a 10 microsecond quiet period. Wait here! |
| 1884 | */ |
| 1885 | udelay(10); |
| 1886 | |
| 1887 | free_irq(dev->irq, dev); |
| 1888 | speedo_show_state(dev); |
| 1889 | |
| 1890 | /* Free all the skbuffs in the Rx and Tx queues. */ |
| 1891 | for (i = 0; i < RX_RING_SIZE; i++) { |
| 1892 | struct sk_buff *skb = sp->rx_skbuff[i]; |
| 1893 | sp->rx_skbuff[i] = NULL; |
| 1894 | /* Clear the Rx descriptors. */ |
| 1895 | if (skb) { |
| 1896 | pci_unmap_single(sp->pdev, |
| 1897 | sp->rx_ring_dma[i], |
| 1898 | PKT_BUF_SZ + sizeof(struct RxFD), PCI_DMA_FROMDEVICE); |
| 1899 | dev_kfree_skb(skb); |
| 1900 | } |
| 1901 | } |
| 1902 | |
| 1903 | for (i = 0; i < TX_RING_SIZE; i++) { |
| 1904 | struct sk_buff *skb = sp->tx_skbuff[i]; |
| 1905 | sp->tx_skbuff[i] = NULL; |
| 1906 | /* Clear the Tx descriptors. */ |
| 1907 | if (skb) { |
| 1908 | pci_unmap_single(sp->pdev, |
| 1909 | le32_to_cpu(sp->tx_ring[i].tx_buf_addr0), |
| 1910 | skb->len, PCI_DMA_TODEVICE); |
| 1911 | dev_kfree_skb(skb); |
| 1912 | } |
| 1913 | } |
| 1914 | |
| 1915 | /* Free multicast setting blocks. */ |
| 1916 | for (i = 0; sp->mc_setup_head != NULL; i++) { |
| 1917 | struct speedo_mc_block *t; |
| 1918 | t = sp->mc_setup_head->next; |
| 1919 | kfree(sp->mc_setup_head); |
| 1920 | sp->mc_setup_head = t; |
| 1921 | } |
| 1922 | sp->mc_setup_tail = NULL; |
| 1923 | if (netif_msg_ifdown(sp)) |
| 1924 | printk(KERN_DEBUG "%s: %d multicast blocks dropped.\n", dev->name, i); |
| 1925 | |
| 1926 | pci_set_power_state(sp->pdev, PCI_D2); |
| 1927 | |
| 1928 | return 0; |
| 1929 | } |
| 1930 | |
| 1931 | /* The Speedo-3 has an especially awkward and unusable method of getting |
| 1932 | statistics out of the chip. It takes an unpredictable length of time |
| 1933 | for the dump-stats command to complete. To avoid a busy-wait loop we |
| 1934 | update the stats with the previous dump results, and then trigger a |
| 1935 | new dump. |
| 1936 | |
| 1937 | Oh, and incoming frames are dropped while executing dump-stats! |
| 1938 | */ |
| 1939 | static struct net_device_stats * |
| 1940 | speedo_get_stats(struct net_device *dev) |
| 1941 | { |
| 1942 | struct speedo_private *sp = netdev_priv(dev); |
| 1943 | void __iomem *ioaddr = sp->regs; |
| 1944 | |
| 1945 | /* Update only if the previous dump finished. */ |
| 1946 | if (sp->lstats->done_marker == le32_to_cpu(0xA007)) { |
| 1947 | sp->stats.tx_aborted_errors += le32_to_cpu(sp->lstats->tx_coll16_errs); |
| 1948 | sp->stats.tx_window_errors += le32_to_cpu(sp->lstats->tx_late_colls); |
| 1949 | sp->stats.tx_fifo_errors += le32_to_cpu(sp->lstats->tx_underruns); |
| 1950 | sp->stats.tx_fifo_errors += le32_to_cpu(sp->lstats->tx_lost_carrier); |
| 1951 | /*sp->stats.tx_deferred += le32_to_cpu(sp->lstats->tx_deferred);*/ |
| 1952 | sp->stats.collisions += le32_to_cpu(sp->lstats->tx_total_colls); |
| 1953 | sp->stats.rx_crc_errors += le32_to_cpu(sp->lstats->rx_crc_errs); |
| 1954 | sp->stats.rx_frame_errors += le32_to_cpu(sp->lstats->rx_align_errs); |
| 1955 | sp->stats.rx_over_errors += le32_to_cpu(sp->lstats->rx_resource_errs); |
| 1956 | sp->stats.rx_fifo_errors += le32_to_cpu(sp->lstats->rx_overrun_errs); |
| 1957 | sp->stats.rx_length_errors += le32_to_cpu(sp->lstats->rx_runt_errs); |
| 1958 | sp->lstats->done_marker = 0x0000; |
| 1959 | if (netif_running(dev)) { |
| 1960 | unsigned long flags; |
| 1961 | /* Take a spinlock to make wait_for_cmd_done and sending the |
| 1962 | command atomic. --SAW */ |
| 1963 | spin_lock_irqsave(&sp->lock, flags); |
| 1964 | wait_for_cmd_done(dev, sp); |
| 1965 | iowrite8(CUDumpStats, ioaddr + SCBCmd); |
| 1966 | spin_unlock_irqrestore(&sp->lock, flags); |
| 1967 | } |
| 1968 | } |
| 1969 | return &sp->stats; |
| 1970 | } |
| 1971 | |
| 1972 | static void speedo_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) |
| 1973 | { |
| 1974 | struct speedo_private *sp = netdev_priv(dev); |
| 1975 | strncpy(info->driver, "eepro100", sizeof(info->driver)-1); |
| 1976 | strncpy(info->version, version, sizeof(info->version)-1); |
| 1977 | if (sp->pdev) |
| 1978 | strcpy(info->bus_info, pci_name(sp->pdev)); |
| 1979 | } |
| 1980 | |
| 1981 | static int speedo_get_settings(struct net_device *dev, struct ethtool_cmd *ecmd) |
| 1982 | { |
| 1983 | struct speedo_private *sp = netdev_priv(dev); |
| 1984 | spin_lock_irq(&sp->lock); |
| 1985 | mii_ethtool_gset(&sp->mii_if, ecmd); |
| 1986 | spin_unlock_irq(&sp->lock); |
| 1987 | return 0; |
| 1988 | } |
| 1989 | |
| 1990 | static int speedo_set_settings(struct net_device *dev, struct ethtool_cmd *ecmd) |
| 1991 | { |
| 1992 | struct speedo_private *sp = netdev_priv(dev); |
| 1993 | int res; |
| 1994 | spin_lock_irq(&sp->lock); |
| 1995 | res = mii_ethtool_sset(&sp->mii_if, ecmd); |
| 1996 | spin_unlock_irq(&sp->lock); |
| 1997 | return res; |
| 1998 | } |
| 1999 | |
| 2000 | static int speedo_nway_reset(struct net_device *dev) |
| 2001 | { |
| 2002 | struct speedo_private *sp = netdev_priv(dev); |
| 2003 | return mii_nway_restart(&sp->mii_if); |
| 2004 | } |
| 2005 | |
| 2006 | static u32 speedo_get_link(struct net_device *dev) |
| 2007 | { |
| 2008 | struct speedo_private *sp = netdev_priv(dev); |
| 2009 | return mii_link_ok(&sp->mii_if); |
| 2010 | } |
| 2011 | |
| 2012 | static u32 speedo_get_msglevel(struct net_device *dev) |
| 2013 | { |
| 2014 | struct speedo_private *sp = netdev_priv(dev); |
| 2015 | return sp->msg_enable; |
| 2016 | } |
| 2017 | |
| 2018 | static void speedo_set_msglevel(struct net_device *dev, u32 v) |
| 2019 | { |
| 2020 | struct speedo_private *sp = netdev_priv(dev); |
| 2021 | sp->msg_enable = v; |
| 2022 | } |
| 2023 | |
| 2024 | static struct ethtool_ops ethtool_ops = { |
| 2025 | .get_drvinfo = speedo_get_drvinfo, |
| 2026 | .get_settings = speedo_get_settings, |
| 2027 | .set_settings = speedo_set_settings, |
| 2028 | .nway_reset = speedo_nway_reset, |
| 2029 | .get_link = speedo_get_link, |
| 2030 | .get_msglevel = speedo_get_msglevel, |
| 2031 | .set_msglevel = speedo_set_msglevel, |
| 2032 | }; |
| 2033 | |
| 2034 | static int speedo_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) |
| 2035 | { |
| 2036 | struct speedo_private *sp = netdev_priv(dev); |
| 2037 | struct mii_ioctl_data *data = if_mii(rq); |
| 2038 | int phy = sp->phy[0] & 0x1f; |
| 2039 | int saved_acpi; |
| 2040 | int t; |
| 2041 | |
| 2042 | switch(cmd) { |
| 2043 | case SIOCGMIIPHY: /* Get address of MII PHY in use. */ |
| 2044 | data->phy_id = phy; |
| 2045 | |
| 2046 | case SIOCGMIIREG: /* Read MII PHY register. */ |
| 2047 | /* FIXME: these operations need to be serialized with MDIO |
| 2048 | access from the timeout handler. |
| 2049 | They are currently serialized only with MDIO access from the |
| 2050 | timer routine. 2000/05/09 SAW */ |
| 2051 | saved_acpi = pci_set_power_state(sp->pdev, PCI_D0); |
| 2052 | t = del_timer_sync(&sp->timer); |
| 2053 | data->val_out = mdio_read(dev, data->phy_id & 0x1f, data->reg_num & 0x1f); |
| 2054 | if (t) |
| 2055 | add_timer(&sp->timer); /* may be set to the past --SAW */ |
| 2056 | pci_set_power_state(sp->pdev, saved_acpi); |
| 2057 | return 0; |
| 2058 | |
| 2059 | case SIOCSMIIREG: /* Write MII PHY register. */ |
| 2060 | if (!capable(CAP_NET_ADMIN)) |
| 2061 | return -EPERM; |
| 2062 | saved_acpi = pci_set_power_state(sp->pdev, PCI_D0); |
| 2063 | t = del_timer_sync(&sp->timer); |
| 2064 | mdio_write(dev, data->phy_id, data->reg_num, data->val_in); |
| 2065 | if (t) |
| 2066 | add_timer(&sp->timer); /* may be set to the past --SAW */ |
| 2067 | pci_set_power_state(sp->pdev, saved_acpi); |
| 2068 | return 0; |
| 2069 | default: |
| 2070 | return -EOPNOTSUPP; |
| 2071 | } |
| 2072 | } |
| 2073 | |
| 2074 | /* Set or clear the multicast filter for this adaptor. |
| 2075 | This is very ugly with Intel chips -- we usually have to execute an |
| 2076 | entire configuration command, plus process a multicast command. |
| 2077 | This is complicated. We must put a large configuration command and |
| 2078 | an arbitrarily-sized multicast command in the transmit list. |
| 2079 | To minimize the disruption -- the previous command might have already |
| 2080 | loaded the link -- we convert the current command block, normally a Tx |
| 2081 | command, into a no-op and link it to the new command. |
| 2082 | */ |
| 2083 | static void set_rx_mode(struct net_device *dev) |
| 2084 | { |
| 2085 | struct speedo_private *sp = netdev_priv(dev); |
| 2086 | void __iomem *ioaddr = sp->regs; |
| 2087 | struct descriptor *last_cmd; |
| 2088 | char new_rx_mode; |
| 2089 | unsigned long flags; |
| 2090 | int entry, i; |
| 2091 | |
| 2092 | if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */ |
| 2093 | new_rx_mode = 3; |
| 2094 | } else if ((dev->flags & IFF_ALLMULTI) || |
| 2095 | dev->mc_count > multicast_filter_limit) { |
| 2096 | new_rx_mode = 1; |
| 2097 | } else |
| 2098 | new_rx_mode = 0; |
| 2099 | |
| 2100 | if (netif_msg_rx_status(sp)) |
| 2101 | printk(KERN_DEBUG "%s: set_rx_mode %d -> %d\n", dev->name, |
| 2102 | sp->rx_mode, new_rx_mode); |
| 2103 | |
| 2104 | if ((int)(sp->cur_tx - sp->dirty_tx) > TX_RING_SIZE - TX_MULTICAST_SIZE) { |
| 2105 | /* The Tx ring is full -- don't add anything! Hope the mode will be |
| 2106 | * set again later. */ |
| 2107 | sp->rx_mode = -1; |
| 2108 | return; |
| 2109 | } |
| 2110 | |
| 2111 | if (new_rx_mode != sp->rx_mode) { |
| 2112 | u8 *config_cmd_data; |
| 2113 | |
| 2114 | spin_lock_irqsave(&sp->lock, flags); |
| 2115 | entry = sp->cur_tx++ % TX_RING_SIZE; |
| 2116 | last_cmd = sp->last_cmd; |
| 2117 | sp->last_cmd = (struct descriptor *)&sp->tx_ring[entry]; |
| 2118 | |
| 2119 | sp->tx_skbuff[entry] = NULL; /* Redundant. */ |
| 2120 | sp->tx_ring[entry].status = cpu_to_le32(CmdSuspend | CmdConfigure); |
| 2121 | sp->tx_ring[entry].link = |
| 2122 | cpu_to_le32(TX_RING_ELEM_DMA(sp, (entry + 1) % TX_RING_SIZE)); |
| 2123 | config_cmd_data = (void *)&sp->tx_ring[entry].tx_desc_addr; |
| 2124 | /* Construct a full CmdConfig frame. */ |
| 2125 | memcpy(config_cmd_data, i82558_config_cmd, CONFIG_DATA_SIZE); |
| 2126 | config_cmd_data[1] = (txfifo << 4) | rxfifo; |
| 2127 | config_cmd_data[4] = rxdmacount; |
| 2128 | config_cmd_data[5] = txdmacount + 0x80; |
| 2129 | config_cmd_data[15] |= (new_rx_mode & 2) ? 1 : 0; |
| 2130 | /* 0x80 doesn't disable FC 0x84 does. |
| 2131 | Disable Flow control since we are not ACK-ing any FC interrupts |
| 2132 | for now. --Dragan */ |
| 2133 | config_cmd_data[19] = 0x84; |
| 2134 | config_cmd_data[19] |= sp->mii_if.full_duplex ? 0x40 : 0; |
| 2135 | config_cmd_data[21] = (new_rx_mode & 1) ? 0x0D : 0x05; |
| 2136 | if (sp->phy[0] & 0x8000) { /* Use the AUI port instead. */ |
| 2137 | config_cmd_data[15] |= 0x80; |
| 2138 | config_cmd_data[8] = 0; |
| 2139 | } |
| 2140 | /* Trigger the command unit resume. */ |
| 2141 | wait_for_cmd_done(dev, sp); |
| 2142 | clear_suspend(last_cmd); |
| 2143 | iowrite8(CUResume, ioaddr + SCBCmd); |
| 2144 | if ((int)(sp->cur_tx - sp->dirty_tx) >= TX_QUEUE_LIMIT) { |
| 2145 | netif_stop_queue(dev); |
| 2146 | sp->tx_full = 1; |
| 2147 | } |
| 2148 | spin_unlock_irqrestore(&sp->lock, flags); |
| 2149 | } |
| 2150 | |
| 2151 | if (new_rx_mode == 0 && dev->mc_count < 4) { |
| 2152 | /* The simple case of 0-3 multicast list entries occurs often, and |
| 2153 | fits within one tx_ring[] entry. */ |
| 2154 | struct dev_mc_list *mclist; |
| 2155 | u16 *setup_params, *eaddrs; |
| 2156 | |
| 2157 | spin_lock_irqsave(&sp->lock, flags); |
| 2158 | entry = sp->cur_tx++ % TX_RING_SIZE; |
| 2159 | last_cmd = sp->last_cmd; |
| 2160 | sp->last_cmd = (struct descriptor *)&sp->tx_ring[entry]; |
| 2161 | |
| 2162 | sp->tx_skbuff[entry] = NULL; |
| 2163 | sp->tx_ring[entry].status = cpu_to_le32(CmdSuspend | CmdMulticastList); |
| 2164 | sp->tx_ring[entry].link = |
| 2165 | cpu_to_le32(TX_RING_ELEM_DMA(sp, (entry + 1) % TX_RING_SIZE)); |
| 2166 | sp->tx_ring[entry].tx_desc_addr = 0; /* Really MC list count. */ |
| 2167 | setup_params = (u16 *)&sp->tx_ring[entry].tx_desc_addr; |
| 2168 | *setup_params++ = cpu_to_le16(dev->mc_count*6); |
| 2169 | /* Fill in the multicast addresses. */ |
| 2170 | for (i = 0, mclist = dev->mc_list; i < dev->mc_count; |
| 2171 | i++, mclist = mclist->next) { |
| 2172 | eaddrs = (u16 *)mclist->dmi_addr; |
| 2173 | *setup_params++ = *eaddrs++; |
| 2174 | *setup_params++ = *eaddrs++; |
| 2175 | *setup_params++ = *eaddrs++; |
| 2176 | } |
| 2177 | |
| 2178 | wait_for_cmd_done(dev, sp); |
| 2179 | clear_suspend(last_cmd); |
| 2180 | /* Immediately trigger the command unit resume. */ |
| 2181 | iowrite8(CUResume, ioaddr + SCBCmd); |
| 2182 | |
| 2183 | if ((int)(sp->cur_tx - sp->dirty_tx) >= TX_QUEUE_LIMIT) { |
| 2184 | netif_stop_queue(dev); |
| 2185 | sp->tx_full = 1; |
| 2186 | } |
| 2187 | spin_unlock_irqrestore(&sp->lock, flags); |
| 2188 | } else if (new_rx_mode == 0) { |
| 2189 | struct dev_mc_list *mclist; |
| 2190 | u16 *setup_params, *eaddrs; |
| 2191 | struct speedo_mc_block *mc_blk; |
| 2192 | struct descriptor *mc_setup_frm; |
| 2193 | int i; |
| 2194 | |
| 2195 | mc_blk = kmalloc(sizeof(*mc_blk) + 2 + multicast_filter_limit*6, |
| 2196 | GFP_ATOMIC); |
| 2197 | if (mc_blk == NULL) { |
| 2198 | printk(KERN_ERR "%s: Failed to allocate a setup frame.\n", |
| 2199 | dev->name); |
| 2200 | sp->rx_mode = -1; /* We failed, try again. */ |
| 2201 | return; |
| 2202 | } |
| 2203 | mc_blk->next = NULL; |
| 2204 | mc_blk->len = 2 + multicast_filter_limit*6; |
| 2205 | mc_blk->frame_dma = |
| 2206 | pci_map_single(sp->pdev, &mc_blk->frame, mc_blk->len, |
| 2207 | PCI_DMA_TODEVICE); |
| 2208 | mc_setup_frm = &mc_blk->frame; |
| 2209 | |
| 2210 | /* Fill the setup frame. */ |
| 2211 | if (netif_msg_ifup(sp)) |
| 2212 | printk(KERN_DEBUG "%s: Constructing a setup frame at %p.\n", |
| 2213 | dev->name, mc_setup_frm); |
| 2214 | mc_setup_frm->cmd_status = |
| 2215 | cpu_to_le32(CmdSuspend | CmdIntr | CmdMulticastList); |
| 2216 | /* Link set below. */ |
| 2217 | setup_params = (u16 *)&mc_setup_frm->params; |
| 2218 | *setup_params++ = cpu_to_le16(dev->mc_count*6); |
| 2219 | /* Fill in the multicast addresses. */ |
| 2220 | for (i = 0, mclist = dev->mc_list; i < dev->mc_count; |
| 2221 | i++, mclist = mclist->next) { |
| 2222 | eaddrs = (u16 *)mclist->dmi_addr; |
| 2223 | *setup_params++ = *eaddrs++; |
| 2224 | *setup_params++ = *eaddrs++; |
| 2225 | *setup_params++ = *eaddrs++; |
| 2226 | } |
| 2227 | |
| 2228 | /* Disable interrupts while playing with the Tx Cmd list. */ |
| 2229 | spin_lock_irqsave(&sp->lock, flags); |
| 2230 | |
| 2231 | if (sp->mc_setup_tail) |
| 2232 | sp->mc_setup_tail->next = mc_blk; |
| 2233 | else |
| 2234 | sp->mc_setup_head = mc_blk; |
| 2235 | sp->mc_setup_tail = mc_blk; |
| 2236 | mc_blk->tx = sp->cur_tx; |
| 2237 | |
| 2238 | entry = sp->cur_tx++ % TX_RING_SIZE; |
| 2239 | last_cmd = sp->last_cmd; |
| 2240 | sp->last_cmd = mc_setup_frm; |
| 2241 | |
| 2242 | /* Change the command to a NoOp, pointing to the CmdMulti command. */ |
| 2243 | sp->tx_skbuff[entry] = NULL; |
| 2244 | sp->tx_ring[entry].status = cpu_to_le32(CmdNOp); |
| 2245 | sp->tx_ring[entry].link = cpu_to_le32(mc_blk->frame_dma); |
| 2246 | |
| 2247 | /* Set the link in the setup frame. */ |
| 2248 | mc_setup_frm->link = |
| 2249 | cpu_to_le32(TX_RING_ELEM_DMA(sp, (entry + 1) % TX_RING_SIZE)); |
| 2250 | |
| 2251 | pci_dma_sync_single_for_device(sp->pdev, mc_blk->frame_dma, |
| 2252 | mc_blk->len, PCI_DMA_TODEVICE); |
| 2253 | |
| 2254 | wait_for_cmd_done(dev, sp); |
| 2255 | clear_suspend(last_cmd); |
| 2256 | /* Immediately trigger the command unit resume. */ |
| 2257 | iowrite8(CUResume, ioaddr + SCBCmd); |
| 2258 | |
| 2259 | if ((int)(sp->cur_tx - sp->dirty_tx) >= TX_QUEUE_LIMIT) { |
| 2260 | netif_stop_queue(dev); |
| 2261 | sp->tx_full = 1; |
| 2262 | } |
| 2263 | spin_unlock_irqrestore(&sp->lock, flags); |
| 2264 | |
| 2265 | if (netif_msg_rx_status(sp)) |
| 2266 | printk(" CmdMCSetup frame length %d in entry %d.\n", |
| 2267 | dev->mc_count, entry); |
| 2268 | } |
| 2269 | |
| 2270 | sp->rx_mode = new_rx_mode; |
| 2271 | } |
| 2272 | |
| 2273 | #ifdef CONFIG_PM |
| 2274 | static int eepro100_suspend(struct pci_dev *pdev, pm_message_t state) |
| 2275 | { |
| 2276 | struct net_device *dev = pci_get_drvdata (pdev); |
| 2277 | struct speedo_private *sp = netdev_priv(dev); |
| 2278 | void __iomem *ioaddr = sp->regs; |
| 2279 | |
| 2280 | pci_save_state(pdev); |
| 2281 | |
| 2282 | if (!netif_running(dev)) |
| 2283 | return 0; |
| 2284 | |
| 2285 | del_timer_sync(&sp->timer); |
| 2286 | |
| 2287 | netif_device_detach(dev); |
| 2288 | iowrite32(PortPartialReset, ioaddr + SCBPort); |
| 2289 | |
| 2290 | /* XXX call pci_set_power_state ()? */ |
| 2291 | pci_disable_device(pdev); |
| 2292 | pci_set_power_state (pdev, PCI_D3hot); |
| 2293 | return 0; |
| 2294 | } |
| 2295 | |
| 2296 | static int eepro100_resume(struct pci_dev *pdev) |
| 2297 | { |
| 2298 | struct net_device *dev = pci_get_drvdata (pdev); |
| 2299 | struct speedo_private *sp = netdev_priv(dev); |
| 2300 | void __iomem *ioaddr = sp->regs; |
| 2301 | |
| 2302 | pci_set_power_state(pdev, PCI_D0); |
| 2303 | pci_restore_state(pdev); |
| 2304 | pci_enable_device(pdev); |
| 2305 | pci_set_master(pdev); |
| 2306 | |
| 2307 | if (!netif_running(dev)) |
| 2308 | return 0; |
| 2309 | |
| 2310 | /* I'm absolutely uncertain if this part of code may work. |
| 2311 | The problems are: |
| 2312 | - correct hardware reinitialization; |
| 2313 | - correct driver behavior between different steps of the |
| 2314 | reinitialization; |
| 2315 | - serialization with other driver calls. |
| 2316 | 2000/03/08 SAW */ |
| 2317 | iowrite16(SCBMaskAll, ioaddr + SCBCmd); |
| 2318 | speedo_resume(dev); |
| 2319 | netif_device_attach(dev); |
| 2320 | sp->rx_mode = -1; |
| 2321 | sp->flow_ctrl = sp->partner = 0; |
| 2322 | set_rx_mode(dev); |
| 2323 | sp->timer.expires = RUN_AT(2*HZ); |
| 2324 | add_timer(&sp->timer); |
| 2325 | return 0; |
| 2326 | } |
| 2327 | #endif /* CONFIG_PM */ |
| 2328 | |
| 2329 | static void __devexit eepro100_remove_one (struct pci_dev *pdev) |
| 2330 | { |
| 2331 | struct net_device *dev = pci_get_drvdata (pdev); |
| 2332 | struct speedo_private *sp = netdev_priv(dev); |
| 2333 | |
| 2334 | unregister_netdev(dev); |
| 2335 | |
| 2336 | release_region(pci_resource_start(pdev, 1), pci_resource_len(pdev, 1)); |
| 2337 | release_mem_region(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0)); |
| 2338 | |
| 2339 | pci_iounmap(pdev, sp->regs); |
| 2340 | pci_free_consistent(pdev, TX_RING_SIZE * sizeof(struct TxFD) |
| 2341 | + sizeof(struct speedo_stats), |
| 2342 | sp->tx_ring, sp->tx_ring_dma); |
| 2343 | pci_disable_device(pdev); |
| 2344 | free_netdev(dev); |
| 2345 | } |
| 2346 | |
| 2347 | static struct pci_device_id eepro100_pci_tbl[] = { |
| 2348 | { PCI_VENDOR_ID_INTEL, 0x1229, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2349 | { PCI_VENDOR_ID_INTEL, 0x1209, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2350 | { PCI_VENDOR_ID_INTEL, 0x1029, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2351 | { PCI_VENDOR_ID_INTEL, 0x1030, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2352 | { PCI_VENDOR_ID_INTEL, 0x1031, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2353 | { PCI_VENDOR_ID_INTEL, 0x1032, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2354 | { PCI_VENDOR_ID_INTEL, 0x1033, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2355 | { PCI_VENDOR_ID_INTEL, 0x1034, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2356 | { PCI_VENDOR_ID_INTEL, 0x1035, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2357 | { PCI_VENDOR_ID_INTEL, 0x1036, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2358 | { PCI_VENDOR_ID_INTEL, 0x1037, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2359 | { PCI_VENDOR_ID_INTEL, 0x1038, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2360 | { PCI_VENDOR_ID_INTEL, 0x1039, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2361 | { PCI_VENDOR_ID_INTEL, 0x103A, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2362 | { PCI_VENDOR_ID_INTEL, 0x103B, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2363 | { PCI_VENDOR_ID_INTEL, 0x103C, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2364 | { PCI_VENDOR_ID_INTEL, 0x103D, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2365 | { PCI_VENDOR_ID_INTEL, 0x103E, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2366 | { PCI_VENDOR_ID_INTEL, 0x1050, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2367 | { PCI_VENDOR_ID_INTEL, 0x1059, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2368 | { PCI_VENDOR_ID_INTEL, 0x1227, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2369 | { PCI_VENDOR_ID_INTEL, 0x2449, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2370 | { PCI_VENDOR_ID_INTEL, 0x2459, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2371 | { PCI_VENDOR_ID_INTEL, 0x245D, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2372 | { PCI_VENDOR_ID_INTEL, 0x5200, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2373 | { PCI_VENDOR_ID_INTEL, 0x5201, PCI_ANY_ID, PCI_ANY_ID, }, |
| 2374 | { 0,} |
| 2375 | }; |
| 2376 | MODULE_DEVICE_TABLE(pci, eepro100_pci_tbl); |
| 2377 | |
| 2378 | static struct pci_driver eepro100_driver = { |
| 2379 | .name = "eepro100", |
| 2380 | .id_table = eepro100_pci_tbl, |
| 2381 | .probe = eepro100_init_one, |
| 2382 | .remove = __devexit_p(eepro100_remove_one), |
| 2383 | #ifdef CONFIG_PM |
| 2384 | .suspend = eepro100_suspend, |
| 2385 | .resume = eepro100_resume, |
| 2386 | #endif /* CONFIG_PM */ |
| 2387 | }; |
| 2388 | |
| 2389 | static int __init eepro100_init_module(void) |
| 2390 | { |
| 2391 | #ifdef MODULE |
| 2392 | printk(version); |
| 2393 | #endif |
| 2394 | return pci_module_init(&eepro100_driver); |
| 2395 | } |
| 2396 | |
| 2397 | static void __exit eepro100_cleanup_module(void) |
| 2398 | { |
| 2399 | pci_unregister_driver(&eepro100_driver); |
| 2400 | } |
| 2401 | |
| 2402 | module_init(eepro100_init_module); |
| 2403 | module_exit(eepro100_cleanup_module); |
| 2404 | |
| 2405 | /* |
| 2406 | * Local variables: |
| 2407 | * 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`" |
| 2408 | * c-indent-level: 4 |
| 2409 | * c-basic-offset: 4 |
| 2410 | * tab-width: 4 |
| 2411 | * End: |
| 2412 | */ |