3196 lines · c
1// SPDX-License-Identifier: GPL-2.02/* Copyright(c) 1999 - 2006 Intel Corporation. */3 4/*5 * e100.c: Intel(R) PRO/100 ethernet driver6 *7 * (Re)written 2003 by scott.feldman@intel.com. Based loosely on8 * original e100 driver, but better described as a munging of9 * e100, e1000, eepro100, tg3, 8139cp, and other drivers.10 *11 * References:12 * Intel 8255x 10/100 Mbps Ethernet Controller Family,13 * Open Source Software Developers Manual,14 * http://sourceforge.net/projects/e100015 *16 *17 * Theory of Operation18 *19 * I. General20 *21 * The driver supports Intel(R) 10/100 Mbps PCI Fast Ethernet22 * controller family, which includes the 82557, 82558, 82559, 82550,23 * 82551, and 82562 devices. 82558 and greater controllers24 * integrate the Intel 82555 PHY. The controllers are used in25 * server and client network interface cards, as well as in26 * LAN-On-Motherboard (LOM), CardBus, MiniPCI, and ICHx27 * configurations. 8255x supports a 32-bit linear addressing28 * mode and operates at 33Mhz PCI clock rate.29 *30 * II. Driver Operation31 *32 * Memory-mapped mode is used exclusively to access the device's33 * shared-memory structure, the Control/Status Registers (CSR). All34 * setup, configuration, and control of the device, including queuing35 * of Tx, Rx, and configuration commands is through the CSR.36 * cmd_lock serializes accesses to the CSR command register. cb_lock37 * protects the shared Command Block List (CBL).38 *39 * 8255x is highly MII-compliant and all access to the PHY go40 * through the Management Data Interface (MDI). Consequently, the41 * driver leverages the mii.c library shared with other MII-compliant42 * devices.43 *44 * Big- and Little-Endian byte order as well as 32- and 64-bit45 * archs are supported. Weak-ordered memory and non-cache-coherent46 * archs are supported.47 *48 * III. Transmit49 *50 * A Tx skb is mapped and hangs off of a TCB. TCBs are linked51 * together in a fixed-size ring (CBL) thus forming the flexible mode52 * memory structure. A TCB marked with the suspend-bit indicates53 * the end of the ring. The last TCB processed suspends the54 * controller, and the controller can be restarted by issue a CU55 * resume command to continue from the suspend point, or a CU start56 * command to start at a given position in the ring.57 *58 * Non-Tx commands (config, multicast setup, etc) are linked59 * into the CBL ring along with Tx commands. The common structure60 * used for both Tx and non-Tx commands is the Command Block (CB).61 *62 * cb_to_use is the next CB to use for queuing a command; cb_to_clean63 * is the next CB to check for completion; cb_to_send is the first64 * CB to start on in case of a previous failure to resume. CB clean65 * up happens in interrupt context in response to a CU interrupt.66 * cbs_avail keeps track of number of free CB resources available.67 *68 * Hardware padding of short packets to minimum packet size is69 * enabled. 82557 pads with 7Eh, while the later controllers pad70 * with 00h.71 *72 * IV. Receive73 *74 * The Receive Frame Area (RFA) comprises a ring of Receive Frame75 * Descriptors (RFD) + data buffer, thus forming the simplified mode76 * memory structure. Rx skbs are allocated to contain both the RFD77 * and the data buffer, but the RFD is pulled off before the skb is78 * indicated. The data buffer is aligned such that encapsulated79 * protocol headers are u32-aligned. Since the RFD is part of the80 * mapped shared memory, and completion status is contained within81 * the RFD, the RFD must be dma_sync'ed to maintain a consistent82 * view from software and hardware.83 *84 * In order to keep updates to the RFD link field from colliding with85 * hardware writes to mark packets complete, we use the feature that86 * hardware will not write to a size 0 descriptor and mark the previous87 * packet as end-of-list (EL). After updating the link, we remove EL88 * and only then restore the size such that hardware may use the89 * previous-to-end RFD.90 *91 * Under typical operation, the receive unit (RU) is start once,92 * and the controller happily fills RFDs as frames arrive. If93 * replacement RFDs cannot be allocated, or the RU goes non-active,94 * the RU must be restarted. Frame arrival generates an interrupt,95 * and Rx indication and re-allocation happen in the same context,96 * therefore no locking is required. A software-generated interrupt97 * is generated from the watchdog to recover from a failed allocation98 * scenario where all Rx resources have been indicated and none re-99 * placed.100 *101 * V. Miscellaneous102 *103 * VLAN offloading of tagging, stripping and filtering is not104 * supported, but driver will accommodate the extra 4-byte VLAN tag105 * for processing by upper layers. Tx/Rx Checksum offloading is not106 * supported. Tx Scatter/Gather is not supported. Jumbo Frames is107 * not supported (hardware limitation).108 *109 * MagicPacket(tm) WoL support is enabled/disabled via ethtool.110 *111 * Thanks to JC (jchapman@katalix.com) for helping with112 * testing/troubleshooting the development driver.113 *114 * TODO:115 * o several entry points race with dev->close116 * o check for tx-no-resources/stop Q races with tx clean/wake Q117 *118 * FIXES:119 * 2005/12/02 - Michael O'Donnell <Michael.ODonnell at stratus dot com>120 * - Stratus87247: protect MDI control register manipulations121 * 2009/06/01 - Andreas Mohr <andi at lisas dot de>122 * - add clean lowlevel I/O emulation for cards with MII-lacking PHYs123 */124 125#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt126 127#include <linux/hardirq.h>128#include <linux/interrupt.h>129#include <linux/module.h>130#include <linux/moduleparam.h>131#include <linux/kernel.h>132#include <linux/types.h>133#include <linux/sched.h>134#include <linux/slab.h>135#include <linux/delay.h>136#include <linux/init.h>137#include <linux/pci.h>138#include <linux/dma-mapping.h>139#include <linux/dmapool.h>140#include <linux/netdevice.h>141#include <linux/etherdevice.h>142#include <linux/mii.h>143#include <linux/if_vlan.h>144#include <linux/skbuff.h>145#include <linux/ethtool.h>146#include <linux/string.h>147#include <linux/firmware.h>148#include <linux/rtnetlink.h>149#include <linux/unaligned.h>150 151 152#define DRV_NAME "e100"153#define DRV_DESCRIPTION "Intel(R) PRO/100 Network Driver"154#define DRV_COPYRIGHT "Copyright(c) 1999-2006 Intel Corporation"155 156#define E100_WATCHDOG_PERIOD (2 * HZ)157#define E100_NAPI_WEIGHT 16158 159#define FIRMWARE_D101M "e100/d101m_ucode.bin"160#define FIRMWARE_D101S "e100/d101s_ucode.bin"161#define FIRMWARE_D102E "e100/d102e_ucode.bin"162 163MODULE_DESCRIPTION(DRV_DESCRIPTION);164MODULE_LICENSE("GPL v2");165MODULE_FIRMWARE(FIRMWARE_D101M);166MODULE_FIRMWARE(FIRMWARE_D101S);167MODULE_FIRMWARE(FIRMWARE_D102E);168 169static int debug = 3;170static int eeprom_bad_csum_allow = 0;171static int use_io = 0;172module_param(debug, int, 0);173module_param(eeprom_bad_csum_allow, int, 0444);174module_param(use_io, int, 0444);175MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)");176MODULE_PARM_DESC(eeprom_bad_csum_allow, "Allow bad eeprom checksums");177MODULE_PARM_DESC(use_io, "Force use of i/o access mode");178 179#define INTEL_8255X_ETHERNET_DEVICE(device_id, ich) {\180 PCI_VENDOR_ID_INTEL, device_id, PCI_ANY_ID, PCI_ANY_ID, \181 PCI_CLASS_NETWORK_ETHERNET << 8, 0xFFFF00, ich }182static const struct pci_device_id e100_id_table[] = {183 INTEL_8255X_ETHERNET_DEVICE(0x1029, 0),184 INTEL_8255X_ETHERNET_DEVICE(0x1030, 0),185 INTEL_8255X_ETHERNET_DEVICE(0x1031, 3),186 INTEL_8255X_ETHERNET_DEVICE(0x1032, 3),187 INTEL_8255X_ETHERNET_DEVICE(0x1033, 3),188 INTEL_8255X_ETHERNET_DEVICE(0x1034, 3),189 INTEL_8255X_ETHERNET_DEVICE(0x1038, 3),190 INTEL_8255X_ETHERNET_DEVICE(0x1039, 4),191 INTEL_8255X_ETHERNET_DEVICE(0x103A, 4),192 INTEL_8255X_ETHERNET_DEVICE(0x103B, 4),193 INTEL_8255X_ETHERNET_DEVICE(0x103C, 4),194 INTEL_8255X_ETHERNET_DEVICE(0x103D, 4),195 INTEL_8255X_ETHERNET_DEVICE(0x103E, 4),196 INTEL_8255X_ETHERNET_DEVICE(0x1050, 5),197 INTEL_8255X_ETHERNET_DEVICE(0x1051, 5),198 INTEL_8255X_ETHERNET_DEVICE(0x1052, 5),199 INTEL_8255X_ETHERNET_DEVICE(0x1053, 5),200 INTEL_8255X_ETHERNET_DEVICE(0x1054, 5),201 INTEL_8255X_ETHERNET_DEVICE(0x1055, 5),202 INTEL_8255X_ETHERNET_DEVICE(0x1056, 5),203 INTEL_8255X_ETHERNET_DEVICE(0x1057, 5),204 INTEL_8255X_ETHERNET_DEVICE(0x1059, 0),205 INTEL_8255X_ETHERNET_DEVICE(0x1064, 6),206 INTEL_8255X_ETHERNET_DEVICE(0x1065, 6),207 INTEL_8255X_ETHERNET_DEVICE(0x1066, 6),208 INTEL_8255X_ETHERNET_DEVICE(0x1067, 6),209 INTEL_8255X_ETHERNET_DEVICE(0x1068, 6),210 INTEL_8255X_ETHERNET_DEVICE(0x1069, 6),211 INTEL_8255X_ETHERNET_DEVICE(0x106A, 6),212 INTEL_8255X_ETHERNET_DEVICE(0x106B, 6),213 INTEL_8255X_ETHERNET_DEVICE(0x1091, 7),214 INTEL_8255X_ETHERNET_DEVICE(0x1092, 7),215 INTEL_8255X_ETHERNET_DEVICE(0x1093, 7),216 INTEL_8255X_ETHERNET_DEVICE(0x1094, 7),217 INTEL_8255X_ETHERNET_DEVICE(0x1095, 7),218 INTEL_8255X_ETHERNET_DEVICE(0x10fe, 7),219 INTEL_8255X_ETHERNET_DEVICE(0x1209, 0),220 INTEL_8255X_ETHERNET_DEVICE(0x1229, 0),221 INTEL_8255X_ETHERNET_DEVICE(0x2449, 2),222 INTEL_8255X_ETHERNET_DEVICE(0x2459, 2),223 INTEL_8255X_ETHERNET_DEVICE(0x245D, 2),224 INTEL_8255X_ETHERNET_DEVICE(0x27DC, 7),225 { 0, }226};227MODULE_DEVICE_TABLE(pci, e100_id_table);228 229enum mac {230 mac_82557_D100_A = 0,231 mac_82557_D100_B = 1,232 mac_82557_D100_C = 2,233 mac_82558_D101_A4 = 4,234 mac_82558_D101_B0 = 5,235 mac_82559_D101M = 8,236 mac_82559_D101S = 9,237 mac_82550_D102 = 12,238 mac_82550_D102_C = 13,239 mac_82551_E = 14,240 mac_82551_F = 15,241 mac_82551_10 = 16,242 mac_unknown = 0xFF,243};244 245enum phy {246 phy_100a = 0x000003E0,247 phy_100c = 0x035002A8,248 phy_82555_tx = 0x015002A8,249 phy_nsc_tx = 0x5C002000,250 phy_82562_et = 0x033002A8,251 phy_82562_em = 0x032002A8,252 phy_82562_ek = 0x031002A8,253 phy_82562_eh = 0x017002A8,254 phy_82552_v = 0xd061004d,255 phy_unknown = 0xFFFFFFFF,256};257 258/* CSR (Control/Status Registers) */259struct csr {260 struct {261 u8 status;262 u8 stat_ack;263 u8 cmd_lo;264 u8 cmd_hi;265 u32 gen_ptr;266 } scb;267 u32 port;268 u16 flash_ctrl;269 u8 eeprom_ctrl_lo;270 u8 eeprom_ctrl_hi;271 u32 mdi_ctrl;272 u32 rx_dma_count;273};274 275enum scb_status {276 rus_no_res = 0x08,277 rus_ready = 0x10,278 rus_mask = 0x3C,279};280 281enum ru_state {282 RU_SUSPENDED = 0,283 RU_RUNNING = 1,284 RU_UNINITIALIZED = -1,285};286 287enum scb_stat_ack {288 stat_ack_not_ours = 0x00,289 stat_ack_sw_gen = 0x04,290 stat_ack_rnr = 0x10,291 stat_ack_cu_idle = 0x20,292 stat_ack_frame_rx = 0x40,293 stat_ack_cu_cmd_done = 0x80,294 stat_ack_not_present = 0xFF,295 stat_ack_rx = (stat_ack_sw_gen | stat_ack_rnr | stat_ack_frame_rx),296 stat_ack_tx = (stat_ack_cu_idle | stat_ack_cu_cmd_done),297};298 299enum scb_cmd_hi {300 irq_mask_none = 0x00,301 irq_mask_all = 0x01,302 irq_sw_gen = 0x02,303};304 305enum scb_cmd_lo {306 cuc_nop = 0x00,307 ruc_start = 0x01,308 ruc_load_base = 0x06,309 cuc_start = 0x10,310 cuc_resume = 0x20,311 cuc_dump_addr = 0x40,312 cuc_dump_stats = 0x50,313 cuc_load_base = 0x60,314 cuc_dump_reset = 0x70,315};316 317enum cuc_dump {318 cuc_dump_complete = 0x0000A005,319 cuc_dump_reset_complete = 0x0000A007,320};321 322enum port {323 software_reset = 0x0000,324 selftest = 0x0001,325 selective_reset = 0x0002,326};327 328enum eeprom_ctrl_lo {329 eesk = 0x01,330 eecs = 0x02,331 eedi = 0x04,332 eedo = 0x08,333};334 335enum mdi_ctrl {336 mdi_write = 0x04000000,337 mdi_read = 0x08000000,338 mdi_ready = 0x10000000,339};340 341enum eeprom_op {342 op_write = 0x05,343 op_read = 0x06,344 op_ewds = 0x10,345 op_ewen = 0x13,346};347 348enum eeprom_offsets {349 eeprom_cnfg_mdix = 0x03,350 eeprom_phy_iface = 0x06,351 eeprom_id = 0x0A,352 eeprom_config_asf = 0x0D,353 eeprom_smbus_addr = 0x90,354};355 356enum eeprom_cnfg_mdix {357 eeprom_mdix_enabled = 0x0080,358};359 360enum eeprom_phy_iface {361 NoSuchPhy = 0,362 I82553AB,363 I82553C,364 I82503,365 DP83840,366 S80C240,367 S80C24,368 I82555,369 DP83840A = 10,370};371 372enum eeprom_id {373 eeprom_id_wol = 0x0020,374};375 376enum eeprom_config_asf {377 eeprom_asf = 0x8000,378 eeprom_gcl = 0x4000,379};380 381enum cb_status {382 cb_complete = 0x8000,383 cb_ok = 0x2000,384};385 386/*387 * cb_command - Command Block flags388 * @cb_tx_nc: 0: controller does CRC (normal), 1: CRC from skb memory389 */390enum cb_command {391 cb_nop = 0x0000,392 cb_iaaddr = 0x0001,393 cb_config = 0x0002,394 cb_multi = 0x0003,395 cb_tx = 0x0004,396 cb_ucode = 0x0005,397 cb_dump = 0x0006,398 cb_tx_sf = 0x0008,399 cb_tx_nc = 0x0010,400 cb_cid = 0x1f00,401 cb_i = 0x2000,402 cb_s = 0x4000,403 cb_el = 0x8000,404};405 406struct rfd {407 __le16 status;408 __le16 command;409 __le32 link;410 __le32 rbd;411 __le16 actual_size;412 __le16 size;413};414 415struct rx {416 struct rx *next, *prev;417 struct sk_buff *skb;418 dma_addr_t dma_addr;419};420 421#if defined(__BIG_ENDIAN_BITFIELD)422#define X(a,b) b,a423#else424#define X(a,b) a,b425#endif426struct config {427/*0*/ u8 X(byte_count:6, pad0:2);428/*1*/ u8 X(X(rx_fifo_limit:4, tx_fifo_limit:3), pad1:1);429/*2*/ u8 adaptive_ifs;430/*3*/ u8 X(X(X(X(mwi_enable:1, type_enable:1), read_align_enable:1),431 term_write_cache_line:1), pad3:4);432/*4*/ u8 X(rx_dma_max_count:7, pad4:1);433/*5*/ u8 X(tx_dma_max_count:7, dma_max_count_enable:1);434/*6*/ u8 X(X(X(X(X(X(X(late_scb_update:1, direct_rx_dma:1),435 tno_intr:1), cna_intr:1), standard_tcb:1), standard_stat_counter:1),436 rx_save_overruns : 1), rx_save_bad_frames : 1);437/*7*/ u8 X(X(X(X(X(rx_discard_short_frames:1, tx_underrun_retry:2),438 pad7:2), rx_extended_rfd:1), tx_two_frames_in_fifo:1),439 tx_dynamic_tbd:1);440/*8*/ u8 X(X(mii_mode:1, pad8:6), csma_disabled:1);441/*9*/ u8 X(X(X(X(X(rx_tcpudp_checksum:1, pad9:3), vlan_arp_tco:1),442 link_status_wake:1), arp_wake:1), mcmatch_wake:1);443/*10*/ u8 X(X(X(pad10:3, no_source_addr_insertion:1), preamble_length:2),444 loopback:2);445/*11*/ u8 X(linear_priority:3, pad11:5);446/*12*/ u8 X(X(linear_priority_mode:1, pad12:3), ifs:4);447/*13*/ u8 ip_addr_lo;448/*14*/ u8 ip_addr_hi;449/*15*/ u8 X(X(X(X(X(X(X(promiscuous_mode:1, broadcast_disabled:1),450 wait_after_win:1), pad15_1:1), ignore_ul_bit:1), crc_16_bit:1),451 pad15_2:1), crs_or_cdt:1);452/*16*/ u8 fc_delay_lo;453/*17*/ u8 fc_delay_hi;454/*18*/ u8 X(X(X(X(X(rx_stripping:1, tx_padding:1), rx_crc_transfer:1),455 rx_long_ok:1), fc_priority_threshold:3), pad18:1);456/*19*/ u8 X(X(X(X(X(X(X(addr_wake:1, magic_packet_disable:1),457 fc_disable:1), fc_restop:1), fc_restart:1), fc_reject:1),458 full_duplex_force:1), full_duplex_pin:1);459/*20*/ u8 X(X(X(pad20_1:5, fc_priority_location:1), multi_ia:1), pad20_2:1);460/*21*/ u8 X(X(pad21_1:3, multicast_all:1), pad21_2:4);461/*22*/ u8 X(X(rx_d102_mode:1, rx_vlan_drop:1), pad22:6);462 u8 pad_d102[9];463};464 465#define E100_MAX_MULTICAST_ADDRS 64466struct multi {467 __le16 count;468 u8 addr[E100_MAX_MULTICAST_ADDRS * ETH_ALEN + 2/*pad*/];469};470 471/* Important: keep total struct u32-aligned */472#define UCODE_SIZE 134473struct cb {474 __le16 status;475 __le16 command;476 __le32 link;477 union {478 u8 iaaddr[ETH_ALEN];479 __le32 ucode[UCODE_SIZE];480 struct config config;481 struct multi multi;482 struct {483 u32 tbd_array;484 u16 tcb_byte_count;485 u8 threshold;486 u8 tbd_count;487 struct {488 __le32 buf_addr;489 __le16 size;490 u16 eol;491 } tbd;492 } tcb;493 __le32 dump_buffer_addr;494 } u;495 struct cb *next, *prev;496 dma_addr_t dma_addr;497 struct sk_buff *skb;498};499 500enum loopback {501 lb_none = 0, lb_mac = 1, lb_phy = 3,502};503 504struct stats {505 __le32 tx_good_frames, tx_max_collisions, tx_late_collisions,506 tx_underruns, tx_lost_crs, tx_deferred, tx_single_collisions,507 tx_multiple_collisions, tx_total_collisions;508 __le32 rx_good_frames, rx_crc_errors, rx_alignment_errors,509 rx_resource_errors, rx_overrun_errors, rx_cdt_errors,510 rx_short_frame_errors;511 __le32 fc_xmt_pause, fc_rcv_pause, fc_rcv_unsupported;512 __le16 xmt_tco_frames, rcv_tco_frames;513 __le32 complete;514};515 516struct mem {517 struct {518 u32 signature;519 u32 result;520 } selftest;521 struct stats stats;522 u8 dump_buf[596];523};524 525struct param_range {526 u32 min;527 u32 max;528 u32 count;529};530 531struct params {532 struct param_range rfds;533 struct param_range cbs;534};535 536struct nic {537 /* Begin: frequently used values: keep adjacent for cache effect */538 u32 msg_enable ____cacheline_aligned;539 struct net_device *netdev;540 struct pci_dev *pdev;541 u16 (*mdio_ctrl)(struct nic *nic, u32 addr, u32 dir, u32 reg, u16 data);542 543 struct rx *rxs ____cacheline_aligned;544 struct rx *rx_to_use;545 struct rx *rx_to_clean;546 struct rfd blank_rfd;547 enum ru_state ru_running;548 549 spinlock_t cb_lock ____cacheline_aligned;550 spinlock_t cmd_lock;551 struct csr __iomem *csr;552 enum scb_cmd_lo cuc_cmd;553 unsigned int cbs_avail;554 struct napi_struct napi;555 struct cb *cbs;556 struct cb *cb_to_use;557 struct cb *cb_to_send;558 struct cb *cb_to_clean;559 __le16 tx_command;560 /* End: frequently used values: keep adjacent for cache effect */561 562 enum {563 ich = (1 << 0),564 promiscuous = (1 << 1),565 multicast_all = (1 << 2),566 wol_magic = (1 << 3),567 ich_10h_workaround = (1 << 4),568 } flags ____cacheline_aligned;569 570 enum mac mac;571 enum phy phy;572 struct params params;573 struct timer_list watchdog;574 struct mii_if_info mii;575 struct work_struct tx_timeout_task;576 enum loopback loopback;577 578 struct mem *mem;579 dma_addr_t dma_addr;580 581 struct dma_pool *cbs_pool;582 dma_addr_t cbs_dma_addr;583 u8 adaptive_ifs;584 u8 tx_threshold;585 u32 tx_frames;586 u32 tx_collisions;587 u32 tx_deferred;588 u32 tx_single_collisions;589 u32 tx_multiple_collisions;590 u32 tx_fc_pause;591 u32 tx_tco_frames;592 593 u32 rx_fc_pause;594 u32 rx_fc_unsupported;595 u32 rx_tco_frames;596 u32 rx_short_frame_errors;597 u32 rx_over_length_errors;598 599 u16 eeprom_wc;600 __le16 eeprom[256];601 spinlock_t mdio_lock;602 const struct firmware *fw;603};604 605static inline void e100_write_flush(struct nic *nic)606{607 /* Flush previous PCI writes through intermediate bridges608 * by doing a benign read */609 (void)ioread8(&nic->csr->scb.status);610}611 612static void e100_enable_irq(struct nic *nic)613{614 unsigned long flags;615 616 spin_lock_irqsave(&nic->cmd_lock, flags);617 iowrite8(irq_mask_none, &nic->csr->scb.cmd_hi);618 e100_write_flush(nic);619 spin_unlock_irqrestore(&nic->cmd_lock, flags);620}621 622static void e100_disable_irq(struct nic *nic)623{624 unsigned long flags;625 626 spin_lock_irqsave(&nic->cmd_lock, flags);627 iowrite8(irq_mask_all, &nic->csr->scb.cmd_hi);628 e100_write_flush(nic);629 spin_unlock_irqrestore(&nic->cmd_lock, flags);630}631 632static void e100_hw_reset(struct nic *nic)633{634 /* Put CU and RU into idle with a selective reset to get635 * device off of PCI bus */636 iowrite32(selective_reset, &nic->csr->port);637 e100_write_flush(nic); udelay(20);638 639 /* Now fully reset device */640 iowrite32(software_reset, &nic->csr->port);641 e100_write_flush(nic); udelay(20);642 643 /* Mask off our interrupt line - it's unmasked after reset */644 e100_disable_irq(nic);645}646 647static int e100_self_test(struct nic *nic)648{649 u32 dma_addr = nic->dma_addr + offsetof(struct mem, selftest);650 651 /* Passing the self-test is a pretty good indication652 * that the device can DMA to/from host memory */653 654 nic->mem->selftest.signature = 0;655 nic->mem->selftest.result = 0xFFFFFFFF;656 657 iowrite32(selftest | dma_addr, &nic->csr->port);658 e100_write_flush(nic);659 /* Wait 10 msec for self-test to complete */660 msleep(10);661 662 /* Interrupts are enabled after self-test */663 e100_disable_irq(nic);664 665 /* Check results of self-test */666 if (nic->mem->selftest.result != 0) {667 netif_err(nic, hw, nic->netdev,668 "Self-test failed: result=0x%08X\n",669 nic->mem->selftest.result);670 return -ETIMEDOUT;671 }672 if (nic->mem->selftest.signature == 0) {673 netif_err(nic, hw, nic->netdev, "Self-test failed: timed out\n");674 return -ETIMEDOUT;675 }676 677 return 0;678}679 680static void e100_eeprom_write(struct nic *nic, u16 addr_len, u16 addr, __le16 data)681{682 u32 cmd_addr_data[3];683 u8 ctrl;684 int i, j;685 686 /* Three cmds: write/erase enable, write data, write/erase disable */687 cmd_addr_data[0] = op_ewen << (addr_len - 2);688 cmd_addr_data[1] = (((op_write << addr_len) | addr) << 16) |689 le16_to_cpu(data);690 cmd_addr_data[2] = op_ewds << (addr_len - 2);691 692 /* Bit-bang cmds to write word to eeprom */693 for (j = 0; j < 3; j++) {694 695 /* Chip select */696 iowrite8(eecs | eesk, &nic->csr->eeprom_ctrl_lo);697 e100_write_flush(nic); udelay(4);698 699 for (i = 31; i >= 0; i--) {700 ctrl = (cmd_addr_data[j] & (1 << i)) ?701 eecs | eedi : eecs;702 iowrite8(ctrl, &nic->csr->eeprom_ctrl_lo);703 e100_write_flush(nic); udelay(4);704 705 iowrite8(ctrl | eesk, &nic->csr->eeprom_ctrl_lo);706 e100_write_flush(nic); udelay(4);707 }708 /* Wait 10 msec for cmd to complete */709 msleep(10);710 711 /* Chip deselect */712 iowrite8(0, &nic->csr->eeprom_ctrl_lo);713 e100_write_flush(nic); udelay(4);714 }715};716 717/* General technique stolen from the eepro100 driver - very clever */718static __le16 e100_eeprom_read(struct nic *nic, u16 *addr_len, u16 addr)719{720 u32 cmd_addr_data;721 u16 data = 0;722 u8 ctrl;723 int i;724 725 cmd_addr_data = ((op_read << *addr_len) | addr) << 16;726 727 /* Chip select */728 iowrite8(eecs | eesk, &nic->csr->eeprom_ctrl_lo);729 e100_write_flush(nic); udelay(4);730 731 /* Bit-bang to read word from eeprom */732 for (i = 31; i >= 0; i--) {733 ctrl = (cmd_addr_data & (1 << i)) ? eecs | eedi : eecs;734 iowrite8(ctrl, &nic->csr->eeprom_ctrl_lo);735 e100_write_flush(nic); udelay(4);736 737 iowrite8(ctrl | eesk, &nic->csr->eeprom_ctrl_lo);738 e100_write_flush(nic); udelay(4);739 740 /* Eeprom drives a dummy zero to EEDO after receiving741 * complete address. Use this to adjust addr_len. */742 ctrl = ioread8(&nic->csr->eeprom_ctrl_lo);743 if (!(ctrl & eedo) && i > 16) {744 *addr_len -= (i - 16);745 i = 17;746 }747 748 data = (data << 1) | (ctrl & eedo ? 1 : 0);749 }750 751 /* Chip deselect */752 iowrite8(0, &nic->csr->eeprom_ctrl_lo);753 e100_write_flush(nic); udelay(4);754 755 return cpu_to_le16(data);756};757 758/* Load entire EEPROM image into driver cache and validate checksum */759static int e100_eeprom_load(struct nic *nic)760{761 u16 addr, addr_len = 8, checksum = 0;762 763 /* Try reading with an 8-bit addr len to discover actual addr len */764 e100_eeprom_read(nic, &addr_len, 0);765 nic->eeprom_wc = 1 << addr_len;766 767 for (addr = 0; addr < nic->eeprom_wc; addr++) {768 nic->eeprom[addr] = e100_eeprom_read(nic, &addr_len, addr);769 if (addr < nic->eeprom_wc - 1)770 checksum += le16_to_cpu(nic->eeprom[addr]);771 }772 773 /* The checksum, stored in the last word, is calculated such that774 * the sum of words should be 0xBABA */775 if (cpu_to_le16(0xBABA - checksum) != nic->eeprom[nic->eeprom_wc - 1]) {776 netif_err(nic, probe, nic->netdev, "EEPROM corrupted\n");777 if (!eeprom_bad_csum_allow)778 return -EAGAIN;779 }780 781 return 0;782}783 784/* Save (portion of) driver EEPROM cache to device and update checksum */785static int e100_eeprom_save(struct nic *nic, u16 start, u16 count)786{787 u16 addr, addr_len = 8, checksum = 0;788 789 /* Try reading with an 8-bit addr len to discover actual addr len */790 e100_eeprom_read(nic, &addr_len, 0);791 nic->eeprom_wc = 1 << addr_len;792 793 if (start + count >= nic->eeprom_wc)794 return -EINVAL;795 796 for (addr = start; addr < start + count; addr++)797 e100_eeprom_write(nic, addr_len, addr, nic->eeprom[addr]);798 799 /* The checksum, stored in the last word, is calculated such that800 * the sum of words should be 0xBABA */801 for (addr = 0; addr < nic->eeprom_wc - 1; addr++)802 checksum += le16_to_cpu(nic->eeprom[addr]);803 nic->eeprom[nic->eeprom_wc - 1] = cpu_to_le16(0xBABA - checksum);804 e100_eeprom_write(nic, addr_len, nic->eeprom_wc - 1,805 nic->eeprom[nic->eeprom_wc - 1]);806 807 return 0;808}809 810#define E100_WAIT_SCB_TIMEOUT 20000 /* we might have to wait 100ms!!! */811#define E100_WAIT_SCB_FAST 20 /* delay like the old code */812static int e100_exec_cmd(struct nic *nic, u8 cmd, dma_addr_t dma_addr)813{814 unsigned long flags;815 unsigned int i;816 int err = 0;817 818 spin_lock_irqsave(&nic->cmd_lock, flags);819 820 /* Previous command is accepted when SCB clears */821 for (i = 0; i < E100_WAIT_SCB_TIMEOUT; i++) {822 if (likely(!ioread8(&nic->csr->scb.cmd_lo)))823 break;824 cpu_relax();825 if (unlikely(i > E100_WAIT_SCB_FAST))826 udelay(5);827 }828 if (unlikely(i == E100_WAIT_SCB_TIMEOUT)) {829 err = -EAGAIN;830 goto err_unlock;831 }832 833 if (unlikely(cmd != cuc_resume))834 iowrite32(dma_addr, &nic->csr->scb.gen_ptr);835 iowrite8(cmd, &nic->csr->scb.cmd_lo);836 837err_unlock:838 spin_unlock_irqrestore(&nic->cmd_lock, flags);839 840 return err;841}842 843static int e100_exec_cb(struct nic *nic, struct sk_buff *skb,844 int (*cb_prepare)(struct nic *, struct cb *, struct sk_buff *))845{846 struct cb *cb;847 unsigned long flags;848 int err;849 850 spin_lock_irqsave(&nic->cb_lock, flags);851 852 if (unlikely(!nic->cbs_avail)) {853 err = -ENOMEM;854 goto err_unlock;855 }856 857 cb = nic->cb_to_use;858 nic->cb_to_use = cb->next;859 nic->cbs_avail--;860 cb->skb = skb;861 862 err = cb_prepare(nic, cb, skb);863 if (err)864 goto err_unlock;865 866 if (unlikely(!nic->cbs_avail))867 err = -ENOSPC;868 869 870 /* Order is important otherwise we'll be in a race with h/w:871 * set S-bit in current first, then clear S-bit in previous. */872 cb->command |= cpu_to_le16(cb_s);873 dma_wmb();874 cb->prev->command &= cpu_to_le16(~cb_s);875 876 while (nic->cb_to_send != nic->cb_to_use) {877 if (unlikely(e100_exec_cmd(nic, nic->cuc_cmd,878 nic->cb_to_send->dma_addr))) {879 /* Ok, here's where things get sticky. It's880 * possible that we can't schedule the command881 * because the controller is too busy, so882 * let's just queue the command and try again883 * when another command is scheduled. */884 if (err == -ENOSPC) {885 //request a reset886 schedule_work(&nic->tx_timeout_task);887 }888 break;889 } else {890 nic->cuc_cmd = cuc_resume;891 nic->cb_to_send = nic->cb_to_send->next;892 }893 }894 895err_unlock:896 spin_unlock_irqrestore(&nic->cb_lock, flags);897 898 return err;899}900 901static int mdio_read(struct net_device *netdev, int addr, int reg)902{903 struct nic *nic = netdev_priv(netdev);904 return nic->mdio_ctrl(nic, addr, mdi_read, reg, 0);905}906 907static void mdio_write(struct net_device *netdev, int addr, int reg, int data)908{909 struct nic *nic = netdev_priv(netdev);910 911 nic->mdio_ctrl(nic, addr, mdi_write, reg, data);912}913 914/* the standard mdio_ctrl() function for usual MII-compliant hardware */915static u16 mdio_ctrl_hw(struct nic *nic, u32 addr, u32 dir, u32 reg, u16 data)916{917 u32 data_out = 0;918 unsigned int i;919 unsigned long flags;920 921 922 /*923 * Stratus87247: we shouldn't be writing the MDI control924 * register until the Ready bit shows True. Also, since925 * manipulation of the MDI control registers is a multi-step926 * procedure it should be done under lock.927 */928 spin_lock_irqsave(&nic->mdio_lock, flags);929 for (i = 100; i; --i) {930 if (ioread32(&nic->csr->mdi_ctrl) & mdi_ready)931 break;932 udelay(20);933 }934 if (unlikely(!i)) {935 netdev_err(nic->netdev, "e100.mdio_ctrl won't go Ready\n");936 spin_unlock_irqrestore(&nic->mdio_lock, flags);937 return 0; /* No way to indicate timeout error */938 }939 iowrite32((reg << 16) | (addr << 21) | dir | data, &nic->csr->mdi_ctrl);940 941 for (i = 0; i < 100; i++) {942 udelay(20);943 if ((data_out = ioread32(&nic->csr->mdi_ctrl)) & mdi_ready)944 break;945 }946 spin_unlock_irqrestore(&nic->mdio_lock, flags);947 netif_printk(nic, hw, KERN_DEBUG, nic->netdev,948 "%s:addr=%d, reg=%d, data_in=0x%04X, data_out=0x%04X\n",949 dir == mdi_read ? "READ" : "WRITE",950 addr, reg, data, data_out);951 return (u16)data_out;952}953 954/* slightly tweaked mdio_ctrl() function for phy_82552_v specifics */955static u16 mdio_ctrl_phy_82552_v(struct nic *nic,956 u32 addr,957 u32 dir,958 u32 reg,959 u16 data)960{961 if ((reg == MII_BMCR) && (dir == mdi_write)) {962 if (data & (BMCR_ANRESTART | BMCR_ANENABLE)) {963 u16 advert = mdio_read(nic->netdev, nic->mii.phy_id,964 MII_ADVERTISE);965 966 /*967 * Workaround Si issue where sometimes the part will not968 * autoneg to 100Mbps even when advertised.969 */970 if (advert & ADVERTISE_100FULL)971 data |= BMCR_SPEED100 | BMCR_FULLDPLX;972 else if (advert & ADVERTISE_100HALF)973 data |= BMCR_SPEED100;974 }975 }976 return mdio_ctrl_hw(nic, addr, dir, reg, data);977}978 979/* Fully software-emulated mdio_ctrl() function for cards without980 * MII-compliant PHYs.981 * For now, this is mainly geared towards 80c24 support; in case of further982 * requirements for other types (i82503, ...?) either extend this mechanism983 * or split it, whichever is cleaner.984 */985static u16 mdio_ctrl_phy_mii_emulated(struct nic *nic,986 u32 addr,987 u32 dir,988 u32 reg,989 u16 data)990{991 /* might need to allocate a netdev_priv'ed register array eventually992 * to be able to record state changes, but for now993 * some fully hardcoded register handling ought to be ok I guess. */994 995 if (dir == mdi_read) {996 switch (reg) {997 case MII_BMCR:998 /* Auto-negotiation, right? */999 return BMCR_ANENABLE |1000 BMCR_FULLDPLX;1001 case MII_BMSR:1002 return BMSR_LSTATUS /* for mii_link_ok() */ |1003 BMSR_ANEGCAPABLE |1004 BMSR_10FULL;1005 case MII_ADVERTISE:1006 /* 80c24 is a "combo card" PHY, right? */1007 return ADVERTISE_10HALF |1008 ADVERTISE_10FULL;1009 default:1010 netif_printk(nic, hw, KERN_DEBUG, nic->netdev,1011 "%s:addr=%d, reg=%d, data=0x%04X: unimplemented emulation!\n",1012 dir == mdi_read ? "READ" : "WRITE",1013 addr, reg, data);1014 return 0xFFFF;1015 }1016 } else {1017 switch (reg) {1018 default:1019 netif_printk(nic, hw, KERN_DEBUG, nic->netdev,1020 "%s:addr=%d, reg=%d, data=0x%04X: unimplemented emulation!\n",1021 dir == mdi_read ? "READ" : "WRITE",1022 addr, reg, data);1023 return 0xFFFF;1024 }1025 }1026}1027static inline int e100_phy_supports_mii(struct nic *nic)1028{1029 /* for now, just check it by comparing whether we1030 are using MII software emulation.1031 */1032 return (nic->mdio_ctrl != mdio_ctrl_phy_mii_emulated);1033}1034 1035static void e100_get_defaults(struct nic *nic)1036{1037 struct param_range rfds = { .min = 16, .max = 256, .count = 256 };1038 struct param_range cbs = { .min = 64, .max = 256, .count = 128 };1039 1040 /* MAC type is encoded as rev ID; exception: ICH is treated as 82559 */1041 nic->mac = (nic->flags & ich) ? mac_82559_D101M : nic->pdev->revision;1042 if (nic->mac == mac_unknown)1043 nic->mac = mac_82557_D100_A;1044 1045 nic->params.rfds = rfds;1046 nic->params.cbs = cbs;1047 1048 /* Quadwords to DMA into FIFO before starting frame transmit */1049 nic->tx_threshold = 0xE0;1050 1051 /* no interrupt for every tx completion, delay = 256us if not 557 */1052 nic->tx_command = cpu_to_le16(cb_tx | cb_tx_sf |1053 ((nic->mac >= mac_82558_D101_A4) ? cb_cid : cb_i));1054 1055 /* Template for a freshly allocated RFD */1056 nic->blank_rfd.command = 0;1057 nic->blank_rfd.rbd = cpu_to_le32(0xFFFFFFFF);1058 nic->blank_rfd.size = cpu_to_le16(VLAN_ETH_FRAME_LEN + ETH_FCS_LEN);1059 1060 /* MII setup */1061 nic->mii.phy_id_mask = 0x1F;1062 nic->mii.reg_num_mask = 0x1F;1063 nic->mii.dev = nic->netdev;1064 nic->mii.mdio_read = mdio_read;1065 nic->mii.mdio_write = mdio_write;1066}1067 1068static int e100_configure(struct nic *nic, struct cb *cb, struct sk_buff *skb)1069{1070 struct config *config = &cb->u.config;1071 u8 *c = (u8 *)config;1072 struct net_device *netdev = nic->netdev;1073 1074 cb->command = cpu_to_le16(cb_config);1075 1076 memset(config, 0, sizeof(struct config));1077 1078 config->byte_count = 0x16; /* bytes in this struct */1079 config->rx_fifo_limit = 0x8; /* bytes in FIFO before DMA */1080 config->direct_rx_dma = 0x1; /* reserved */1081 config->standard_tcb = 0x1; /* 1=standard, 0=extended */1082 config->standard_stat_counter = 0x1; /* 1=standard, 0=extended */1083 config->rx_discard_short_frames = 0x1; /* 1=discard, 0=pass */1084 config->tx_underrun_retry = 0x3; /* # of underrun retries */1085 if (e100_phy_supports_mii(nic))1086 config->mii_mode = 1; /* 1=MII mode, 0=i82503 mode */1087 config->pad10 = 0x6;1088 config->no_source_addr_insertion = 0x1; /* 1=no, 0=yes */1089 config->preamble_length = 0x2; /* 0=1, 1=3, 2=7, 3=15 bytes */1090 config->ifs = 0x6; /* x16 = inter frame spacing */1091 config->ip_addr_hi = 0xF2; /* ARP IP filter - not used */1092 config->pad15_1 = 0x1;1093 config->pad15_2 = 0x1;1094 config->crs_or_cdt = 0x0; /* 0=CRS only, 1=CRS or CDT */1095 config->fc_delay_hi = 0x40; /* time delay for fc frame */1096 config->tx_padding = 0x1; /* 1=pad short frames */1097 config->fc_priority_threshold = 0x7; /* 7=priority fc disabled */1098 config->pad18 = 0x1;1099 config->full_duplex_pin = 0x1; /* 1=examine FDX# pin */1100 config->pad20_1 = 0x1F;1101 config->fc_priority_location = 0x1; /* 1=byte#31, 0=byte#19 */1102 config->pad21_1 = 0x5;1103 1104 config->adaptive_ifs = nic->adaptive_ifs;1105 config->loopback = nic->loopback;1106 1107 if (nic->mii.force_media && nic->mii.full_duplex)1108 config->full_duplex_force = 0x1; /* 1=force, 0=auto */1109 1110 if (nic->flags & promiscuous || nic->loopback) {1111 config->rx_save_bad_frames = 0x1; /* 1=save, 0=discard */1112 config->rx_discard_short_frames = 0x0; /* 1=discard, 0=save */1113 config->promiscuous_mode = 0x1; /* 1=on, 0=off */1114 }1115 1116 if (unlikely(netdev->features & NETIF_F_RXFCS))1117 config->rx_crc_transfer = 0x1; /* 1=save, 0=discard */1118 1119 if (nic->flags & multicast_all)1120 config->multicast_all = 0x1; /* 1=accept, 0=no */1121 1122 /* disable WoL when up */1123 if (netif_running(nic->netdev) || !(nic->flags & wol_magic))1124 config->magic_packet_disable = 0x1; /* 1=off, 0=on */1125 1126 if (nic->mac >= mac_82558_D101_A4) {1127 config->fc_disable = 0x1; /* 1=Tx fc off, 0=Tx fc on */1128 config->mwi_enable = 0x1; /* 1=enable, 0=disable */1129 config->standard_tcb = 0x0; /* 1=standard, 0=extended */1130 config->rx_long_ok = 0x1; /* 1=VLANs ok, 0=standard */1131 if (nic->mac >= mac_82559_D101M) {1132 config->tno_intr = 0x1; /* TCO stats enable */1133 /* Enable TCO in extended config */1134 if (nic->mac >= mac_82551_10) {1135 config->byte_count = 0x20; /* extended bytes */1136 config->rx_d102_mode = 0x1; /* GMRC for TCO */1137 }1138 } else {1139 config->standard_stat_counter = 0x0;1140 }1141 }1142 1143 if (netdev->features & NETIF_F_RXALL) {1144 config->rx_save_overruns = 0x1; /* 1=save, 0=discard */1145 config->rx_save_bad_frames = 0x1; /* 1=save, 0=discard */1146 config->rx_discard_short_frames = 0x0; /* 1=discard, 0=save */1147 }1148 1149 netif_printk(nic, hw, KERN_DEBUG, nic->netdev, "[00-07]=%8ph\n",1150 c + 0);1151 netif_printk(nic, hw, KERN_DEBUG, nic->netdev, "[08-15]=%8ph\n",1152 c + 8);1153 netif_printk(nic, hw, KERN_DEBUG, nic->netdev, "[16-23]=%8ph\n",1154 c + 16);1155 return 0;1156}1157 1158/*************************************************************************1159* CPUSaver parameters1160*1161* All CPUSaver parameters are 16-bit literals that are part of a1162* "move immediate value" instruction. By changing the value of1163* the literal in the instruction before the code is loaded, the1164* driver can change the algorithm.1165*1166* INTDELAY - This loads the dead-man timer with its initial value.1167* When this timer expires the interrupt is asserted, and the1168* timer is reset each time a new packet is received. (see1169* BUNDLEMAX below to set the limit on number of chained packets)1170* The current default is 0x600 or 1536. Experiments show that1171* the value should probably stay within the 0x200 - 0x1000.1172*1173* BUNDLEMAX -1174* This sets the maximum number of frames that will be bundled. In1175* some situations, such as the TCP windowing algorithm, it may be1176* better to limit the growth of the bundle size than let it go as1177* high as it can, because that could cause too much added latency.1178* The default is six, because this is the number of packets in the1179* default TCP window size. A value of 1 would make CPUSaver indicate1180* an interrupt for every frame received. If you do not want to put1181* a limit on the bundle size, set this value to xFFFF.1182*1183* BUNDLESMALL -1184* This contains a bit-mask describing the minimum size frame that1185* will be bundled. The default masks the lower 7 bits, which means1186* that any frame less than 128 bytes in length will not be bundled,1187* but will instead immediately generate an interrupt. This does1188* not affect the current bundle in any way. Any frame that is 1281189* bytes or large will be bundled normally. This feature is meant1190* to provide immediate indication of ACK frames in a TCP environment.1191* Customers were seeing poor performance when a machine with CPUSaver1192* enabled was sending but not receiving. The delay introduced when1193* the ACKs were received was enough to reduce total throughput, because1194* the sender would sit idle until the ACK was finally seen.1195*1196* The current default is 0xFF80, which masks out the lower 7 bits.1197* This means that any frame which is x7F (127) bytes or smaller1198* will cause an immediate interrupt. Because this value must be a1199* bit mask, there are only a few valid values that can be used. To1200* turn this feature off, the driver can write the value xFFFF to the1201* lower word of this instruction (in the same way that the other1202* parameters are used). Likewise, a value of 0xF800 (2047) would1203* cause an interrupt to be generated for every frame, because all1204* standard Ethernet frames are <= 2047 bytes in length.1205*************************************************************************/1206 1207/* if you wish to disable the ucode functionality, while maintaining the1208 * workarounds it provides, set the following defines to:1209 * BUNDLESMALL 01210 * BUNDLEMAX 11211 * INTDELAY 11212 */1213#define BUNDLESMALL 11214#define BUNDLEMAX (u16)61215#define INTDELAY (u16)1536 /* 0x600 */1216 1217/* Initialize firmware */1218static const struct firmware *e100_request_firmware(struct nic *nic)1219{1220 const char *fw_name;1221 const struct firmware *fw = nic->fw;1222 u8 timer, bundle, min_size;1223 int err = 0;1224 bool required = false;1225 1226 /* do not load u-code for ICH devices */1227 if (nic->flags & ich)1228 return NULL;1229 1230 /* Search for ucode match against h/w revision1231 *1232 * Based on comments in the source code for the FreeBSD fxp1233 * driver, the FIRMWARE_D102E ucode includes both CPUSaver and1234 *1235 * "fixes for bugs in the B-step hardware (specifically, bugs1236 * with Inline Receive)."1237 *1238 * So we must fail if it cannot be loaded.1239 *1240 * The other microcode files are only required for the optional1241 * CPUSaver feature. Nice to have, but no reason to fail.1242 */1243 if (nic->mac == mac_82559_D101M) {1244 fw_name = FIRMWARE_D101M;1245 } else if (nic->mac == mac_82559_D101S) {1246 fw_name = FIRMWARE_D101S;1247 } else if (nic->mac == mac_82551_F || nic->mac == mac_82551_10) {1248 fw_name = FIRMWARE_D102E;1249 required = true;1250 } else { /* No ucode on other devices */1251 return NULL;1252 }1253 1254 /* If the firmware has not previously been loaded, request a pointer1255 * to it. If it was previously loaded, we are reinitializing the1256 * adapter, possibly in a resume from hibernate, in which case1257 * request_firmware() cannot be used.1258 */1259 if (!fw)1260 err = request_firmware(&fw, fw_name, &nic->pdev->dev);1261 1262 if (err) {1263 if (required) {1264 netif_err(nic, probe, nic->netdev,1265 "Failed to load firmware \"%s\": %d\n",1266 fw_name, err);1267 return ERR_PTR(err);1268 } else {1269 netif_info(nic, probe, nic->netdev,1270 "CPUSaver disabled. Needs \"%s\": %d\n",1271 fw_name, err);1272 return NULL;1273 }1274 }1275 1276 /* Firmware should be precisely UCODE_SIZE (words) plus three bytes1277 indicating the offsets for BUNDLESMALL, BUNDLEMAX, INTDELAY */1278 if (fw->size != UCODE_SIZE * 4 + 3) {1279 netif_err(nic, probe, nic->netdev,1280 "Firmware \"%s\" has wrong size %zu\n",1281 fw_name, fw->size);1282 release_firmware(fw);1283 return ERR_PTR(-EINVAL);1284 }1285 1286 /* Read timer, bundle and min_size from end of firmware blob */1287 timer = fw->data[UCODE_SIZE * 4];1288 bundle = fw->data[UCODE_SIZE * 4 + 1];1289 min_size = fw->data[UCODE_SIZE * 4 + 2];1290 1291 if (timer >= UCODE_SIZE || bundle >= UCODE_SIZE ||1292 min_size >= UCODE_SIZE) {1293 netif_err(nic, probe, nic->netdev,1294 "\"%s\" has bogus offset values (0x%x,0x%x,0x%x)\n",1295 fw_name, timer, bundle, min_size);1296 release_firmware(fw);1297 return ERR_PTR(-EINVAL);1298 }1299 1300 /* OK, firmware is validated and ready to use. Save a pointer1301 * to it in the nic */1302 nic->fw = fw;1303 return fw;1304}1305 1306static int e100_setup_ucode(struct nic *nic, struct cb *cb,1307 struct sk_buff *skb)1308{1309 const struct firmware *fw = (void *)skb;1310 u8 timer, bundle, min_size;1311 1312 /* It's not a real skb; we just abused the fact that e100_exec_cb1313 will pass it through to here... */1314 cb->skb = NULL;1315 1316 /* firmware is stored as little endian already */1317 memcpy(cb->u.ucode, fw->data, UCODE_SIZE * 4);1318 1319 /* Read timer, bundle and min_size from end of firmware blob */1320 timer = fw->data[UCODE_SIZE * 4];1321 bundle = fw->data[UCODE_SIZE * 4 + 1];1322 min_size = fw->data[UCODE_SIZE * 4 + 2];1323 1324 /* Insert user-tunable settings in cb->u.ucode */1325 cb->u.ucode[timer] &= cpu_to_le32(0xFFFF0000);1326 cb->u.ucode[timer] |= cpu_to_le32(INTDELAY);1327 cb->u.ucode[bundle] &= cpu_to_le32(0xFFFF0000);1328 cb->u.ucode[bundle] |= cpu_to_le32(BUNDLEMAX);1329 cb->u.ucode[min_size] &= cpu_to_le32(0xFFFF0000);1330 cb->u.ucode[min_size] |= cpu_to_le32((BUNDLESMALL) ? 0xFFFF : 0xFF80);1331 1332 cb->command = cpu_to_le16(cb_ucode | cb_el);1333 return 0;1334}1335 1336static inline int e100_load_ucode_wait(struct nic *nic)1337{1338 const struct firmware *fw;1339 int err = 0, counter = 50;1340 struct cb *cb = nic->cb_to_clean;1341 1342 fw = e100_request_firmware(nic);1343 /* If it's NULL, then no ucode is required */1344 if (IS_ERR_OR_NULL(fw))1345 return PTR_ERR_OR_ZERO(fw);1346 1347 if ((err = e100_exec_cb(nic, (void *)fw, e100_setup_ucode)))1348 netif_err(nic, probe, nic->netdev,1349 "ucode cmd failed with error %d\n", err);1350 1351 /* must restart cuc */1352 nic->cuc_cmd = cuc_start;1353 1354 /* wait for completion */1355 e100_write_flush(nic);1356 udelay(10);1357 1358 /* wait for possibly (ouch) 500ms */1359 while (!(cb->status & cpu_to_le16(cb_complete))) {1360 msleep(10);1361 if (!--counter) break;1362 }1363 1364 /* ack any interrupts, something could have been set */1365 iowrite8(~0, &nic->csr->scb.stat_ack);1366 1367 /* if the command failed, or is not OK, notify and return */1368 if (!counter || !(cb->status & cpu_to_le16(cb_ok))) {1369 netif_err(nic, probe, nic->netdev, "ucode load failed\n");1370 err = -EPERM;1371 }1372 1373 return err;1374}1375 1376static int e100_setup_iaaddr(struct nic *nic, struct cb *cb,1377 struct sk_buff *skb)1378{1379 cb->command = cpu_to_le16(cb_iaaddr);1380 memcpy(cb->u.iaaddr, nic->netdev->dev_addr, ETH_ALEN);1381 return 0;1382}1383 1384static int e100_dump(struct nic *nic, struct cb *cb, struct sk_buff *skb)1385{1386 cb->command = cpu_to_le16(cb_dump);1387 cb->u.dump_buffer_addr = cpu_to_le32(nic->dma_addr +1388 offsetof(struct mem, dump_buf));1389 return 0;1390}1391 1392static int e100_phy_check_without_mii(struct nic *nic)1393{1394 u8 phy_type;1395 int without_mii;1396 1397 phy_type = (le16_to_cpu(nic->eeprom[eeprom_phy_iface]) >> 8) & 0x0f;1398 1399 switch (phy_type) {1400 case NoSuchPhy: /* Non-MII PHY; UNTESTED! */1401 case I82503: /* Non-MII PHY; UNTESTED! */1402 case S80C24: /* Non-MII PHY; tested and working */1403 /* paragraph from the FreeBSD driver, "FXP_PHY_80C24":1404 * The Seeq 80c24 AutoDUPLEX(tm) Ethernet Interface Adapter1405 * doesn't have a programming interface of any sort. The1406 * media is sensed automatically based on how the link partner1407 * is configured. This is, in essence, manual configuration.1408 */1409 netif_info(nic, probe, nic->netdev,1410 "found MII-less i82503 or 80c24 or other PHY\n");1411 1412 nic->mdio_ctrl = mdio_ctrl_phy_mii_emulated;1413 nic->mii.phy_id = 0; /* is this ok for an MII-less PHY? */1414 1415 /* these might be needed for certain MII-less cards...1416 * nic->flags |= ich;1417 * nic->flags |= ich_10h_workaround; */1418 1419 without_mii = 1;1420 break;1421 default:1422 without_mii = 0;1423 break;1424 }1425 return without_mii;1426}1427 1428#define NCONFIG_AUTO_SWITCH 0x00801429#define MII_NSC_CONG MII_RESV11430#define NSC_CONG_ENABLE 0x01001431#define NSC_CONG_TXREADY 0x04001432static int e100_phy_init(struct nic *nic)1433{1434 struct net_device *netdev = nic->netdev;1435 u32 addr;1436 u16 bmcr, stat, id_lo, id_hi, cong;1437 1438 /* Discover phy addr by searching addrs in order {1,0,2,..., 31} */1439 for (addr = 0; addr < 32; addr++) {1440 nic->mii.phy_id = (addr == 0) ? 1 : (addr == 1) ? 0 : addr;1441 bmcr = mdio_read(netdev, nic->mii.phy_id, MII_BMCR);1442 stat = mdio_read(netdev, nic->mii.phy_id, MII_BMSR);1443 stat = mdio_read(netdev, nic->mii.phy_id, MII_BMSR);1444 if (!((bmcr == 0xFFFF) || ((stat == 0) && (bmcr == 0))))1445 break;1446 }1447 if (addr == 32) {1448 /* uhoh, no PHY detected: check whether we seem to be some1449 * weird, rare variant which is *known* to not have any MII.1450 * But do this AFTER MII checking only, since this does1451 * lookup of EEPROM values which may easily be unreliable. */1452 if (e100_phy_check_without_mii(nic))1453 return 0; /* simply return and hope for the best */1454 else {1455 /* for unknown cases log a fatal error */1456 netif_err(nic, hw, nic->netdev,1457 "Failed to locate any known PHY, aborting\n");1458 return -EAGAIN;1459 }1460 } else1461 netif_printk(nic, hw, KERN_DEBUG, nic->netdev,1462 "phy_addr = %d\n", nic->mii.phy_id);1463 1464 /* Get phy ID */1465 id_lo = mdio_read(netdev, nic->mii.phy_id, MII_PHYSID1);1466 id_hi = mdio_read(netdev, nic->mii.phy_id, MII_PHYSID2);1467 nic->phy = (u32)id_hi << 16 | (u32)id_lo;1468 netif_printk(nic, hw, KERN_DEBUG, nic->netdev,1469 "phy ID = 0x%08X\n", nic->phy);1470 1471 /* Select the phy and isolate the rest */1472 for (addr = 0; addr < 32; addr++) {1473 if (addr != nic->mii.phy_id) {1474 mdio_write(netdev, addr, MII_BMCR, BMCR_ISOLATE);1475 } else if (nic->phy != phy_82552_v) {1476 bmcr = mdio_read(netdev, addr, MII_BMCR);1477 mdio_write(netdev, addr, MII_BMCR,1478 bmcr & ~BMCR_ISOLATE);1479 }1480 }1481 /*1482 * Workaround for 82552:1483 * Clear the ISOLATE bit on selected phy_id last (mirrored on all1484 * other phy_id's) using bmcr value from addr discovery loop above.1485 */1486 if (nic->phy == phy_82552_v)1487 mdio_write(netdev, nic->mii.phy_id, MII_BMCR,1488 bmcr & ~BMCR_ISOLATE);1489 1490 /* Handle National tx phys */1491#define NCS_PHY_MODEL_MASK 0xFFF0FFFF1492 if ((nic->phy & NCS_PHY_MODEL_MASK) == phy_nsc_tx) {1493 /* Disable congestion control */1494 cong = mdio_read(netdev, nic->mii.phy_id, MII_NSC_CONG);1495 cong |= NSC_CONG_TXREADY;1496 cong &= ~NSC_CONG_ENABLE;1497 mdio_write(netdev, nic->mii.phy_id, MII_NSC_CONG, cong);1498 }1499 1500 if (nic->phy == phy_82552_v) {1501 u16 advert = mdio_read(netdev, nic->mii.phy_id, MII_ADVERTISE);1502 1503 /* assign special tweaked mdio_ctrl() function */1504 nic->mdio_ctrl = mdio_ctrl_phy_82552_v;1505 1506 /* Workaround Si not advertising flow-control during autoneg */1507 advert |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;1508 mdio_write(netdev, nic->mii.phy_id, MII_ADVERTISE, advert);1509 1510 /* Reset for the above changes to take effect */1511 bmcr = mdio_read(netdev, nic->mii.phy_id, MII_BMCR);1512 bmcr |= BMCR_RESET;1513 mdio_write(netdev, nic->mii.phy_id, MII_BMCR, bmcr);1514 } else if ((nic->mac >= mac_82550_D102) || ((nic->flags & ich) &&1515 (mdio_read(netdev, nic->mii.phy_id, MII_TPISTATUS) & 0x8000) &&1516 (le16_to_cpu(nic->eeprom[eeprom_cnfg_mdix]) & eeprom_mdix_enabled))) {1517 /* enable/disable MDI/MDI-X auto-switching. */1518 mdio_write(netdev, nic->mii.phy_id, MII_NCONFIG,1519 nic->mii.force_media ? 0 : NCONFIG_AUTO_SWITCH);1520 }1521 1522 return 0;1523}1524 1525static int e100_hw_init(struct nic *nic)1526{1527 int err = 0;1528 1529 e100_hw_reset(nic);1530 1531 netif_err(nic, hw, nic->netdev, "e100_hw_init\n");1532 if ((err = e100_self_test(nic)))1533 return err;1534 1535 if ((err = e100_phy_init(nic)))1536 return err;1537 if ((err = e100_exec_cmd(nic, cuc_load_base, 0)))1538 return err;1539 if ((err = e100_exec_cmd(nic, ruc_load_base, 0)))1540 return err;1541 if ((err = e100_load_ucode_wait(nic)))1542 return err;1543 if ((err = e100_exec_cb(nic, NULL, e100_configure)))1544 return err;1545 if ((err = e100_exec_cb(nic, NULL, e100_setup_iaaddr)))1546 return err;1547 if ((err = e100_exec_cmd(nic, cuc_dump_addr,1548 nic->dma_addr + offsetof(struct mem, stats))))1549 return err;1550 if ((err = e100_exec_cmd(nic, cuc_dump_reset, 0)))1551 return err;1552 1553 e100_disable_irq(nic);1554 1555 return 0;1556}1557 1558static int e100_multi(struct nic *nic, struct cb *cb, struct sk_buff *skb)1559{1560 struct net_device *netdev = nic->netdev;1561 struct netdev_hw_addr *ha;1562 u16 i, count = min(netdev_mc_count(netdev), E100_MAX_MULTICAST_ADDRS);1563 1564 cb->command = cpu_to_le16(cb_multi);1565 cb->u.multi.count = cpu_to_le16(count * ETH_ALEN);1566 i = 0;1567 netdev_for_each_mc_addr(ha, netdev) {1568 if (i == count)1569 break;1570 memcpy(&cb->u.multi.addr[i++ * ETH_ALEN], &ha->addr,1571 ETH_ALEN);1572 }1573 return 0;1574}1575 1576static void e100_set_multicast_list(struct net_device *netdev)1577{1578 struct nic *nic = netdev_priv(netdev);1579 1580 netif_printk(nic, hw, KERN_DEBUG, nic->netdev,1581 "mc_count=%d, flags=0x%04X\n",1582 netdev_mc_count(netdev), netdev->flags);1583 1584 if (netdev->flags & IFF_PROMISC)1585 nic->flags |= promiscuous;1586 else1587 nic->flags &= ~promiscuous;1588 1589 if (netdev->flags & IFF_ALLMULTI ||1590 netdev_mc_count(netdev) > E100_MAX_MULTICAST_ADDRS)1591 nic->flags |= multicast_all;1592 else1593 nic->flags &= ~multicast_all;1594 1595 e100_exec_cb(nic, NULL, e100_configure);1596 e100_exec_cb(nic, NULL, e100_multi);1597}1598 1599static void e100_update_stats(struct nic *nic)1600{1601 struct net_device *dev = nic->netdev;1602 struct net_device_stats *ns = &dev->stats;1603 struct stats *s = &nic->mem->stats;1604 __le32 *complete = (nic->mac < mac_82558_D101_A4) ? &s->fc_xmt_pause :1605 (nic->mac < mac_82559_D101M) ? (__le32 *)&s->xmt_tco_frames :1606 &s->complete;1607 1608 /* Device's stats reporting may take several microseconds to1609 * complete, so we're always waiting for results of the1610 * previous command. */1611 1612 if (*complete == cpu_to_le32(cuc_dump_reset_complete)) {1613 *complete = 0;1614 nic->tx_frames = le32_to_cpu(s->tx_good_frames);1615 nic->tx_collisions = le32_to_cpu(s->tx_total_collisions);1616 ns->tx_aborted_errors += le32_to_cpu(s->tx_max_collisions);1617 ns->tx_window_errors += le32_to_cpu(s->tx_late_collisions);1618 ns->tx_carrier_errors += le32_to_cpu(s->tx_lost_crs);1619 ns->tx_fifo_errors += le32_to_cpu(s->tx_underruns);1620 ns->collisions += nic->tx_collisions;1621 ns->tx_errors += le32_to_cpu(s->tx_max_collisions) +1622 le32_to_cpu(s->tx_lost_crs);1623 nic->rx_short_frame_errors +=1624 le32_to_cpu(s->rx_short_frame_errors);1625 ns->rx_length_errors = nic->rx_short_frame_errors +1626 nic->rx_over_length_errors;1627 ns->rx_crc_errors += le32_to_cpu(s->rx_crc_errors);1628 ns->rx_frame_errors += le32_to_cpu(s->rx_alignment_errors);1629 ns->rx_over_errors += le32_to_cpu(s->rx_overrun_errors);1630 ns->rx_fifo_errors += le32_to_cpu(s->rx_overrun_errors);1631 ns->rx_missed_errors += le32_to_cpu(s->rx_resource_errors);1632 ns->rx_errors += le32_to_cpu(s->rx_crc_errors) +1633 le32_to_cpu(s->rx_alignment_errors) +1634 le32_to_cpu(s->rx_short_frame_errors) +1635 le32_to_cpu(s->rx_cdt_errors);1636 nic->tx_deferred += le32_to_cpu(s->tx_deferred);1637 nic->tx_single_collisions +=1638 le32_to_cpu(s->tx_single_collisions);1639 nic->tx_multiple_collisions +=1640 le32_to_cpu(s->tx_multiple_collisions);1641 if (nic->mac >= mac_82558_D101_A4) {1642 nic->tx_fc_pause += le32_to_cpu(s->fc_xmt_pause);1643 nic->rx_fc_pause += le32_to_cpu(s->fc_rcv_pause);1644 nic->rx_fc_unsupported +=1645 le32_to_cpu(s->fc_rcv_unsupported);1646 if (nic->mac >= mac_82559_D101M) {1647 nic->tx_tco_frames +=1648 le16_to_cpu(s->xmt_tco_frames);1649 nic->rx_tco_frames +=1650 le16_to_cpu(s->rcv_tco_frames);1651 }1652 }1653 }1654 1655 1656 if (e100_exec_cmd(nic, cuc_dump_reset, 0))1657 netif_printk(nic, tx_err, KERN_DEBUG, nic->netdev,1658 "exec cuc_dump_reset failed\n");1659}1660 1661static void e100_adjust_adaptive_ifs(struct nic *nic, int speed, int duplex)1662{1663 /* Adjust inter-frame-spacing (IFS) between two transmits if1664 * we're getting collisions on a half-duplex connection. */1665 1666 if (duplex == DUPLEX_HALF) {1667 u32 prev = nic->adaptive_ifs;1668 u32 min_frames = (speed == SPEED_100) ? 1000 : 100;1669 1670 if ((nic->tx_frames / 32 < nic->tx_collisions) &&1671 (nic->tx_frames > min_frames)) {1672 if (nic->adaptive_ifs < 60)1673 nic->adaptive_ifs += 5;1674 } else if (nic->tx_frames < min_frames) {1675 if (nic->adaptive_ifs >= 5)1676 nic->adaptive_ifs -= 5;1677 }1678 if (nic->adaptive_ifs != prev)1679 e100_exec_cb(nic, NULL, e100_configure);1680 }1681}1682 1683static void e100_watchdog(struct timer_list *t)1684{1685 struct nic *nic = from_timer(nic, t, watchdog);1686 struct ethtool_cmd cmd = { .cmd = ETHTOOL_GSET };1687 u32 speed;1688 1689 netif_printk(nic, timer, KERN_DEBUG, nic->netdev,1690 "right now = %ld\n", jiffies);1691 1692 /* mii library handles link maintenance tasks */1693 1694 mii_ethtool_gset(&nic->mii, &cmd);1695 speed = ethtool_cmd_speed(&cmd);1696 1697 if (mii_link_ok(&nic->mii) && !netif_carrier_ok(nic->netdev)) {1698 netdev_info(nic->netdev, "NIC Link is Up %u Mbps %s Duplex\n",1699 speed == SPEED_100 ? 100 : 10,1700 cmd.duplex == DUPLEX_FULL ? "Full" : "Half");1701 } else if (!mii_link_ok(&nic->mii) && netif_carrier_ok(nic->netdev)) {1702 netdev_info(nic->netdev, "NIC Link is Down\n");1703 }1704 1705 mii_check_link(&nic->mii);1706 1707 /* Software generated interrupt to recover from (rare) Rx1708 * allocation failure.1709 * Unfortunately have to use a spinlock to not re-enable interrupts1710 * accidentally, due to hardware that shares a register between the1711 * interrupt mask bit and the SW Interrupt generation bit */1712 spin_lock_irq(&nic->cmd_lock);1713 iowrite8(ioread8(&nic->csr->scb.cmd_hi) | irq_sw_gen,&nic->csr->scb.cmd_hi);1714 e100_write_flush(nic);1715 spin_unlock_irq(&nic->cmd_lock);1716 1717 e100_update_stats(nic);1718 e100_adjust_adaptive_ifs(nic, speed, cmd.duplex);1719 1720 if (nic->mac <= mac_82557_D100_C)1721 /* Issue a multicast command to workaround a 557 lock up */1722 e100_set_multicast_list(nic->netdev);1723 1724 if (nic->flags & ich && speed == SPEED_10 && cmd.duplex == DUPLEX_HALF)1725 /* Need SW workaround for ICH[x] 10Mbps/half duplex Tx hang. */1726 nic->flags |= ich_10h_workaround;1727 else1728 nic->flags &= ~ich_10h_workaround;1729 1730 mod_timer(&nic->watchdog,1731 round_jiffies(jiffies + E100_WATCHDOG_PERIOD));1732}1733 1734static int e100_xmit_prepare(struct nic *nic, struct cb *cb,1735 struct sk_buff *skb)1736{1737 dma_addr_t dma_addr;1738 cb->command = nic->tx_command;1739 1740 dma_addr = dma_map_single(&nic->pdev->dev, skb->data, skb->len,1741 DMA_TO_DEVICE);1742 /* If we can't map the skb, have the upper layer try later */1743 if (dma_mapping_error(&nic->pdev->dev, dma_addr))1744 return -ENOMEM;1745 1746 /*1747 * Use the last 4 bytes of the SKB payload packet as the CRC, used for1748 * testing, ie sending frames with bad CRC.1749 */1750 if (unlikely(skb->no_fcs))1751 cb->command |= cpu_to_le16(cb_tx_nc);1752 else1753 cb->command &= ~cpu_to_le16(cb_tx_nc);1754 1755 /* interrupt every 16 packets regardless of delay */1756 if ((nic->cbs_avail & ~15) == nic->cbs_avail)1757 cb->command |= cpu_to_le16(cb_i);1758 cb->u.tcb.tbd_array = cb->dma_addr + offsetof(struct cb, u.tcb.tbd);1759 cb->u.tcb.tcb_byte_count = 0;1760 cb->u.tcb.threshold = nic->tx_threshold;1761 cb->u.tcb.tbd_count = 1;1762 cb->u.tcb.tbd.buf_addr = cpu_to_le32(dma_addr);1763 cb->u.tcb.tbd.size = cpu_to_le16(skb->len);1764 skb_tx_timestamp(skb);1765 return 0;1766}1767 1768static netdev_tx_t e100_xmit_frame(struct sk_buff *skb,1769 struct net_device *netdev)1770{1771 struct nic *nic = netdev_priv(netdev);1772 int err;1773 1774 if (nic->flags & ich_10h_workaround) {1775 /* SW workaround for ICH[x] 10Mbps/half duplex Tx hang.1776 Issue a NOP command followed by a 1us delay before1777 issuing the Tx command. */1778 if (e100_exec_cmd(nic, cuc_nop, 0))1779 netif_printk(nic, tx_err, KERN_DEBUG, nic->netdev,1780 "exec cuc_nop failed\n");1781 udelay(1);1782 }1783 1784 err = e100_exec_cb(nic, skb, e100_xmit_prepare);1785 1786 switch (err) {1787 case -ENOSPC:1788 /* We queued the skb, but now we're out of space. */1789 netif_printk(nic, tx_err, KERN_DEBUG, nic->netdev,1790 "No space for CB\n");1791 netif_stop_queue(netdev);1792 break;1793 case -ENOMEM:1794 /* This is a hard error - log it. */1795 netif_printk(nic, tx_err, KERN_DEBUG, nic->netdev,1796 "Out of Tx resources, returning skb\n");1797 netif_stop_queue(netdev);1798 return NETDEV_TX_BUSY;1799 }1800 1801 return NETDEV_TX_OK;1802}1803 1804static int e100_tx_clean(struct nic *nic)1805{1806 struct net_device *dev = nic->netdev;1807 struct cb *cb;1808 int tx_cleaned = 0;1809 1810 spin_lock(&nic->cb_lock);1811 1812 /* Clean CBs marked complete */1813 for (cb = nic->cb_to_clean;1814 cb->status & cpu_to_le16(cb_complete);1815 cb = nic->cb_to_clean = cb->next) {1816 dma_rmb(); /* read skb after status */1817 netif_printk(nic, tx_done, KERN_DEBUG, nic->netdev,1818 "cb[%d]->status = 0x%04X\n",1819 (int)(((void*)cb - (void*)nic->cbs)/sizeof(struct cb)),1820 cb->status);1821 1822 if (likely(cb->skb != NULL)) {1823 dev->stats.tx_packets++;1824 dev->stats.tx_bytes += cb->skb->len;1825 1826 dma_unmap_single(&nic->pdev->dev,1827 le32_to_cpu(cb->u.tcb.tbd.buf_addr),1828 le16_to_cpu(cb->u.tcb.tbd.size),1829 DMA_TO_DEVICE);1830 dev_kfree_skb_any(cb->skb);1831 cb->skb = NULL;1832 tx_cleaned = 1;1833 }1834 cb->status = 0;1835 nic->cbs_avail++;1836 }1837 1838 spin_unlock(&nic->cb_lock);1839 1840 /* Recover from running out of Tx resources in xmit_frame */1841 if (unlikely(tx_cleaned && netif_queue_stopped(nic->netdev)))1842 netif_wake_queue(nic->netdev);1843 1844 return tx_cleaned;1845}1846 1847static void e100_clean_cbs(struct nic *nic)1848{1849 if (nic->cbs) {1850 while (nic->cbs_avail != nic->params.cbs.count) {1851 struct cb *cb = nic->cb_to_clean;1852 if (cb->skb) {1853 dma_unmap_single(&nic->pdev->dev,1854 le32_to_cpu(cb->u.tcb.tbd.buf_addr),1855 le16_to_cpu(cb->u.tcb.tbd.size),1856 DMA_TO_DEVICE);1857 dev_kfree_skb(cb->skb);1858 }1859 nic->cb_to_clean = nic->cb_to_clean->next;1860 nic->cbs_avail++;1861 }1862 dma_pool_free(nic->cbs_pool, nic->cbs, nic->cbs_dma_addr);1863 nic->cbs = NULL;1864 nic->cbs_avail = 0;1865 }1866 nic->cuc_cmd = cuc_start;1867 nic->cb_to_use = nic->cb_to_send = nic->cb_to_clean =1868 nic->cbs;1869}1870 1871static int e100_alloc_cbs(struct nic *nic)1872{1873 struct cb *cb;1874 unsigned int i, count = nic->params.cbs.count;1875 1876 nic->cuc_cmd = cuc_start;1877 nic->cb_to_use = nic->cb_to_send = nic->cb_to_clean = NULL;1878 nic->cbs_avail = 0;1879 1880 nic->cbs = dma_pool_zalloc(nic->cbs_pool, GFP_KERNEL,1881 &nic->cbs_dma_addr);1882 if (!nic->cbs)1883 return -ENOMEM;1884 1885 for (cb = nic->cbs, i = 0; i < count; cb++, i++) {1886 cb->next = (i + 1 < count) ? cb + 1 : nic->cbs;1887 cb->prev = (i == 0) ? nic->cbs + count - 1 : cb - 1;1888 1889 cb->dma_addr = nic->cbs_dma_addr + i * sizeof(struct cb);1890 cb->link = cpu_to_le32(nic->cbs_dma_addr +1891 ((i+1) % count) * sizeof(struct cb));1892 }1893 1894 nic->cb_to_use = nic->cb_to_send = nic->cb_to_clean = nic->cbs;1895 nic->cbs_avail = count;1896 1897 return 0;1898}1899 1900static inline void e100_start_receiver(struct nic *nic, struct rx *rx)1901{1902 if (!nic->rxs) return;1903 if (RU_SUSPENDED != nic->ru_running) return;1904 1905 /* handle init time starts */1906 if (!rx) rx = nic->rxs;1907 1908 /* (Re)start RU if suspended or idle and RFA is non-NULL */1909 if (rx->skb) {1910 e100_exec_cmd(nic, ruc_start, rx->dma_addr);1911 nic->ru_running = RU_RUNNING;1912 }1913}1914 1915#define RFD_BUF_LEN (sizeof(struct rfd) + VLAN_ETH_FRAME_LEN + ETH_FCS_LEN)1916static int e100_rx_alloc_skb(struct nic *nic, struct rx *rx)1917{1918 if (!(rx->skb = netdev_alloc_skb_ip_align(nic->netdev, RFD_BUF_LEN)))1919 return -ENOMEM;1920 1921 /* Init, and map the RFD. */1922 skb_copy_to_linear_data(rx->skb, &nic->blank_rfd, sizeof(struct rfd));1923 rx->dma_addr = dma_map_single(&nic->pdev->dev, rx->skb->data,1924 RFD_BUF_LEN, DMA_BIDIRECTIONAL);1925 1926 if (dma_mapping_error(&nic->pdev->dev, rx->dma_addr)) {1927 dev_kfree_skb_any(rx->skb);1928 rx->skb = NULL;1929 rx->dma_addr = 0;1930 return -ENOMEM;1931 }1932 1933 /* Link the RFD to end of RFA by linking previous RFD to1934 * this one. We are safe to touch the previous RFD because1935 * it is protected by the before last buffer's el bit being set */1936 if (rx->prev->skb) {1937 struct rfd *prev_rfd = (struct rfd *)rx->prev->skb->data;1938 put_unaligned_le32(rx->dma_addr, &prev_rfd->link);1939 dma_sync_single_for_device(&nic->pdev->dev,1940 rx->prev->dma_addr,1941 sizeof(struct rfd),1942 DMA_BIDIRECTIONAL);1943 }1944 1945 return 0;1946}1947 1948static int e100_rx_indicate(struct nic *nic, struct rx *rx,1949 unsigned int *work_done, unsigned int work_to_do)1950{1951 struct net_device *dev = nic->netdev;1952 struct sk_buff *skb = rx->skb;1953 struct rfd *rfd = (struct rfd *)skb->data;1954 u16 rfd_status, actual_size;1955 u16 fcs_pad = 0;1956 1957 if (unlikely(work_done && *work_done >= work_to_do))1958 return -EAGAIN;1959 1960 /* Need to sync before taking a peek at cb_complete bit */1961 dma_sync_single_for_cpu(&nic->pdev->dev, rx->dma_addr,1962 sizeof(struct rfd), DMA_BIDIRECTIONAL);1963 rfd_status = le16_to_cpu(rfd->status);1964 1965 netif_printk(nic, rx_status, KERN_DEBUG, nic->netdev,1966 "status=0x%04X\n", rfd_status);1967 dma_rmb(); /* read size after status bit */1968 1969 /* If data isn't ready, nothing to indicate */1970 if (unlikely(!(rfd_status & cb_complete))) {1971 /* If the next buffer has the el bit, but we think the receiver1972 * is still running, check to see if it really stopped while1973 * we had interrupts off.1974 * This allows for a fast restart without re-enabling1975 * interrupts */1976 if ((le16_to_cpu(rfd->command) & cb_el) &&1977 (RU_RUNNING == nic->ru_running))1978 1979 if (ioread8(&nic->csr->scb.status) & rus_no_res)1980 nic->ru_running = RU_SUSPENDED;1981 dma_sync_single_for_device(&nic->pdev->dev, rx->dma_addr,1982 sizeof(struct rfd),1983 DMA_FROM_DEVICE);1984 return -ENODATA;1985 }1986 1987 /* Get actual data size */1988 if (unlikely(dev->features & NETIF_F_RXFCS))1989 fcs_pad = 4;1990 actual_size = le16_to_cpu(rfd->actual_size) & 0x3FFF;1991 if (unlikely(actual_size > RFD_BUF_LEN - sizeof(struct rfd)))1992 actual_size = RFD_BUF_LEN - sizeof(struct rfd);1993 1994 /* Get data */1995 dma_unmap_single(&nic->pdev->dev, rx->dma_addr, RFD_BUF_LEN,1996 DMA_BIDIRECTIONAL);1997 1998 /* If this buffer has the el bit, but we think the receiver1999 * is still running, check to see if it really stopped while2000 * we had interrupts off.2001 * This allows for a fast restart without re-enabling interrupts.2002 * This can happen when the RU sees the size change but also sees2003 * the el bit set. */2004 if ((le16_to_cpu(rfd->command) & cb_el) &&2005 (RU_RUNNING == nic->ru_running)) {2006 2007 if (ioread8(&nic->csr->scb.status) & rus_no_res)2008 nic->ru_running = RU_SUSPENDED;2009 }2010 2011 /* Pull off the RFD and put the actual data (minus eth hdr) */2012 skb_reserve(skb, sizeof(struct rfd));2013 skb_put(skb, actual_size);2014 skb->protocol = eth_type_trans(skb, nic->netdev);2015 2016 /* If we are receiving all frames, then don't bother2017 * checking for errors.2018 */2019 if (unlikely(dev->features & NETIF_F_RXALL)) {2020 if (actual_size > ETH_DATA_LEN + VLAN_ETH_HLEN + fcs_pad)2021 /* Received oversized frame, but keep it. */2022 nic->rx_over_length_errors++;2023 goto process_skb;2024 }2025 2026 if (unlikely(!(rfd_status & cb_ok))) {2027 /* Don't indicate if hardware indicates errors */2028 dev_kfree_skb_any(skb);2029 } else if (actual_size > ETH_DATA_LEN + VLAN_ETH_HLEN + fcs_pad) {2030 /* Don't indicate oversized frames */2031 nic->rx_over_length_errors++;2032 dev_kfree_skb_any(skb);2033 } else {2034process_skb:2035 dev->stats.rx_packets++;2036 dev->stats.rx_bytes += (actual_size - fcs_pad);2037 netif_receive_skb(skb);2038 if (work_done)2039 (*work_done)++;2040 }2041 2042 rx->skb = NULL;2043 2044 return 0;2045}2046 2047static void e100_rx_clean(struct nic *nic, unsigned int *work_done,2048 unsigned int work_to_do)2049{2050 struct rx *rx;2051 int restart_required = 0, err = 0;2052 struct rx *old_before_last_rx, *new_before_last_rx;2053 struct rfd *old_before_last_rfd, *new_before_last_rfd;2054 2055 /* Indicate newly arrived packets */2056 for (rx = nic->rx_to_clean; rx->skb; rx = nic->rx_to_clean = rx->next) {2057 err = e100_rx_indicate(nic, rx, work_done, work_to_do);2058 /* Hit quota or no more to clean */2059 if (-EAGAIN == err || -ENODATA == err)2060 break;2061 }2062 2063 2064 /* On EAGAIN, hit quota so have more work to do, restart once2065 * cleanup is complete.2066 * Else, are we already rnr? then pay attention!!! this ensures that2067 * the state machine progression never allows a start with a2068 * partially cleaned list, avoiding a race between hardware2069 * and rx_to_clean when in NAPI mode */2070 if (-EAGAIN != err && RU_SUSPENDED == nic->ru_running)2071 restart_required = 1;2072 2073 old_before_last_rx = nic->rx_to_use->prev->prev;2074 old_before_last_rfd = (struct rfd *)old_before_last_rx->skb->data;2075 2076 /* Alloc new skbs to refill list */2077 for (rx = nic->rx_to_use; !rx->skb; rx = nic->rx_to_use = rx->next) {2078 if (unlikely(e100_rx_alloc_skb(nic, rx)))2079 break; /* Better luck next time (see watchdog) */2080 }2081 2082 new_before_last_rx = nic->rx_to_use->prev->prev;2083 if (new_before_last_rx != old_before_last_rx) {2084 /* Set the el-bit on the buffer that is before the last buffer.2085 * This lets us update the next pointer on the last buffer2086 * without worrying about hardware touching it.2087 * We set the size to 0 to prevent hardware from touching this2088 * buffer.2089 * When the hardware hits the before last buffer with el-bit2090 * and size of 0, it will RNR interrupt, the RUS will go into2091 * the No Resources state. It will not complete nor write to2092 * this buffer. */2093 new_before_last_rfd =2094 (struct rfd *)new_before_last_rx->skb->data;2095 new_before_last_rfd->size = 0;2096 new_before_last_rfd->command |= cpu_to_le16(cb_el);2097 dma_sync_single_for_device(&nic->pdev->dev,2098 new_before_last_rx->dma_addr,2099 sizeof(struct rfd),2100 DMA_BIDIRECTIONAL);2101 2102 /* Now that we have a new stopping point, we can clear the old2103 * stopping point. We must sync twice to get the proper2104 * ordering on the hardware side of things. */2105 old_before_last_rfd->command &= ~cpu_to_le16(cb_el);2106 dma_sync_single_for_device(&nic->pdev->dev,2107 old_before_last_rx->dma_addr,2108 sizeof(struct rfd),2109 DMA_BIDIRECTIONAL);2110 old_before_last_rfd->size = cpu_to_le16(VLAN_ETH_FRAME_LEN2111 + ETH_FCS_LEN);2112 dma_sync_single_for_device(&nic->pdev->dev,2113 old_before_last_rx->dma_addr,2114 sizeof(struct rfd),2115 DMA_BIDIRECTIONAL);2116 }2117 2118 if (restart_required) {2119 // ack the rnr?2120 iowrite8(stat_ack_rnr, &nic->csr->scb.stat_ack);2121 e100_start_receiver(nic, nic->rx_to_clean);2122 if (work_done)2123 (*work_done)++;2124 }2125}2126 2127static void e100_rx_clean_list(struct nic *nic)2128{2129 struct rx *rx;2130 unsigned int i, count = nic->params.rfds.count;2131 2132 nic->ru_running = RU_UNINITIALIZED;2133 2134 if (nic->rxs) {2135 for (rx = nic->rxs, i = 0; i < count; rx++, i++) {2136 if (rx->skb) {2137 dma_unmap_single(&nic->pdev->dev,2138 rx->dma_addr, RFD_BUF_LEN,2139 DMA_BIDIRECTIONAL);2140 dev_kfree_skb(rx->skb);2141 }2142 }2143 kfree(nic->rxs);2144 nic->rxs = NULL;2145 }2146 2147 nic->rx_to_use = nic->rx_to_clean = NULL;2148}2149 2150static int e100_rx_alloc_list(struct nic *nic)2151{2152 struct rx *rx;2153 unsigned int i, count = nic->params.rfds.count;2154 struct rfd *before_last;2155 2156 nic->rx_to_use = nic->rx_to_clean = NULL;2157 nic->ru_running = RU_UNINITIALIZED;2158 2159 if (!(nic->rxs = kcalloc(count, sizeof(struct rx), GFP_KERNEL)))2160 return -ENOMEM;2161 2162 for (rx = nic->rxs, i = 0; i < count; rx++, i++) {2163 rx->next = (i + 1 < count) ? rx + 1 : nic->rxs;2164 rx->prev = (i == 0) ? nic->rxs + count - 1 : rx - 1;2165 if (e100_rx_alloc_skb(nic, rx)) {2166 e100_rx_clean_list(nic);2167 return -ENOMEM;2168 }2169 }2170 /* Set the el-bit on the buffer that is before the last buffer.2171 * This lets us update the next pointer on the last buffer without2172 * worrying about hardware touching it.2173 * We set the size to 0 to prevent hardware from touching this buffer.2174 * When the hardware hits the before last buffer with el-bit and size2175 * of 0, it will RNR interrupt, the RU will go into the No Resources2176 * state. It will not complete nor write to this buffer. */2177 rx = nic->rxs->prev->prev;2178 before_last = (struct rfd *)rx->skb->data;2179 before_last->command |= cpu_to_le16(cb_el);2180 before_last->size = 0;2181 dma_sync_single_for_device(&nic->pdev->dev, rx->dma_addr,2182 sizeof(struct rfd), DMA_BIDIRECTIONAL);2183 2184 nic->rx_to_use = nic->rx_to_clean = nic->rxs;2185 nic->ru_running = RU_SUSPENDED;2186 2187 return 0;2188}2189 2190static irqreturn_t e100_intr(int irq, void *dev_id)2191{2192 struct net_device *netdev = dev_id;2193 struct nic *nic = netdev_priv(netdev);2194 u8 stat_ack = ioread8(&nic->csr->scb.stat_ack);2195 2196 netif_printk(nic, intr, KERN_DEBUG, nic->netdev,2197 "stat_ack = 0x%02X\n", stat_ack);2198 2199 if (stat_ack == stat_ack_not_ours || /* Not our interrupt */2200 stat_ack == stat_ack_not_present) /* Hardware is ejected */2201 return IRQ_NONE;2202 2203 /* Ack interrupt(s) */2204 iowrite8(stat_ack, &nic->csr->scb.stat_ack);2205 2206 /* We hit Receive No Resource (RNR); restart RU after cleaning */2207 if (stat_ack & stat_ack_rnr)2208 nic->ru_running = RU_SUSPENDED;2209 2210 if (likely(napi_schedule_prep(&nic->napi))) {2211 e100_disable_irq(nic);2212 __napi_schedule(&nic->napi);2213 }2214 2215 return IRQ_HANDLED;2216}2217 2218static int e100_poll(struct napi_struct *napi, int budget)2219{2220 struct nic *nic = container_of(napi, struct nic, napi);2221 unsigned int work_done = 0;2222 2223 e100_rx_clean(nic, &work_done, budget);2224 e100_tx_clean(nic);2225 2226 /* If budget fully consumed, continue polling */2227 if (work_done == budget)2228 return budget;2229 2230 /* only re-enable interrupt if stack agrees polling is really done */2231 if (likely(napi_complete_done(napi, work_done)))2232 e100_enable_irq(nic);2233 2234 return work_done;2235}2236 2237#ifdef CONFIG_NET_POLL_CONTROLLER2238static void e100_netpoll(struct net_device *netdev)2239{2240 struct nic *nic = netdev_priv(netdev);2241 2242 e100_disable_irq(nic);2243 e100_intr(nic->pdev->irq, netdev);2244 e100_tx_clean(nic);2245 e100_enable_irq(nic);2246}2247#endif2248 2249static int e100_set_mac_address(struct net_device *netdev, void *p)2250{2251 struct nic *nic = netdev_priv(netdev);2252 struct sockaddr *addr = p;2253 2254 if (!is_valid_ether_addr(addr->sa_data))2255 return -EADDRNOTAVAIL;2256 2257 eth_hw_addr_set(netdev, addr->sa_data);2258 e100_exec_cb(nic, NULL, e100_setup_iaaddr);2259 2260 return 0;2261}2262 2263static int e100_asf(struct nic *nic)2264{2265 /* ASF can be enabled from eeprom */2266 return (nic->pdev->device >= 0x1050) && (nic->pdev->device <= 0x1057) &&2267 (le16_to_cpu(nic->eeprom[eeprom_config_asf]) & eeprom_asf) &&2268 !(le16_to_cpu(nic->eeprom[eeprom_config_asf]) & eeprom_gcl) &&2269 ((le16_to_cpu(nic->eeprom[eeprom_smbus_addr]) & 0xFF) != 0xFE);2270}2271 2272static int e100_up(struct nic *nic)2273{2274 int err;2275 2276 if ((err = e100_rx_alloc_list(nic)))2277 return err;2278 if ((err = e100_alloc_cbs(nic)))2279 goto err_rx_clean_list;2280 if ((err = e100_hw_init(nic)))2281 goto err_clean_cbs;2282 e100_set_multicast_list(nic->netdev);2283 e100_start_receiver(nic, NULL);2284 mod_timer(&nic->watchdog, jiffies);2285 if ((err = request_irq(nic->pdev->irq, e100_intr, IRQF_SHARED,2286 nic->netdev->name, nic->netdev)))2287 goto err_no_irq;2288 netif_wake_queue(nic->netdev);2289 napi_enable(&nic->napi);2290 /* enable ints _after_ enabling poll, preventing a race between2291 * disable ints+schedule */2292 e100_enable_irq(nic);2293 return 0;2294 2295err_no_irq:2296 del_timer_sync(&nic->watchdog);2297err_clean_cbs:2298 e100_clean_cbs(nic);2299err_rx_clean_list:2300 e100_rx_clean_list(nic);2301 return err;2302}2303 2304static void e100_down(struct nic *nic)2305{2306 /* wait here for poll to complete */2307 napi_disable(&nic->napi);2308 netif_stop_queue(nic->netdev);2309 e100_hw_reset(nic);2310 free_irq(nic->pdev->irq, nic->netdev);2311 del_timer_sync(&nic->watchdog);2312 netif_carrier_off(nic->netdev);2313 e100_clean_cbs(nic);2314 e100_rx_clean_list(nic);2315}2316 2317static void e100_tx_timeout(struct net_device *netdev, unsigned int txqueue)2318{2319 struct nic *nic = netdev_priv(netdev);2320 2321 /* Reset outside of interrupt context, to avoid request_irq2322 * in interrupt context */2323 schedule_work(&nic->tx_timeout_task);2324}2325 2326static void e100_tx_timeout_task(struct work_struct *work)2327{2328 struct nic *nic = container_of(work, struct nic, tx_timeout_task);2329 struct net_device *netdev = nic->netdev;2330 2331 netif_printk(nic, tx_err, KERN_DEBUG, nic->netdev,2332 "scb.status=0x%02X\n", ioread8(&nic->csr->scb.status));2333 2334 rtnl_lock();2335 if (netif_running(netdev)) {2336 e100_down(netdev_priv(netdev));2337 e100_up(netdev_priv(netdev));2338 }2339 rtnl_unlock();2340}2341 2342static int e100_loopback_test(struct nic *nic, enum loopback loopback_mode)2343{2344 int err;2345 struct sk_buff *skb;2346 2347 /* Use driver resources to perform internal MAC or PHY2348 * loopback test. A single packet is prepared and transmitted2349 * in loopback mode, and the test passes if the received2350 * packet compares byte-for-byte to the transmitted packet. */2351 2352 if ((err = e100_rx_alloc_list(nic)))2353 return err;2354 if ((err = e100_alloc_cbs(nic)))2355 goto err_clean_rx;2356 2357 /* ICH PHY loopback is broken so do MAC loopback instead */2358 if (nic->flags & ich && loopback_mode == lb_phy)2359 loopback_mode = lb_mac;2360 2361 nic->loopback = loopback_mode;2362 if ((err = e100_hw_init(nic)))2363 goto err_loopback_none;2364 2365 if (loopback_mode == lb_phy)2366 mdio_write(nic->netdev, nic->mii.phy_id, MII_BMCR,2367 BMCR_LOOPBACK);2368 2369 e100_start_receiver(nic, NULL);2370 2371 if (!(skb = netdev_alloc_skb(nic->netdev, ETH_DATA_LEN))) {2372 err = -ENOMEM;2373 goto err_loopback_none;2374 }2375 skb_put(skb, ETH_DATA_LEN);2376 memset(skb->data, 0xFF, ETH_DATA_LEN);2377 e100_xmit_frame(skb, nic->netdev);2378 2379 msleep(10);2380 2381 dma_sync_single_for_cpu(&nic->pdev->dev, nic->rx_to_clean->dma_addr,2382 RFD_BUF_LEN, DMA_BIDIRECTIONAL);2383 2384 if (memcmp(nic->rx_to_clean->skb->data + sizeof(struct rfd),2385 skb->data, ETH_DATA_LEN))2386 err = -EAGAIN;2387 2388err_loopback_none:2389 mdio_write(nic->netdev, nic->mii.phy_id, MII_BMCR, 0);2390 nic->loopback = lb_none;2391 e100_clean_cbs(nic);2392 e100_hw_reset(nic);2393err_clean_rx:2394 e100_rx_clean_list(nic);2395 return err;2396}2397 2398#define MII_LED_CONTROL 0x1B2399#define E100_82552_LED_OVERRIDE 0x192400#define E100_82552_LED_ON 0x000F /* LEDTX and LED_RX both on */2401#define E100_82552_LED_OFF 0x000A /* LEDTX and LED_RX both off */2402 2403static int e100_get_link_ksettings(struct net_device *netdev,2404 struct ethtool_link_ksettings *cmd)2405{2406 struct nic *nic = netdev_priv(netdev);2407 2408 mii_ethtool_get_link_ksettings(&nic->mii, cmd);2409 2410 return 0;2411}2412 2413static int e100_set_link_ksettings(struct net_device *netdev,2414 const struct ethtool_link_ksettings *cmd)2415{2416 struct nic *nic = netdev_priv(netdev);2417 int err;2418 2419 mdio_write(netdev, nic->mii.phy_id, MII_BMCR, BMCR_RESET);2420 err = mii_ethtool_set_link_ksettings(&nic->mii, cmd);2421 e100_exec_cb(nic, NULL, e100_configure);2422 2423 return err;2424}2425 2426static void e100_get_drvinfo(struct net_device *netdev,2427 struct ethtool_drvinfo *info)2428{2429 struct nic *nic = netdev_priv(netdev);2430 strscpy(info->driver, DRV_NAME, sizeof(info->driver));2431 strscpy(info->bus_info, pci_name(nic->pdev),2432 sizeof(info->bus_info));2433}2434 2435#define E100_PHY_REGS 0x1D2436static int e100_get_regs_len(struct net_device *netdev)2437{2438 struct nic *nic = netdev_priv(netdev);2439 2440 /* We know the number of registers, and the size of the dump buffer.2441 * Calculate the total size in bytes.2442 */2443 return (1 + E100_PHY_REGS) * sizeof(u32) + sizeof(nic->mem->dump_buf);2444}2445 2446static void e100_get_regs(struct net_device *netdev,2447 struct ethtool_regs *regs, void *p)2448{2449 struct nic *nic = netdev_priv(netdev);2450 u32 *buff = p;2451 int i;2452 2453 regs->version = (1 << 24) | nic->pdev->revision;2454 buff[0] = ioread8(&nic->csr->scb.cmd_hi) << 24 |2455 ioread8(&nic->csr->scb.cmd_lo) << 16 |2456 ioread16(&nic->csr->scb.status);2457 for (i = 0; i < E100_PHY_REGS; i++)2458 /* Note that we read the registers in reverse order. This2459 * ordering is the ABI apparently used by ethtool and other2460 * applications.2461 */2462 buff[1 + i] = mdio_read(netdev, nic->mii.phy_id,2463 E100_PHY_REGS - 1 - i);2464 memset(nic->mem->dump_buf, 0, sizeof(nic->mem->dump_buf));2465 e100_exec_cb(nic, NULL, e100_dump);2466 msleep(10);2467 memcpy(&buff[1 + E100_PHY_REGS], nic->mem->dump_buf,2468 sizeof(nic->mem->dump_buf));2469}2470 2471static void e100_get_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)2472{2473 struct nic *nic = netdev_priv(netdev);2474 wol->supported = (nic->mac >= mac_82558_D101_A4) ? WAKE_MAGIC : 0;2475 wol->wolopts = (nic->flags & wol_magic) ? WAKE_MAGIC : 0;2476}2477 2478static int e100_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)2479{2480 struct nic *nic = netdev_priv(netdev);2481 2482 if ((wol->wolopts && wol->wolopts != WAKE_MAGIC) ||2483 !device_can_wakeup(&nic->pdev->dev))2484 return -EOPNOTSUPP;2485 2486 if (wol->wolopts)2487 nic->flags |= wol_magic;2488 else2489 nic->flags &= ~wol_magic;2490 2491 device_set_wakeup_enable(&nic->pdev->dev, wol->wolopts);2492 2493 e100_exec_cb(nic, NULL, e100_configure);2494 2495 return 0;2496}2497 2498static u32 e100_get_msglevel(struct net_device *netdev)2499{2500 struct nic *nic = netdev_priv(netdev);2501 return nic->msg_enable;2502}2503 2504static void e100_set_msglevel(struct net_device *netdev, u32 value)2505{2506 struct nic *nic = netdev_priv(netdev);2507 nic->msg_enable = value;2508}2509 2510static int e100_nway_reset(struct net_device *netdev)2511{2512 struct nic *nic = netdev_priv(netdev);2513 return mii_nway_restart(&nic->mii);2514}2515 2516static u32 e100_get_link(struct net_device *netdev)2517{2518 struct nic *nic = netdev_priv(netdev);2519 return mii_link_ok(&nic->mii);2520}2521 2522static int e100_get_eeprom_len(struct net_device *netdev)2523{2524 struct nic *nic = netdev_priv(netdev);2525 return nic->eeprom_wc << 1;2526}2527 2528#define E100_EEPROM_MAGIC 0x12342529static int e100_get_eeprom(struct net_device *netdev,2530 struct ethtool_eeprom *eeprom, u8 *bytes)2531{2532 struct nic *nic = netdev_priv(netdev);2533 2534 eeprom->magic = E100_EEPROM_MAGIC;2535 memcpy(bytes, &((u8 *)nic->eeprom)[eeprom->offset], eeprom->len);2536 2537 return 0;2538}2539 2540static int e100_set_eeprom(struct net_device *netdev,2541 struct ethtool_eeprom *eeprom, u8 *bytes)2542{2543 struct nic *nic = netdev_priv(netdev);2544 2545 if (eeprom->magic != E100_EEPROM_MAGIC)2546 return -EINVAL;2547 2548 memcpy(&((u8 *)nic->eeprom)[eeprom->offset], bytes, eeprom->len);2549 2550 return e100_eeprom_save(nic, eeprom->offset >> 1,2551 (eeprom->len >> 1) + 1);2552}2553 2554static void e100_get_ringparam(struct net_device *netdev,2555 struct ethtool_ringparam *ring,2556 struct kernel_ethtool_ringparam *kernel_ring,2557 struct netlink_ext_ack *extack)2558{2559 struct nic *nic = netdev_priv(netdev);2560 struct param_range *rfds = &nic->params.rfds;2561 struct param_range *cbs = &nic->params.cbs;2562 2563 ring->rx_max_pending = rfds->max;2564 ring->tx_max_pending = cbs->max;2565 ring->rx_pending = rfds->count;2566 ring->tx_pending = cbs->count;2567}2568 2569static int e100_set_ringparam(struct net_device *netdev,2570 struct ethtool_ringparam *ring,2571 struct kernel_ethtool_ringparam *kernel_ring,2572 struct netlink_ext_ack *extack)2573{2574 struct nic *nic = netdev_priv(netdev);2575 struct param_range *rfds = &nic->params.rfds;2576 struct param_range *cbs = &nic->params.cbs;2577 2578 if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending))2579 return -EINVAL;2580 2581 if (netif_running(netdev))2582 e100_down(nic);2583 rfds->count = max(ring->rx_pending, rfds->min);2584 rfds->count = min(rfds->count, rfds->max);2585 cbs->count = max(ring->tx_pending, cbs->min);2586 cbs->count = min(cbs->count, cbs->max);2587 netif_info(nic, drv, nic->netdev, "Ring Param settings: rx: %d, tx %d\n",2588 rfds->count, cbs->count);2589 if (netif_running(netdev))2590 e100_up(nic);2591 2592 return 0;2593}2594 2595static const char e100_gstrings_test[][ETH_GSTRING_LEN] = {2596 "Link test (on/offline)",2597 "Eeprom test (on/offline)",2598 "Self test (offline)",2599 "Mac loopback (offline)",2600 "Phy loopback (offline)",2601};2602#define E100_TEST_LEN ARRAY_SIZE(e100_gstrings_test)2603 2604static void e100_diag_test(struct net_device *netdev,2605 struct ethtool_test *test, u64 *data)2606{2607 struct ethtool_cmd cmd;2608 struct nic *nic = netdev_priv(netdev);2609 int i;2610 2611 memset(data, 0, E100_TEST_LEN * sizeof(u64));2612 data[0] = !mii_link_ok(&nic->mii);2613 data[1] = e100_eeprom_load(nic);2614 if (test->flags & ETH_TEST_FL_OFFLINE) {2615 2616 /* save speed, duplex & autoneg settings */2617 mii_ethtool_gset(&nic->mii, &cmd);2618 2619 if (netif_running(netdev))2620 e100_down(nic);2621 data[2] = e100_self_test(nic);2622 data[3] = e100_loopback_test(nic, lb_mac);2623 data[4] = e100_loopback_test(nic, lb_phy);2624 2625 /* restore speed, duplex & autoneg settings */2626 mii_ethtool_sset(&nic->mii, &cmd);2627 2628 if (netif_running(netdev))2629 e100_up(nic);2630 }2631 for (i = 0; i < E100_TEST_LEN; i++)2632 test->flags |= data[i] ? ETH_TEST_FL_FAILED : 0;2633 2634 msleep_interruptible(4 * 1000);2635}2636 2637static int e100_set_phys_id(struct net_device *netdev,2638 enum ethtool_phys_id_state state)2639{2640 struct nic *nic = netdev_priv(netdev);2641 enum led_state {2642 led_on = 0x01,2643 led_off = 0x04,2644 led_on_559 = 0x05,2645 led_on_557 = 0x07,2646 };2647 u16 led_reg = (nic->phy == phy_82552_v) ? E100_82552_LED_OVERRIDE :2648 MII_LED_CONTROL;2649 u16 leds = 0;2650 2651 switch (state) {2652 case ETHTOOL_ID_ACTIVE:2653 return 2;2654 2655 case ETHTOOL_ID_ON:2656 leds = (nic->phy == phy_82552_v) ? E100_82552_LED_ON :2657 (nic->mac < mac_82559_D101M) ? led_on_557 : led_on_559;2658 break;2659 2660 case ETHTOOL_ID_OFF:2661 leds = (nic->phy == phy_82552_v) ? E100_82552_LED_OFF : led_off;2662 break;2663 2664 case ETHTOOL_ID_INACTIVE:2665 break;2666 }2667 2668 mdio_write(netdev, nic->mii.phy_id, led_reg, leds);2669 return 0;2670}2671 2672static const char e100_gstrings_stats[][ETH_GSTRING_LEN] = {2673 "rx_packets", "tx_packets", "rx_bytes", "tx_bytes", "rx_errors",2674 "tx_errors", "rx_dropped", "tx_dropped", "multicast", "collisions",2675 "rx_length_errors", "rx_over_errors", "rx_crc_errors",2676 "rx_frame_errors", "rx_fifo_errors", "rx_missed_errors",2677 "tx_aborted_errors", "tx_carrier_errors", "tx_fifo_errors",2678 "tx_heartbeat_errors", "tx_window_errors",2679 /* device-specific stats */2680 "tx_deferred", "tx_single_collisions", "tx_multi_collisions",2681 "tx_flow_control_pause", "rx_flow_control_pause",2682 "rx_flow_control_unsupported", "tx_tco_packets", "rx_tco_packets",2683 "rx_short_frame_errors", "rx_over_length_errors",2684};2685#define E100_NET_STATS_LEN 212686#define E100_STATS_LEN ARRAY_SIZE(e100_gstrings_stats)2687 2688static int e100_get_sset_count(struct net_device *netdev, int sset)2689{2690 switch (sset) {2691 case ETH_SS_TEST:2692 return E100_TEST_LEN;2693 case ETH_SS_STATS:2694 return E100_STATS_LEN;2695 default:2696 return -EOPNOTSUPP;2697 }2698}2699 2700static void e100_get_ethtool_stats(struct net_device *netdev,2701 struct ethtool_stats *stats, u64 *data)2702{2703 struct nic *nic = netdev_priv(netdev);2704 int i;2705 2706 for (i = 0; i < E100_NET_STATS_LEN; i++)2707 data[i] = ((unsigned long *)&netdev->stats)[i];2708 2709 data[i++] = nic->tx_deferred;2710 data[i++] = nic->tx_single_collisions;2711 data[i++] = nic->tx_multiple_collisions;2712 data[i++] = nic->tx_fc_pause;2713 data[i++] = nic->rx_fc_pause;2714 data[i++] = nic->rx_fc_unsupported;2715 data[i++] = nic->tx_tco_frames;2716 data[i++] = nic->rx_tco_frames;2717 data[i++] = nic->rx_short_frame_errors;2718 data[i++] = nic->rx_over_length_errors;2719}2720 2721static void e100_get_strings(struct net_device *netdev, u32 stringset, u8 *data)2722{2723 switch (stringset) {2724 case ETH_SS_TEST:2725 memcpy(data, e100_gstrings_test, sizeof(e100_gstrings_test));2726 break;2727 case ETH_SS_STATS:2728 memcpy(data, e100_gstrings_stats, sizeof(e100_gstrings_stats));2729 break;2730 }2731}2732 2733static const struct ethtool_ops e100_ethtool_ops = {2734 .get_drvinfo = e100_get_drvinfo,2735 .get_regs_len = e100_get_regs_len,2736 .get_regs = e100_get_regs,2737 .get_wol = e100_get_wol,2738 .set_wol = e100_set_wol,2739 .get_msglevel = e100_get_msglevel,2740 .set_msglevel = e100_set_msglevel,2741 .nway_reset = e100_nway_reset,2742 .get_link = e100_get_link,2743 .get_eeprom_len = e100_get_eeprom_len,2744 .get_eeprom = e100_get_eeprom,2745 .set_eeprom = e100_set_eeprom,2746 .get_ringparam = e100_get_ringparam,2747 .set_ringparam = e100_set_ringparam,2748 .self_test = e100_diag_test,2749 .get_strings = e100_get_strings,2750 .set_phys_id = e100_set_phys_id,2751 .get_ethtool_stats = e100_get_ethtool_stats,2752 .get_sset_count = e100_get_sset_count,2753 .get_ts_info = ethtool_op_get_ts_info,2754 .get_link_ksettings = e100_get_link_ksettings,2755 .set_link_ksettings = e100_set_link_ksettings,2756};2757 2758static int e100_do_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)2759{2760 struct nic *nic = netdev_priv(netdev);2761 2762 return generic_mii_ioctl(&nic->mii, if_mii(ifr), cmd, NULL);2763}2764 2765static int e100_alloc(struct nic *nic)2766{2767 nic->mem = dma_alloc_coherent(&nic->pdev->dev, sizeof(struct mem),2768 &nic->dma_addr, GFP_KERNEL);2769 return nic->mem ? 0 : -ENOMEM;2770}2771 2772static void e100_free(struct nic *nic)2773{2774 if (nic->mem) {2775 dma_free_coherent(&nic->pdev->dev, sizeof(struct mem),2776 nic->mem, nic->dma_addr);2777 nic->mem = NULL;2778 }2779}2780 2781static int e100_open(struct net_device *netdev)2782{2783 struct nic *nic = netdev_priv(netdev);2784 int err = 0;2785 2786 netif_carrier_off(netdev);2787 if ((err = e100_up(nic)))2788 netif_err(nic, ifup, nic->netdev, "Cannot open interface, aborting\n");2789 return err;2790}2791 2792static int e100_close(struct net_device *netdev)2793{2794 e100_down(netdev_priv(netdev));2795 return 0;2796}2797 2798static int e100_set_features(struct net_device *netdev,2799 netdev_features_t features)2800{2801 struct nic *nic = netdev_priv(netdev);2802 netdev_features_t changed = features ^ netdev->features;2803 2804 if (!(changed & (NETIF_F_RXFCS | NETIF_F_RXALL)))2805 return 0;2806 2807 netdev->features = features;2808 e100_exec_cb(nic, NULL, e100_configure);2809 return 1;2810}2811 2812static const struct net_device_ops e100_netdev_ops = {2813 .ndo_open = e100_open,2814 .ndo_stop = e100_close,2815 .ndo_start_xmit = e100_xmit_frame,2816 .ndo_validate_addr = eth_validate_addr,2817 .ndo_set_rx_mode = e100_set_multicast_list,2818 .ndo_set_mac_address = e100_set_mac_address,2819 .ndo_eth_ioctl = e100_do_ioctl,2820 .ndo_tx_timeout = e100_tx_timeout,2821#ifdef CONFIG_NET_POLL_CONTROLLER2822 .ndo_poll_controller = e100_netpoll,2823#endif2824 .ndo_set_features = e100_set_features,2825};2826 2827static int e100_probe(struct pci_dev *pdev, const struct pci_device_id *ent)2828{2829 struct net_device *netdev;2830 struct nic *nic;2831 int err;2832 2833 if (!(netdev = alloc_etherdev(sizeof(struct nic))))2834 return -ENOMEM;2835 2836 netdev->hw_features |= NETIF_F_RXFCS;2837 netdev->priv_flags |= IFF_SUPP_NOFCS;2838 netdev->hw_features |= NETIF_F_RXALL;2839 2840 netdev->netdev_ops = &e100_netdev_ops;2841 netdev->ethtool_ops = &e100_ethtool_ops;2842 netdev->watchdog_timeo = E100_WATCHDOG_PERIOD;2843 strscpy(netdev->name, pci_name(pdev), sizeof(netdev->name));2844 2845 nic = netdev_priv(netdev);2846 netif_napi_add_weight(netdev, &nic->napi, e100_poll, E100_NAPI_WEIGHT);2847 nic->netdev = netdev;2848 nic->pdev = pdev;2849 nic->msg_enable = (1 << debug) - 1;2850 nic->mdio_ctrl = mdio_ctrl_hw;2851 pci_set_drvdata(pdev, netdev);2852 2853 if ((err = pci_enable_device(pdev))) {2854 netif_err(nic, probe, nic->netdev, "Cannot enable PCI device, aborting\n");2855 goto err_out_free_dev;2856 }2857 2858 if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {2859 netif_err(nic, probe, nic->netdev, "Cannot find proper PCI device base address, aborting\n");2860 err = -ENODEV;2861 goto err_out_disable_pdev;2862 }2863 2864 if ((err = pci_request_regions(pdev, DRV_NAME))) {2865 netif_err(nic, probe, nic->netdev, "Cannot obtain PCI resources, aborting\n");2866 goto err_out_disable_pdev;2867 }2868 2869 if ((err = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32)))) {2870 netif_err(nic, probe, nic->netdev, "No usable DMA configuration, aborting\n");2871 goto err_out_free_res;2872 }2873 2874 SET_NETDEV_DEV(netdev, &pdev->dev);2875 2876 if (use_io)2877 netif_info(nic, probe, nic->netdev, "using i/o access mode\n");2878 2879 nic->csr = pci_iomap(pdev, (use_io ? 1 : 0), sizeof(struct csr));2880 if (!nic->csr) {2881 netif_err(nic, probe, nic->netdev, "Cannot map device registers, aborting\n");2882 err = -ENOMEM;2883 goto err_out_free_res;2884 }2885 2886 if (ent->driver_data)2887 nic->flags |= ich;2888 else2889 nic->flags &= ~ich;2890 2891 e100_get_defaults(nic);2892 2893 /* D100 MAC doesn't allow rx of vlan packets with normal MTU */2894 if (nic->mac < mac_82558_D101_A4)2895 netdev->features |= NETIF_F_VLAN_CHALLENGED;2896 2897 /* locks must be initialized before calling hw_reset */2898 spin_lock_init(&nic->cb_lock);2899 spin_lock_init(&nic->cmd_lock);2900 spin_lock_init(&nic->mdio_lock);2901 2902 /* Reset the device before pci_set_master() in case device is in some2903 * funky state and has an interrupt pending - hint: we don't have the2904 * interrupt handler registered yet. */2905 e100_hw_reset(nic);2906 2907 pci_set_master(pdev);2908 2909 timer_setup(&nic->watchdog, e100_watchdog, 0);2910 2911 INIT_WORK(&nic->tx_timeout_task, e100_tx_timeout_task);2912 2913 if ((err = e100_alloc(nic))) {2914 netif_err(nic, probe, nic->netdev, "Cannot alloc driver memory, aborting\n");2915 goto err_out_iounmap;2916 }2917 2918 if ((err = e100_eeprom_load(nic)))2919 goto err_out_free;2920 2921 e100_phy_init(nic);2922 2923 eth_hw_addr_set(netdev, (u8 *)nic->eeprom);2924 if (!is_valid_ether_addr(netdev->dev_addr)) {2925 if (!eeprom_bad_csum_allow) {2926 netif_err(nic, probe, nic->netdev, "Invalid MAC address from EEPROM, aborting\n");2927 err = -EAGAIN;2928 goto err_out_free;2929 } else {2930 netif_err(nic, probe, nic->netdev, "Invalid MAC address from EEPROM, you MUST configure one.\n");2931 }2932 }2933 2934 /* Wol magic packet can be enabled from eeprom */2935 if ((nic->mac >= mac_82558_D101_A4) &&2936 (le16_to_cpu(nic->eeprom[eeprom_id]) & eeprom_id_wol)) {2937 nic->flags |= wol_magic;2938 device_set_wakeup_enable(&pdev->dev, true);2939 }2940 2941 /* ack any pending wake events, disable PME */2942 pci_pme_active(pdev, false);2943 2944 strcpy(netdev->name, "eth%d");2945 if ((err = register_netdev(netdev))) {2946 netif_err(nic, probe, nic->netdev, "Cannot register net device, aborting\n");2947 goto err_out_free;2948 }2949 nic->cbs_pool = dma_pool_create(netdev->name,2950 &nic->pdev->dev,2951 nic->params.cbs.max * sizeof(struct cb),2952 sizeof(u32),2953 0);2954 if (!nic->cbs_pool) {2955 netif_err(nic, probe, nic->netdev, "Cannot create DMA pool, aborting\n");2956 err = -ENOMEM;2957 goto err_out_pool;2958 }2959 netif_info(nic, probe, nic->netdev,2960 "addr 0x%llx, irq %d, MAC addr %pM\n",2961 (unsigned long long)pci_resource_start(pdev, use_io ? 1 : 0),2962 pdev->irq, netdev->dev_addr);2963 2964 return 0;2965 2966err_out_pool:2967 unregister_netdev(netdev);2968err_out_free:2969 e100_free(nic);2970err_out_iounmap:2971 pci_iounmap(pdev, nic->csr);2972err_out_free_res:2973 pci_release_regions(pdev);2974err_out_disable_pdev:2975 pci_disable_device(pdev);2976err_out_free_dev:2977 free_netdev(netdev);2978 return err;2979}2980 2981static void e100_remove(struct pci_dev *pdev)2982{2983 struct net_device *netdev = pci_get_drvdata(pdev);2984 2985 if (netdev) {2986 struct nic *nic = netdev_priv(netdev);2987 unregister_netdev(netdev);2988 e100_free(nic);2989 pci_iounmap(pdev, nic->csr);2990 dma_pool_destroy(nic->cbs_pool);2991 free_netdev(netdev);2992 pci_release_regions(pdev);2993 pci_disable_device(pdev);2994 }2995}2996 2997#define E100_82552_SMARTSPEED 0x14 /* SmartSpeed Ctrl register */2998#define E100_82552_REV_ANEG 0x0200 /* Reverse auto-negotiation */2999#define E100_82552_ANEG_NOW 0x0400 /* Auto-negotiate now */3000static void __e100_shutdown(struct pci_dev *pdev, bool *enable_wake)3001{3002 struct net_device *netdev = pci_get_drvdata(pdev);3003 struct nic *nic = netdev_priv(netdev);3004 3005 netif_device_detach(netdev);3006 3007 if (netif_running(netdev))3008 e100_down(nic);3009 3010 if ((nic->flags & wol_magic) | e100_asf(nic)) {3011 /* enable reverse auto-negotiation */3012 if (nic->phy == phy_82552_v) {3013 u16 smartspeed = mdio_read(netdev, nic->mii.phy_id,3014 E100_82552_SMARTSPEED);3015 3016 mdio_write(netdev, nic->mii.phy_id,3017 E100_82552_SMARTSPEED, smartspeed |3018 E100_82552_REV_ANEG | E100_82552_ANEG_NOW);3019 }3020 *enable_wake = true;3021 } else {3022 *enable_wake = false;3023 }3024 3025 pci_disable_device(pdev);3026}3027 3028static int __e100_power_off(struct pci_dev *pdev, bool wake)3029{3030 if (wake)3031 return pci_prepare_to_sleep(pdev);3032 3033 pci_wake_from_d3(pdev, false);3034 pci_set_power_state(pdev, PCI_D3hot);3035 3036 return 0;3037}3038 3039static int e100_suspend(struct device *dev_d)3040{3041 bool wake;3042 3043 __e100_shutdown(to_pci_dev(dev_d), &wake);3044 3045 return 0;3046}3047 3048static int e100_resume(struct device *dev_d)3049{3050 struct net_device *netdev = dev_get_drvdata(dev_d);3051 struct nic *nic = netdev_priv(netdev);3052 int err;3053 3054 err = pci_enable_device(to_pci_dev(dev_d));3055 if (err) {3056 netdev_err(netdev, "Resume cannot enable PCI device, aborting\n");3057 return err;3058 }3059 pci_set_master(to_pci_dev(dev_d));3060 3061 /* disable reverse auto-negotiation */3062 if (nic->phy == phy_82552_v) {3063 u16 smartspeed = mdio_read(netdev, nic->mii.phy_id,3064 E100_82552_SMARTSPEED);3065 3066 mdio_write(netdev, nic->mii.phy_id,3067 E100_82552_SMARTSPEED,3068 smartspeed & ~(E100_82552_REV_ANEG));3069 }3070 3071 if (netif_running(netdev))3072 e100_up(nic);3073 3074 netif_device_attach(netdev);3075 3076 return 0;3077}3078 3079static void e100_shutdown(struct pci_dev *pdev)3080{3081 bool wake;3082 __e100_shutdown(pdev, &wake);3083 if (system_state == SYSTEM_POWER_OFF)3084 __e100_power_off(pdev, wake);3085}3086 3087/* ------------------ PCI Error Recovery infrastructure -------------- */3088/**3089 * e100_io_error_detected - called when PCI error is detected.3090 * @pdev: Pointer to PCI device3091 * @state: The current pci connection state3092 */3093static pci_ers_result_t e100_io_error_detected(struct pci_dev *pdev, pci_channel_state_t state)3094{3095 struct net_device *netdev = pci_get_drvdata(pdev);3096 struct nic *nic = netdev_priv(netdev);3097 3098 netif_device_detach(netdev);3099 3100 if (state == pci_channel_io_perm_failure)3101 return PCI_ERS_RESULT_DISCONNECT;3102 3103 if (netif_running(netdev))3104 e100_down(nic);3105 pci_disable_device(pdev);3106 3107 /* Request a slot reset. */3108 return PCI_ERS_RESULT_NEED_RESET;3109}3110 3111/**3112 * e100_io_slot_reset - called after the pci bus has been reset.3113 * @pdev: Pointer to PCI device3114 *3115 * Restart the card from scratch.3116 */3117static pci_ers_result_t e100_io_slot_reset(struct pci_dev *pdev)3118{3119 struct net_device *netdev = pci_get_drvdata(pdev);3120 struct nic *nic = netdev_priv(netdev);3121 3122 if (pci_enable_device(pdev)) {3123 pr_err("Cannot re-enable PCI device after reset\n");3124 return PCI_ERS_RESULT_DISCONNECT;3125 }3126 pci_set_master(pdev);3127 3128 /* Only one device per card can do a reset */3129 if (0 != PCI_FUNC(pdev->devfn))3130 return PCI_ERS_RESULT_RECOVERED;3131 e100_hw_reset(nic);3132 e100_phy_init(nic);3133 3134 return PCI_ERS_RESULT_RECOVERED;3135}3136 3137/**3138 * e100_io_resume - resume normal operations3139 * @pdev: Pointer to PCI device3140 *3141 * Resume normal operations after an error recovery3142 * sequence has been completed.3143 */3144static void e100_io_resume(struct pci_dev *pdev)3145{3146 struct net_device *netdev = pci_get_drvdata(pdev);3147 struct nic *nic = netdev_priv(netdev);3148 3149 /* ack any pending wake events, disable PME */3150 pci_enable_wake(pdev, PCI_D0, 0);3151 3152 netif_device_attach(netdev);3153 if (netif_running(netdev)) {3154 e100_open(netdev);3155 mod_timer(&nic->watchdog, jiffies);3156 }3157}3158 3159static const struct pci_error_handlers e100_err_handler = {3160 .error_detected = e100_io_error_detected,3161 .slot_reset = e100_io_slot_reset,3162 .resume = e100_io_resume,3163};3164 3165static DEFINE_SIMPLE_DEV_PM_OPS(e100_pm_ops, e100_suspend, e100_resume);3166 3167static struct pci_driver e100_driver = {3168 .name = DRV_NAME,3169 .id_table = e100_id_table,3170 .probe = e100_probe,3171 .remove = e100_remove,3172 3173 /* Power Management hooks */3174 .driver.pm = pm_sleep_ptr(&e100_pm_ops),3175 3176 .shutdown = e100_shutdown,3177 .err_handler = &e100_err_handler,3178};3179 3180static int __init e100_init_module(void)3181{3182 if (((1 << debug) - 1) & NETIF_MSG_DRV) {3183 pr_info("%s\n", DRV_DESCRIPTION);3184 pr_info("%s\n", DRV_COPYRIGHT);3185 }3186 return pci_register_driver(&e100_driver);3187}3188 3189static void __exit e100_cleanup_module(void)3190{3191 pci_unregister_driver(&e100_driver);3192}3193 3194module_init(e100_init_module);3195module_exit(e100_cleanup_module);3196