1874aeea5SJeff Kirsher /**************************************************************************** 2f7a6d2c4SBen Hutchings * Driver for Solarflare network controllers and boards 3874aeea5SJeff Kirsher * Copyright 2005-2006 Fen Systems Ltd. 4f7a6d2c4SBen Hutchings * Copyright 2005-2013 Solarflare Communications Inc. 5874aeea5SJeff Kirsher * 6874aeea5SJeff Kirsher * This program is free software; you can redistribute it and/or modify it 7874aeea5SJeff Kirsher * under the terms of the GNU General Public License version 2 as published 8874aeea5SJeff Kirsher * by the Free Software Foundation, incorporated herein by reference. 9874aeea5SJeff Kirsher */ 10874aeea5SJeff Kirsher 11874aeea5SJeff Kirsher #include <linux/module.h> 12874aeea5SJeff Kirsher #include <linux/pci.h> 13874aeea5SJeff Kirsher #include <linux/netdevice.h> 14874aeea5SJeff Kirsher #include <linux/etherdevice.h> 15874aeea5SJeff Kirsher #include <linux/delay.h> 16874aeea5SJeff Kirsher #include <linux/notifier.h> 17874aeea5SJeff Kirsher #include <linux/ip.h> 18874aeea5SJeff Kirsher #include <linux/tcp.h> 19874aeea5SJeff Kirsher #include <linux/in.h> 20874aeea5SJeff Kirsher #include <linux/ethtool.h> 21874aeea5SJeff Kirsher #include <linux/topology.h> 22874aeea5SJeff Kirsher #include <linux/gfp.h> 23626950dbSAlexandre Rames #include <linux/aer.h> 24b28405b0SAlexandre Rames #include <linux/interrupt.h> 25874aeea5SJeff Kirsher #include "net_driver.h" 26874aeea5SJeff Kirsher #include "efx.h" 27874aeea5SJeff Kirsher #include "nic.h" 28dd40781eSBen Hutchings #include "selftest.h" 29874aeea5SJeff Kirsher 30874aeea5SJeff Kirsher #include "mcdi.h" 31874aeea5SJeff Kirsher #include "workarounds.h" 32874aeea5SJeff Kirsher 33874aeea5SJeff Kirsher /************************************************************************** 34874aeea5SJeff Kirsher * 35874aeea5SJeff Kirsher * Type name strings 36874aeea5SJeff Kirsher * 37874aeea5SJeff Kirsher ************************************************************************** 38874aeea5SJeff Kirsher */ 39874aeea5SJeff Kirsher 40874aeea5SJeff Kirsher /* Loopback mode names (see LOOPBACK_MODE()) */ 41874aeea5SJeff Kirsher const unsigned int efx_loopback_mode_max = LOOPBACK_MAX; 4218e83e4cSBen Hutchings const char *const efx_loopback_mode_names[] = { 43874aeea5SJeff Kirsher [LOOPBACK_NONE] = "NONE", 44874aeea5SJeff Kirsher [LOOPBACK_DATA] = "DATAPATH", 45874aeea5SJeff Kirsher [LOOPBACK_GMAC] = "GMAC", 46874aeea5SJeff Kirsher [LOOPBACK_XGMII] = "XGMII", 47874aeea5SJeff Kirsher [LOOPBACK_XGXS] = "XGXS", 48874aeea5SJeff Kirsher [LOOPBACK_XAUI] = "XAUI", 49874aeea5SJeff Kirsher [LOOPBACK_GMII] = "GMII", 50874aeea5SJeff Kirsher [LOOPBACK_SGMII] = "SGMII", 51874aeea5SJeff Kirsher [LOOPBACK_XGBR] = "XGBR", 52874aeea5SJeff Kirsher [LOOPBACK_XFI] = "XFI", 53874aeea5SJeff Kirsher [LOOPBACK_XAUI_FAR] = "XAUI_FAR", 54874aeea5SJeff Kirsher [LOOPBACK_GMII_FAR] = "GMII_FAR", 55874aeea5SJeff Kirsher [LOOPBACK_SGMII_FAR] = "SGMII_FAR", 56874aeea5SJeff Kirsher [LOOPBACK_XFI_FAR] = "XFI_FAR", 57874aeea5SJeff Kirsher [LOOPBACK_GPHY] = "GPHY", 58874aeea5SJeff Kirsher [LOOPBACK_PHYXS] = "PHYXS", 59874aeea5SJeff Kirsher [LOOPBACK_PCS] = "PCS", 60874aeea5SJeff Kirsher [LOOPBACK_PMAPMD] = "PMA/PMD", 61874aeea5SJeff Kirsher [LOOPBACK_XPORT] = "XPORT", 62874aeea5SJeff Kirsher [LOOPBACK_XGMII_WS] = "XGMII_WS", 63874aeea5SJeff Kirsher [LOOPBACK_XAUI_WS] = "XAUI_WS", 64874aeea5SJeff Kirsher [LOOPBACK_XAUI_WS_FAR] = "XAUI_WS_FAR", 65874aeea5SJeff Kirsher [LOOPBACK_XAUI_WS_NEAR] = "XAUI_WS_NEAR", 66874aeea5SJeff Kirsher [LOOPBACK_GMII_WS] = "GMII_WS", 67874aeea5SJeff Kirsher [LOOPBACK_XFI_WS] = "XFI_WS", 68874aeea5SJeff Kirsher [LOOPBACK_XFI_WS_FAR] = "XFI_WS_FAR", 69874aeea5SJeff Kirsher [LOOPBACK_PHYXS_WS] = "PHYXS_WS", 70874aeea5SJeff Kirsher }; 71874aeea5SJeff Kirsher 72874aeea5SJeff Kirsher const unsigned int efx_reset_type_max = RESET_TYPE_MAX; 7318e83e4cSBen Hutchings const char *const efx_reset_type_names[] = { 74874aeea5SJeff Kirsher [RESET_TYPE_INVISIBLE] = "INVISIBLE", 75874aeea5SJeff Kirsher [RESET_TYPE_ALL] = "ALL", 76626950dbSAlexandre Rames [RESET_TYPE_RECOVER_OR_ALL] = "RECOVER_OR_ALL", 77874aeea5SJeff Kirsher [RESET_TYPE_WORLD] = "WORLD", 78626950dbSAlexandre Rames [RESET_TYPE_RECOVER_OR_DISABLE] = "RECOVER_OR_DISABLE", 79e283546cSEdward Cree [RESET_TYPE_MC_BIST] = "MC_BIST", 80874aeea5SJeff Kirsher [RESET_TYPE_DISABLE] = "DISABLE", 81874aeea5SJeff Kirsher [RESET_TYPE_TX_WATCHDOG] = "TX_WATCHDOG", 82874aeea5SJeff Kirsher [RESET_TYPE_INT_ERROR] = "INT_ERROR", 83874aeea5SJeff Kirsher [RESET_TYPE_RX_RECOVERY] = "RX_RECOVERY", 843de82b91SAlexandre Rames [RESET_TYPE_DMA_ERROR] = "DMA_ERROR", 85874aeea5SJeff Kirsher [RESET_TYPE_TX_SKIP] = "TX_SKIP", 86874aeea5SJeff Kirsher [RESET_TYPE_MC_FAILURE] = "MC_FAILURE", 87e283546cSEdward Cree [RESET_TYPE_MCDI_TIMEOUT] = "MCDI_TIMEOUT (FLR)", 88874aeea5SJeff Kirsher }; 89874aeea5SJeff Kirsher 90874aeea5SJeff Kirsher /* Reset workqueue. If any NIC has a hardware failure then a reset will be 91874aeea5SJeff Kirsher * queued onto this work queue. This is not a per-nic work queue, because 92874aeea5SJeff Kirsher * efx_reset_work() acquires the rtnl lock, so resets are naturally serialised. 93874aeea5SJeff Kirsher */ 94874aeea5SJeff Kirsher static struct workqueue_struct *reset_workqueue; 95874aeea5SJeff Kirsher 9674cd60a4SJon Cooper /* How often and how many times to poll for a reset while waiting for a 9774cd60a4SJon Cooper * BIST that another function started to complete. 9874cd60a4SJon Cooper */ 9974cd60a4SJon Cooper #define BIST_WAIT_DELAY_MS 100 10074cd60a4SJon Cooper #define BIST_WAIT_DELAY_COUNT 100 10174cd60a4SJon Cooper 102874aeea5SJeff Kirsher /************************************************************************** 103874aeea5SJeff Kirsher * 104874aeea5SJeff Kirsher * Configurable values 105874aeea5SJeff Kirsher * 106874aeea5SJeff Kirsher *************************************************************************/ 107874aeea5SJeff Kirsher 108874aeea5SJeff Kirsher /* 109874aeea5SJeff Kirsher * Use separate channels for TX and RX events 110874aeea5SJeff Kirsher * 111874aeea5SJeff Kirsher * Set this to 1 to use separate channels for TX and RX. It allows us 112874aeea5SJeff Kirsher * to control interrupt affinity separately for TX and RX. 113874aeea5SJeff Kirsher * 114874aeea5SJeff Kirsher * This is only used in MSI-X interrupt mode 115874aeea5SJeff Kirsher */ 116b9cc977dSBen Hutchings static bool separate_tx_channels; 117b9cc977dSBen Hutchings module_param(separate_tx_channels, bool, 0444); 118874aeea5SJeff Kirsher MODULE_PARM_DESC(separate_tx_channels, 119874aeea5SJeff Kirsher "Use separate channels for TX and RX"); 120874aeea5SJeff Kirsher 121874aeea5SJeff Kirsher /* This is the weight assigned to each of the (per-channel) virtual 122874aeea5SJeff Kirsher * NAPI devices. 123874aeea5SJeff Kirsher */ 124874aeea5SJeff Kirsher static int napi_weight = 64; 125874aeea5SJeff Kirsher 126874aeea5SJeff Kirsher /* This is the time (in jiffies) between invocations of the hardware 127626950dbSAlexandre Rames * monitor. 128626950dbSAlexandre Rames * On Falcon-based NICs, this will: 129874aeea5SJeff Kirsher * - Check the on-board hardware monitor; 130874aeea5SJeff Kirsher * - Poll the link state and reconfigure the hardware as necessary. 131626950dbSAlexandre Rames * On Siena-based NICs for power systems with EEH support, this will give EEH a 132626950dbSAlexandre Rames * chance to start. 133874aeea5SJeff Kirsher */ 134874aeea5SJeff Kirsher static unsigned int efx_monitor_interval = 1 * HZ; 135874aeea5SJeff Kirsher 136874aeea5SJeff Kirsher /* Initial interrupt moderation settings. They can be modified after 137874aeea5SJeff Kirsher * module load with ethtool. 138874aeea5SJeff Kirsher * 139874aeea5SJeff Kirsher * The default for RX should strike a balance between increasing the 140874aeea5SJeff Kirsher * round-trip latency and reducing overhead. 141874aeea5SJeff Kirsher */ 142874aeea5SJeff Kirsher static unsigned int rx_irq_mod_usec = 60; 143874aeea5SJeff Kirsher 144874aeea5SJeff Kirsher /* Initial interrupt moderation settings. They can be modified after 145874aeea5SJeff Kirsher * module load with ethtool. 146874aeea5SJeff Kirsher * 147874aeea5SJeff Kirsher * This default is chosen to ensure that a 10G link does not go idle 148874aeea5SJeff Kirsher * while a TX queue is stopped after it has become full. A queue is 149874aeea5SJeff Kirsher * restarted when it drops below half full. The time this takes (assuming 150874aeea5SJeff Kirsher * worst case 3 descriptors per packet and 1024 descriptors) is 151874aeea5SJeff Kirsher * 512 / 3 * 1.2 = 205 usec. 152874aeea5SJeff Kirsher */ 153874aeea5SJeff Kirsher static unsigned int tx_irq_mod_usec = 150; 154874aeea5SJeff Kirsher 155874aeea5SJeff Kirsher /* This is the first interrupt mode to try out of: 156874aeea5SJeff Kirsher * 0 => MSI-X 157874aeea5SJeff Kirsher * 1 => MSI 158874aeea5SJeff Kirsher * 2 => legacy 159874aeea5SJeff Kirsher */ 160874aeea5SJeff Kirsher static unsigned int interrupt_mode; 161874aeea5SJeff Kirsher 162874aeea5SJeff Kirsher /* This is the requested number of CPUs to use for Receive-Side Scaling (RSS), 163874aeea5SJeff Kirsher * i.e. the number of CPUs among which we may distribute simultaneous 164874aeea5SJeff Kirsher * interrupt handling. 165874aeea5SJeff Kirsher * 166874aeea5SJeff Kirsher * Cards without MSI-X will only target one CPU via legacy or MSI interrupt. 167cdb08f8fSBen Hutchings * The default (0) means to assign an interrupt to each core. 168874aeea5SJeff Kirsher */ 169874aeea5SJeff Kirsher static unsigned int rss_cpus; 170874aeea5SJeff Kirsher module_param(rss_cpus, uint, 0444); 171874aeea5SJeff Kirsher MODULE_PARM_DESC(rss_cpus, "Number of CPUs to use for Receive-Side Scaling"); 172874aeea5SJeff Kirsher 173b9cc977dSBen Hutchings static bool phy_flash_cfg; 174b9cc977dSBen Hutchings module_param(phy_flash_cfg, bool, 0644); 175874aeea5SJeff Kirsher MODULE_PARM_DESC(phy_flash_cfg, "Set PHYs into reflash mode initially"); 176874aeea5SJeff Kirsher 177e7bed9c8SBen Hutchings static unsigned irq_adapt_low_thresh = 8000; 178874aeea5SJeff Kirsher module_param(irq_adapt_low_thresh, uint, 0644); 179874aeea5SJeff Kirsher MODULE_PARM_DESC(irq_adapt_low_thresh, 180874aeea5SJeff Kirsher "Threshold score for reducing IRQ moderation"); 181874aeea5SJeff Kirsher 182e7bed9c8SBen Hutchings static unsigned irq_adapt_high_thresh = 16000; 183874aeea5SJeff Kirsher module_param(irq_adapt_high_thresh, uint, 0644); 184874aeea5SJeff Kirsher MODULE_PARM_DESC(irq_adapt_high_thresh, 185874aeea5SJeff Kirsher "Threshold score for increasing IRQ moderation"); 186874aeea5SJeff Kirsher 187874aeea5SJeff Kirsher static unsigned debug = (NETIF_MSG_DRV | NETIF_MSG_PROBE | 188874aeea5SJeff Kirsher NETIF_MSG_LINK | NETIF_MSG_IFDOWN | 189874aeea5SJeff Kirsher NETIF_MSG_IFUP | NETIF_MSG_RX_ERR | 190874aeea5SJeff Kirsher NETIF_MSG_TX_ERR | NETIF_MSG_HW); 191874aeea5SJeff Kirsher module_param(debug, uint, 0); 192874aeea5SJeff Kirsher MODULE_PARM_DESC(debug, "Bitmapped debugging message enable value"); 193874aeea5SJeff Kirsher 194874aeea5SJeff Kirsher /************************************************************************** 195874aeea5SJeff Kirsher * 196874aeea5SJeff Kirsher * Utility functions and prototypes 197874aeea5SJeff Kirsher * 198874aeea5SJeff Kirsher *************************************************************************/ 199874aeea5SJeff Kirsher 200261e4d96SJon Cooper static int efx_soft_enable_interrupts(struct efx_nic *efx); 201d8291187SBen Hutchings static void efx_soft_disable_interrupts(struct efx_nic *efx); 2027f967c01SBen Hutchings static void efx_remove_channel(struct efx_channel *channel); 203874aeea5SJeff Kirsher static void efx_remove_channels(struct efx_nic *efx); 2047f967c01SBen Hutchings static const struct efx_channel_type efx_default_channel_type; 205874aeea5SJeff Kirsher static void efx_remove_port(struct efx_nic *efx); 2067f967c01SBen Hutchings static void efx_init_napi_channel(struct efx_channel *channel); 207874aeea5SJeff Kirsher static void efx_fini_napi(struct efx_nic *efx); 208874aeea5SJeff Kirsher static void efx_fini_napi_channel(struct efx_channel *channel); 209874aeea5SJeff Kirsher static void efx_fini_struct(struct efx_nic *efx); 210874aeea5SJeff Kirsher static void efx_start_all(struct efx_nic *efx); 211874aeea5SJeff Kirsher static void efx_stop_all(struct efx_nic *efx); 212874aeea5SJeff Kirsher 213874aeea5SJeff Kirsher #define EFX_ASSERT_RESET_SERIALISED(efx) \ 214874aeea5SJeff Kirsher do { \ 215f16aeea0SBen Hutchings if ((efx->state == STATE_READY) || \ 216626950dbSAlexandre Rames (efx->state == STATE_RECOVERY) || \ 217874aeea5SJeff Kirsher (efx->state == STATE_DISABLED)) \ 218874aeea5SJeff Kirsher ASSERT_RTNL(); \ 219874aeea5SJeff Kirsher } while (0) 220874aeea5SJeff Kirsher 2218b7325b4SBen Hutchings static int efx_check_disabled(struct efx_nic *efx) 2228b7325b4SBen Hutchings { 223626950dbSAlexandre Rames if (efx->state == STATE_DISABLED || efx->state == STATE_RECOVERY) { 2248b7325b4SBen Hutchings netif_err(efx, drv, efx->net_dev, 2258b7325b4SBen Hutchings "device is disabled due to earlier errors\n"); 2268b7325b4SBen Hutchings return -EIO; 2278b7325b4SBen Hutchings } 2288b7325b4SBen Hutchings return 0; 2298b7325b4SBen Hutchings } 2308b7325b4SBen Hutchings 231874aeea5SJeff Kirsher /************************************************************************** 232874aeea5SJeff Kirsher * 233874aeea5SJeff Kirsher * Event queue processing 234874aeea5SJeff Kirsher * 235874aeea5SJeff Kirsher *************************************************************************/ 236874aeea5SJeff Kirsher 237874aeea5SJeff Kirsher /* Process channel's event queue 238874aeea5SJeff Kirsher * 239874aeea5SJeff Kirsher * This function is responsible for processing the event queue of a 240874aeea5SJeff Kirsher * single channel. The caller must guarantee that this function will 241874aeea5SJeff Kirsher * never be concurrently called more than once on the same channel, 242874aeea5SJeff Kirsher * though different channels may be being processed concurrently. 243874aeea5SJeff Kirsher */ 244874aeea5SJeff Kirsher static int efx_process_channel(struct efx_channel *channel, int budget) 245874aeea5SJeff Kirsher { 246874aeea5SJeff Kirsher int spent; 247874aeea5SJeff Kirsher 2489f2cb71cSBen Hutchings if (unlikely(!channel->enabled)) 249874aeea5SJeff Kirsher return 0; 250874aeea5SJeff Kirsher 251874aeea5SJeff Kirsher spent = efx_nic_process_eventq(channel, budget); 252d9ab7007SBen Hutchings if (spent && efx_channel_has_rx_queue(channel)) { 253d9ab7007SBen Hutchings struct efx_rx_queue *rx_queue = 254d9ab7007SBen Hutchings efx_channel_get_rx_queue(channel); 255874aeea5SJeff Kirsher 256ff734ef4SBen Hutchings efx_rx_flush_packet(channel); 257cce28794SJon Cooper efx_fast_push_rx_descriptors(rx_queue, true); 258d9ab7007SBen Hutchings } 259874aeea5SJeff Kirsher 260874aeea5SJeff Kirsher return spent; 261874aeea5SJeff Kirsher } 262874aeea5SJeff Kirsher 263874aeea5SJeff Kirsher /* NAPI poll handler 264874aeea5SJeff Kirsher * 265874aeea5SJeff Kirsher * NAPI guarantees serialisation of polls of the same device, which 266874aeea5SJeff Kirsher * provides the guarantee required by efx_process_channel(). 267874aeea5SJeff Kirsher */ 268874aeea5SJeff Kirsher static int efx_poll(struct napi_struct *napi, int budget) 269874aeea5SJeff Kirsher { 270874aeea5SJeff Kirsher struct efx_channel *channel = 271874aeea5SJeff Kirsher container_of(napi, struct efx_channel, napi_str); 272874aeea5SJeff Kirsher struct efx_nic *efx = channel->efx; 273874aeea5SJeff Kirsher int spent; 274874aeea5SJeff Kirsher 27536763266SAlexandre Rames if (!efx_channel_lock_napi(channel)) 27636763266SAlexandre Rames return budget; 27736763266SAlexandre Rames 278874aeea5SJeff Kirsher netif_vdbg(efx, intr, efx->net_dev, 279874aeea5SJeff Kirsher "channel %d NAPI poll executing on CPU %d\n", 280874aeea5SJeff Kirsher channel->channel, raw_smp_processor_id()); 281874aeea5SJeff Kirsher 282874aeea5SJeff Kirsher spent = efx_process_channel(channel, budget); 283874aeea5SJeff Kirsher 284874aeea5SJeff Kirsher if (spent < budget) { 2859d9a6973SBen Hutchings if (efx_channel_has_rx_queue(channel) && 286874aeea5SJeff Kirsher efx->irq_rx_adaptive && 287874aeea5SJeff Kirsher unlikely(++channel->irq_count == 1000)) { 288874aeea5SJeff Kirsher if (unlikely(channel->irq_mod_score < 289874aeea5SJeff Kirsher irq_adapt_low_thresh)) { 290874aeea5SJeff Kirsher if (channel->irq_moderation > 1) { 291874aeea5SJeff Kirsher channel->irq_moderation -= 1; 292874aeea5SJeff Kirsher efx->type->push_irq_moderation(channel); 293874aeea5SJeff Kirsher } 294874aeea5SJeff Kirsher } else if (unlikely(channel->irq_mod_score > 295874aeea5SJeff Kirsher irq_adapt_high_thresh)) { 296874aeea5SJeff Kirsher if (channel->irq_moderation < 297874aeea5SJeff Kirsher efx->irq_rx_moderation) { 298874aeea5SJeff Kirsher channel->irq_moderation += 1; 299874aeea5SJeff Kirsher efx->type->push_irq_moderation(channel); 300874aeea5SJeff Kirsher } 301874aeea5SJeff Kirsher } 302874aeea5SJeff Kirsher channel->irq_count = 0; 303874aeea5SJeff Kirsher channel->irq_mod_score = 0; 304874aeea5SJeff Kirsher } 305874aeea5SJeff Kirsher 306874aeea5SJeff Kirsher efx_filter_rfs_expire(channel); 307874aeea5SJeff Kirsher 308874aeea5SJeff Kirsher /* There is no race here; although napi_disable() will 309874aeea5SJeff Kirsher * only wait for napi_complete(), this isn't a problem 310514bedbcSBen Hutchings * since efx_nic_eventq_read_ack() will have no effect if 311874aeea5SJeff Kirsher * interrupts have already been disabled. 312874aeea5SJeff Kirsher */ 313874aeea5SJeff Kirsher napi_complete(napi); 314514bedbcSBen Hutchings efx_nic_eventq_read_ack(channel); 315874aeea5SJeff Kirsher } 316874aeea5SJeff Kirsher 31736763266SAlexandre Rames efx_channel_unlock_napi(channel); 318874aeea5SJeff Kirsher return spent; 319874aeea5SJeff Kirsher } 320874aeea5SJeff Kirsher 321874aeea5SJeff Kirsher /* Create event queue 322874aeea5SJeff Kirsher * Event queue memory allocations are done only once. If the channel 323874aeea5SJeff Kirsher * is reset, the memory buffer will be reused; this guards against 324874aeea5SJeff Kirsher * errors during channel reset and also simplifies interrupt handling. 325874aeea5SJeff Kirsher */ 326874aeea5SJeff Kirsher static int efx_probe_eventq(struct efx_channel *channel) 327874aeea5SJeff Kirsher { 328874aeea5SJeff Kirsher struct efx_nic *efx = channel->efx; 329874aeea5SJeff Kirsher unsigned long entries; 330874aeea5SJeff Kirsher 33186ee5302SBen Hutchings netif_dbg(efx, probe, efx->net_dev, 332874aeea5SJeff Kirsher "chan %d create event queue\n", channel->channel); 333874aeea5SJeff Kirsher 334874aeea5SJeff Kirsher /* Build an event queue with room for one event per tx and rx buffer, 335874aeea5SJeff Kirsher * plus some extra for link state events and MCDI completions. */ 336874aeea5SJeff Kirsher entries = roundup_pow_of_two(efx->rxq_entries + efx->txq_entries + 128); 337874aeea5SJeff Kirsher EFX_BUG_ON_PARANOID(entries > EFX_MAX_EVQ_SIZE); 338874aeea5SJeff Kirsher channel->eventq_mask = max(entries, EFX_MIN_EVQ_SIZE) - 1; 339874aeea5SJeff Kirsher 340874aeea5SJeff Kirsher return efx_nic_probe_eventq(channel); 341874aeea5SJeff Kirsher } 342874aeea5SJeff Kirsher 343874aeea5SJeff Kirsher /* Prepare channel's event queue */ 344261e4d96SJon Cooper static int efx_init_eventq(struct efx_channel *channel) 345874aeea5SJeff Kirsher { 34615acb1ceSBen Hutchings struct efx_nic *efx = channel->efx; 347261e4d96SJon Cooper int rc; 348261e4d96SJon Cooper 349261e4d96SJon Cooper EFX_WARN_ON_PARANOID(channel->eventq_init); 350261e4d96SJon Cooper 35115acb1ceSBen Hutchings netif_dbg(efx, drv, efx->net_dev, 352874aeea5SJeff Kirsher "chan %d init event queue\n", channel->channel); 353874aeea5SJeff Kirsher 354261e4d96SJon Cooper rc = efx_nic_init_eventq(channel); 355261e4d96SJon Cooper if (rc == 0) { 35615acb1ceSBen Hutchings efx->type->push_irq_moderation(channel); 357874aeea5SJeff Kirsher channel->eventq_read_ptr = 0; 358be3fc09cSBen Hutchings channel->eventq_init = true; 359874aeea5SJeff Kirsher } 360261e4d96SJon Cooper return rc; 361261e4d96SJon Cooper } 362874aeea5SJeff Kirsher 3639f2cb71cSBen Hutchings /* Enable event queue processing and NAPI */ 36436763266SAlexandre Rames void efx_start_eventq(struct efx_channel *channel) 3659f2cb71cSBen Hutchings { 3669f2cb71cSBen Hutchings netif_dbg(channel->efx, ifup, channel->efx->net_dev, 3679f2cb71cSBen Hutchings "chan %d start event queue\n", channel->channel); 3689f2cb71cSBen Hutchings 369514bedbcSBen Hutchings /* Make sure the NAPI handler sees the enabled flag set */ 3709f2cb71cSBen Hutchings channel->enabled = true; 3719f2cb71cSBen Hutchings smp_wmb(); 3729f2cb71cSBen Hutchings 37336763266SAlexandre Rames efx_channel_enable(channel); 3749f2cb71cSBen Hutchings napi_enable(&channel->napi_str); 3759f2cb71cSBen Hutchings efx_nic_eventq_read_ack(channel); 3769f2cb71cSBen Hutchings } 3779f2cb71cSBen Hutchings 3789f2cb71cSBen Hutchings /* Disable event queue processing and NAPI */ 37936763266SAlexandre Rames void efx_stop_eventq(struct efx_channel *channel) 3809f2cb71cSBen Hutchings { 3819f2cb71cSBen Hutchings if (!channel->enabled) 3829f2cb71cSBen Hutchings return; 3839f2cb71cSBen Hutchings 3849f2cb71cSBen Hutchings napi_disable(&channel->napi_str); 38536763266SAlexandre Rames while (!efx_channel_disable(channel)) 38636763266SAlexandre Rames usleep_range(1000, 20000); 3879f2cb71cSBen Hutchings channel->enabled = false; 3889f2cb71cSBen Hutchings } 3899f2cb71cSBen Hutchings 390874aeea5SJeff Kirsher static void efx_fini_eventq(struct efx_channel *channel) 391874aeea5SJeff Kirsher { 392be3fc09cSBen Hutchings if (!channel->eventq_init) 393be3fc09cSBen Hutchings return; 394be3fc09cSBen Hutchings 395874aeea5SJeff Kirsher netif_dbg(channel->efx, drv, channel->efx->net_dev, 396874aeea5SJeff Kirsher "chan %d fini event queue\n", channel->channel); 397874aeea5SJeff Kirsher 398874aeea5SJeff Kirsher efx_nic_fini_eventq(channel); 399be3fc09cSBen Hutchings channel->eventq_init = false; 400874aeea5SJeff Kirsher } 401874aeea5SJeff Kirsher 402874aeea5SJeff Kirsher static void efx_remove_eventq(struct efx_channel *channel) 403874aeea5SJeff Kirsher { 404874aeea5SJeff Kirsher netif_dbg(channel->efx, drv, channel->efx->net_dev, 405874aeea5SJeff Kirsher "chan %d remove event queue\n", channel->channel); 406874aeea5SJeff Kirsher 407874aeea5SJeff Kirsher efx_nic_remove_eventq(channel); 408874aeea5SJeff Kirsher } 409874aeea5SJeff Kirsher 410874aeea5SJeff Kirsher /************************************************************************** 411874aeea5SJeff Kirsher * 412874aeea5SJeff Kirsher * Channel handling 413874aeea5SJeff Kirsher * 414874aeea5SJeff Kirsher *************************************************************************/ 415874aeea5SJeff Kirsher 4167f967c01SBen Hutchings /* Allocate and initialise a channel structure. */ 417874aeea5SJeff Kirsher static struct efx_channel * 418874aeea5SJeff Kirsher efx_alloc_channel(struct efx_nic *efx, int i, struct efx_channel *old_channel) 419874aeea5SJeff Kirsher { 420874aeea5SJeff Kirsher struct efx_channel *channel; 421874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 422874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 423874aeea5SJeff Kirsher int j; 424874aeea5SJeff Kirsher 4257f967c01SBen Hutchings channel = kzalloc(sizeof(*channel), GFP_KERNEL); 4267f967c01SBen Hutchings if (!channel) 4277f967c01SBen Hutchings return NULL; 4287f967c01SBen Hutchings 4297f967c01SBen Hutchings channel->efx = efx; 4307f967c01SBen Hutchings channel->channel = i; 4317f967c01SBen Hutchings channel->type = &efx_default_channel_type; 4327f967c01SBen Hutchings 4337f967c01SBen Hutchings for (j = 0; j < EFX_TXQ_TYPES; j++) { 4347f967c01SBen Hutchings tx_queue = &channel->tx_queue[j]; 4357f967c01SBen Hutchings tx_queue->efx = efx; 4367f967c01SBen Hutchings tx_queue->queue = i * EFX_TXQ_TYPES + j; 4377f967c01SBen Hutchings tx_queue->channel = channel; 4387f967c01SBen Hutchings } 4397f967c01SBen Hutchings 4407f967c01SBen Hutchings rx_queue = &channel->rx_queue; 4417f967c01SBen Hutchings rx_queue->efx = efx; 4427f967c01SBen Hutchings setup_timer(&rx_queue->slow_fill, efx_rx_slow_fill, 4437f967c01SBen Hutchings (unsigned long)rx_queue); 4447f967c01SBen Hutchings 4457f967c01SBen Hutchings return channel; 4467f967c01SBen Hutchings } 4477f967c01SBen Hutchings 4487f967c01SBen Hutchings /* Allocate and initialise a channel structure, copying parameters 4497f967c01SBen Hutchings * (but not resources) from an old channel structure. 4507f967c01SBen Hutchings */ 4517f967c01SBen Hutchings static struct efx_channel * 4527f967c01SBen Hutchings efx_copy_channel(const struct efx_channel *old_channel) 4537f967c01SBen Hutchings { 4547f967c01SBen Hutchings struct efx_channel *channel; 4557f967c01SBen Hutchings struct efx_rx_queue *rx_queue; 4567f967c01SBen Hutchings struct efx_tx_queue *tx_queue; 4577f967c01SBen Hutchings int j; 4587f967c01SBen Hutchings 459874aeea5SJeff Kirsher channel = kmalloc(sizeof(*channel), GFP_KERNEL); 460874aeea5SJeff Kirsher if (!channel) 461874aeea5SJeff Kirsher return NULL; 462874aeea5SJeff Kirsher 463874aeea5SJeff Kirsher *channel = *old_channel; 464874aeea5SJeff Kirsher 465874aeea5SJeff Kirsher channel->napi_dev = NULL; 466874aeea5SJeff Kirsher memset(&channel->eventq, 0, sizeof(channel->eventq)); 467874aeea5SJeff Kirsher 468874aeea5SJeff Kirsher for (j = 0; j < EFX_TXQ_TYPES; j++) { 469874aeea5SJeff Kirsher tx_queue = &channel->tx_queue[j]; 470874aeea5SJeff Kirsher if (tx_queue->channel) 471874aeea5SJeff Kirsher tx_queue->channel = channel; 472874aeea5SJeff Kirsher tx_queue->buffer = NULL; 473874aeea5SJeff Kirsher memset(&tx_queue->txd, 0, sizeof(tx_queue->txd)); 474874aeea5SJeff Kirsher } 475874aeea5SJeff Kirsher 476874aeea5SJeff Kirsher rx_queue = &channel->rx_queue; 4777f967c01SBen Hutchings rx_queue->buffer = NULL; 4787f967c01SBen Hutchings memset(&rx_queue->rxd, 0, sizeof(rx_queue->rxd)); 479874aeea5SJeff Kirsher setup_timer(&rx_queue->slow_fill, efx_rx_slow_fill, 480874aeea5SJeff Kirsher (unsigned long)rx_queue); 481874aeea5SJeff Kirsher 482874aeea5SJeff Kirsher return channel; 483874aeea5SJeff Kirsher } 484874aeea5SJeff Kirsher 485874aeea5SJeff Kirsher static int efx_probe_channel(struct efx_channel *channel) 486874aeea5SJeff Kirsher { 487874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 488874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 489874aeea5SJeff Kirsher int rc; 490874aeea5SJeff Kirsher 491874aeea5SJeff Kirsher netif_dbg(channel->efx, probe, channel->efx->net_dev, 492874aeea5SJeff Kirsher "creating channel %d\n", channel->channel); 493874aeea5SJeff Kirsher 4947f967c01SBen Hutchings rc = channel->type->pre_probe(channel); 4957f967c01SBen Hutchings if (rc) 4967f967c01SBen Hutchings goto fail; 4977f967c01SBen Hutchings 498874aeea5SJeff Kirsher rc = efx_probe_eventq(channel); 499874aeea5SJeff Kirsher if (rc) 5007f967c01SBen Hutchings goto fail; 501874aeea5SJeff Kirsher 502874aeea5SJeff Kirsher efx_for_each_channel_tx_queue(tx_queue, channel) { 503874aeea5SJeff Kirsher rc = efx_probe_tx_queue(tx_queue); 504874aeea5SJeff Kirsher if (rc) 5057f967c01SBen Hutchings goto fail; 506874aeea5SJeff Kirsher } 507874aeea5SJeff Kirsher 508874aeea5SJeff Kirsher efx_for_each_channel_rx_queue(rx_queue, channel) { 509874aeea5SJeff Kirsher rc = efx_probe_rx_queue(rx_queue); 510874aeea5SJeff Kirsher if (rc) 5117f967c01SBen Hutchings goto fail; 512874aeea5SJeff Kirsher } 513874aeea5SJeff Kirsher 514874aeea5SJeff Kirsher return 0; 515874aeea5SJeff Kirsher 5167f967c01SBen Hutchings fail: 5177f967c01SBen Hutchings efx_remove_channel(channel); 518874aeea5SJeff Kirsher return rc; 519874aeea5SJeff Kirsher } 520874aeea5SJeff Kirsher 5217f967c01SBen Hutchings static void 5227f967c01SBen Hutchings efx_get_channel_name(struct efx_channel *channel, char *buf, size_t len) 5237f967c01SBen Hutchings { 5247f967c01SBen Hutchings struct efx_nic *efx = channel->efx; 5257f967c01SBen Hutchings const char *type; 5267f967c01SBen Hutchings int number; 5277f967c01SBen Hutchings 5287f967c01SBen Hutchings number = channel->channel; 5297f967c01SBen Hutchings if (efx->tx_channel_offset == 0) { 5307f967c01SBen Hutchings type = ""; 5317f967c01SBen Hutchings } else if (channel->channel < efx->tx_channel_offset) { 5327f967c01SBen Hutchings type = "-rx"; 5337f967c01SBen Hutchings } else { 5347f967c01SBen Hutchings type = "-tx"; 5357f967c01SBen Hutchings number -= efx->tx_channel_offset; 5367f967c01SBen Hutchings } 5377f967c01SBen Hutchings snprintf(buf, len, "%s%s-%d", efx->name, type, number); 5387f967c01SBen Hutchings } 539874aeea5SJeff Kirsher 540874aeea5SJeff Kirsher static void efx_set_channel_names(struct efx_nic *efx) 541874aeea5SJeff Kirsher { 542874aeea5SJeff Kirsher struct efx_channel *channel; 543874aeea5SJeff Kirsher 5447f967c01SBen Hutchings efx_for_each_channel(channel, efx) 5457f967c01SBen Hutchings channel->type->get_name(channel, 546d8291187SBen Hutchings efx->msi_context[channel->channel].name, 547d8291187SBen Hutchings sizeof(efx->msi_context[0].name)); 548874aeea5SJeff Kirsher } 549874aeea5SJeff Kirsher 550874aeea5SJeff Kirsher static int efx_probe_channels(struct efx_nic *efx) 551874aeea5SJeff Kirsher { 552874aeea5SJeff Kirsher struct efx_channel *channel; 553874aeea5SJeff Kirsher int rc; 554874aeea5SJeff Kirsher 555874aeea5SJeff Kirsher /* Restart special buffer allocation */ 556874aeea5SJeff Kirsher efx->next_buffer_table = 0; 557874aeea5SJeff Kirsher 558c92aaff1SBen Hutchings /* Probe channels in reverse, so that any 'extra' channels 559c92aaff1SBen Hutchings * use the start of the buffer table. This allows the traffic 560c92aaff1SBen Hutchings * channels to be resized without moving them or wasting the 561c92aaff1SBen Hutchings * entries before them. 562c92aaff1SBen Hutchings */ 563c92aaff1SBen Hutchings efx_for_each_channel_rev(channel, efx) { 564874aeea5SJeff Kirsher rc = efx_probe_channel(channel); 565874aeea5SJeff Kirsher if (rc) { 566874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 567874aeea5SJeff Kirsher "failed to create channel %d\n", 568874aeea5SJeff Kirsher channel->channel); 569874aeea5SJeff Kirsher goto fail; 570874aeea5SJeff Kirsher } 571874aeea5SJeff Kirsher } 572874aeea5SJeff Kirsher efx_set_channel_names(efx); 573874aeea5SJeff Kirsher 574874aeea5SJeff Kirsher return 0; 575874aeea5SJeff Kirsher 576874aeea5SJeff Kirsher fail: 577874aeea5SJeff Kirsher efx_remove_channels(efx); 578874aeea5SJeff Kirsher return rc; 579874aeea5SJeff Kirsher } 580874aeea5SJeff Kirsher 581874aeea5SJeff Kirsher /* Channels are shutdown and reinitialised whilst the NIC is running 582874aeea5SJeff Kirsher * to propagate configuration changes (mtu, checksum offload), or 583874aeea5SJeff Kirsher * to clear hardware error conditions 584874aeea5SJeff Kirsher */ 5859f2cb71cSBen Hutchings static void efx_start_datapath(struct efx_nic *efx) 586874aeea5SJeff Kirsher { 58785740cdfSBen Hutchings bool old_rx_scatter = efx->rx_scatter; 588874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 589874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 590874aeea5SJeff Kirsher struct efx_channel *channel; 59185740cdfSBen Hutchings size_t rx_buf_len; 592874aeea5SJeff Kirsher 593874aeea5SJeff Kirsher /* Calculate the rx buffer allocation parameters required to 594874aeea5SJeff Kirsher * support the current MTU, including padding for header 595874aeea5SJeff Kirsher * alignment and overruns. 596874aeea5SJeff Kirsher */ 59743a3739dSJon Cooper efx->rx_dma_len = (efx->rx_prefix_size + 598874aeea5SJeff Kirsher EFX_MAX_FRAME_LEN(efx->net_dev->mtu) + 599874aeea5SJeff Kirsher efx->type->rx_buffer_padding); 60085740cdfSBen Hutchings rx_buf_len = (sizeof(struct efx_rx_page_state) + 6012ec03014SAndrew Rybchenko efx->rx_ip_align + efx->rx_dma_len); 60285740cdfSBen Hutchings if (rx_buf_len <= PAGE_SIZE) { 603e8c68c0aSJon Cooper efx->rx_scatter = efx->type->always_rx_scatter; 60485740cdfSBen Hutchings efx->rx_buffer_order = 0; 60585740cdfSBen Hutchings } else if (efx->type->can_rx_scatter) { 606950c54dfSBen Hutchings BUILD_BUG_ON(EFX_RX_USR_BUF_SIZE % L1_CACHE_BYTES); 60785740cdfSBen Hutchings BUILD_BUG_ON(sizeof(struct efx_rx_page_state) + 608950c54dfSBen Hutchings 2 * ALIGN(NET_IP_ALIGN + EFX_RX_USR_BUF_SIZE, 609950c54dfSBen Hutchings EFX_RX_BUF_ALIGNMENT) > 610950c54dfSBen Hutchings PAGE_SIZE); 61185740cdfSBen Hutchings efx->rx_scatter = true; 61285740cdfSBen Hutchings efx->rx_dma_len = EFX_RX_USR_BUF_SIZE; 61385740cdfSBen Hutchings efx->rx_buffer_order = 0; 61485740cdfSBen Hutchings } else { 61585740cdfSBen Hutchings efx->rx_scatter = false; 61685740cdfSBen Hutchings efx->rx_buffer_order = get_order(rx_buf_len); 61785740cdfSBen Hutchings } 61885740cdfSBen Hutchings 6191648a23fSDaniel Pieczko efx_rx_config_page_split(efx); 6201648a23fSDaniel Pieczko if (efx->rx_buffer_order) 6211648a23fSDaniel Pieczko netif_dbg(efx, drv, efx->net_dev, 6221648a23fSDaniel Pieczko "RX buf len=%u; page order=%u batch=%u\n", 6231648a23fSDaniel Pieczko efx->rx_dma_len, efx->rx_buffer_order, 6241648a23fSDaniel Pieczko efx->rx_pages_per_batch); 6251648a23fSDaniel Pieczko else 6261648a23fSDaniel Pieczko netif_dbg(efx, drv, efx->net_dev, 6271648a23fSDaniel Pieczko "RX buf len=%u step=%u bpp=%u; page batch=%u\n", 6281648a23fSDaniel Pieczko efx->rx_dma_len, efx->rx_page_buf_step, 6291648a23fSDaniel Pieczko efx->rx_bufs_per_page, efx->rx_pages_per_batch); 6302768935aSDaniel Pieczko 631e8c68c0aSJon Cooper /* RX filters may also have scatter-enabled flags */ 63285740cdfSBen Hutchings if (efx->rx_scatter != old_rx_scatter) 633add72477SBen Hutchings efx->type->filter_update_rx_scatter(efx); 634874aeea5SJeff Kirsher 63514bf718fSBen Hutchings /* We must keep at least one descriptor in a TX ring empty. 63614bf718fSBen Hutchings * We could avoid this when the queue size does not exactly 63714bf718fSBen Hutchings * match the hardware ring size, but it's not that important. 63814bf718fSBen Hutchings * Therefore we stop the queue when one more skb might fill 63914bf718fSBen Hutchings * the ring completely. We wake it when half way back to 64014bf718fSBen Hutchings * empty. 64114bf718fSBen Hutchings */ 64214bf718fSBen Hutchings efx->txq_stop_thresh = efx->txq_entries - efx_tx_max_skb_descs(efx); 64314bf718fSBen Hutchings efx->txq_wake_thresh = efx->txq_stop_thresh / 2; 64414bf718fSBen Hutchings 645874aeea5SJeff Kirsher /* Initialise the channels */ 646874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 6473881d8abSAlexandre Rames efx_for_each_channel_tx_queue(tx_queue, channel) { 648874aeea5SJeff Kirsher efx_init_tx_queue(tx_queue); 6493881d8abSAlexandre Rames atomic_inc(&efx->active_queues); 6503881d8abSAlexandre Rames } 651874aeea5SJeff Kirsher 6529f2cb71cSBen Hutchings efx_for_each_channel_rx_queue(rx_queue, channel) { 653874aeea5SJeff Kirsher efx_init_rx_queue(rx_queue); 6543881d8abSAlexandre Rames atomic_inc(&efx->active_queues); 655cce28794SJon Cooper efx_stop_eventq(channel); 656cce28794SJon Cooper efx_fast_push_rx_descriptors(rx_queue, false); 657cce28794SJon Cooper efx_start_eventq(channel); 6589f2cb71cSBen Hutchings } 659874aeea5SJeff Kirsher 66085740cdfSBen Hutchings WARN_ON(channel->rx_pkt_n_frags); 661874aeea5SJeff Kirsher } 6629f2cb71cSBen Hutchings 6632ea4dc28SAlexandre Rames efx_ptp_start_datapath(efx); 6642ea4dc28SAlexandre Rames 6659f2cb71cSBen Hutchings if (netif_device_present(efx->net_dev)) 6669f2cb71cSBen Hutchings netif_tx_wake_all_queues(efx->net_dev); 667874aeea5SJeff Kirsher } 668874aeea5SJeff Kirsher 6699f2cb71cSBen Hutchings static void efx_stop_datapath(struct efx_nic *efx) 670874aeea5SJeff Kirsher { 671874aeea5SJeff Kirsher struct efx_channel *channel; 672874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 673874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 674874aeea5SJeff Kirsher int rc; 675874aeea5SJeff Kirsher 676874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 677874aeea5SJeff Kirsher BUG_ON(efx->port_enabled); 678874aeea5SJeff Kirsher 6792ea4dc28SAlexandre Rames efx_ptp_stop_datapath(efx); 6802ea4dc28SAlexandre Rames 681d8aec745SBen Hutchings /* Stop RX refill */ 682d8aec745SBen Hutchings efx_for_each_channel(channel, efx) { 683d8aec745SBen Hutchings efx_for_each_channel_rx_queue(rx_queue, channel) 684d8aec745SBen Hutchings rx_queue->refill_enabled = false; 685d8aec745SBen Hutchings } 686d8aec745SBen Hutchings 687874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 6889f2cb71cSBen Hutchings /* RX packet processing is pipelined, so wait for the 6899f2cb71cSBen Hutchings * NAPI handler to complete. At least event queue 0 6909f2cb71cSBen Hutchings * might be kept active by non-data events, so don't 6919f2cb71cSBen Hutchings * use napi_synchronize() but actually disable NAPI 6929f2cb71cSBen Hutchings * temporarily. 6939f2cb71cSBen Hutchings */ 6949f2cb71cSBen Hutchings if (efx_channel_has_rx_queue(channel)) { 6959f2cb71cSBen Hutchings efx_stop_eventq(channel); 6969f2cb71cSBen Hutchings efx_start_eventq(channel); 6979f2cb71cSBen Hutchings } 698e42c3d85SBen Hutchings } 699874aeea5SJeff Kirsher 700e42c3d85SBen Hutchings rc = efx->type->fini_dmaq(efx); 701e42c3d85SBen Hutchings if (rc && EFX_WORKAROUND_7803(efx)) { 702e42c3d85SBen Hutchings /* Schedule a reset to recover from the flush failure. The 703e42c3d85SBen Hutchings * descriptor caches reference memory we're about to free, 704e42c3d85SBen Hutchings * but falcon_reconfigure_mac_wrapper() won't reconnect 705e42c3d85SBen Hutchings * the MACs because of the pending reset. 706e42c3d85SBen Hutchings */ 707e42c3d85SBen Hutchings netif_err(efx, drv, efx->net_dev, 708e42c3d85SBen Hutchings "Resetting to recover from flush failure\n"); 709e42c3d85SBen Hutchings efx_schedule_reset(efx, RESET_TYPE_ALL); 710e42c3d85SBen Hutchings } else if (rc) { 711e42c3d85SBen Hutchings netif_err(efx, drv, efx->net_dev, "failed to flush queues\n"); 712e42c3d85SBen Hutchings } else { 713e42c3d85SBen Hutchings netif_dbg(efx, drv, efx->net_dev, 714e42c3d85SBen Hutchings "successfully flushed all queues\n"); 715e42c3d85SBen Hutchings } 716e42c3d85SBen Hutchings 717e42c3d85SBen Hutchings efx_for_each_channel(channel, efx) { 718874aeea5SJeff Kirsher efx_for_each_channel_rx_queue(rx_queue, channel) 719874aeea5SJeff Kirsher efx_fini_rx_queue(rx_queue); 720874aeea5SJeff Kirsher efx_for_each_possible_channel_tx_queue(tx_queue, channel) 721874aeea5SJeff Kirsher efx_fini_tx_queue(tx_queue); 722874aeea5SJeff Kirsher } 723874aeea5SJeff Kirsher } 724874aeea5SJeff Kirsher 725874aeea5SJeff Kirsher static void efx_remove_channel(struct efx_channel *channel) 726874aeea5SJeff Kirsher { 727874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 728874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 729874aeea5SJeff Kirsher 730874aeea5SJeff Kirsher netif_dbg(channel->efx, drv, channel->efx->net_dev, 731874aeea5SJeff Kirsher "destroy chan %d\n", channel->channel); 732874aeea5SJeff Kirsher 733874aeea5SJeff Kirsher efx_for_each_channel_rx_queue(rx_queue, channel) 734874aeea5SJeff Kirsher efx_remove_rx_queue(rx_queue); 735874aeea5SJeff Kirsher efx_for_each_possible_channel_tx_queue(tx_queue, channel) 736874aeea5SJeff Kirsher efx_remove_tx_queue(tx_queue); 737874aeea5SJeff Kirsher efx_remove_eventq(channel); 738c31e5f9fSStuart Hodgson channel->type->post_remove(channel); 739874aeea5SJeff Kirsher } 740874aeea5SJeff Kirsher 741874aeea5SJeff Kirsher static void efx_remove_channels(struct efx_nic *efx) 742874aeea5SJeff Kirsher { 743874aeea5SJeff Kirsher struct efx_channel *channel; 744874aeea5SJeff Kirsher 745874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 746874aeea5SJeff Kirsher efx_remove_channel(channel); 747874aeea5SJeff Kirsher } 748874aeea5SJeff Kirsher 749874aeea5SJeff Kirsher int 750874aeea5SJeff Kirsher efx_realloc_channels(struct efx_nic *efx, u32 rxq_entries, u32 txq_entries) 751874aeea5SJeff Kirsher { 752874aeea5SJeff Kirsher struct efx_channel *other_channel[EFX_MAX_CHANNELS], *channel; 753874aeea5SJeff Kirsher u32 old_rxq_entries, old_txq_entries; 7547f967c01SBen Hutchings unsigned i, next_buffer_table = 0; 755261e4d96SJon Cooper int rc, rc2; 7568b7325b4SBen Hutchings 7578b7325b4SBen Hutchings rc = efx_check_disabled(efx); 7588b7325b4SBen Hutchings if (rc) 7598b7325b4SBen Hutchings return rc; 7607f967c01SBen Hutchings 7617f967c01SBen Hutchings /* Not all channels should be reallocated. We must avoid 7627f967c01SBen Hutchings * reallocating their buffer table entries. 7637f967c01SBen Hutchings */ 7647f967c01SBen Hutchings efx_for_each_channel(channel, efx) { 7657f967c01SBen Hutchings struct efx_rx_queue *rx_queue; 7667f967c01SBen Hutchings struct efx_tx_queue *tx_queue; 7677f967c01SBen Hutchings 7687f967c01SBen Hutchings if (channel->type->copy) 7697f967c01SBen Hutchings continue; 7707f967c01SBen Hutchings next_buffer_table = max(next_buffer_table, 7717f967c01SBen Hutchings channel->eventq.index + 7727f967c01SBen Hutchings channel->eventq.entries); 7737f967c01SBen Hutchings efx_for_each_channel_rx_queue(rx_queue, channel) 7747f967c01SBen Hutchings next_buffer_table = max(next_buffer_table, 7757f967c01SBen Hutchings rx_queue->rxd.index + 7767f967c01SBen Hutchings rx_queue->rxd.entries); 7777f967c01SBen Hutchings efx_for_each_channel_tx_queue(tx_queue, channel) 7787f967c01SBen Hutchings next_buffer_table = max(next_buffer_table, 7797f967c01SBen Hutchings tx_queue->txd.index + 7807f967c01SBen Hutchings tx_queue->txd.entries); 7817f967c01SBen Hutchings } 782874aeea5SJeff Kirsher 78329c69a48SBen Hutchings efx_device_detach_sync(efx); 784874aeea5SJeff Kirsher efx_stop_all(efx); 785d8291187SBen Hutchings efx_soft_disable_interrupts(efx); 786874aeea5SJeff Kirsher 7877f967c01SBen Hutchings /* Clone channels (where possible) */ 788874aeea5SJeff Kirsher memset(other_channel, 0, sizeof(other_channel)); 789874aeea5SJeff Kirsher for (i = 0; i < efx->n_channels; i++) { 7907f967c01SBen Hutchings channel = efx->channel[i]; 7917f967c01SBen Hutchings if (channel->type->copy) 7927f967c01SBen Hutchings channel = channel->type->copy(channel); 793874aeea5SJeff Kirsher if (!channel) { 794874aeea5SJeff Kirsher rc = -ENOMEM; 795874aeea5SJeff Kirsher goto out; 796874aeea5SJeff Kirsher } 797874aeea5SJeff Kirsher other_channel[i] = channel; 798874aeea5SJeff Kirsher } 799874aeea5SJeff Kirsher 800874aeea5SJeff Kirsher /* Swap entry counts and channel pointers */ 801874aeea5SJeff Kirsher old_rxq_entries = efx->rxq_entries; 802874aeea5SJeff Kirsher old_txq_entries = efx->txq_entries; 803874aeea5SJeff Kirsher efx->rxq_entries = rxq_entries; 804874aeea5SJeff Kirsher efx->txq_entries = txq_entries; 805874aeea5SJeff Kirsher for (i = 0; i < efx->n_channels; i++) { 806874aeea5SJeff Kirsher channel = efx->channel[i]; 807874aeea5SJeff Kirsher efx->channel[i] = other_channel[i]; 808874aeea5SJeff Kirsher other_channel[i] = channel; 809874aeea5SJeff Kirsher } 810874aeea5SJeff Kirsher 8117f967c01SBen Hutchings /* Restart buffer table allocation */ 8127f967c01SBen Hutchings efx->next_buffer_table = next_buffer_table; 8137f967c01SBen Hutchings 8147f967c01SBen Hutchings for (i = 0; i < efx->n_channels; i++) { 8157f967c01SBen Hutchings channel = efx->channel[i]; 8167f967c01SBen Hutchings if (!channel->type->copy) 8177f967c01SBen Hutchings continue; 8187f967c01SBen Hutchings rc = efx_probe_channel(channel); 819874aeea5SJeff Kirsher if (rc) 820874aeea5SJeff Kirsher goto rollback; 8217f967c01SBen Hutchings efx_init_napi_channel(efx->channel[i]); 822874aeea5SJeff Kirsher } 823874aeea5SJeff Kirsher 8247f967c01SBen Hutchings out: 8257f967c01SBen Hutchings /* Destroy unused channel structures */ 8267f967c01SBen Hutchings for (i = 0; i < efx->n_channels; i++) { 8277f967c01SBen Hutchings channel = other_channel[i]; 8287f967c01SBen Hutchings if (channel && channel->type->copy) { 8297f967c01SBen Hutchings efx_fini_napi_channel(channel); 8307f967c01SBen Hutchings efx_remove_channel(channel); 8317f967c01SBen Hutchings kfree(channel); 8327f967c01SBen Hutchings } 8337f967c01SBen Hutchings } 8347f967c01SBen Hutchings 835261e4d96SJon Cooper rc2 = efx_soft_enable_interrupts(efx); 836261e4d96SJon Cooper if (rc2) { 837261e4d96SJon Cooper rc = rc ? rc : rc2; 838261e4d96SJon Cooper netif_err(efx, drv, efx->net_dev, 839261e4d96SJon Cooper "unable to restart interrupts on channel reallocation\n"); 840261e4d96SJon Cooper efx_schedule_reset(efx, RESET_TYPE_DISABLE); 841261e4d96SJon Cooper } else { 842874aeea5SJeff Kirsher efx_start_all(efx); 84329c69a48SBen Hutchings netif_device_attach(efx->net_dev); 844261e4d96SJon Cooper } 845874aeea5SJeff Kirsher return rc; 846874aeea5SJeff Kirsher 847874aeea5SJeff Kirsher rollback: 848874aeea5SJeff Kirsher /* Swap back */ 849874aeea5SJeff Kirsher efx->rxq_entries = old_rxq_entries; 850874aeea5SJeff Kirsher efx->txq_entries = old_txq_entries; 851874aeea5SJeff Kirsher for (i = 0; i < efx->n_channels; i++) { 852874aeea5SJeff Kirsher channel = efx->channel[i]; 853874aeea5SJeff Kirsher efx->channel[i] = other_channel[i]; 854874aeea5SJeff Kirsher other_channel[i] = channel; 855874aeea5SJeff Kirsher } 856874aeea5SJeff Kirsher goto out; 857874aeea5SJeff Kirsher } 858874aeea5SJeff Kirsher 859874aeea5SJeff Kirsher void efx_schedule_slow_fill(struct efx_rx_queue *rx_queue) 860874aeea5SJeff Kirsher { 861874aeea5SJeff Kirsher mod_timer(&rx_queue->slow_fill, jiffies + msecs_to_jiffies(100)); 862874aeea5SJeff Kirsher } 863874aeea5SJeff Kirsher 8647f967c01SBen Hutchings static const struct efx_channel_type efx_default_channel_type = { 8657f967c01SBen Hutchings .pre_probe = efx_channel_dummy_op_int, 866c31e5f9fSStuart Hodgson .post_remove = efx_channel_dummy_op_void, 8677f967c01SBen Hutchings .get_name = efx_get_channel_name, 8687f967c01SBen Hutchings .copy = efx_copy_channel, 8697f967c01SBen Hutchings .keep_eventq = false, 8707f967c01SBen Hutchings }; 8717f967c01SBen Hutchings 8727f967c01SBen Hutchings int efx_channel_dummy_op_int(struct efx_channel *channel) 8737f967c01SBen Hutchings { 8747f967c01SBen Hutchings return 0; 8757f967c01SBen Hutchings } 8767f967c01SBen Hutchings 877c31e5f9fSStuart Hodgson void efx_channel_dummy_op_void(struct efx_channel *channel) 878c31e5f9fSStuart Hodgson { 879c31e5f9fSStuart Hodgson } 880c31e5f9fSStuart Hodgson 881874aeea5SJeff Kirsher /************************************************************************** 882874aeea5SJeff Kirsher * 883874aeea5SJeff Kirsher * Port handling 884874aeea5SJeff Kirsher * 885874aeea5SJeff Kirsher **************************************************************************/ 886874aeea5SJeff Kirsher 887874aeea5SJeff Kirsher /* This ensures that the kernel is kept informed (via 888874aeea5SJeff Kirsher * netif_carrier_on/off) of the link status, and also maintains the 889874aeea5SJeff Kirsher * link status's stop on the port's TX queue. 890874aeea5SJeff Kirsher */ 891874aeea5SJeff Kirsher void efx_link_status_changed(struct efx_nic *efx) 892874aeea5SJeff Kirsher { 893874aeea5SJeff Kirsher struct efx_link_state *link_state = &efx->link_state; 894874aeea5SJeff Kirsher 895874aeea5SJeff Kirsher /* SFC Bug 5356: A net_dev notifier is registered, so we must ensure 896874aeea5SJeff Kirsher * that no events are triggered between unregister_netdev() and the 897874aeea5SJeff Kirsher * driver unloading. A more general condition is that NETDEV_CHANGE 898874aeea5SJeff Kirsher * can only be generated between NETDEV_UP and NETDEV_DOWN */ 899874aeea5SJeff Kirsher if (!netif_running(efx->net_dev)) 900874aeea5SJeff Kirsher return; 901874aeea5SJeff Kirsher 902874aeea5SJeff Kirsher if (link_state->up != netif_carrier_ok(efx->net_dev)) { 903874aeea5SJeff Kirsher efx->n_link_state_changes++; 904874aeea5SJeff Kirsher 905874aeea5SJeff Kirsher if (link_state->up) 906874aeea5SJeff Kirsher netif_carrier_on(efx->net_dev); 907874aeea5SJeff Kirsher else 908874aeea5SJeff Kirsher netif_carrier_off(efx->net_dev); 909874aeea5SJeff Kirsher } 910874aeea5SJeff Kirsher 911874aeea5SJeff Kirsher /* Status message for kernel log */ 9122aa9ef11SBen Hutchings if (link_state->up) 913874aeea5SJeff Kirsher netif_info(efx, link, efx->net_dev, 914964e6135SBen Hutchings "link up at %uMbps %s-duplex (MTU %d)\n", 915874aeea5SJeff Kirsher link_state->speed, link_state->fd ? "full" : "half", 916964e6135SBen Hutchings efx->net_dev->mtu); 9172aa9ef11SBen Hutchings else 918874aeea5SJeff Kirsher netif_info(efx, link, efx->net_dev, "link down\n"); 919874aeea5SJeff Kirsher } 920874aeea5SJeff Kirsher 921874aeea5SJeff Kirsher void efx_link_set_advertising(struct efx_nic *efx, u32 advertising) 922874aeea5SJeff Kirsher { 923874aeea5SJeff Kirsher efx->link_advertising = advertising; 924874aeea5SJeff Kirsher if (advertising) { 925874aeea5SJeff Kirsher if (advertising & ADVERTISED_Pause) 926874aeea5SJeff Kirsher efx->wanted_fc |= (EFX_FC_TX | EFX_FC_RX); 927874aeea5SJeff Kirsher else 928874aeea5SJeff Kirsher efx->wanted_fc &= ~(EFX_FC_TX | EFX_FC_RX); 929874aeea5SJeff Kirsher if (advertising & ADVERTISED_Asym_Pause) 930874aeea5SJeff Kirsher efx->wanted_fc ^= EFX_FC_TX; 931874aeea5SJeff Kirsher } 932874aeea5SJeff Kirsher } 933874aeea5SJeff Kirsher 934874aeea5SJeff Kirsher void efx_link_set_wanted_fc(struct efx_nic *efx, u8 wanted_fc) 935874aeea5SJeff Kirsher { 936874aeea5SJeff Kirsher efx->wanted_fc = wanted_fc; 937874aeea5SJeff Kirsher if (efx->link_advertising) { 938874aeea5SJeff Kirsher if (wanted_fc & EFX_FC_RX) 939874aeea5SJeff Kirsher efx->link_advertising |= (ADVERTISED_Pause | 940874aeea5SJeff Kirsher ADVERTISED_Asym_Pause); 941874aeea5SJeff Kirsher else 942874aeea5SJeff Kirsher efx->link_advertising &= ~(ADVERTISED_Pause | 943874aeea5SJeff Kirsher ADVERTISED_Asym_Pause); 944874aeea5SJeff Kirsher if (wanted_fc & EFX_FC_TX) 945874aeea5SJeff Kirsher efx->link_advertising ^= ADVERTISED_Asym_Pause; 946874aeea5SJeff Kirsher } 947874aeea5SJeff Kirsher } 948874aeea5SJeff Kirsher 949874aeea5SJeff Kirsher static void efx_fini_port(struct efx_nic *efx); 950874aeea5SJeff Kirsher 951874aeea5SJeff Kirsher /* Push loopback/power/transmit disable settings to the PHY, and reconfigure 952874aeea5SJeff Kirsher * the MAC appropriately. All other PHY configuration changes are pushed 953874aeea5SJeff Kirsher * through phy_op->set_settings(), and pushed asynchronously to the MAC 954874aeea5SJeff Kirsher * through efx_monitor(). 955874aeea5SJeff Kirsher * 956874aeea5SJeff Kirsher * Callers must hold the mac_lock 957874aeea5SJeff Kirsher */ 958874aeea5SJeff Kirsher int __efx_reconfigure_port(struct efx_nic *efx) 959874aeea5SJeff Kirsher { 960874aeea5SJeff Kirsher enum efx_phy_mode phy_mode; 961874aeea5SJeff Kirsher int rc; 962874aeea5SJeff Kirsher 963874aeea5SJeff Kirsher WARN_ON(!mutex_is_locked(&efx->mac_lock)); 964874aeea5SJeff Kirsher 965874aeea5SJeff Kirsher /* Disable PHY transmit in mac level loopbacks */ 966874aeea5SJeff Kirsher phy_mode = efx->phy_mode; 967874aeea5SJeff Kirsher if (LOOPBACK_INTERNAL(efx)) 968874aeea5SJeff Kirsher efx->phy_mode |= PHY_MODE_TX_DISABLED; 969874aeea5SJeff Kirsher else 970874aeea5SJeff Kirsher efx->phy_mode &= ~PHY_MODE_TX_DISABLED; 971874aeea5SJeff Kirsher 972874aeea5SJeff Kirsher rc = efx->type->reconfigure_port(efx); 973874aeea5SJeff Kirsher 974874aeea5SJeff Kirsher if (rc) 975874aeea5SJeff Kirsher efx->phy_mode = phy_mode; 976874aeea5SJeff Kirsher 977874aeea5SJeff Kirsher return rc; 978874aeea5SJeff Kirsher } 979874aeea5SJeff Kirsher 980874aeea5SJeff Kirsher /* Reinitialise the MAC to pick up new PHY settings, even if the port is 981874aeea5SJeff Kirsher * disabled. */ 982874aeea5SJeff Kirsher int efx_reconfigure_port(struct efx_nic *efx) 983874aeea5SJeff Kirsher { 984874aeea5SJeff Kirsher int rc; 985874aeea5SJeff Kirsher 986874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 987874aeea5SJeff Kirsher 988874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 989874aeea5SJeff Kirsher rc = __efx_reconfigure_port(efx); 990874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 991874aeea5SJeff Kirsher 992874aeea5SJeff Kirsher return rc; 993874aeea5SJeff Kirsher } 994874aeea5SJeff Kirsher 995874aeea5SJeff Kirsher /* Asynchronous work item for changing MAC promiscuity and multicast 996874aeea5SJeff Kirsher * hash. Avoid a drain/rx_ingress enable by reconfiguring the current 997874aeea5SJeff Kirsher * MAC directly. */ 998874aeea5SJeff Kirsher static void efx_mac_work(struct work_struct *data) 999874aeea5SJeff Kirsher { 1000874aeea5SJeff Kirsher struct efx_nic *efx = container_of(data, struct efx_nic, mac_work); 1001874aeea5SJeff Kirsher 1002874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 100330b81cdaSBen Hutchings if (efx->port_enabled) 1004710b208dSBen Hutchings efx->type->reconfigure_mac(efx); 1005874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1006874aeea5SJeff Kirsher } 1007874aeea5SJeff Kirsher 1008874aeea5SJeff Kirsher static int efx_probe_port(struct efx_nic *efx) 1009874aeea5SJeff Kirsher { 1010874aeea5SJeff Kirsher int rc; 1011874aeea5SJeff Kirsher 1012874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "create port\n"); 1013874aeea5SJeff Kirsher 1014874aeea5SJeff Kirsher if (phy_flash_cfg) 1015874aeea5SJeff Kirsher efx->phy_mode = PHY_MODE_SPECIAL; 1016874aeea5SJeff Kirsher 1017874aeea5SJeff Kirsher /* Connect up MAC/PHY operations table */ 1018874aeea5SJeff Kirsher rc = efx->type->probe_port(efx); 1019874aeea5SJeff Kirsher if (rc) 1020874aeea5SJeff Kirsher return rc; 1021874aeea5SJeff Kirsher 1022e332bcb3SBen Hutchings /* Initialise MAC address to permanent address */ 1023cd84ff4dSEdward Cree ether_addr_copy(efx->net_dev->dev_addr, efx->net_dev->perm_addr); 1024874aeea5SJeff Kirsher 1025874aeea5SJeff Kirsher return 0; 1026874aeea5SJeff Kirsher } 1027874aeea5SJeff Kirsher 1028874aeea5SJeff Kirsher static int efx_init_port(struct efx_nic *efx) 1029874aeea5SJeff Kirsher { 1030874aeea5SJeff Kirsher int rc; 1031874aeea5SJeff Kirsher 1032874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "init port\n"); 1033874aeea5SJeff Kirsher 1034874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1035874aeea5SJeff Kirsher 1036874aeea5SJeff Kirsher rc = efx->phy_op->init(efx); 1037874aeea5SJeff Kirsher if (rc) 1038874aeea5SJeff Kirsher goto fail1; 1039874aeea5SJeff Kirsher 1040874aeea5SJeff Kirsher efx->port_initialized = true; 1041874aeea5SJeff Kirsher 1042874aeea5SJeff Kirsher /* Reconfigure the MAC before creating dma queues (required for 1043874aeea5SJeff Kirsher * Falcon/A1 where RX_INGR_EN/TX_DRAIN_EN isn't supported) */ 1044710b208dSBen Hutchings efx->type->reconfigure_mac(efx); 1045874aeea5SJeff Kirsher 1046874aeea5SJeff Kirsher /* Ensure the PHY advertises the correct flow control settings */ 1047874aeea5SJeff Kirsher rc = efx->phy_op->reconfigure(efx); 1048874aeea5SJeff Kirsher if (rc) 1049874aeea5SJeff Kirsher goto fail2; 1050874aeea5SJeff Kirsher 1051874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1052874aeea5SJeff Kirsher return 0; 1053874aeea5SJeff Kirsher 1054874aeea5SJeff Kirsher fail2: 1055874aeea5SJeff Kirsher efx->phy_op->fini(efx); 1056874aeea5SJeff Kirsher fail1: 1057874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1058874aeea5SJeff Kirsher return rc; 1059874aeea5SJeff Kirsher } 1060874aeea5SJeff Kirsher 1061874aeea5SJeff Kirsher static void efx_start_port(struct efx_nic *efx) 1062874aeea5SJeff Kirsher { 1063874aeea5SJeff Kirsher netif_dbg(efx, ifup, efx->net_dev, "start port\n"); 1064874aeea5SJeff Kirsher BUG_ON(efx->port_enabled); 1065874aeea5SJeff Kirsher 1066874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1067874aeea5SJeff Kirsher efx->port_enabled = true; 1068874aeea5SJeff Kirsher 1069d615c039SBen Hutchings /* Ensure MAC ingress/egress is enabled */ 1070710b208dSBen Hutchings efx->type->reconfigure_mac(efx); 1071874aeea5SJeff Kirsher 1072874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1073874aeea5SJeff Kirsher } 1074874aeea5SJeff Kirsher 1075d615c039SBen Hutchings /* Cancel work for MAC reconfiguration, periodic hardware monitoring 1076d615c039SBen Hutchings * and the async self-test, wait for them to finish and prevent them 1077d615c039SBen Hutchings * being scheduled again. This doesn't cover online resets, which 1078d615c039SBen Hutchings * should only be cancelled when removing the device. 1079d615c039SBen Hutchings */ 1080874aeea5SJeff Kirsher static void efx_stop_port(struct efx_nic *efx) 1081874aeea5SJeff Kirsher { 1082874aeea5SJeff Kirsher netif_dbg(efx, ifdown, efx->net_dev, "stop port\n"); 1083874aeea5SJeff Kirsher 1084d615c039SBen Hutchings EFX_ASSERT_RESET_SERIALISED(efx); 1085d615c039SBen Hutchings 1086874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1087874aeea5SJeff Kirsher efx->port_enabled = false; 1088874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1089874aeea5SJeff Kirsher 1090874aeea5SJeff Kirsher /* Serialise against efx_set_multicast_list() */ 1091874aeea5SJeff Kirsher netif_addr_lock_bh(efx->net_dev); 1092874aeea5SJeff Kirsher netif_addr_unlock_bh(efx->net_dev); 1093d615c039SBen Hutchings 1094d615c039SBen Hutchings cancel_delayed_work_sync(&efx->monitor_work); 1095d615c039SBen Hutchings efx_selftest_async_cancel(efx); 1096d615c039SBen Hutchings cancel_work_sync(&efx->mac_work); 1097874aeea5SJeff Kirsher } 1098874aeea5SJeff Kirsher 1099874aeea5SJeff Kirsher static void efx_fini_port(struct efx_nic *efx) 1100874aeea5SJeff Kirsher { 1101874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "shut down port\n"); 1102874aeea5SJeff Kirsher 1103874aeea5SJeff Kirsher if (!efx->port_initialized) 1104874aeea5SJeff Kirsher return; 1105874aeea5SJeff Kirsher 1106874aeea5SJeff Kirsher efx->phy_op->fini(efx); 1107874aeea5SJeff Kirsher efx->port_initialized = false; 1108874aeea5SJeff Kirsher 1109874aeea5SJeff Kirsher efx->link_state.up = false; 1110874aeea5SJeff Kirsher efx_link_status_changed(efx); 1111874aeea5SJeff Kirsher } 1112874aeea5SJeff Kirsher 1113874aeea5SJeff Kirsher static void efx_remove_port(struct efx_nic *efx) 1114874aeea5SJeff Kirsher { 1115874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "destroying port\n"); 1116874aeea5SJeff Kirsher 1117874aeea5SJeff Kirsher efx->type->remove_port(efx); 1118874aeea5SJeff Kirsher } 1119874aeea5SJeff Kirsher 1120874aeea5SJeff Kirsher /************************************************************************** 1121874aeea5SJeff Kirsher * 1122874aeea5SJeff Kirsher * NIC handling 1123874aeea5SJeff Kirsher * 1124874aeea5SJeff Kirsher **************************************************************************/ 1125874aeea5SJeff Kirsher 11260bcf4a64SBen Hutchings static LIST_HEAD(efx_primary_list); 11270bcf4a64SBen Hutchings static LIST_HEAD(efx_unassociated_list); 11280bcf4a64SBen Hutchings 11290bcf4a64SBen Hutchings static bool efx_same_controller(struct efx_nic *left, struct efx_nic *right) 11300bcf4a64SBen Hutchings { 11310bcf4a64SBen Hutchings return left->type == right->type && 11320bcf4a64SBen Hutchings left->vpd_sn && right->vpd_sn && 11330bcf4a64SBen Hutchings !strcmp(left->vpd_sn, right->vpd_sn); 11340bcf4a64SBen Hutchings } 11350bcf4a64SBen Hutchings 11360bcf4a64SBen Hutchings static void efx_associate(struct efx_nic *efx) 11370bcf4a64SBen Hutchings { 11380bcf4a64SBen Hutchings struct efx_nic *other, *next; 11390bcf4a64SBen Hutchings 11400bcf4a64SBen Hutchings if (efx->primary == efx) { 11410bcf4a64SBen Hutchings /* Adding primary function; look for secondaries */ 11420bcf4a64SBen Hutchings 11430bcf4a64SBen Hutchings netif_dbg(efx, probe, efx->net_dev, "adding to primary list\n"); 11440bcf4a64SBen Hutchings list_add_tail(&efx->node, &efx_primary_list); 11450bcf4a64SBen Hutchings 11460bcf4a64SBen Hutchings list_for_each_entry_safe(other, next, &efx_unassociated_list, 11470bcf4a64SBen Hutchings node) { 11480bcf4a64SBen Hutchings if (efx_same_controller(efx, other)) { 11490bcf4a64SBen Hutchings list_del(&other->node); 11500bcf4a64SBen Hutchings netif_dbg(other, probe, other->net_dev, 11510bcf4a64SBen Hutchings "moving to secondary list of %s %s\n", 11520bcf4a64SBen Hutchings pci_name(efx->pci_dev), 11530bcf4a64SBen Hutchings efx->net_dev->name); 11540bcf4a64SBen Hutchings list_add_tail(&other->node, 11550bcf4a64SBen Hutchings &efx->secondary_list); 11560bcf4a64SBen Hutchings other->primary = efx; 11570bcf4a64SBen Hutchings } 11580bcf4a64SBen Hutchings } 11590bcf4a64SBen Hutchings } else { 11600bcf4a64SBen Hutchings /* Adding secondary function; look for primary */ 11610bcf4a64SBen Hutchings 11620bcf4a64SBen Hutchings list_for_each_entry(other, &efx_primary_list, node) { 11630bcf4a64SBen Hutchings if (efx_same_controller(efx, other)) { 11640bcf4a64SBen Hutchings netif_dbg(efx, probe, efx->net_dev, 11650bcf4a64SBen Hutchings "adding to secondary list of %s %s\n", 11660bcf4a64SBen Hutchings pci_name(other->pci_dev), 11670bcf4a64SBen Hutchings other->net_dev->name); 11680bcf4a64SBen Hutchings list_add_tail(&efx->node, 11690bcf4a64SBen Hutchings &other->secondary_list); 11700bcf4a64SBen Hutchings efx->primary = other; 11710bcf4a64SBen Hutchings return; 11720bcf4a64SBen Hutchings } 11730bcf4a64SBen Hutchings } 11740bcf4a64SBen Hutchings 11750bcf4a64SBen Hutchings netif_dbg(efx, probe, efx->net_dev, 11760bcf4a64SBen Hutchings "adding to unassociated list\n"); 11770bcf4a64SBen Hutchings list_add_tail(&efx->node, &efx_unassociated_list); 11780bcf4a64SBen Hutchings } 11790bcf4a64SBen Hutchings } 11800bcf4a64SBen Hutchings 11810bcf4a64SBen Hutchings static void efx_dissociate(struct efx_nic *efx) 11820bcf4a64SBen Hutchings { 11830bcf4a64SBen Hutchings struct efx_nic *other, *next; 11840bcf4a64SBen Hutchings 11850bcf4a64SBen Hutchings list_del(&efx->node); 11860bcf4a64SBen Hutchings efx->primary = NULL; 11870bcf4a64SBen Hutchings 11880bcf4a64SBen Hutchings list_for_each_entry_safe(other, next, &efx->secondary_list, node) { 11890bcf4a64SBen Hutchings list_del(&other->node); 11900bcf4a64SBen Hutchings netif_dbg(other, probe, other->net_dev, 11910bcf4a64SBen Hutchings "moving to unassociated list\n"); 11920bcf4a64SBen Hutchings list_add_tail(&other->node, &efx_unassociated_list); 11930bcf4a64SBen Hutchings other->primary = NULL; 11940bcf4a64SBen Hutchings } 11950bcf4a64SBen Hutchings } 11960bcf4a64SBen Hutchings 1197874aeea5SJeff Kirsher /* This configures the PCI device to enable I/O and DMA. */ 1198874aeea5SJeff Kirsher static int efx_init_io(struct efx_nic *efx) 1199874aeea5SJeff Kirsher { 1200874aeea5SJeff Kirsher struct pci_dev *pci_dev = efx->pci_dev; 1201874aeea5SJeff Kirsher dma_addr_t dma_mask = efx->type->max_dma_mask; 1202b105798fSBen Hutchings unsigned int mem_map_size = efx->type->mem_map_size(efx); 1203874aeea5SJeff Kirsher int rc; 1204874aeea5SJeff Kirsher 1205874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "initialising I/O\n"); 1206874aeea5SJeff Kirsher 1207874aeea5SJeff Kirsher rc = pci_enable_device(pci_dev); 1208874aeea5SJeff Kirsher if (rc) { 1209874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1210874aeea5SJeff Kirsher "failed to enable PCI device\n"); 1211874aeea5SJeff Kirsher goto fail1; 1212874aeea5SJeff Kirsher } 1213874aeea5SJeff Kirsher 1214874aeea5SJeff Kirsher pci_set_master(pci_dev); 1215874aeea5SJeff Kirsher 1216874aeea5SJeff Kirsher /* Set the PCI DMA mask. Try all possibilities from our 1217874aeea5SJeff Kirsher * genuine mask down to 32 bits, because some architectures 1218874aeea5SJeff Kirsher * (e.g. x86_64 with iommu_sac_force set) will allow 40 bit 1219874aeea5SJeff Kirsher * masks event though they reject 46 bit masks. 1220874aeea5SJeff Kirsher */ 1221874aeea5SJeff Kirsher while (dma_mask > 0x7fffffffUL) { 12220e33d870SBen Hutchings if (dma_supported(&pci_dev->dev, dma_mask)) { 12239663dedaSRussell King rc = dma_set_mask_and_coherent(&pci_dev->dev, dma_mask); 1224e9e01846SBen Hutchings if (rc == 0) 1225874aeea5SJeff Kirsher break; 1226e9e01846SBen Hutchings } 1227874aeea5SJeff Kirsher dma_mask >>= 1; 1228874aeea5SJeff Kirsher } 1229874aeea5SJeff Kirsher if (rc) { 1230874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1231874aeea5SJeff Kirsher "could not find a suitable DMA mask\n"); 1232874aeea5SJeff Kirsher goto fail2; 1233874aeea5SJeff Kirsher } 1234874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, 1235874aeea5SJeff Kirsher "using DMA mask %llx\n", (unsigned long long) dma_mask); 1236874aeea5SJeff Kirsher 1237874aeea5SJeff Kirsher efx->membase_phys = pci_resource_start(efx->pci_dev, EFX_MEM_BAR); 1238874aeea5SJeff Kirsher rc = pci_request_region(pci_dev, EFX_MEM_BAR, "sfc"); 1239874aeea5SJeff Kirsher if (rc) { 1240874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1241874aeea5SJeff Kirsher "request for memory BAR failed\n"); 1242874aeea5SJeff Kirsher rc = -EIO; 1243874aeea5SJeff Kirsher goto fail3; 1244874aeea5SJeff Kirsher } 1245b105798fSBen Hutchings efx->membase = ioremap_nocache(efx->membase_phys, mem_map_size); 1246874aeea5SJeff Kirsher if (!efx->membase) { 1247874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1248874aeea5SJeff Kirsher "could not map memory BAR at %llx+%x\n", 1249b105798fSBen Hutchings (unsigned long long)efx->membase_phys, mem_map_size); 1250874aeea5SJeff Kirsher rc = -ENOMEM; 1251874aeea5SJeff Kirsher goto fail4; 1252874aeea5SJeff Kirsher } 1253874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, 1254874aeea5SJeff Kirsher "memory BAR at %llx+%x (virtual %p)\n", 1255b105798fSBen Hutchings (unsigned long long)efx->membase_phys, mem_map_size, 1256b105798fSBen Hutchings efx->membase); 1257874aeea5SJeff Kirsher 1258874aeea5SJeff Kirsher return 0; 1259874aeea5SJeff Kirsher 1260874aeea5SJeff Kirsher fail4: 1261874aeea5SJeff Kirsher pci_release_region(efx->pci_dev, EFX_MEM_BAR); 1262874aeea5SJeff Kirsher fail3: 1263874aeea5SJeff Kirsher efx->membase_phys = 0; 1264874aeea5SJeff Kirsher fail2: 1265874aeea5SJeff Kirsher pci_disable_device(efx->pci_dev); 1266874aeea5SJeff Kirsher fail1: 1267874aeea5SJeff Kirsher return rc; 1268874aeea5SJeff Kirsher } 1269874aeea5SJeff Kirsher 1270874aeea5SJeff Kirsher static void efx_fini_io(struct efx_nic *efx) 1271874aeea5SJeff Kirsher { 1272874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "shutting down I/O\n"); 1273874aeea5SJeff Kirsher 1274874aeea5SJeff Kirsher if (efx->membase) { 1275874aeea5SJeff Kirsher iounmap(efx->membase); 1276874aeea5SJeff Kirsher efx->membase = NULL; 1277874aeea5SJeff Kirsher } 1278874aeea5SJeff Kirsher 1279874aeea5SJeff Kirsher if (efx->membase_phys) { 1280874aeea5SJeff Kirsher pci_release_region(efx->pci_dev, EFX_MEM_BAR); 1281874aeea5SJeff Kirsher efx->membase_phys = 0; 1282874aeea5SJeff Kirsher } 1283874aeea5SJeff Kirsher 1284874aeea5SJeff Kirsher pci_disable_device(efx->pci_dev); 1285874aeea5SJeff Kirsher } 1286874aeea5SJeff Kirsher 1287a9a52506SBen Hutchings static unsigned int efx_wanted_parallelism(struct efx_nic *efx) 1288874aeea5SJeff Kirsher { 1289cdb08f8fSBen Hutchings cpumask_var_t thread_mask; 1290a16e5b24SBen Hutchings unsigned int count; 1291874aeea5SJeff Kirsher int cpu; 1292874aeea5SJeff Kirsher 1293cd2d5b52SBen Hutchings if (rss_cpus) { 1294cd2d5b52SBen Hutchings count = rss_cpus; 1295cd2d5b52SBen Hutchings } else { 1296cdb08f8fSBen Hutchings if (unlikely(!zalloc_cpumask_var(&thread_mask, GFP_KERNEL))) { 1297a9a52506SBen Hutchings netif_warn(efx, probe, efx->net_dev, 1298a9a52506SBen Hutchings "RSS disabled due to allocation failure\n"); 1299874aeea5SJeff Kirsher return 1; 1300874aeea5SJeff Kirsher } 1301874aeea5SJeff Kirsher 1302874aeea5SJeff Kirsher count = 0; 1303874aeea5SJeff Kirsher for_each_online_cpu(cpu) { 1304cdb08f8fSBen Hutchings if (!cpumask_test_cpu(cpu, thread_mask)) { 1305874aeea5SJeff Kirsher ++count; 1306cdb08f8fSBen Hutchings cpumask_or(thread_mask, thread_mask, 1307cdb08f8fSBen Hutchings topology_thread_cpumask(cpu)); 1308874aeea5SJeff Kirsher } 1309874aeea5SJeff Kirsher } 1310874aeea5SJeff Kirsher 1311cdb08f8fSBen Hutchings free_cpumask_var(thread_mask); 1312cd2d5b52SBen Hutchings } 1313cd2d5b52SBen Hutchings 1314cd2d5b52SBen Hutchings /* If RSS is requested for the PF *and* VFs then we can't write RSS 1315cd2d5b52SBen Hutchings * table entries that are inaccessible to VFs 1316cd2d5b52SBen Hutchings */ 1317d98a4ffeSShradha Shah if (efx->type->sriov_wanted(efx) && efx_vf_size(efx) > 1 && 1318cd2d5b52SBen Hutchings count > efx_vf_size(efx)) { 1319cd2d5b52SBen Hutchings netif_warn(efx, probe, efx->net_dev, 1320cd2d5b52SBen Hutchings "Reducing number of RSS channels from %u to %u for " 1321cd2d5b52SBen Hutchings "VF support. Increase vf-msix-limit to use more " 1322cd2d5b52SBen Hutchings "channels on the PF.\n", 1323cd2d5b52SBen Hutchings count, efx_vf_size(efx)); 1324cd2d5b52SBen Hutchings count = efx_vf_size(efx); 1325cd2d5b52SBen Hutchings } 1326cd2d5b52SBen Hutchings 1327874aeea5SJeff Kirsher return count; 1328874aeea5SJeff Kirsher } 1329874aeea5SJeff Kirsher 1330874aeea5SJeff Kirsher /* Probe the number and type of interrupts we are able to obtain, and 1331874aeea5SJeff Kirsher * the resulting numbers of channels and RX queues. 1332874aeea5SJeff Kirsher */ 1333874aeea5SJeff Kirsher static int efx_probe_interrupts(struct efx_nic *efx) 1334874aeea5SJeff Kirsher { 13357f967c01SBen Hutchings unsigned int extra_channels = 0; 13367f967c01SBen Hutchings unsigned int i, j; 1337a16e5b24SBen Hutchings int rc; 1338874aeea5SJeff Kirsher 13397f967c01SBen Hutchings for (i = 0; i < EFX_MAX_EXTRA_CHANNELS; i++) 13407f967c01SBen Hutchings if (efx->extra_channel_type[i]) 13417f967c01SBen Hutchings ++extra_channels; 13427f967c01SBen Hutchings 1343874aeea5SJeff Kirsher if (efx->interrupt_mode == EFX_INT_MODE_MSIX) { 1344874aeea5SJeff Kirsher struct msix_entry xentries[EFX_MAX_CHANNELS]; 1345a16e5b24SBen Hutchings unsigned int n_channels; 1346874aeea5SJeff Kirsher 1347a9a52506SBen Hutchings n_channels = efx_wanted_parallelism(efx); 1348874aeea5SJeff Kirsher if (separate_tx_channels) 1349874aeea5SJeff Kirsher n_channels *= 2; 13507f967c01SBen Hutchings n_channels += extra_channels; 1351b105798fSBen Hutchings n_channels = min(n_channels, efx->max_channels); 1352874aeea5SJeff Kirsher 1353874aeea5SJeff Kirsher for (i = 0; i < n_channels; i++) 1354874aeea5SJeff Kirsher xentries[i].entry = i; 1355184603d8SAlexander Gordeev rc = pci_enable_msix_range(efx->pci_dev, 1356184603d8SAlexander Gordeev xentries, 1, n_channels); 1357184603d8SAlexander Gordeev if (rc < 0) { 1358184603d8SAlexander Gordeev /* Fall back to single channel MSI */ 1359184603d8SAlexander Gordeev efx->interrupt_mode = EFX_INT_MODE_MSI; 1360184603d8SAlexander Gordeev netif_err(efx, drv, efx->net_dev, 1361184603d8SAlexander Gordeev "could not enable MSI-X\n"); 1362184603d8SAlexander Gordeev } else if (rc < n_channels) { 1363874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 1364874aeea5SJeff Kirsher "WARNING: Insufficient MSI-X vectors" 1365a16e5b24SBen Hutchings " available (%d < %u).\n", rc, n_channels); 1366874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 1367874aeea5SJeff Kirsher "WARNING: Performance may be reduced.\n"); 1368874aeea5SJeff Kirsher n_channels = rc; 1369874aeea5SJeff Kirsher } 1370874aeea5SJeff Kirsher 1371184603d8SAlexander Gordeev if (rc > 0) { 1372874aeea5SJeff Kirsher efx->n_channels = n_channels; 13737f967c01SBen Hutchings if (n_channels > extra_channels) 13747f967c01SBen Hutchings n_channels -= extra_channels; 1375874aeea5SJeff Kirsher if (separate_tx_channels) { 13767f967c01SBen Hutchings efx->n_tx_channels = max(n_channels / 2, 1U); 13777f967c01SBen Hutchings efx->n_rx_channels = max(n_channels - 13787f967c01SBen Hutchings efx->n_tx_channels, 13797f967c01SBen Hutchings 1U); 1380874aeea5SJeff Kirsher } else { 13817f967c01SBen Hutchings efx->n_tx_channels = n_channels; 13827f967c01SBen Hutchings efx->n_rx_channels = n_channels; 1383874aeea5SJeff Kirsher } 13847f967c01SBen Hutchings for (i = 0; i < efx->n_channels; i++) 1385874aeea5SJeff Kirsher efx_get_channel(efx, i)->irq = 1386874aeea5SJeff Kirsher xentries[i].vector; 1387874aeea5SJeff Kirsher } 1388874aeea5SJeff Kirsher } 1389874aeea5SJeff Kirsher 1390874aeea5SJeff Kirsher /* Try single interrupt MSI */ 1391874aeea5SJeff Kirsher if (efx->interrupt_mode == EFX_INT_MODE_MSI) { 1392874aeea5SJeff Kirsher efx->n_channels = 1; 1393874aeea5SJeff Kirsher efx->n_rx_channels = 1; 1394874aeea5SJeff Kirsher efx->n_tx_channels = 1; 1395874aeea5SJeff Kirsher rc = pci_enable_msi(efx->pci_dev); 1396874aeea5SJeff Kirsher if (rc == 0) { 1397874aeea5SJeff Kirsher efx_get_channel(efx, 0)->irq = efx->pci_dev->irq; 1398874aeea5SJeff Kirsher } else { 1399874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 1400874aeea5SJeff Kirsher "could not enable MSI\n"); 1401874aeea5SJeff Kirsher efx->interrupt_mode = EFX_INT_MODE_LEGACY; 1402874aeea5SJeff Kirsher } 1403874aeea5SJeff Kirsher } 1404874aeea5SJeff Kirsher 1405874aeea5SJeff Kirsher /* Assume legacy interrupts */ 1406874aeea5SJeff Kirsher if (efx->interrupt_mode == EFX_INT_MODE_LEGACY) { 1407874aeea5SJeff Kirsher efx->n_channels = 1 + (separate_tx_channels ? 1 : 0); 1408874aeea5SJeff Kirsher efx->n_rx_channels = 1; 1409874aeea5SJeff Kirsher efx->n_tx_channels = 1; 1410874aeea5SJeff Kirsher efx->legacy_irq = efx->pci_dev->irq; 1411874aeea5SJeff Kirsher } 1412874aeea5SJeff Kirsher 14137f967c01SBen Hutchings /* Assign extra channels if possible */ 14147f967c01SBen Hutchings j = efx->n_channels; 14157f967c01SBen Hutchings for (i = 0; i < EFX_MAX_EXTRA_CHANNELS; i++) { 14167f967c01SBen Hutchings if (!efx->extra_channel_type[i]) 14177f967c01SBen Hutchings continue; 14187f967c01SBen Hutchings if (efx->interrupt_mode != EFX_INT_MODE_MSIX || 14197f967c01SBen Hutchings efx->n_channels <= extra_channels) { 14207f967c01SBen Hutchings efx->extra_channel_type[i]->handle_no_channel(efx); 14217f967c01SBen Hutchings } else { 14227f967c01SBen Hutchings --j; 14237f967c01SBen Hutchings efx_get_channel(efx, j)->type = 14247f967c01SBen Hutchings efx->extra_channel_type[i]; 14257f967c01SBen Hutchings } 14267f967c01SBen Hutchings } 14277f967c01SBen Hutchings 1428cd2d5b52SBen Hutchings /* RSS might be usable on VFs even if it is disabled on the PF */ 1429d98a4ffeSShradha Shah 1430327c685eSShradha Shah efx->rss_spread = ((efx->n_rx_channels > 1 || 1431d98a4ffeSShradha Shah !efx->type->sriov_wanted(efx)) ? 1432cd2d5b52SBen Hutchings efx->n_rx_channels : efx_vf_size(efx)); 1433cd2d5b52SBen Hutchings 1434874aeea5SJeff Kirsher return 0; 1435874aeea5SJeff Kirsher } 1436874aeea5SJeff Kirsher 1437261e4d96SJon Cooper static int efx_soft_enable_interrupts(struct efx_nic *efx) 1438d8291187SBen Hutchings { 1439261e4d96SJon Cooper struct efx_channel *channel, *end_channel; 1440261e4d96SJon Cooper int rc; 1441d8291187SBen Hutchings 1442d8291187SBen Hutchings BUG_ON(efx->state == STATE_DISABLED); 1443d8291187SBen Hutchings 1444d8291187SBen Hutchings efx->irq_soft_enabled = true; 1445d8291187SBen Hutchings smp_wmb(); 1446d8291187SBen Hutchings 1447d8291187SBen Hutchings efx_for_each_channel(channel, efx) { 1448261e4d96SJon Cooper if (!channel->type->keep_eventq) { 1449261e4d96SJon Cooper rc = efx_init_eventq(channel); 1450261e4d96SJon Cooper if (rc) 1451261e4d96SJon Cooper goto fail; 1452261e4d96SJon Cooper } 1453d8291187SBen Hutchings efx_start_eventq(channel); 1454d8291187SBen Hutchings } 1455d8291187SBen Hutchings 1456d8291187SBen Hutchings efx_mcdi_mode_event(efx); 1457261e4d96SJon Cooper 1458261e4d96SJon Cooper return 0; 1459261e4d96SJon Cooper fail: 1460261e4d96SJon Cooper end_channel = channel; 1461261e4d96SJon Cooper efx_for_each_channel(channel, efx) { 1462261e4d96SJon Cooper if (channel == end_channel) 1463261e4d96SJon Cooper break; 1464261e4d96SJon Cooper efx_stop_eventq(channel); 1465261e4d96SJon Cooper if (!channel->type->keep_eventq) 1466261e4d96SJon Cooper efx_fini_eventq(channel); 1467261e4d96SJon Cooper } 1468261e4d96SJon Cooper 1469261e4d96SJon Cooper return rc; 1470d8291187SBen Hutchings } 1471d8291187SBen Hutchings 1472d8291187SBen Hutchings static void efx_soft_disable_interrupts(struct efx_nic *efx) 1473d8291187SBen Hutchings { 1474d8291187SBen Hutchings struct efx_channel *channel; 1475d8291187SBen Hutchings 1476d8291187SBen Hutchings if (efx->state == STATE_DISABLED) 1477d8291187SBen Hutchings return; 1478d8291187SBen Hutchings 1479d8291187SBen Hutchings efx_mcdi_mode_poll(efx); 1480d8291187SBen Hutchings 1481d8291187SBen Hutchings efx->irq_soft_enabled = false; 1482d8291187SBen Hutchings smp_wmb(); 1483d8291187SBen Hutchings 1484d8291187SBen Hutchings if (efx->legacy_irq) 1485d8291187SBen Hutchings synchronize_irq(efx->legacy_irq); 1486d8291187SBen Hutchings 1487d8291187SBen Hutchings efx_for_each_channel(channel, efx) { 1488d8291187SBen Hutchings if (channel->irq) 1489d8291187SBen Hutchings synchronize_irq(channel->irq); 1490d8291187SBen Hutchings 1491d8291187SBen Hutchings efx_stop_eventq(channel); 1492d8291187SBen Hutchings if (!channel->type->keep_eventq) 1493d8291187SBen Hutchings efx_fini_eventq(channel); 1494d8291187SBen Hutchings } 1495cade715fSBen Hutchings 1496cade715fSBen Hutchings /* Flush the asynchronous MCDI request queue */ 1497cade715fSBen Hutchings efx_mcdi_flush_async(efx); 1498d8291187SBen Hutchings } 1499d8291187SBen Hutchings 1500261e4d96SJon Cooper static int efx_enable_interrupts(struct efx_nic *efx) 15019f2cb71cSBen Hutchings { 1502261e4d96SJon Cooper struct efx_channel *channel, *end_channel; 1503261e4d96SJon Cooper int rc; 15049f2cb71cSBen Hutchings 15058b7325b4SBen Hutchings BUG_ON(efx->state == STATE_DISABLED); 15068b7325b4SBen Hutchings 1507b28405b0SAlexandre Rames if (efx->eeh_disabled_legacy_irq) { 1508b28405b0SAlexandre Rames enable_irq(efx->legacy_irq); 1509b28405b0SAlexandre Rames efx->eeh_disabled_legacy_irq = false; 1510b28405b0SAlexandre Rames } 1511d8291187SBen Hutchings 151286094f7fSBen Hutchings efx->type->irq_enable_master(efx); 15139f2cb71cSBen Hutchings 15149f2cb71cSBen Hutchings efx_for_each_channel(channel, efx) { 1515261e4d96SJon Cooper if (channel->type->keep_eventq) { 1516261e4d96SJon Cooper rc = efx_init_eventq(channel); 1517261e4d96SJon Cooper if (rc) 1518261e4d96SJon Cooper goto fail; 1519261e4d96SJon Cooper } 15209f2cb71cSBen Hutchings } 15219f2cb71cSBen Hutchings 1522261e4d96SJon Cooper rc = efx_soft_enable_interrupts(efx); 1523261e4d96SJon Cooper if (rc) 1524261e4d96SJon Cooper goto fail; 1525261e4d96SJon Cooper 1526261e4d96SJon Cooper return 0; 1527261e4d96SJon Cooper 1528261e4d96SJon Cooper fail: 1529261e4d96SJon Cooper end_channel = channel; 1530261e4d96SJon Cooper efx_for_each_channel(channel, efx) { 1531261e4d96SJon Cooper if (channel == end_channel) 1532261e4d96SJon Cooper break; 1533261e4d96SJon Cooper if (channel->type->keep_eventq) 1534261e4d96SJon Cooper efx_fini_eventq(channel); 1535261e4d96SJon Cooper } 1536261e4d96SJon Cooper 1537261e4d96SJon Cooper efx->type->irq_disable_non_ev(efx); 1538261e4d96SJon Cooper 1539261e4d96SJon Cooper return rc; 15409f2cb71cSBen Hutchings } 15419f2cb71cSBen Hutchings 1542d8291187SBen Hutchings static void efx_disable_interrupts(struct efx_nic *efx) 15439f2cb71cSBen Hutchings { 15449f2cb71cSBen Hutchings struct efx_channel *channel; 15459f2cb71cSBen Hutchings 1546d8291187SBen Hutchings efx_soft_disable_interrupts(efx); 15479f2cb71cSBen Hutchings 15489f2cb71cSBen Hutchings efx_for_each_channel(channel, efx) { 1549d8291187SBen Hutchings if (channel->type->keep_eventq) 15509f2cb71cSBen Hutchings efx_fini_eventq(channel); 15519f2cb71cSBen Hutchings } 1552d8291187SBen Hutchings 155386094f7fSBen Hutchings efx->type->irq_disable_non_ev(efx); 15549f2cb71cSBen Hutchings } 15559f2cb71cSBen Hutchings 1556874aeea5SJeff Kirsher static void efx_remove_interrupts(struct efx_nic *efx) 1557874aeea5SJeff Kirsher { 1558874aeea5SJeff Kirsher struct efx_channel *channel; 1559874aeea5SJeff Kirsher 1560874aeea5SJeff Kirsher /* Remove MSI/MSI-X interrupts */ 1561874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 1562874aeea5SJeff Kirsher channel->irq = 0; 1563874aeea5SJeff Kirsher pci_disable_msi(efx->pci_dev); 1564874aeea5SJeff Kirsher pci_disable_msix(efx->pci_dev); 1565874aeea5SJeff Kirsher 1566874aeea5SJeff Kirsher /* Remove legacy interrupt */ 1567874aeea5SJeff Kirsher efx->legacy_irq = 0; 1568874aeea5SJeff Kirsher } 1569874aeea5SJeff Kirsher 1570874aeea5SJeff Kirsher static void efx_set_channels(struct efx_nic *efx) 1571874aeea5SJeff Kirsher { 1572874aeea5SJeff Kirsher struct efx_channel *channel; 1573874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 1574874aeea5SJeff Kirsher 1575874aeea5SJeff Kirsher efx->tx_channel_offset = 1576874aeea5SJeff Kirsher separate_tx_channels ? efx->n_channels - efx->n_tx_channels : 0; 1577874aeea5SJeff Kirsher 157879d68b37SStuart Hodgson /* We need to mark which channels really have RX and TX 157979d68b37SStuart Hodgson * queues, and adjust the TX queue numbers if we have separate 1580874aeea5SJeff Kirsher * RX-only and TX-only channels. 1581874aeea5SJeff Kirsher */ 1582874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 158379d68b37SStuart Hodgson if (channel->channel < efx->n_rx_channels) 158479d68b37SStuart Hodgson channel->rx_queue.core_index = channel->channel; 158579d68b37SStuart Hodgson else 158679d68b37SStuart Hodgson channel->rx_queue.core_index = -1; 158779d68b37SStuart Hodgson 1588874aeea5SJeff Kirsher efx_for_each_channel_tx_queue(tx_queue, channel) 1589874aeea5SJeff Kirsher tx_queue->queue -= (efx->tx_channel_offset * 1590874aeea5SJeff Kirsher EFX_TXQ_TYPES); 1591874aeea5SJeff Kirsher } 1592874aeea5SJeff Kirsher } 1593874aeea5SJeff Kirsher 1594874aeea5SJeff Kirsher static int efx_probe_nic(struct efx_nic *efx) 1595874aeea5SJeff Kirsher { 1596874aeea5SJeff Kirsher size_t i; 1597874aeea5SJeff Kirsher int rc; 1598874aeea5SJeff Kirsher 1599874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "creating NIC\n"); 1600874aeea5SJeff Kirsher 1601874aeea5SJeff Kirsher /* Carry out hardware-type specific initialisation */ 1602874aeea5SJeff Kirsher rc = efx->type->probe(efx); 1603874aeea5SJeff Kirsher if (rc) 1604874aeea5SJeff Kirsher return rc; 1605874aeea5SJeff Kirsher 1606874aeea5SJeff Kirsher /* Determine the number of channels and queues by trying to hook 1607874aeea5SJeff Kirsher * in MSI-X interrupts. */ 1608874aeea5SJeff Kirsher rc = efx_probe_interrupts(efx); 1609874aeea5SJeff Kirsher if (rc) 1610c15eed22SBen Hutchings goto fail1; 1611874aeea5SJeff Kirsher 161252ad762bSDaniel Pieczko efx_set_channels(efx); 161352ad762bSDaniel Pieczko 1614c15eed22SBen Hutchings rc = efx->type->dimension_resources(efx); 1615c15eed22SBen Hutchings if (rc) 1616c15eed22SBen Hutchings goto fail2; 161728e47c49SBen Hutchings 1618874aeea5SJeff Kirsher if (efx->n_channels > 1) 16197a20db37SEric Dumazet netdev_rss_key_fill(&efx->rx_hash_key, sizeof(efx->rx_hash_key)); 1620874aeea5SJeff Kirsher for (i = 0; i < ARRAY_SIZE(efx->rx_indir_table); i++) 1621278bc429SBen Hutchings efx->rx_indir_table[i] = 1622cd2d5b52SBen Hutchings ethtool_rxfh_indir_default(i, efx->rss_spread); 1623874aeea5SJeff Kirsher 1624874aeea5SJeff Kirsher netif_set_real_num_tx_queues(efx->net_dev, efx->n_tx_channels); 1625874aeea5SJeff Kirsher netif_set_real_num_rx_queues(efx->net_dev, efx->n_rx_channels); 1626874aeea5SJeff Kirsher 1627874aeea5SJeff Kirsher /* Initialise the interrupt moderation settings */ 16289e393b30SBen Hutchings efx_init_irq_moderation(efx, tx_irq_mod_usec, rx_irq_mod_usec, true, 16299e393b30SBen Hutchings true); 1630874aeea5SJeff Kirsher 1631874aeea5SJeff Kirsher return 0; 1632874aeea5SJeff Kirsher 1633c15eed22SBen Hutchings fail2: 1634c15eed22SBen Hutchings efx_remove_interrupts(efx); 1635c15eed22SBen Hutchings fail1: 1636874aeea5SJeff Kirsher efx->type->remove(efx); 1637874aeea5SJeff Kirsher return rc; 1638874aeea5SJeff Kirsher } 1639874aeea5SJeff Kirsher 1640874aeea5SJeff Kirsher static void efx_remove_nic(struct efx_nic *efx) 1641874aeea5SJeff Kirsher { 1642874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "destroying NIC\n"); 1643874aeea5SJeff Kirsher 1644874aeea5SJeff Kirsher efx_remove_interrupts(efx); 1645874aeea5SJeff Kirsher efx->type->remove(efx); 1646874aeea5SJeff Kirsher } 1647874aeea5SJeff Kirsher 1648add72477SBen Hutchings static int efx_probe_filters(struct efx_nic *efx) 1649add72477SBen Hutchings { 1650add72477SBen Hutchings int rc; 1651add72477SBen Hutchings 1652add72477SBen Hutchings spin_lock_init(&efx->filter_lock); 1653add72477SBen Hutchings 1654add72477SBen Hutchings rc = efx->type->filter_table_probe(efx); 1655add72477SBen Hutchings if (rc) 1656add72477SBen Hutchings return rc; 1657add72477SBen Hutchings 1658add72477SBen Hutchings #ifdef CONFIG_RFS_ACCEL 1659add72477SBen Hutchings if (efx->type->offload_features & NETIF_F_NTUPLE) { 1660add72477SBen Hutchings efx->rps_flow_id = kcalloc(efx->type->max_rx_ip_filters, 1661add72477SBen Hutchings sizeof(*efx->rps_flow_id), 1662add72477SBen Hutchings GFP_KERNEL); 1663add72477SBen Hutchings if (!efx->rps_flow_id) { 1664add72477SBen Hutchings efx->type->filter_table_remove(efx); 1665add72477SBen Hutchings return -ENOMEM; 1666add72477SBen Hutchings } 1667add72477SBen Hutchings } 1668add72477SBen Hutchings #endif 1669add72477SBen Hutchings 1670add72477SBen Hutchings return 0; 1671add72477SBen Hutchings } 1672add72477SBen Hutchings 1673add72477SBen Hutchings static void efx_remove_filters(struct efx_nic *efx) 1674add72477SBen Hutchings { 1675add72477SBen Hutchings #ifdef CONFIG_RFS_ACCEL 1676add72477SBen Hutchings kfree(efx->rps_flow_id); 1677add72477SBen Hutchings #endif 1678add72477SBen Hutchings efx->type->filter_table_remove(efx); 1679add72477SBen Hutchings } 1680add72477SBen Hutchings 1681add72477SBen Hutchings static void efx_restore_filters(struct efx_nic *efx) 1682add72477SBen Hutchings { 1683add72477SBen Hutchings efx->type->filter_table_restore(efx); 1684add72477SBen Hutchings } 1685add72477SBen Hutchings 1686874aeea5SJeff Kirsher /************************************************************************** 1687874aeea5SJeff Kirsher * 1688874aeea5SJeff Kirsher * NIC startup/shutdown 1689874aeea5SJeff Kirsher * 1690874aeea5SJeff Kirsher *************************************************************************/ 1691874aeea5SJeff Kirsher 1692874aeea5SJeff Kirsher static int efx_probe_all(struct efx_nic *efx) 1693874aeea5SJeff Kirsher { 1694874aeea5SJeff Kirsher int rc; 1695874aeea5SJeff Kirsher 1696874aeea5SJeff Kirsher rc = efx_probe_nic(efx); 1697874aeea5SJeff Kirsher if (rc) { 1698874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, "failed to create NIC\n"); 1699874aeea5SJeff Kirsher goto fail1; 1700874aeea5SJeff Kirsher } 1701874aeea5SJeff Kirsher 1702874aeea5SJeff Kirsher rc = efx_probe_port(efx); 1703874aeea5SJeff Kirsher if (rc) { 1704874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, "failed to create port\n"); 1705874aeea5SJeff Kirsher goto fail2; 1706874aeea5SJeff Kirsher } 1707874aeea5SJeff Kirsher 17087e6d06f0SBen Hutchings BUILD_BUG_ON(EFX_DEFAULT_DMAQ_SIZE < EFX_RXQ_MIN_ENT); 17097e6d06f0SBen Hutchings if (WARN_ON(EFX_DEFAULT_DMAQ_SIZE < EFX_TXQ_MIN_ENT(efx))) { 17107e6d06f0SBen Hutchings rc = -EINVAL; 17117e6d06f0SBen Hutchings goto fail3; 17127e6d06f0SBen Hutchings } 1713874aeea5SJeff Kirsher efx->rxq_entries = efx->txq_entries = EFX_DEFAULT_DMAQ_SIZE; 1714874aeea5SJeff Kirsher 1715874aeea5SJeff Kirsher rc = efx_probe_filters(efx); 1716874aeea5SJeff Kirsher if (rc) { 1717874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1718874aeea5SJeff Kirsher "failed to create filter tables\n"); 17197f967c01SBen Hutchings goto fail3; 1720874aeea5SJeff Kirsher } 1721874aeea5SJeff Kirsher 17227f967c01SBen Hutchings rc = efx_probe_channels(efx); 17237f967c01SBen Hutchings if (rc) 17247f967c01SBen Hutchings goto fail4; 17257f967c01SBen Hutchings 1726874aeea5SJeff Kirsher return 0; 1727874aeea5SJeff Kirsher 1728874aeea5SJeff Kirsher fail4: 17297f967c01SBen Hutchings efx_remove_filters(efx); 1730874aeea5SJeff Kirsher fail3: 1731874aeea5SJeff Kirsher efx_remove_port(efx); 1732874aeea5SJeff Kirsher fail2: 1733874aeea5SJeff Kirsher efx_remove_nic(efx); 1734874aeea5SJeff Kirsher fail1: 1735874aeea5SJeff Kirsher return rc; 1736874aeea5SJeff Kirsher } 1737874aeea5SJeff Kirsher 17388b7325b4SBen Hutchings /* If the interface is supposed to be running but is not, start 17398b7325b4SBen Hutchings * the hardware and software data path, regular activity for the port 17408b7325b4SBen Hutchings * (MAC statistics, link polling, etc.) and schedule the port to be 17418b7325b4SBen Hutchings * reconfigured. Interrupts must already be enabled. This function 17428b7325b4SBen Hutchings * is safe to call multiple times, so long as the NIC is not disabled. 17438b7325b4SBen Hutchings * Requires the RTNL lock. 17449f2cb71cSBen Hutchings */ 1745874aeea5SJeff Kirsher static void efx_start_all(struct efx_nic *efx) 1746874aeea5SJeff Kirsher { 1747874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 17488b7325b4SBen Hutchings BUG_ON(efx->state == STATE_DISABLED); 1749874aeea5SJeff Kirsher 1750874aeea5SJeff Kirsher /* Check that it is appropriate to restart the interface. All 1751874aeea5SJeff Kirsher * of these flags are safe to read under just the rtnl lock */ 1752e283546cSEdward Cree if (efx->port_enabled || !netif_running(efx->net_dev) || 1753e283546cSEdward Cree efx->reset_pending) 1754874aeea5SJeff Kirsher return; 1755874aeea5SJeff Kirsher 1756874aeea5SJeff Kirsher efx_start_port(efx); 17579f2cb71cSBen Hutchings efx_start_datapath(efx); 1758874aeea5SJeff Kirsher 1759626950dbSAlexandre Rames /* Start the hardware monitor if there is one */ 1760626950dbSAlexandre Rames if (efx->type->monitor != NULL) 1761874aeea5SJeff Kirsher queue_delayed_work(efx->workqueue, &efx->monitor_work, 1762874aeea5SJeff Kirsher efx_monitor_interval); 1763626950dbSAlexandre Rames 1764626950dbSAlexandre Rames /* If link state detection is normally event-driven, we have 1765626950dbSAlexandre Rames * to poll now because we could have missed a change 1766626950dbSAlexandre Rames */ 1767626950dbSAlexandre Rames if (efx_nic_rev(efx) >= EFX_REV_SIENA_A0) { 1768874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1769874aeea5SJeff Kirsher if (efx->phy_op->poll(efx)) 1770874aeea5SJeff Kirsher efx_link_status_changed(efx); 1771874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1772874aeea5SJeff Kirsher } 1773874aeea5SJeff Kirsher 1774874aeea5SJeff Kirsher efx->type->start_stats(efx); 1775f8f3b5aeSJon Cooper efx->type->pull_stats(efx); 1776f8f3b5aeSJon Cooper spin_lock_bh(&efx->stats_lock); 1777f8f3b5aeSJon Cooper efx->type->update_stats(efx, NULL, NULL); 1778f8f3b5aeSJon Cooper spin_unlock_bh(&efx->stats_lock); 1779874aeea5SJeff Kirsher } 1780874aeea5SJeff Kirsher 17818b7325b4SBen Hutchings /* Quiesce the hardware and software data path, and regular activity 17828b7325b4SBen Hutchings * for the port without bringing the link down. Safe to call multiple 17838b7325b4SBen Hutchings * times with the NIC in almost any state, but interrupts should be 17848b7325b4SBen Hutchings * enabled. Requires the RTNL lock. 17858b7325b4SBen Hutchings */ 1786874aeea5SJeff Kirsher static void efx_stop_all(struct efx_nic *efx) 1787874aeea5SJeff Kirsher { 1788874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 1789874aeea5SJeff Kirsher 1790874aeea5SJeff Kirsher /* port_enabled can be read safely under the rtnl lock */ 1791874aeea5SJeff Kirsher if (!efx->port_enabled) 1792874aeea5SJeff Kirsher return; 1793874aeea5SJeff Kirsher 1794f8f3b5aeSJon Cooper /* update stats before we go down so we can accurately count 1795f8f3b5aeSJon Cooper * rx_nodesc_drops 1796f8f3b5aeSJon Cooper */ 1797f8f3b5aeSJon Cooper efx->type->pull_stats(efx); 1798f8f3b5aeSJon Cooper spin_lock_bh(&efx->stats_lock); 1799f8f3b5aeSJon Cooper efx->type->update_stats(efx, NULL, NULL); 1800f8f3b5aeSJon Cooper spin_unlock_bh(&efx->stats_lock); 1801874aeea5SJeff Kirsher efx->type->stop_stats(efx); 1802874aeea5SJeff Kirsher efx_stop_port(efx); 1803874aeea5SJeff Kirsher 180429c69a48SBen Hutchings /* Stop the kernel transmit interface. This is only valid if 180529c69a48SBen Hutchings * the device is stopped or detached; otherwise the watchdog 180629c69a48SBen Hutchings * may fire immediately. 180729c69a48SBen Hutchings */ 180829c69a48SBen Hutchings WARN_ON(netif_running(efx->net_dev) && 180929c69a48SBen Hutchings netif_device_present(efx->net_dev)); 18109f2cb71cSBen Hutchings netif_tx_disable(efx->net_dev); 18119f2cb71cSBen Hutchings 18129f2cb71cSBen Hutchings efx_stop_datapath(efx); 1813874aeea5SJeff Kirsher } 1814874aeea5SJeff Kirsher 1815874aeea5SJeff Kirsher static void efx_remove_all(struct efx_nic *efx) 1816874aeea5SJeff Kirsher { 1817874aeea5SJeff Kirsher efx_remove_channels(efx); 18187f967c01SBen Hutchings efx_remove_filters(efx); 1819874aeea5SJeff Kirsher efx_remove_port(efx); 1820874aeea5SJeff Kirsher efx_remove_nic(efx); 1821874aeea5SJeff Kirsher } 1822874aeea5SJeff Kirsher 1823874aeea5SJeff Kirsher /************************************************************************** 1824874aeea5SJeff Kirsher * 1825874aeea5SJeff Kirsher * Interrupt moderation 1826874aeea5SJeff Kirsher * 1827874aeea5SJeff Kirsher **************************************************************************/ 1828874aeea5SJeff Kirsher 1829cc180b69SBen Hutchings static unsigned int irq_mod_ticks(unsigned int usecs, unsigned int quantum_ns) 1830874aeea5SJeff Kirsher { 1831b548f976SBen Hutchings if (usecs == 0) 1832b548f976SBen Hutchings return 0; 1833cc180b69SBen Hutchings if (usecs * 1000 < quantum_ns) 1834874aeea5SJeff Kirsher return 1; /* never round down to 0 */ 1835cc180b69SBen Hutchings return usecs * 1000 / quantum_ns; 1836874aeea5SJeff Kirsher } 1837874aeea5SJeff Kirsher 1838874aeea5SJeff Kirsher /* Set interrupt moderation parameters */ 18399e393b30SBen Hutchings int efx_init_irq_moderation(struct efx_nic *efx, unsigned int tx_usecs, 18409e393b30SBen Hutchings unsigned int rx_usecs, bool rx_adaptive, 18419e393b30SBen Hutchings bool rx_may_override_tx) 1842874aeea5SJeff Kirsher { 1843874aeea5SJeff Kirsher struct efx_channel *channel; 1844cc180b69SBen Hutchings unsigned int irq_mod_max = DIV_ROUND_UP(efx->type->timer_period_max * 1845cc180b69SBen Hutchings efx->timer_quantum_ns, 1846cc180b69SBen Hutchings 1000); 1847cc180b69SBen Hutchings unsigned int tx_ticks; 1848cc180b69SBen Hutchings unsigned int rx_ticks; 1849874aeea5SJeff Kirsher 1850874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 1851874aeea5SJeff Kirsher 1852cc180b69SBen Hutchings if (tx_usecs > irq_mod_max || rx_usecs > irq_mod_max) 18539e393b30SBen Hutchings return -EINVAL; 18549e393b30SBen Hutchings 1855cc180b69SBen Hutchings tx_ticks = irq_mod_ticks(tx_usecs, efx->timer_quantum_ns); 1856cc180b69SBen Hutchings rx_ticks = irq_mod_ticks(rx_usecs, efx->timer_quantum_ns); 1857cc180b69SBen Hutchings 18589e393b30SBen Hutchings if (tx_ticks != rx_ticks && efx->tx_channel_offset == 0 && 18599e393b30SBen Hutchings !rx_may_override_tx) { 18609e393b30SBen Hutchings netif_err(efx, drv, efx->net_dev, "Channels are shared. " 18619e393b30SBen Hutchings "RX and TX IRQ moderation must be equal\n"); 18629e393b30SBen Hutchings return -EINVAL; 18639e393b30SBen Hutchings } 18649e393b30SBen Hutchings 1865874aeea5SJeff Kirsher efx->irq_rx_adaptive = rx_adaptive; 1866874aeea5SJeff Kirsher efx->irq_rx_moderation = rx_ticks; 1867874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 1868874aeea5SJeff Kirsher if (efx_channel_has_rx_queue(channel)) 1869874aeea5SJeff Kirsher channel->irq_moderation = rx_ticks; 1870874aeea5SJeff Kirsher else if (efx_channel_has_tx_queues(channel)) 1871874aeea5SJeff Kirsher channel->irq_moderation = tx_ticks; 1872874aeea5SJeff Kirsher } 18739e393b30SBen Hutchings 18749e393b30SBen Hutchings return 0; 1875874aeea5SJeff Kirsher } 1876874aeea5SJeff Kirsher 1877a0c4faf5SBen Hutchings void efx_get_irq_moderation(struct efx_nic *efx, unsigned int *tx_usecs, 1878a0c4faf5SBen Hutchings unsigned int *rx_usecs, bool *rx_adaptive) 1879a0c4faf5SBen Hutchings { 1880cc180b69SBen Hutchings /* We must round up when converting ticks to microseconds 1881cc180b69SBen Hutchings * because we round down when converting the other way. 1882cc180b69SBen Hutchings */ 1883cc180b69SBen Hutchings 1884a0c4faf5SBen Hutchings *rx_adaptive = efx->irq_rx_adaptive; 1885cc180b69SBen Hutchings *rx_usecs = DIV_ROUND_UP(efx->irq_rx_moderation * 1886cc180b69SBen Hutchings efx->timer_quantum_ns, 1887cc180b69SBen Hutchings 1000); 1888a0c4faf5SBen Hutchings 1889a0c4faf5SBen Hutchings /* If channels are shared between RX and TX, so is IRQ 1890a0c4faf5SBen Hutchings * moderation. Otherwise, IRQ moderation is the same for all 1891a0c4faf5SBen Hutchings * TX channels and is not adaptive. 1892a0c4faf5SBen Hutchings */ 1893a0c4faf5SBen Hutchings if (efx->tx_channel_offset == 0) 1894a0c4faf5SBen Hutchings *tx_usecs = *rx_usecs; 1895a0c4faf5SBen Hutchings else 1896cc180b69SBen Hutchings *tx_usecs = DIV_ROUND_UP( 1897a0c4faf5SBen Hutchings efx->channel[efx->tx_channel_offset]->irq_moderation * 1898cc180b69SBen Hutchings efx->timer_quantum_ns, 1899cc180b69SBen Hutchings 1000); 1900a0c4faf5SBen Hutchings } 1901a0c4faf5SBen Hutchings 1902874aeea5SJeff Kirsher /************************************************************************** 1903874aeea5SJeff Kirsher * 1904874aeea5SJeff Kirsher * Hardware monitor 1905874aeea5SJeff Kirsher * 1906874aeea5SJeff Kirsher **************************************************************************/ 1907874aeea5SJeff Kirsher 1908874aeea5SJeff Kirsher /* Run periodically off the general workqueue */ 1909874aeea5SJeff Kirsher static void efx_monitor(struct work_struct *data) 1910874aeea5SJeff Kirsher { 1911874aeea5SJeff Kirsher struct efx_nic *efx = container_of(data, struct efx_nic, 1912874aeea5SJeff Kirsher monitor_work.work); 1913874aeea5SJeff Kirsher 1914874aeea5SJeff Kirsher netif_vdbg(efx, timer, efx->net_dev, 1915874aeea5SJeff Kirsher "hardware monitor executing on CPU %d\n", 1916874aeea5SJeff Kirsher raw_smp_processor_id()); 1917874aeea5SJeff Kirsher BUG_ON(efx->type->monitor == NULL); 1918874aeea5SJeff Kirsher 1919874aeea5SJeff Kirsher /* If the mac_lock is already held then it is likely a port 1920874aeea5SJeff Kirsher * reconfiguration is already in place, which will likely do 1921874aeea5SJeff Kirsher * most of the work of monitor() anyway. */ 1922874aeea5SJeff Kirsher if (mutex_trylock(&efx->mac_lock)) { 1923874aeea5SJeff Kirsher if (efx->port_enabled) 1924874aeea5SJeff Kirsher efx->type->monitor(efx); 1925874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1926874aeea5SJeff Kirsher } 1927874aeea5SJeff Kirsher 1928874aeea5SJeff Kirsher queue_delayed_work(efx->workqueue, &efx->monitor_work, 1929874aeea5SJeff Kirsher efx_monitor_interval); 1930874aeea5SJeff Kirsher } 1931874aeea5SJeff Kirsher 1932874aeea5SJeff Kirsher /************************************************************************** 1933874aeea5SJeff Kirsher * 1934874aeea5SJeff Kirsher * ioctls 1935874aeea5SJeff Kirsher * 1936874aeea5SJeff Kirsher *************************************************************************/ 1937874aeea5SJeff Kirsher 1938874aeea5SJeff Kirsher /* Net device ioctl 1939874aeea5SJeff Kirsher * Context: process, rtnl_lock() held. 1940874aeea5SJeff Kirsher */ 1941874aeea5SJeff Kirsher static int efx_ioctl(struct net_device *net_dev, struct ifreq *ifr, int cmd) 1942874aeea5SJeff Kirsher { 1943874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 1944874aeea5SJeff Kirsher struct mii_ioctl_data *data = if_mii(ifr); 1945874aeea5SJeff Kirsher 19467c236c43SStuart Hodgson if (cmd == SIOCSHWTSTAMP) 1947433dc9b3SBen Hutchings return efx_ptp_set_ts_config(efx, ifr); 1948433dc9b3SBen Hutchings if (cmd == SIOCGHWTSTAMP) 1949433dc9b3SBen Hutchings return efx_ptp_get_ts_config(efx, ifr); 19507c236c43SStuart Hodgson 1951874aeea5SJeff Kirsher /* Convert phy_id from older PRTAD/DEVAD format */ 1952874aeea5SJeff Kirsher if ((cmd == SIOCGMIIREG || cmd == SIOCSMIIREG) && 1953874aeea5SJeff Kirsher (data->phy_id & 0xfc00) == 0x0400) 1954874aeea5SJeff Kirsher data->phy_id ^= MDIO_PHY_ID_C45 | 0x0400; 1955874aeea5SJeff Kirsher 1956874aeea5SJeff Kirsher return mdio_mii_ioctl(&efx->mdio, data, cmd); 1957874aeea5SJeff Kirsher } 1958874aeea5SJeff Kirsher 1959874aeea5SJeff Kirsher /************************************************************************** 1960874aeea5SJeff Kirsher * 1961874aeea5SJeff Kirsher * NAPI interface 1962874aeea5SJeff Kirsher * 1963874aeea5SJeff Kirsher **************************************************************************/ 1964874aeea5SJeff Kirsher 19657f967c01SBen Hutchings static void efx_init_napi_channel(struct efx_channel *channel) 1966874aeea5SJeff Kirsher { 19677f967c01SBen Hutchings struct efx_nic *efx = channel->efx; 1968874aeea5SJeff Kirsher 1969874aeea5SJeff Kirsher channel->napi_dev = efx->net_dev; 1970874aeea5SJeff Kirsher netif_napi_add(channel->napi_dev, &channel->napi_str, 1971874aeea5SJeff Kirsher efx_poll, napi_weight); 197236763266SAlexandre Rames napi_hash_add(&channel->napi_str); 197336763266SAlexandre Rames efx_channel_init_lock(channel); 1974874aeea5SJeff Kirsher } 19757f967c01SBen Hutchings 19767f967c01SBen Hutchings static void efx_init_napi(struct efx_nic *efx) 19777f967c01SBen Hutchings { 19787f967c01SBen Hutchings struct efx_channel *channel; 19797f967c01SBen Hutchings 19807f967c01SBen Hutchings efx_for_each_channel(channel, efx) 19817f967c01SBen Hutchings efx_init_napi_channel(channel); 1982874aeea5SJeff Kirsher } 1983874aeea5SJeff Kirsher 1984874aeea5SJeff Kirsher static void efx_fini_napi_channel(struct efx_channel *channel) 1985874aeea5SJeff Kirsher { 198636763266SAlexandre Rames if (channel->napi_dev) { 1987874aeea5SJeff Kirsher netif_napi_del(&channel->napi_str); 198836763266SAlexandre Rames napi_hash_del(&channel->napi_str); 198936763266SAlexandre Rames } 1990874aeea5SJeff Kirsher channel->napi_dev = NULL; 1991874aeea5SJeff Kirsher } 1992874aeea5SJeff Kirsher 1993874aeea5SJeff Kirsher static void efx_fini_napi(struct efx_nic *efx) 1994874aeea5SJeff Kirsher { 1995874aeea5SJeff Kirsher struct efx_channel *channel; 1996874aeea5SJeff Kirsher 1997874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 1998874aeea5SJeff Kirsher efx_fini_napi_channel(channel); 1999874aeea5SJeff Kirsher } 2000874aeea5SJeff Kirsher 2001874aeea5SJeff Kirsher /************************************************************************** 2002874aeea5SJeff Kirsher * 2003874aeea5SJeff Kirsher * Kernel netpoll interface 2004874aeea5SJeff Kirsher * 2005874aeea5SJeff Kirsher *************************************************************************/ 2006874aeea5SJeff Kirsher 2007874aeea5SJeff Kirsher #ifdef CONFIG_NET_POLL_CONTROLLER 2008874aeea5SJeff Kirsher 2009874aeea5SJeff Kirsher /* Although in the common case interrupts will be disabled, this is not 2010874aeea5SJeff Kirsher * guaranteed. However, all our work happens inside the NAPI callback, 2011874aeea5SJeff Kirsher * so no locking is required. 2012874aeea5SJeff Kirsher */ 2013874aeea5SJeff Kirsher static void efx_netpoll(struct net_device *net_dev) 2014874aeea5SJeff Kirsher { 2015874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2016874aeea5SJeff Kirsher struct efx_channel *channel; 2017874aeea5SJeff Kirsher 2018874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 2019874aeea5SJeff Kirsher efx_schedule_channel(channel); 2020874aeea5SJeff Kirsher } 2021874aeea5SJeff Kirsher 2022874aeea5SJeff Kirsher #endif 2023874aeea5SJeff Kirsher 202436763266SAlexandre Rames #ifdef CONFIG_NET_RX_BUSY_POLL 202536763266SAlexandre Rames static int efx_busy_poll(struct napi_struct *napi) 202636763266SAlexandre Rames { 202736763266SAlexandre Rames struct efx_channel *channel = 202836763266SAlexandre Rames container_of(napi, struct efx_channel, napi_str); 202936763266SAlexandre Rames struct efx_nic *efx = channel->efx; 203036763266SAlexandre Rames int budget = 4; 203136763266SAlexandre Rames int old_rx_packets, rx_packets; 203236763266SAlexandre Rames 203336763266SAlexandre Rames if (!netif_running(efx->net_dev)) 203436763266SAlexandre Rames return LL_FLUSH_FAILED; 203536763266SAlexandre Rames 203636763266SAlexandre Rames if (!efx_channel_lock_poll(channel)) 203736763266SAlexandre Rames return LL_FLUSH_BUSY; 203836763266SAlexandre Rames 203936763266SAlexandre Rames old_rx_packets = channel->rx_queue.rx_packets; 204036763266SAlexandre Rames efx_process_channel(channel, budget); 204136763266SAlexandre Rames 204236763266SAlexandre Rames rx_packets = channel->rx_queue.rx_packets - old_rx_packets; 204336763266SAlexandre Rames 204436763266SAlexandre Rames /* There is no race condition with NAPI here. 204536763266SAlexandre Rames * NAPI will automatically be rescheduled if it yielded during busy 204636763266SAlexandre Rames * polling, because it was not able to take the lock and thus returned 204736763266SAlexandre Rames * the full budget. 204836763266SAlexandre Rames */ 204936763266SAlexandre Rames efx_channel_unlock_poll(channel); 205036763266SAlexandre Rames 205136763266SAlexandre Rames return rx_packets; 205236763266SAlexandre Rames } 205336763266SAlexandre Rames #endif 205436763266SAlexandre Rames 2055874aeea5SJeff Kirsher /************************************************************************** 2056874aeea5SJeff Kirsher * 2057874aeea5SJeff Kirsher * Kernel net device interface 2058874aeea5SJeff Kirsher * 2059874aeea5SJeff Kirsher *************************************************************************/ 2060874aeea5SJeff Kirsher 2061874aeea5SJeff Kirsher /* Context: process, rtnl_lock() held. */ 2062874aeea5SJeff Kirsher static int efx_net_open(struct net_device *net_dev) 2063874aeea5SJeff Kirsher { 2064874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 20658b7325b4SBen Hutchings int rc; 20668b7325b4SBen Hutchings 2067874aeea5SJeff Kirsher netif_dbg(efx, ifup, efx->net_dev, "opening device on CPU %d\n", 2068874aeea5SJeff Kirsher raw_smp_processor_id()); 2069874aeea5SJeff Kirsher 20708b7325b4SBen Hutchings rc = efx_check_disabled(efx); 20718b7325b4SBen Hutchings if (rc) 20728b7325b4SBen Hutchings return rc; 2073874aeea5SJeff Kirsher if (efx->phy_mode & PHY_MODE_SPECIAL) 2074874aeea5SJeff Kirsher return -EBUSY; 2075874aeea5SJeff Kirsher if (efx_mcdi_poll_reboot(efx) && efx_reset(efx, RESET_TYPE_ALL)) 2076874aeea5SJeff Kirsher return -EIO; 2077874aeea5SJeff Kirsher 2078874aeea5SJeff Kirsher /* Notify the kernel of the link state polled during driver load, 2079874aeea5SJeff Kirsher * before the monitor starts running */ 2080874aeea5SJeff Kirsher efx_link_status_changed(efx); 2081874aeea5SJeff Kirsher 2082874aeea5SJeff Kirsher efx_start_all(efx); 2083dd40781eSBen Hutchings efx_selftest_async_start(efx); 2084874aeea5SJeff Kirsher return 0; 2085874aeea5SJeff Kirsher } 2086874aeea5SJeff Kirsher 2087874aeea5SJeff Kirsher /* Context: process, rtnl_lock() held. 2088874aeea5SJeff Kirsher * Note that the kernel will ignore our return code; this method 2089874aeea5SJeff Kirsher * should really be a void. 2090874aeea5SJeff Kirsher */ 2091874aeea5SJeff Kirsher static int efx_net_stop(struct net_device *net_dev) 2092874aeea5SJeff Kirsher { 2093874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2094874aeea5SJeff Kirsher 2095874aeea5SJeff Kirsher netif_dbg(efx, ifdown, efx->net_dev, "closing on CPU %d\n", 2096874aeea5SJeff Kirsher raw_smp_processor_id()); 2097874aeea5SJeff Kirsher 2098874aeea5SJeff Kirsher /* Stop the device and flush all the channels */ 2099874aeea5SJeff Kirsher efx_stop_all(efx); 2100874aeea5SJeff Kirsher 2101874aeea5SJeff Kirsher return 0; 2102874aeea5SJeff Kirsher } 2103874aeea5SJeff Kirsher 2104874aeea5SJeff Kirsher /* Context: process, dev_base_lock or RTNL held, non-blocking. */ 21052aa9ef11SBen Hutchings static struct rtnl_link_stats64 *efx_net_stats(struct net_device *net_dev, 21062aa9ef11SBen Hutchings struct rtnl_link_stats64 *stats) 2107874aeea5SJeff Kirsher { 2108874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2109874aeea5SJeff Kirsher 2110874aeea5SJeff Kirsher spin_lock_bh(&efx->stats_lock); 2111cd0ecc9aSBen Hutchings efx->type->update_stats(efx, NULL, stats); 21121cb34522SBen Hutchings spin_unlock_bh(&efx->stats_lock); 21131cb34522SBen Hutchings 2114874aeea5SJeff Kirsher return stats; 2115874aeea5SJeff Kirsher } 2116874aeea5SJeff Kirsher 2117874aeea5SJeff Kirsher /* Context: netif_tx_lock held, BHs disabled. */ 2118874aeea5SJeff Kirsher static void efx_watchdog(struct net_device *net_dev) 2119874aeea5SJeff Kirsher { 2120874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2121874aeea5SJeff Kirsher 2122874aeea5SJeff Kirsher netif_err(efx, tx_err, efx->net_dev, 2123874aeea5SJeff Kirsher "TX stuck with port_enabled=%d: resetting channels\n", 2124874aeea5SJeff Kirsher efx->port_enabled); 2125874aeea5SJeff Kirsher 2126874aeea5SJeff Kirsher efx_schedule_reset(efx, RESET_TYPE_TX_WATCHDOG); 2127874aeea5SJeff Kirsher } 2128874aeea5SJeff Kirsher 2129874aeea5SJeff Kirsher 2130874aeea5SJeff Kirsher /* Context: process, rtnl_lock() held. */ 2131874aeea5SJeff Kirsher static int efx_change_mtu(struct net_device *net_dev, int new_mtu) 2132874aeea5SJeff Kirsher { 2133874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 21348b7325b4SBen Hutchings int rc; 2135874aeea5SJeff Kirsher 21368b7325b4SBen Hutchings rc = efx_check_disabled(efx); 21378b7325b4SBen Hutchings if (rc) 21388b7325b4SBen Hutchings return rc; 2139874aeea5SJeff Kirsher if (new_mtu > EFX_MAX_MTU) 2140874aeea5SJeff Kirsher return -EINVAL; 2141874aeea5SJeff Kirsher 2142874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "changing MTU to %d\n", new_mtu); 2143874aeea5SJeff Kirsher 214429c69a48SBen Hutchings efx_device_detach_sync(efx); 214529c69a48SBen Hutchings efx_stop_all(efx); 214629c69a48SBen Hutchings 2147874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 2148874aeea5SJeff Kirsher net_dev->mtu = new_mtu; 2149710b208dSBen Hutchings efx->type->reconfigure_mac(efx); 2150874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2151874aeea5SJeff Kirsher 2152874aeea5SJeff Kirsher efx_start_all(efx); 215329c69a48SBen Hutchings netif_device_attach(efx->net_dev); 21546c8eef4aSBen Hutchings return 0; 2155874aeea5SJeff Kirsher } 2156874aeea5SJeff Kirsher 2157874aeea5SJeff Kirsher static int efx_set_mac_address(struct net_device *net_dev, void *data) 2158874aeea5SJeff Kirsher { 2159874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2160874aeea5SJeff Kirsher struct sockaddr *addr = data; 2161e0b3ae30SBen Hutchings u8 *new_addr = addr->sa_data; 2162874aeea5SJeff Kirsher 2163874aeea5SJeff Kirsher if (!is_valid_ether_addr(new_addr)) { 2164874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 2165874aeea5SJeff Kirsher "invalid ethernet MAC address requested: %pM\n", 2166874aeea5SJeff Kirsher new_addr); 2167504f9b5aSDanny Kukawka return -EADDRNOTAVAIL; 2168874aeea5SJeff Kirsher } 2169874aeea5SJeff Kirsher 2170cd84ff4dSEdward Cree ether_addr_copy(net_dev->dev_addr, new_addr); 2171d98a4ffeSShradha Shah efx->type->sriov_mac_address_changed(efx); 2172874aeea5SJeff Kirsher 2173874aeea5SJeff Kirsher /* Reconfigure the MAC */ 2174874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 2175710b208dSBen Hutchings efx->type->reconfigure_mac(efx); 2176874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2177874aeea5SJeff Kirsher 2178874aeea5SJeff Kirsher return 0; 2179874aeea5SJeff Kirsher } 2180874aeea5SJeff Kirsher 2181874aeea5SJeff Kirsher /* Context: netif_addr_lock held, BHs disabled. */ 21820fca8c97SBen Hutchings static void efx_set_rx_mode(struct net_device *net_dev) 2183874aeea5SJeff Kirsher { 2184874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2185874aeea5SJeff Kirsher 2186874aeea5SJeff Kirsher if (efx->port_enabled) 2187874aeea5SJeff Kirsher queue_work(efx->workqueue, &efx->mac_work); 2188874aeea5SJeff Kirsher /* Otherwise efx_start_port() will do this */ 2189874aeea5SJeff Kirsher } 2190874aeea5SJeff Kirsher 2191c8f44affSMichał Mirosław static int efx_set_features(struct net_device *net_dev, netdev_features_t data) 2192874aeea5SJeff Kirsher { 2193874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2194874aeea5SJeff Kirsher 2195874aeea5SJeff Kirsher /* If disabling RX n-tuple filtering, clear existing filters */ 2196874aeea5SJeff Kirsher if (net_dev->features & ~data & NETIF_F_NTUPLE) 2197fbd79120SBen Hutchings return efx->type->filter_clear_rx(efx, EFX_FILTER_PRI_MANUAL); 2198874aeea5SJeff Kirsher 2199874aeea5SJeff Kirsher return 0; 2200874aeea5SJeff Kirsher } 2201874aeea5SJeff Kirsher 22028127d661SBen Hutchings static const struct net_device_ops efx_farch_netdev_ops = { 2203874aeea5SJeff Kirsher .ndo_open = efx_net_open, 2204874aeea5SJeff Kirsher .ndo_stop = efx_net_stop, 2205874aeea5SJeff Kirsher .ndo_get_stats64 = efx_net_stats, 2206874aeea5SJeff Kirsher .ndo_tx_timeout = efx_watchdog, 2207874aeea5SJeff Kirsher .ndo_start_xmit = efx_hard_start_xmit, 2208874aeea5SJeff Kirsher .ndo_validate_addr = eth_validate_addr, 2209874aeea5SJeff Kirsher .ndo_do_ioctl = efx_ioctl, 2210874aeea5SJeff Kirsher .ndo_change_mtu = efx_change_mtu, 2211874aeea5SJeff Kirsher .ndo_set_mac_address = efx_set_mac_address, 22120fca8c97SBen Hutchings .ndo_set_rx_mode = efx_set_rx_mode, 2213874aeea5SJeff Kirsher .ndo_set_features = efx_set_features, 2214cd2d5b52SBen Hutchings #ifdef CONFIG_SFC_SRIOV 2215327c685eSShradha Shah .ndo_set_vf_mac = efx_siena_sriov_set_vf_mac, 2216327c685eSShradha Shah .ndo_set_vf_vlan = efx_siena_sriov_set_vf_vlan, 2217327c685eSShradha Shah .ndo_set_vf_spoofchk = efx_siena_sriov_set_vf_spoofchk, 2218327c685eSShradha Shah .ndo_get_vf_config = efx_siena_sriov_get_vf_config, 2219cd2d5b52SBen Hutchings #endif 2220874aeea5SJeff Kirsher #ifdef CONFIG_NET_POLL_CONTROLLER 2221874aeea5SJeff Kirsher .ndo_poll_controller = efx_netpoll, 2222874aeea5SJeff Kirsher #endif 2223874aeea5SJeff Kirsher .ndo_setup_tc = efx_setup_tc, 222436763266SAlexandre Rames #ifdef CONFIG_NET_RX_BUSY_POLL 222536763266SAlexandre Rames .ndo_busy_poll = efx_busy_poll, 222636763266SAlexandre Rames #endif 2227874aeea5SJeff Kirsher #ifdef CONFIG_RFS_ACCEL 2228874aeea5SJeff Kirsher .ndo_rx_flow_steer = efx_filter_rfs, 2229874aeea5SJeff Kirsher #endif 2230874aeea5SJeff Kirsher }; 2231874aeea5SJeff Kirsher 22328127d661SBen Hutchings static const struct net_device_ops efx_ef10_netdev_ops = { 22338127d661SBen Hutchings .ndo_open = efx_net_open, 22348127d661SBen Hutchings .ndo_stop = efx_net_stop, 22358127d661SBen Hutchings .ndo_get_stats64 = efx_net_stats, 22368127d661SBen Hutchings .ndo_tx_timeout = efx_watchdog, 22378127d661SBen Hutchings .ndo_start_xmit = efx_hard_start_xmit, 22388127d661SBen Hutchings .ndo_validate_addr = eth_validate_addr, 22398127d661SBen Hutchings .ndo_do_ioctl = efx_ioctl, 22408127d661SBen Hutchings .ndo_change_mtu = efx_change_mtu, 22418127d661SBen Hutchings .ndo_set_mac_address = efx_set_mac_address, 22428127d661SBen Hutchings .ndo_set_rx_mode = efx_set_rx_mode, 22438127d661SBen Hutchings .ndo_set_features = efx_set_features, 22448127d661SBen Hutchings #ifdef CONFIG_NET_POLL_CONTROLLER 22458127d661SBen Hutchings .ndo_poll_controller = efx_netpoll, 22468127d661SBen Hutchings #endif 224736763266SAlexandre Rames #ifdef CONFIG_NET_RX_BUSY_POLL 224836763266SAlexandre Rames .ndo_busy_poll = efx_busy_poll, 224936763266SAlexandre Rames #endif 22508127d661SBen Hutchings #ifdef CONFIG_RFS_ACCEL 22518127d661SBen Hutchings .ndo_rx_flow_steer = efx_filter_rfs, 22528127d661SBen Hutchings #endif 22538127d661SBen Hutchings }; 22548127d661SBen Hutchings 2255874aeea5SJeff Kirsher static void efx_update_name(struct efx_nic *efx) 2256874aeea5SJeff Kirsher { 2257874aeea5SJeff Kirsher strcpy(efx->name, efx->net_dev->name); 2258874aeea5SJeff Kirsher efx_mtd_rename(efx); 2259874aeea5SJeff Kirsher efx_set_channel_names(efx); 2260874aeea5SJeff Kirsher } 2261874aeea5SJeff Kirsher 2262874aeea5SJeff Kirsher static int efx_netdev_event(struct notifier_block *this, 2263874aeea5SJeff Kirsher unsigned long event, void *ptr) 2264874aeea5SJeff Kirsher { 2265351638e7SJiri Pirko struct net_device *net_dev = netdev_notifier_info_to_dev(ptr); 2266874aeea5SJeff Kirsher 22678127d661SBen Hutchings if ((net_dev->netdev_ops == &efx_farch_netdev_ops || 22688127d661SBen Hutchings net_dev->netdev_ops == &efx_ef10_netdev_ops) && 2269874aeea5SJeff Kirsher event == NETDEV_CHANGENAME) 2270874aeea5SJeff Kirsher efx_update_name(netdev_priv(net_dev)); 2271874aeea5SJeff Kirsher 2272874aeea5SJeff Kirsher return NOTIFY_DONE; 2273874aeea5SJeff Kirsher } 2274874aeea5SJeff Kirsher 2275874aeea5SJeff Kirsher static struct notifier_block efx_netdev_notifier = { 2276874aeea5SJeff Kirsher .notifier_call = efx_netdev_event, 2277874aeea5SJeff Kirsher }; 2278874aeea5SJeff Kirsher 2279874aeea5SJeff Kirsher static ssize_t 2280874aeea5SJeff Kirsher show_phy_type(struct device *dev, struct device_attribute *attr, char *buf) 2281874aeea5SJeff Kirsher { 2282874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); 2283874aeea5SJeff Kirsher return sprintf(buf, "%d\n", efx->phy_type); 2284874aeea5SJeff Kirsher } 2285776fbcc9SBen Hutchings static DEVICE_ATTR(phy_type, 0444, show_phy_type, NULL); 2286874aeea5SJeff Kirsher 2287874aeea5SJeff Kirsher static int efx_register_netdev(struct efx_nic *efx) 2288874aeea5SJeff Kirsher { 2289874aeea5SJeff Kirsher struct net_device *net_dev = efx->net_dev; 2290874aeea5SJeff Kirsher struct efx_channel *channel; 2291874aeea5SJeff Kirsher int rc; 2292874aeea5SJeff Kirsher 2293874aeea5SJeff Kirsher net_dev->watchdog_timeo = 5 * HZ; 2294874aeea5SJeff Kirsher net_dev->irq = efx->pci_dev->irq; 22958127d661SBen Hutchings if (efx_nic_rev(efx) >= EFX_REV_HUNT_A0) { 22968127d661SBen Hutchings net_dev->netdev_ops = &efx_ef10_netdev_ops; 22978127d661SBen Hutchings net_dev->priv_flags |= IFF_UNICAST_FLT; 22988127d661SBen Hutchings } else { 22998127d661SBen Hutchings net_dev->netdev_ops = &efx_farch_netdev_ops; 23008127d661SBen Hutchings } 23017ad24ea4SWilfried Klaebe net_dev->ethtool_ops = &efx_ethtool_ops; 23027e6d06f0SBen Hutchings net_dev->gso_max_segs = EFX_TSO_MAX_SEGS; 2303874aeea5SJeff Kirsher 2304874aeea5SJeff Kirsher rtnl_lock(); 2305874aeea5SJeff Kirsher 23067153f623SBen Hutchings /* Enable resets to be scheduled and check whether any were 23077153f623SBen Hutchings * already requested. If so, the NIC is probably hosed so we 23087153f623SBen Hutchings * abort. 23097153f623SBen Hutchings */ 23107153f623SBen Hutchings efx->state = STATE_READY; 23117153f623SBen Hutchings smp_mb(); /* ensure we change state before checking reset_pending */ 23127153f623SBen Hutchings if (efx->reset_pending) { 23137153f623SBen Hutchings netif_err(efx, probe, efx->net_dev, 23147153f623SBen Hutchings "aborting probe due to scheduled reset\n"); 23157153f623SBen Hutchings rc = -EIO; 23167153f623SBen Hutchings goto fail_locked; 23177153f623SBen Hutchings } 23187153f623SBen Hutchings 2319874aeea5SJeff Kirsher rc = dev_alloc_name(net_dev, net_dev->name); 2320874aeea5SJeff Kirsher if (rc < 0) 2321874aeea5SJeff Kirsher goto fail_locked; 2322874aeea5SJeff Kirsher efx_update_name(efx); 2323874aeea5SJeff Kirsher 23248f8b3d51SBen Hutchings /* Always start with carrier off; PHY events will detect the link */ 23258f8b3d51SBen Hutchings netif_carrier_off(net_dev); 23268f8b3d51SBen Hutchings 2327874aeea5SJeff Kirsher rc = register_netdevice(net_dev); 2328874aeea5SJeff Kirsher if (rc) 2329874aeea5SJeff Kirsher goto fail_locked; 2330874aeea5SJeff Kirsher 2331874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 2332874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 2333874aeea5SJeff Kirsher efx_for_each_channel_tx_queue(tx_queue, channel) 2334874aeea5SJeff Kirsher efx_init_tx_queue_core_txq(tx_queue); 2335874aeea5SJeff Kirsher } 2336874aeea5SJeff Kirsher 23370bcf4a64SBen Hutchings efx_associate(efx); 23380bcf4a64SBen Hutchings 2339874aeea5SJeff Kirsher rtnl_unlock(); 2340874aeea5SJeff Kirsher 2341874aeea5SJeff Kirsher rc = device_create_file(&efx->pci_dev->dev, &dev_attr_phy_type); 2342874aeea5SJeff Kirsher if (rc) { 2343874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 2344874aeea5SJeff Kirsher "failed to init net dev attributes\n"); 2345874aeea5SJeff Kirsher goto fail_registered; 2346874aeea5SJeff Kirsher } 2347874aeea5SJeff Kirsher 2348874aeea5SJeff Kirsher return 0; 2349874aeea5SJeff Kirsher 23507153f623SBen Hutchings fail_registered: 23517153f623SBen Hutchings rtnl_lock(); 23520bcf4a64SBen Hutchings efx_dissociate(efx); 23537153f623SBen Hutchings unregister_netdevice(net_dev); 2354874aeea5SJeff Kirsher fail_locked: 23557153f623SBen Hutchings efx->state = STATE_UNINIT; 2356874aeea5SJeff Kirsher rtnl_unlock(); 2357874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "could not register net dev\n"); 2358874aeea5SJeff Kirsher return rc; 2359874aeea5SJeff Kirsher } 2360874aeea5SJeff Kirsher 2361874aeea5SJeff Kirsher static void efx_unregister_netdev(struct efx_nic *efx) 2362874aeea5SJeff Kirsher { 2363874aeea5SJeff Kirsher if (!efx->net_dev) 2364874aeea5SJeff Kirsher return; 2365874aeea5SJeff Kirsher 2366874aeea5SJeff Kirsher BUG_ON(netdev_priv(efx->net_dev) != efx); 2367874aeea5SJeff Kirsher 2368874aeea5SJeff Kirsher strlcpy(efx->name, pci_name(efx->pci_dev), sizeof(efx->name)); 2369874aeea5SJeff Kirsher device_remove_file(&efx->pci_dev->dev, &dev_attr_phy_type); 23707153f623SBen Hutchings 23717153f623SBen Hutchings rtnl_lock(); 23727153f623SBen Hutchings unregister_netdevice(efx->net_dev); 23737153f623SBen Hutchings efx->state = STATE_UNINIT; 23747153f623SBen Hutchings rtnl_unlock(); 2375874aeea5SJeff Kirsher } 2376874aeea5SJeff Kirsher 2377874aeea5SJeff Kirsher /************************************************************************** 2378874aeea5SJeff Kirsher * 2379874aeea5SJeff Kirsher * Device reset and suspend 2380874aeea5SJeff Kirsher * 2381874aeea5SJeff Kirsher **************************************************************************/ 2382874aeea5SJeff Kirsher 2383874aeea5SJeff Kirsher /* Tears down the entire software state and most of the hardware state 2384874aeea5SJeff Kirsher * before reset. */ 2385874aeea5SJeff Kirsher void efx_reset_down(struct efx_nic *efx, enum reset_type method) 2386874aeea5SJeff Kirsher { 2387874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 2388874aeea5SJeff Kirsher 2389e283546cSEdward Cree if (method == RESET_TYPE_MCDI_TIMEOUT) 2390e283546cSEdward Cree efx->type->prepare_flr(efx); 2391e283546cSEdward Cree 2392874aeea5SJeff Kirsher efx_stop_all(efx); 2393d8291187SBen Hutchings efx_disable_interrupts(efx); 23945642ceefSBen Hutchings 23955642ceefSBen Hutchings mutex_lock(&efx->mac_lock); 2396874aeea5SJeff Kirsher if (efx->port_initialized && method != RESET_TYPE_INVISIBLE) 2397874aeea5SJeff Kirsher efx->phy_op->fini(efx); 2398874aeea5SJeff Kirsher efx->type->fini(efx); 2399874aeea5SJeff Kirsher } 2400874aeea5SJeff Kirsher 2401874aeea5SJeff Kirsher /* This function will always ensure that the locks acquired in 2402874aeea5SJeff Kirsher * efx_reset_down() are released. A failure return code indicates 2403874aeea5SJeff Kirsher * that we were unable to reinitialise the hardware, and the 2404874aeea5SJeff Kirsher * driver should be disabled. If ok is false, then the rx and tx 2405874aeea5SJeff Kirsher * engines are not restarted, pending a RESET_DISABLE. */ 2406874aeea5SJeff Kirsher int efx_reset_up(struct efx_nic *efx, enum reset_type method, bool ok) 2407874aeea5SJeff Kirsher { 2408874aeea5SJeff Kirsher int rc; 2409874aeea5SJeff Kirsher 2410874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 2411874aeea5SJeff Kirsher 2412e283546cSEdward Cree if (method == RESET_TYPE_MCDI_TIMEOUT) 2413e283546cSEdward Cree efx->type->finish_flr(efx); 2414e283546cSEdward Cree 2415e283546cSEdward Cree /* Ensure that SRAM is initialised even if we're disabling the device */ 2416874aeea5SJeff Kirsher rc = efx->type->init(efx); 2417874aeea5SJeff Kirsher if (rc) { 2418874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "failed to initialise NIC\n"); 2419874aeea5SJeff Kirsher goto fail; 2420874aeea5SJeff Kirsher } 2421874aeea5SJeff Kirsher 2422874aeea5SJeff Kirsher if (!ok) 2423874aeea5SJeff Kirsher goto fail; 2424874aeea5SJeff Kirsher 2425874aeea5SJeff Kirsher if (efx->port_initialized && method != RESET_TYPE_INVISIBLE) { 2426874aeea5SJeff Kirsher rc = efx->phy_op->init(efx); 2427874aeea5SJeff Kirsher if (rc) 2428874aeea5SJeff Kirsher goto fail; 2429874aeea5SJeff Kirsher if (efx->phy_op->reconfigure(efx)) 2430874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 2431874aeea5SJeff Kirsher "could not restore PHY settings\n"); 2432874aeea5SJeff Kirsher } 2433874aeea5SJeff Kirsher 2434261e4d96SJon Cooper rc = efx_enable_interrupts(efx); 2435261e4d96SJon Cooper if (rc) 2436261e4d96SJon Cooper goto fail; 2437874aeea5SJeff Kirsher efx_restore_filters(efx); 2438d98a4ffeSShradha Shah efx->type->sriov_reset(efx); 2439874aeea5SJeff Kirsher 2440874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2441874aeea5SJeff Kirsher 2442874aeea5SJeff Kirsher efx_start_all(efx); 2443874aeea5SJeff Kirsher 2444874aeea5SJeff Kirsher return 0; 2445874aeea5SJeff Kirsher 2446874aeea5SJeff Kirsher fail: 2447874aeea5SJeff Kirsher efx->port_initialized = false; 2448874aeea5SJeff Kirsher 2449874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2450874aeea5SJeff Kirsher 2451874aeea5SJeff Kirsher return rc; 2452874aeea5SJeff Kirsher } 2453874aeea5SJeff Kirsher 2454874aeea5SJeff Kirsher /* Reset the NIC using the specified method. Note that the reset may 2455874aeea5SJeff Kirsher * fail, in which case the card will be left in an unusable state. 2456874aeea5SJeff Kirsher * 2457874aeea5SJeff Kirsher * Caller must hold the rtnl_lock. 2458874aeea5SJeff Kirsher */ 2459874aeea5SJeff Kirsher int efx_reset(struct efx_nic *efx, enum reset_type method) 2460874aeea5SJeff Kirsher { 2461874aeea5SJeff Kirsher int rc, rc2; 2462874aeea5SJeff Kirsher bool disabled; 2463874aeea5SJeff Kirsher 2464874aeea5SJeff Kirsher netif_info(efx, drv, efx->net_dev, "resetting (%s)\n", 2465874aeea5SJeff Kirsher RESET_TYPE(method)); 2466874aeea5SJeff Kirsher 2467c2f3b8e3SDaniel Pieczko efx_device_detach_sync(efx); 2468874aeea5SJeff Kirsher efx_reset_down(efx, method); 2469874aeea5SJeff Kirsher 2470874aeea5SJeff Kirsher rc = efx->type->reset(efx, method); 2471874aeea5SJeff Kirsher if (rc) { 2472874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "failed to reset hardware\n"); 2473874aeea5SJeff Kirsher goto out; 2474874aeea5SJeff Kirsher } 2475874aeea5SJeff Kirsher 2476874aeea5SJeff Kirsher /* Clear flags for the scopes we covered. We assume the NIC and 2477874aeea5SJeff Kirsher * driver are now quiescent so that there is no race here. 2478874aeea5SJeff Kirsher */ 2479e283546cSEdward Cree if (method < RESET_TYPE_MAX_METHOD) 2480874aeea5SJeff Kirsher efx->reset_pending &= -(1 << (method + 1)); 2481e283546cSEdward Cree else /* it doesn't fit into the well-ordered scope hierarchy */ 2482e283546cSEdward Cree __clear_bit(method, &efx->reset_pending); 2483874aeea5SJeff Kirsher 2484874aeea5SJeff Kirsher /* Reinitialise bus-mastering, which may have been turned off before 2485874aeea5SJeff Kirsher * the reset was scheduled. This is still appropriate, even in the 2486874aeea5SJeff Kirsher * RESET_TYPE_DISABLE since this driver generally assumes the hardware 2487874aeea5SJeff Kirsher * can respond to requests. */ 2488874aeea5SJeff Kirsher pci_set_master(efx->pci_dev); 2489874aeea5SJeff Kirsher 2490874aeea5SJeff Kirsher out: 2491874aeea5SJeff Kirsher /* Leave device stopped if necessary */ 2492626950dbSAlexandre Rames disabled = rc || 2493626950dbSAlexandre Rames method == RESET_TYPE_DISABLE || 2494626950dbSAlexandre Rames method == RESET_TYPE_RECOVER_OR_DISABLE; 2495874aeea5SJeff Kirsher rc2 = efx_reset_up(efx, method, !disabled); 2496874aeea5SJeff Kirsher if (rc2) { 2497874aeea5SJeff Kirsher disabled = true; 2498874aeea5SJeff Kirsher if (!rc) 2499874aeea5SJeff Kirsher rc = rc2; 2500874aeea5SJeff Kirsher } 2501874aeea5SJeff Kirsher 2502874aeea5SJeff Kirsher if (disabled) { 2503874aeea5SJeff Kirsher dev_close(efx->net_dev); 2504874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "has been disabled\n"); 2505874aeea5SJeff Kirsher efx->state = STATE_DISABLED; 2506874aeea5SJeff Kirsher } else { 2507874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "reset complete\n"); 2508874aeea5SJeff Kirsher netif_device_attach(efx->net_dev); 2509874aeea5SJeff Kirsher } 2510874aeea5SJeff Kirsher return rc; 2511874aeea5SJeff Kirsher } 2512874aeea5SJeff Kirsher 2513626950dbSAlexandre Rames /* Try recovery mechanisms. 2514626950dbSAlexandre Rames * For now only EEH is supported. 2515626950dbSAlexandre Rames * Returns 0 if the recovery mechanisms are unsuccessful. 2516626950dbSAlexandre Rames * Returns a non-zero value otherwise. 2517626950dbSAlexandre Rames */ 2518b28405b0SAlexandre Rames int efx_try_recovery(struct efx_nic *efx) 2519626950dbSAlexandre Rames { 2520626950dbSAlexandre Rames #ifdef CONFIG_EEH 2521626950dbSAlexandre Rames /* A PCI error can occur and not be seen by EEH because nothing 2522626950dbSAlexandre Rames * happens on the PCI bus. In this case the driver may fail and 2523626950dbSAlexandre Rames * schedule a 'recover or reset', leading to this recovery handler. 2524626950dbSAlexandre Rames * Manually call the eeh failure check function. 2525626950dbSAlexandre Rames */ 2526626950dbSAlexandre Rames struct eeh_dev *eehdev = 2527626950dbSAlexandre Rames of_node_to_eeh_dev(pci_device_to_OF_node(efx->pci_dev)); 2528626950dbSAlexandre Rames 2529626950dbSAlexandre Rames if (eeh_dev_check_failure(eehdev)) { 2530626950dbSAlexandre Rames /* The EEH mechanisms will handle the error and reset the 2531626950dbSAlexandre Rames * device if necessary. 2532626950dbSAlexandre Rames */ 2533626950dbSAlexandre Rames return 1; 2534626950dbSAlexandre Rames } 2535626950dbSAlexandre Rames #endif 2536626950dbSAlexandre Rames return 0; 2537626950dbSAlexandre Rames } 2538626950dbSAlexandre Rames 253974cd60a4SJon Cooper static void efx_wait_for_bist_end(struct efx_nic *efx) 254074cd60a4SJon Cooper { 254174cd60a4SJon Cooper int i; 254274cd60a4SJon Cooper 254374cd60a4SJon Cooper for (i = 0; i < BIST_WAIT_DELAY_COUNT; ++i) { 254474cd60a4SJon Cooper if (efx_mcdi_poll_reboot(efx)) 254574cd60a4SJon Cooper goto out; 254674cd60a4SJon Cooper msleep(BIST_WAIT_DELAY_MS); 254774cd60a4SJon Cooper } 254874cd60a4SJon Cooper 254974cd60a4SJon Cooper netif_err(efx, drv, efx->net_dev, "Warning: No MC reboot after BIST mode\n"); 255074cd60a4SJon Cooper out: 255174cd60a4SJon Cooper /* Either way unset the BIST flag. If we found no reboot we probably 255274cd60a4SJon Cooper * won't recover, but we should try. 255374cd60a4SJon Cooper */ 255474cd60a4SJon Cooper efx->mc_bist_for_other_fn = false; 255574cd60a4SJon Cooper } 255674cd60a4SJon Cooper 2557874aeea5SJeff Kirsher /* The worker thread exists so that code that cannot sleep can 2558874aeea5SJeff Kirsher * schedule a reset for later. 2559874aeea5SJeff Kirsher */ 2560874aeea5SJeff Kirsher static void efx_reset_work(struct work_struct *data) 2561874aeea5SJeff Kirsher { 2562874aeea5SJeff Kirsher struct efx_nic *efx = container_of(data, struct efx_nic, reset_work); 2563626950dbSAlexandre Rames unsigned long pending; 2564626950dbSAlexandre Rames enum reset_type method; 2565626950dbSAlexandre Rames 2566626950dbSAlexandre Rames pending = ACCESS_ONCE(efx->reset_pending); 2567626950dbSAlexandre Rames method = fls(pending) - 1; 2568626950dbSAlexandre Rames 256974cd60a4SJon Cooper if (method == RESET_TYPE_MC_BIST) 257074cd60a4SJon Cooper efx_wait_for_bist_end(efx); 257174cd60a4SJon Cooper 2572626950dbSAlexandre Rames if ((method == RESET_TYPE_RECOVER_OR_DISABLE || 2573626950dbSAlexandre Rames method == RESET_TYPE_RECOVER_OR_ALL) && 2574626950dbSAlexandre Rames efx_try_recovery(efx)) 2575626950dbSAlexandre Rames return; 2576874aeea5SJeff Kirsher 2577874aeea5SJeff Kirsher if (!pending) 2578874aeea5SJeff Kirsher return; 2579874aeea5SJeff Kirsher 2580874aeea5SJeff Kirsher rtnl_lock(); 25817153f623SBen Hutchings 25827153f623SBen Hutchings /* We checked the state in efx_schedule_reset() but it may 25837153f623SBen Hutchings * have changed by now. Now that we have the RTNL lock, 25847153f623SBen Hutchings * it cannot change again. 25857153f623SBen Hutchings */ 25867153f623SBen Hutchings if (efx->state == STATE_READY) 2587626950dbSAlexandre Rames (void)efx_reset(efx, method); 25887153f623SBen Hutchings 2589874aeea5SJeff Kirsher rtnl_unlock(); 2590874aeea5SJeff Kirsher } 2591874aeea5SJeff Kirsher 2592874aeea5SJeff Kirsher void efx_schedule_reset(struct efx_nic *efx, enum reset_type type) 2593874aeea5SJeff Kirsher { 2594874aeea5SJeff Kirsher enum reset_type method; 2595874aeea5SJeff Kirsher 2596626950dbSAlexandre Rames if (efx->state == STATE_RECOVERY) { 2597626950dbSAlexandre Rames netif_dbg(efx, drv, efx->net_dev, 2598626950dbSAlexandre Rames "recovering: skip scheduling %s reset\n", 2599626950dbSAlexandre Rames RESET_TYPE(type)); 2600626950dbSAlexandre Rames return; 2601626950dbSAlexandre Rames } 2602626950dbSAlexandre Rames 2603874aeea5SJeff Kirsher switch (type) { 2604874aeea5SJeff Kirsher case RESET_TYPE_INVISIBLE: 2605874aeea5SJeff Kirsher case RESET_TYPE_ALL: 2606626950dbSAlexandre Rames case RESET_TYPE_RECOVER_OR_ALL: 2607874aeea5SJeff Kirsher case RESET_TYPE_WORLD: 2608874aeea5SJeff Kirsher case RESET_TYPE_DISABLE: 2609626950dbSAlexandre Rames case RESET_TYPE_RECOVER_OR_DISABLE: 261074cd60a4SJon Cooper case RESET_TYPE_MC_BIST: 2611e283546cSEdward Cree case RESET_TYPE_MCDI_TIMEOUT: 2612874aeea5SJeff Kirsher method = type; 2613874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "scheduling %s reset\n", 2614874aeea5SJeff Kirsher RESET_TYPE(method)); 2615874aeea5SJeff Kirsher break; 2616874aeea5SJeff Kirsher default: 2617874aeea5SJeff Kirsher method = efx->type->map_reset_reason(type); 2618874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, 2619874aeea5SJeff Kirsher "scheduling %s reset for %s\n", 2620874aeea5SJeff Kirsher RESET_TYPE(method), RESET_TYPE(type)); 2621874aeea5SJeff Kirsher break; 2622874aeea5SJeff Kirsher } 2623874aeea5SJeff Kirsher 2624874aeea5SJeff Kirsher set_bit(method, &efx->reset_pending); 26257153f623SBen Hutchings smp_mb(); /* ensure we change reset_pending before checking state */ 26267153f623SBen Hutchings 26277153f623SBen Hutchings /* If we're not READY then just leave the flags set as the cue 26287153f623SBen Hutchings * to abort probing or reschedule the reset later. 26297153f623SBen Hutchings */ 26307153f623SBen Hutchings if (ACCESS_ONCE(efx->state) != STATE_READY) 26317153f623SBen Hutchings return; 2632874aeea5SJeff Kirsher 2633874aeea5SJeff Kirsher /* efx_process_channel() will no longer read events once a 2634874aeea5SJeff Kirsher * reset is scheduled. So switch back to poll'd MCDI completions. */ 2635874aeea5SJeff Kirsher efx_mcdi_mode_poll(efx); 2636874aeea5SJeff Kirsher 2637874aeea5SJeff Kirsher queue_work(reset_workqueue, &efx->reset_work); 2638874aeea5SJeff Kirsher } 2639874aeea5SJeff Kirsher 2640874aeea5SJeff Kirsher /************************************************************************** 2641874aeea5SJeff Kirsher * 2642874aeea5SJeff Kirsher * List of NICs we support 2643874aeea5SJeff Kirsher * 2644874aeea5SJeff Kirsher **************************************************************************/ 2645874aeea5SJeff Kirsher 2646874aeea5SJeff Kirsher /* PCI device ID table */ 26479baa3c34SBenoit Taine static const struct pci_device_id efx_pci_table[] = { 26480e59e7e7SLinus Torvalds {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 26490e59e7e7SLinus Torvalds PCI_DEVICE_ID_SOLARFLARE_SFC4000A_0), 2650874aeea5SJeff Kirsher .driver_data = (unsigned long) &falcon_a1_nic_type}, 26510e59e7e7SLinus Torvalds {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 26520e59e7e7SLinus Torvalds PCI_DEVICE_ID_SOLARFLARE_SFC4000B), 2653874aeea5SJeff Kirsher .driver_data = (unsigned long) &falcon_b0_nic_type}, 2654547c474fSBen Hutchings {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x0803), /* SFC9020 */ 2655874aeea5SJeff Kirsher .driver_data = (unsigned long) &siena_a0_nic_type}, 2656547c474fSBen Hutchings {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x0813), /* SFL9021 */ 2657874aeea5SJeff Kirsher .driver_data = (unsigned long) &siena_a0_nic_type}, 26588127d661SBen Hutchings {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x0903), /* SFC9120 PF */ 26598127d661SBen Hutchings .driver_data = (unsigned long) &efx_hunt_a0_nic_type}, 26603b06a00eSMateusz Wrzesinski {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x0923), /* SFC9140 PF */ 26613b06a00eSMateusz Wrzesinski .driver_data = (unsigned long) &efx_hunt_a0_nic_type}, 2662874aeea5SJeff Kirsher {0} /* end of list */ 2663874aeea5SJeff Kirsher }; 2664874aeea5SJeff Kirsher 2665874aeea5SJeff Kirsher /************************************************************************** 2666874aeea5SJeff Kirsher * 2667874aeea5SJeff Kirsher * Dummy PHY/MAC operations 2668874aeea5SJeff Kirsher * 2669874aeea5SJeff Kirsher * Can be used for some unimplemented operations 2670874aeea5SJeff Kirsher * Needed so all function pointers are valid and do not have to be tested 2671874aeea5SJeff Kirsher * before use 2672874aeea5SJeff Kirsher * 2673874aeea5SJeff Kirsher **************************************************************************/ 2674874aeea5SJeff Kirsher int efx_port_dummy_op_int(struct efx_nic *efx) 2675874aeea5SJeff Kirsher { 2676874aeea5SJeff Kirsher return 0; 2677874aeea5SJeff Kirsher } 2678874aeea5SJeff Kirsher void efx_port_dummy_op_void(struct efx_nic *efx) {} 2679874aeea5SJeff Kirsher 2680874aeea5SJeff Kirsher static bool efx_port_dummy_op_poll(struct efx_nic *efx) 2681874aeea5SJeff Kirsher { 2682874aeea5SJeff Kirsher return false; 2683874aeea5SJeff Kirsher } 2684874aeea5SJeff Kirsher 2685874aeea5SJeff Kirsher static const struct efx_phy_operations efx_dummy_phy_operations = { 2686874aeea5SJeff Kirsher .init = efx_port_dummy_op_int, 2687874aeea5SJeff Kirsher .reconfigure = efx_port_dummy_op_int, 2688874aeea5SJeff Kirsher .poll = efx_port_dummy_op_poll, 2689874aeea5SJeff Kirsher .fini = efx_port_dummy_op_void, 2690874aeea5SJeff Kirsher }; 2691874aeea5SJeff Kirsher 2692874aeea5SJeff Kirsher /************************************************************************** 2693874aeea5SJeff Kirsher * 2694874aeea5SJeff Kirsher * Data housekeeping 2695874aeea5SJeff Kirsher * 2696874aeea5SJeff Kirsher **************************************************************************/ 2697874aeea5SJeff Kirsher 2698874aeea5SJeff Kirsher /* This zeroes out and then fills in the invariants in a struct 2699874aeea5SJeff Kirsher * efx_nic (including all sub-structures). 2700874aeea5SJeff Kirsher */ 2701adeb15aaSBen Hutchings static int efx_init_struct(struct efx_nic *efx, 2702874aeea5SJeff Kirsher struct pci_dev *pci_dev, struct net_device *net_dev) 2703874aeea5SJeff Kirsher { 2704874aeea5SJeff Kirsher int i; 2705874aeea5SJeff Kirsher 2706874aeea5SJeff Kirsher /* Initialise common structures */ 27070bcf4a64SBen Hutchings INIT_LIST_HEAD(&efx->node); 27080bcf4a64SBen Hutchings INIT_LIST_HEAD(&efx->secondary_list); 2709874aeea5SJeff Kirsher spin_lock_init(&efx->biu_lock); 2710874aeea5SJeff Kirsher #ifdef CONFIG_SFC_MTD 2711874aeea5SJeff Kirsher INIT_LIST_HEAD(&efx->mtd_list); 2712874aeea5SJeff Kirsher #endif 2713874aeea5SJeff Kirsher INIT_WORK(&efx->reset_work, efx_reset_work); 2714874aeea5SJeff Kirsher INIT_DELAYED_WORK(&efx->monitor_work, efx_monitor); 2715dd40781eSBen Hutchings INIT_DELAYED_WORK(&efx->selftest_work, efx_selftest_async_work); 2716874aeea5SJeff Kirsher efx->pci_dev = pci_dev; 2717874aeea5SJeff Kirsher efx->msg_enable = debug; 2718f16aeea0SBen Hutchings efx->state = STATE_UNINIT; 2719874aeea5SJeff Kirsher strlcpy(efx->name, pci_name(pci_dev), sizeof(efx->name)); 2720874aeea5SJeff Kirsher 2721874aeea5SJeff Kirsher efx->net_dev = net_dev; 272243a3739dSJon Cooper efx->rx_prefix_size = efx->type->rx_prefix_size; 27232ec03014SAndrew Rybchenko efx->rx_ip_align = 27242ec03014SAndrew Rybchenko NET_IP_ALIGN ? (efx->rx_prefix_size + NET_IP_ALIGN) % 4 : 0; 272543a3739dSJon Cooper efx->rx_packet_hash_offset = 272643a3739dSJon Cooper efx->type->rx_hash_offset - efx->type->rx_prefix_size; 2727bd9a265dSJon Cooper efx->rx_packet_ts_offset = 2728bd9a265dSJon Cooper efx->type->rx_ts_offset - efx->type->rx_prefix_size; 2729874aeea5SJeff Kirsher spin_lock_init(&efx->stats_lock); 2730874aeea5SJeff Kirsher mutex_init(&efx->mac_lock); 2731874aeea5SJeff Kirsher efx->phy_op = &efx_dummy_phy_operations; 2732874aeea5SJeff Kirsher efx->mdio.dev = net_dev; 2733874aeea5SJeff Kirsher INIT_WORK(&efx->mac_work, efx_mac_work); 27349f2cb71cSBen Hutchings init_waitqueue_head(&efx->flush_wq); 2735874aeea5SJeff Kirsher 2736874aeea5SJeff Kirsher for (i = 0; i < EFX_MAX_CHANNELS; i++) { 2737874aeea5SJeff Kirsher efx->channel[i] = efx_alloc_channel(efx, i, NULL); 2738874aeea5SJeff Kirsher if (!efx->channel[i]) 2739874aeea5SJeff Kirsher goto fail; 2740d8291187SBen Hutchings efx->msi_context[i].efx = efx; 2741d8291187SBen Hutchings efx->msi_context[i].index = i; 2742874aeea5SJeff Kirsher } 2743874aeea5SJeff Kirsher 2744874aeea5SJeff Kirsher /* Higher numbered interrupt modes are less capable! */ 2745874aeea5SJeff Kirsher efx->interrupt_mode = max(efx->type->max_interrupt_mode, 2746874aeea5SJeff Kirsher interrupt_mode); 2747874aeea5SJeff Kirsher 2748874aeea5SJeff Kirsher /* Would be good to use the net_dev name, but we're too early */ 2749874aeea5SJeff Kirsher snprintf(efx->workqueue_name, sizeof(efx->workqueue_name), "sfc%s", 2750874aeea5SJeff Kirsher pci_name(pci_dev)); 2751874aeea5SJeff Kirsher efx->workqueue = create_singlethread_workqueue(efx->workqueue_name); 2752874aeea5SJeff Kirsher if (!efx->workqueue) 2753874aeea5SJeff Kirsher goto fail; 2754874aeea5SJeff Kirsher 2755874aeea5SJeff Kirsher return 0; 2756874aeea5SJeff Kirsher 2757874aeea5SJeff Kirsher fail: 2758874aeea5SJeff Kirsher efx_fini_struct(efx); 2759874aeea5SJeff Kirsher return -ENOMEM; 2760874aeea5SJeff Kirsher } 2761874aeea5SJeff Kirsher 2762874aeea5SJeff Kirsher static void efx_fini_struct(struct efx_nic *efx) 2763874aeea5SJeff Kirsher { 2764874aeea5SJeff Kirsher int i; 2765874aeea5SJeff Kirsher 2766874aeea5SJeff Kirsher for (i = 0; i < EFX_MAX_CHANNELS; i++) 2767874aeea5SJeff Kirsher kfree(efx->channel[i]); 2768874aeea5SJeff Kirsher 2769ef215e64SBen Hutchings kfree(efx->vpd_sn); 2770ef215e64SBen Hutchings 2771874aeea5SJeff Kirsher if (efx->workqueue) { 2772874aeea5SJeff Kirsher destroy_workqueue(efx->workqueue); 2773874aeea5SJeff Kirsher efx->workqueue = NULL; 2774874aeea5SJeff Kirsher } 2775874aeea5SJeff Kirsher } 2776874aeea5SJeff Kirsher 2777e4d112e4SEdward Cree void efx_update_sw_stats(struct efx_nic *efx, u64 *stats) 2778e4d112e4SEdward Cree { 2779e4d112e4SEdward Cree u64 n_rx_nodesc_trunc = 0; 2780e4d112e4SEdward Cree struct efx_channel *channel; 2781e4d112e4SEdward Cree 2782e4d112e4SEdward Cree efx_for_each_channel(channel, efx) 2783e4d112e4SEdward Cree n_rx_nodesc_trunc += channel->n_rx_nodesc_trunc; 2784e4d112e4SEdward Cree stats[GENERIC_STAT_rx_nodesc_trunc] = n_rx_nodesc_trunc; 2785e4d112e4SEdward Cree stats[GENERIC_STAT_rx_noskb_drops] = atomic_read(&efx->n_rx_noskb_drops); 2786e4d112e4SEdward Cree } 2787e4d112e4SEdward Cree 2788874aeea5SJeff Kirsher /************************************************************************** 2789874aeea5SJeff Kirsher * 2790874aeea5SJeff Kirsher * PCI interface 2791874aeea5SJeff Kirsher * 2792874aeea5SJeff Kirsher **************************************************************************/ 2793874aeea5SJeff Kirsher 2794874aeea5SJeff Kirsher /* Main body of final NIC shutdown code 2795874aeea5SJeff Kirsher * This is called only at module unload (or hotplug removal). 2796874aeea5SJeff Kirsher */ 2797874aeea5SJeff Kirsher static void efx_pci_remove_main(struct efx_nic *efx) 2798874aeea5SJeff Kirsher { 27997153f623SBen Hutchings /* Flush reset_work. It can no longer be scheduled since we 28007153f623SBen Hutchings * are not READY. 28017153f623SBen Hutchings */ 28027153f623SBen Hutchings BUG_ON(efx->state == STATE_READY); 28037153f623SBen Hutchings cancel_work_sync(&efx->reset_work); 28047153f623SBen Hutchings 2805d8291187SBen Hutchings efx_disable_interrupts(efx); 2806874aeea5SJeff Kirsher efx_nic_fini_interrupt(efx); 2807874aeea5SJeff Kirsher efx_fini_port(efx); 2808874aeea5SJeff Kirsher efx->type->fini(efx); 2809874aeea5SJeff Kirsher efx_fini_napi(efx); 2810874aeea5SJeff Kirsher efx_remove_all(efx); 2811874aeea5SJeff Kirsher } 2812874aeea5SJeff Kirsher 2813874aeea5SJeff Kirsher /* Final NIC shutdown 2814874aeea5SJeff Kirsher * This is called only at module unload (or hotplug removal). 2815874aeea5SJeff Kirsher */ 2816874aeea5SJeff Kirsher static void efx_pci_remove(struct pci_dev *pci_dev) 2817874aeea5SJeff Kirsher { 2818874aeea5SJeff Kirsher struct efx_nic *efx; 2819874aeea5SJeff Kirsher 2820874aeea5SJeff Kirsher efx = pci_get_drvdata(pci_dev); 2821874aeea5SJeff Kirsher if (!efx) 2822874aeea5SJeff Kirsher return; 2823874aeea5SJeff Kirsher 2824874aeea5SJeff Kirsher /* Mark the NIC as fini, then stop the interface */ 2825874aeea5SJeff Kirsher rtnl_lock(); 28260bcf4a64SBen Hutchings efx_dissociate(efx); 2827874aeea5SJeff Kirsher dev_close(efx->net_dev); 2828d8291187SBen Hutchings efx_disable_interrupts(efx); 2829874aeea5SJeff Kirsher rtnl_unlock(); 2830874aeea5SJeff Kirsher 2831d98a4ffeSShradha Shah efx->type->sriov_fini(efx); 2832874aeea5SJeff Kirsher efx_unregister_netdev(efx); 2833874aeea5SJeff Kirsher 2834874aeea5SJeff Kirsher efx_mtd_remove(efx); 2835874aeea5SJeff Kirsher 2836874aeea5SJeff Kirsher efx_pci_remove_main(efx); 2837874aeea5SJeff Kirsher 2838874aeea5SJeff Kirsher efx_fini_io(efx); 2839874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "shutdown successful\n"); 2840874aeea5SJeff Kirsher 2841874aeea5SJeff Kirsher efx_fini_struct(efx); 2842874aeea5SJeff Kirsher free_netdev(efx->net_dev); 2843626950dbSAlexandre Rames 2844626950dbSAlexandre Rames pci_disable_pcie_error_reporting(pci_dev); 2845874aeea5SJeff Kirsher }; 2846874aeea5SJeff Kirsher 2847460eeaa0SBen Hutchings /* NIC VPD information 2848460eeaa0SBen Hutchings * Called during probe to display the part number of the 2849460eeaa0SBen Hutchings * installed NIC. VPD is potentially very large but this should 2850460eeaa0SBen Hutchings * always appear within the first 512 bytes. 2851460eeaa0SBen Hutchings */ 2852460eeaa0SBen Hutchings #define SFC_VPD_LEN 512 2853ef215e64SBen Hutchings static void efx_probe_vpd_strings(struct efx_nic *efx) 2854460eeaa0SBen Hutchings { 2855460eeaa0SBen Hutchings struct pci_dev *dev = efx->pci_dev; 2856460eeaa0SBen Hutchings char vpd_data[SFC_VPD_LEN]; 2857460eeaa0SBen Hutchings ssize_t vpd_size; 2858ef215e64SBen Hutchings int ro_start, ro_size, i, j; 2859460eeaa0SBen Hutchings 2860460eeaa0SBen Hutchings /* Get the vpd data from the device */ 2861460eeaa0SBen Hutchings vpd_size = pci_read_vpd(dev, 0, sizeof(vpd_data), vpd_data); 2862460eeaa0SBen Hutchings if (vpd_size <= 0) { 2863460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "Unable to read VPD\n"); 2864460eeaa0SBen Hutchings return; 2865460eeaa0SBen Hutchings } 2866460eeaa0SBen Hutchings 2867460eeaa0SBen Hutchings /* Get the Read only section */ 2868ef215e64SBen Hutchings ro_start = pci_vpd_find_tag(vpd_data, 0, vpd_size, PCI_VPD_LRDT_RO_DATA); 2869ef215e64SBen Hutchings if (ro_start < 0) { 2870460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "VPD Read-only not found\n"); 2871460eeaa0SBen Hutchings return; 2872460eeaa0SBen Hutchings } 2873460eeaa0SBen Hutchings 2874ef215e64SBen Hutchings ro_size = pci_vpd_lrdt_size(&vpd_data[ro_start]); 2875ef215e64SBen Hutchings j = ro_size; 2876ef215e64SBen Hutchings i = ro_start + PCI_VPD_LRDT_TAG_SIZE; 2877460eeaa0SBen Hutchings if (i + j > vpd_size) 2878460eeaa0SBen Hutchings j = vpd_size - i; 2879460eeaa0SBen Hutchings 2880460eeaa0SBen Hutchings /* Get the Part number */ 2881460eeaa0SBen Hutchings i = pci_vpd_find_info_keyword(vpd_data, i, j, "PN"); 2882460eeaa0SBen Hutchings if (i < 0) { 2883460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "Part number not found\n"); 2884460eeaa0SBen Hutchings return; 2885460eeaa0SBen Hutchings } 2886460eeaa0SBen Hutchings 2887460eeaa0SBen Hutchings j = pci_vpd_info_field_size(&vpd_data[i]); 2888460eeaa0SBen Hutchings i += PCI_VPD_INFO_FLD_HDR_SIZE; 2889460eeaa0SBen Hutchings if (i + j > vpd_size) { 2890460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "Incomplete part number\n"); 2891460eeaa0SBen Hutchings return; 2892460eeaa0SBen Hutchings } 2893460eeaa0SBen Hutchings 2894460eeaa0SBen Hutchings netif_info(efx, drv, efx->net_dev, 2895460eeaa0SBen Hutchings "Part Number : %.*s\n", j, &vpd_data[i]); 2896ef215e64SBen Hutchings 2897ef215e64SBen Hutchings i = ro_start + PCI_VPD_LRDT_TAG_SIZE; 2898ef215e64SBen Hutchings j = ro_size; 2899ef215e64SBen Hutchings i = pci_vpd_find_info_keyword(vpd_data, i, j, "SN"); 2900ef215e64SBen Hutchings if (i < 0) { 2901ef215e64SBen Hutchings netif_err(efx, drv, efx->net_dev, "Serial number not found\n"); 2902ef215e64SBen Hutchings return; 2903ef215e64SBen Hutchings } 2904ef215e64SBen Hutchings 2905ef215e64SBen Hutchings j = pci_vpd_info_field_size(&vpd_data[i]); 2906ef215e64SBen Hutchings i += PCI_VPD_INFO_FLD_HDR_SIZE; 2907ef215e64SBen Hutchings if (i + j > vpd_size) { 2908ef215e64SBen Hutchings netif_err(efx, drv, efx->net_dev, "Incomplete serial number\n"); 2909ef215e64SBen Hutchings return; 2910ef215e64SBen Hutchings } 2911ef215e64SBen Hutchings 2912ef215e64SBen Hutchings efx->vpd_sn = kmalloc(j + 1, GFP_KERNEL); 2913ef215e64SBen Hutchings if (!efx->vpd_sn) 2914ef215e64SBen Hutchings return; 2915ef215e64SBen Hutchings 2916ef215e64SBen Hutchings snprintf(efx->vpd_sn, j + 1, "%s", &vpd_data[i]); 2917460eeaa0SBen Hutchings } 2918460eeaa0SBen Hutchings 2919460eeaa0SBen Hutchings 2920874aeea5SJeff Kirsher /* Main body of NIC initialisation 2921874aeea5SJeff Kirsher * This is called at module load (or hotplug insertion, theoretically). 2922874aeea5SJeff Kirsher */ 2923874aeea5SJeff Kirsher static int efx_pci_probe_main(struct efx_nic *efx) 2924874aeea5SJeff Kirsher { 2925874aeea5SJeff Kirsher int rc; 2926874aeea5SJeff Kirsher 2927874aeea5SJeff Kirsher /* Do start-of-day initialisation */ 2928874aeea5SJeff Kirsher rc = efx_probe_all(efx); 2929874aeea5SJeff Kirsher if (rc) 2930874aeea5SJeff Kirsher goto fail1; 2931874aeea5SJeff Kirsher 2932874aeea5SJeff Kirsher efx_init_napi(efx); 2933874aeea5SJeff Kirsher 2934874aeea5SJeff Kirsher rc = efx->type->init(efx); 2935874aeea5SJeff Kirsher if (rc) { 2936874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 2937874aeea5SJeff Kirsher "failed to initialise NIC\n"); 2938874aeea5SJeff Kirsher goto fail3; 2939874aeea5SJeff Kirsher } 2940874aeea5SJeff Kirsher 2941874aeea5SJeff Kirsher rc = efx_init_port(efx); 2942874aeea5SJeff Kirsher if (rc) { 2943874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 2944874aeea5SJeff Kirsher "failed to initialise port\n"); 2945874aeea5SJeff Kirsher goto fail4; 2946874aeea5SJeff Kirsher } 2947874aeea5SJeff Kirsher 2948874aeea5SJeff Kirsher rc = efx_nic_init_interrupt(efx); 2949874aeea5SJeff Kirsher if (rc) 2950874aeea5SJeff Kirsher goto fail5; 2951261e4d96SJon Cooper rc = efx_enable_interrupts(efx); 2952261e4d96SJon Cooper if (rc) 2953261e4d96SJon Cooper goto fail6; 2954874aeea5SJeff Kirsher 2955874aeea5SJeff Kirsher return 0; 2956874aeea5SJeff Kirsher 2957261e4d96SJon Cooper fail6: 2958261e4d96SJon Cooper efx_nic_fini_interrupt(efx); 2959874aeea5SJeff Kirsher fail5: 2960874aeea5SJeff Kirsher efx_fini_port(efx); 2961874aeea5SJeff Kirsher fail4: 2962874aeea5SJeff Kirsher efx->type->fini(efx); 2963874aeea5SJeff Kirsher fail3: 2964874aeea5SJeff Kirsher efx_fini_napi(efx); 2965874aeea5SJeff Kirsher efx_remove_all(efx); 2966874aeea5SJeff Kirsher fail1: 2967874aeea5SJeff Kirsher return rc; 2968874aeea5SJeff Kirsher } 2969874aeea5SJeff Kirsher 2970874aeea5SJeff Kirsher /* NIC initialisation 2971874aeea5SJeff Kirsher * 2972874aeea5SJeff Kirsher * This is called at module load (or hotplug insertion, 297373ba7b68SBen Hutchings * theoretically). It sets up PCI mappings, resets the NIC, 2974874aeea5SJeff Kirsher * sets up and registers the network devices with the kernel and hooks 2975874aeea5SJeff Kirsher * the interrupt service routine. It does not prepare the device for 2976874aeea5SJeff Kirsher * transmission; this is left to the first time one of the network 2977874aeea5SJeff Kirsher * interfaces is brought up (i.e. efx_net_open). 2978874aeea5SJeff Kirsher */ 297987d1fc11SBill Pemberton static int efx_pci_probe(struct pci_dev *pci_dev, 2980874aeea5SJeff Kirsher const struct pci_device_id *entry) 2981874aeea5SJeff Kirsher { 2982874aeea5SJeff Kirsher struct net_device *net_dev; 2983874aeea5SJeff Kirsher struct efx_nic *efx; 2984fadac6aaSBen Hutchings int rc; 2985874aeea5SJeff Kirsher 2986874aeea5SJeff Kirsher /* Allocate and initialise a struct net_device and struct efx_nic */ 2987874aeea5SJeff Kirsher net_dev = alloc_etherdev_mqs(sizeof(*efx), EFX_MAX_CORE_TX_QUEUES, 2988874aeea5SJeff Kirsher EFX_MAX_RX_QUEUES); 2989874aeea5SJeff Kirsher if (!net_dev) 2990874aeea5SJeff Kirsher return -ENOMEM; 2991adeb15aaSBen Hutchings efx = netdev_priv(net_dev); 2992adeb15aaSBen Hutchings efx->type = (const struct efx_nic_type *) entry->driver_data; 2993adeb15aaSBen Hutchings net_dev->features |= (efx->type->offload_features | NETIF_F_SG | 2994874aeea5SJeff Kirsher NETIF_F_HIGHDMA | NETIF_F_TSO | 2995874aeea5SJeff Kirsher NETIF_F_RXCSUM); 2996adeb15aaSBen Hutchings if (efx->type->offload_features & NETIF_F_V6_CSUM) 2997874aeea5SJeff Kirsher net_dev->features |= NETIF_F_TSO6; 2998874aeea5SJeff Kirsher /* Mask for features that also apply to VLAN devices */ 2999874aeea5SJeff Kirsher net_dev->vlan_features |= (NETIF_F_ALL_CSUM | NETIF_F_SG | 3000874aeea5SJeff Kirsher NETIF_F_HIGHDMA | NETIF_F_ALL_TSO | 3001874aeea5SJeff Kirsher NETIF_F_RXCSUM); 3002874aeea5SJeff Kirsher /* All offloads can be toggled */ 3003874aeea5SJeff Kirsher net_dev->hw_features = net_dev->features & ~NETIF_F_HIGHDMA; 3004874aeea5SJeff Kirsher pci_set_drvdata(pci_dev, efx); 3005874aeea5SJeff Kirsher SET_NETDEV_DEV(net_dev, &pci_dev->dev); 3006adeb15aaSBen Hutchings rc = efx_init_struct(efx, pci_dev, net_dev); 3007874aeea5SJeff Kirsher if (rc) 3008874aeea5SJeff Kirsher goto fail1; 3009874aeea5SJeff Kirsher 3010874aeea5SJeff Kirsher netif_info(efx, probe, efx->net_dev, 3011874aeea5SJeff Kirsher "Solarflare NIC detected\n"); 3012874aeea5SJeff Kirsher 3013ef215e64SBen Hutchings efx_probe_vpd_strings(efx); 3014460eeaa0SBen Hutchings 3015874aeea5SJeff Kirsher /* Set up basic I/O (BAR mappings etc) */ 3016874aeea5SJeff Kirsher rc = efx_init_io(efx); 3017874aeea5SJeff Kirsher if (rc) 3018874aeea5SJeff Kirsher goto fail2; 3019874aeea5SJeff Kirsher 3020874aeea5SJeff Kirsher rc = efx_pci_probe_main(efx); 3021fadac6aaSBen Hutchings if (rc) 3022874aeea5SJeff Kirsher goto fail3; 3023874aeea5SJeff Kirsher 3024874aeea5SJeff Kirsher rc = efx_register_netdev(efx); 3025874aeea5SJeff Kirsher if (rc) 3026fadac6aaSBen Hutchings goto fail4; 3027874aeea5SJeff Kirsher 3028d98a4ffeSShradha Shah rc = efx->type->sriov_init(efx); 3029cd2d5b52SBen Hutchings if (rc) 3030cd2d5b52SBen Hutchings netif_err(efx, probe, efx->net_dev, 3031cd2d5b52SBen Hutchings "SR-IOV can't be enabled rc %d\n", rc); 3032cd2d5b52SBen Hutchings 3033874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "initialisation successful\n"); 3034874aeea5SJeff Kirsher 30357c43161cSBen Hutchings /* Try to create MTDs, but allow this to fail */ 3036874aeea5SJeff Kirsher rtnl_lock(); 30377c43161cSBen Hutchings rc = efx_mtd_probe(efx); 3038874aeea5SJeff Kirsher rtnl_unlock(); 30397c43161cSBen Hutchings if (rc) 30407c43161cSBen Hutchings netif_warn(efx, probe, efx->net_dev, 30417c43161cSBen Hutchings "failed to create MTDs (%d)\n", rc); 30427c43161cSBen Hutchings 3043626950dbSAlexandre Rames rc = pci_enable_pcie_error_reporting(pci_dev); 3044626950dbSAlexandre Rames if (rc && rc != -EINVAL) 3045626950dbSAlexandre Rames netif_warn(efx, probe, efx->net_dev, 3046626950dbSAlexandre Rames "pci_enable_pcie_error_reporting failed (%d)\n", rc); 3047626950dbSAlexandre Rames 3048874aeea5SJeff Kirsher return 0; 3049874aeea5SJeff Kirsher 3050874aeea5SJeff Kirsher fail4: 3051fadac6aaSBen Hutchings efx_pci_remove_main(efx); 3052874aeea5SJeff Kirsher fail3: 3053874aeea5SJeff Kirsher efx_fini_io(efx); 3054874aeea5SJeff Kirsher fail2: 3055874aeea5SJeff Kirsher efx_fini_struct(efx); 3056874aeea5SJeff Kirsher fail1: 3057874aeea5SJeff Kirsher WARN_ON(rc > 0); 3058874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "initialisation failed. rc=%d\n", rc); 3059874aeea5SJeff Kirsher free_netdev(net_dev); 3060874aeea5SJeff Kirsher return rc; 3061874aeea5SJeff Kirsher } 3062874aeea5SJeff Kirsher 3063874aeea5SJeff Kirsher static int efx_pm_freeze(struct device *dev) 3064874aeea5SJeff Kirsher { 3065874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); 3066874aeea5SJeff Kirsher 306761da026dSBen Hutchings rtnl_lock(); 306861da026dSBen Hutchings 30696032fb56SBen Hutchings if (efx->state != STATE_DISABLED) { 3070f16aeea0SBen Hutchings efx->state = STATE_UNINIT; 3071874aeea5SJeff Kirsher 3072c2f3b8e3SDaniel Pieczko efx_device_detach_sync(efx); 3073874aeea5SJeff Kirsher 3074874aeea5SJeff Kirsher efx_stop_all(efx); 3075d8291187SBen Hutchings efx_disable_interrupts(efx); 30766032fb56SBen Hutchings } 3077874aeea5SJeff Kirsher 307861da026dSBen Hutchings rtnl_unlock(); 307961da026dSBen Hutchings 3080874aeea5SJeff Kirsher return 0; 3081874aeea5SJeff Kirsher } 3082874aeea5SJeff Kirsher 3083874aeea5SJeff Kirsher static int efx_pm_thaw(struct device *dev) 3084874aeea5SJeff Kirsher { 3085261e4d96SJon Cooper int rc; 3086874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); 3087874aeea5SJeff Kirsher 308861da026dSBen Hutchings rtnl_lock(); 308961da026dSBen Hutchings 30906032fb56SBen Hutchings if (efx->state != STATE_DISABLED) { 3091261e4d96SJon Cooper rc = efx_enable_interrupts(efx); 3092261e4d96SJon Cooper if (rc) 3093261e4d96SJon Cooper goto fail; 3094874aeea5SJeff Kirsher 3095874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 3096874aeea5SJeff Kirsher efx->phy_op->reconfigure(efx); 3097874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 3098874aeea5SJeff Kirsher 3099874aeea5SJeff Kirsher efx_start_all(efx); 3100874aeea5SJeff Kirsher 3101874aeea5SJeff Kirsher netif_device_attach(efx->net_dev); 3102874aeea5SJeff Kirsher 3103f16aeea0SBen Hutchings efx->state = STATE_READY; 3104874aeea5SJeff Kirsher 3105874aeea5SJeff Kirsher efx->type->resume_wol(efx); 31066032fb56SBen Hutchings } 3107874aeea5SJeff Kirsher 310861da026dSBen Hutchings rtnl_unlock(); 310961da026dSBen Hutchings 3110874aeea5SJeff Kirsher /* Reschedule any quenched resets scheduled during efx_pm_freeze() */ 3111874aeea5SJeff Kirsher queue_work(reset_workqueue, &efx->reset_work); 3112874aeea5SJeff Kirsher 3113874aeea5SJeff Kirsher return 0; 3114261e4d96SJon Cooper 3115261e4d96SJon Cooper fail: 3116261e4d96SJon Cooper rtnl_unlock(); 3117261e4d96SJon Cooper 3118261e4d96SJon Cooper return rc; 3119874aeea5SJeff Kirsher } 3120874aeea5SJeff Kirsher 3121874aeea5SJeff Kirsher static int efx_pm_poweroff(struct device *dev) 3122874aeea5SJeff Kirsher { 3123874aeea5SJeff Kirsher struct pci_dev *pci_dev = to_pci_dev(dev); 3124874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(pci_dev); 3125874aeea5SJeff Kirsher 3126874aeea5SJeff Kirsher efx->type->fini(efx); 3127874aeea5SJeff Kirsher 3128874aeea5SJeff Kirsher efx->reset_pending = 0; 3129874aeea5SJeff Kirsher 3130874aeea5SJeff Kirsher pci_save_state(pci_dev); 3131874aeea5SJeff Kirsher return pci_set_power_state(pci_dev, PCI_D3hot); 3132874aeea5SJeff Kirsher } 3133874aeea5SJeff Kirsher 3134874aeea5SJeff Kirsher /* Used for both resume and restore */ 3135874aeea5SJeff Kirsher static int efx_pm_resume(struct device *dev) 3136874aeea5SJeff Kirsher { 3137874aeea5SJeff Kirsher struct pci_dev *pci_dev = to_pci_dev(dev); 3138874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(pci_dev); 3139874aeea5SJeff Kirsher int rc; 3140874aeea5SJeff Kirsher 3141874aeea5SJeff Kirsher rc = pci_set_power_state(pci_dev, PCI_D0); 3142874aeea5SJeff Kirsher if (rc) 3143874aeea5SJeff Kirsher return rc; 3144874aeea5SJeff Kirsher pci_restore_state(pci_dev); 3145874aeea5SJeff Kirsher rc = pci_enable_device(pci_dev); 3146874aeea5SJeff Kirsher if (rc) 3147874aeea5SJeff Kirsher return rc; 3148874aeea5SJeff Kirsher pci_set_master(efx->pci_dev); 3149874aeea5SJeff Kirsher rc = efx->type->reset(efx, RESET_TYPE_ALL); 3150874aeea5SJeff Kirsher if (rc) 3151874aeea5SJeff Kirsher return rc; 3152874aeea5SJeff Kirsher rc = efx->type->init(efx); 3153874aeea5SJeff Kirsher if (rc) 3154874aeea5SJeff Kirsher return rc; 3155261e4d96SJon Cooper rc = efx_pm_thaw(dev); 3156261e4d96SJon Cooper return rc; 3157874aeea5SJeff Kirsher } 3158874aeea5SJeff Kirsher 3159874aeea5SJeff Kirsher static int efx_pm_suspend(struct device *dev) 3160874aeea5SJeff Kirsher { 3161874aeea5SJeff Kirsher int rc; 3162874aeea5SJeff Kirsher 3163874aeea5SJeff Kirsher efx_pm_freeze(dev); 3164874aeea5SJeff Kirsher rc = efx_pm_poweroff(dev); 3165874aeea5SJeff Kirsher if (rc) 3166874aeea5SJeff Kirsher efx_pm_resume(dev); 3167874aeea5SJeff Kirsher return rc; 3168874aeea5SJeff Kirsher } 3169874aeea5SJeff Kirsher 317018e83e4cSBen Hutchings static const struct dev_pm_ops efx_pm_ops = { 3171874aeea5SJeff Kirsher .suspend = efx_pm_suspend, 3172874aeea5SJeff Kirsher .resume = efx_pm_resume, 3173874aeea5SJeff Kirsher .freeze = efx_pm_freeze, 3174874aeea5SJeff Kirsher .thaw = efx_pm_thaw, 3175874aeea5SJeff Kirsher .poweroff = efx_pm_poweroff, 3176874aeea5SJeff Kirsher .restore = efx_pm_resume, 3177874aeea5SJeff Kirsher }; 3178874aeea5SJeff Kirsher 3179626950dbSAlexandre Rames /* A PCI error affecting this device was detected. 3180626950dbSAlexandre Rames * At this point MMIO and DMA may be disabled. 3181626950dbSAlexandre Rames * Stop the software path and request a slot reset. 3182626950dbSAlexandre Rames */ 3183debd0034Sstephen hemminger static pci_ers_result_t efx_io_error_detected(struct pci_dev *pdev, 3184626950dbSAlexandre Rames enum pci_channel_state state) 3185626950dbSAlexandre Rames { 3186626950dbSAlexandre Rames pci_ers_result_t status = PCI_ERS_RESULT_RECOVERED; 3187626950dbSAlexandre Rames struct efx_nic *efx = pci_get_drvdata(pdev); 3188626950dbSAlexandre Rames 3189626950dbSAlexandre Rames if (state == pci_channel_io_perm_failure) 3190626950dbSAlexandre Rames return PCI_ERS_RESULT_DISCONNECT; 3191626950dbSAlexandre Rames 3192626950dbSAlexandre Rames rtnl_lock(); 3193626950dbSAlexandre Rames 3194626950dbSAlexandre Rames if (efx->state != STATE_DISABLED) { 3195626950dbSAlexandre Rames efx->state = STATE_RECOVERY; 3196626950dbSAlexandre Rames efx->reset_pending = 0; 3197626950dbSAlexandre Rames 3198626950dbSAlexandre Rames efx_device_detach_sync(efx); 3199626950dbSAlexandre Rames 3200626950dbSAlexandre Rames efx_stop_all(efx); 3201d8291187SBen Hutchings efx_disable_interrupts(efx); 3202626950dbSAlexandre Rames 3203626950dbSAlexandre Rames status = PCI_ERS_RESULT_NEED_RESET; 3204626950dbSAlexandre Rames } else { 3205626950dbSAlexandre Rames /* If the interface is disabled we don't want to do anything 3206626950dbSAlexandre Rames * with it. 3207626950dbSAlexandre Rames */ 3208626950dbSAlexandre Rames status = PCI_ERS_RESULT_RECOVERED; 3209626950dbSAlexandre Rames } 3210626950dbSAlexandre Rames 3211626950dbSAlexandre Rames rtnl_unlock(); 3212626950dbSAlexandre Rames 3213626950dbSAlexandre Rames pci_disable_device(pdev); 3214626950dbSAlexandre Rames 3215626950dbSAlexandre Rames return status; 3216626950dbSAlexandre Rames } 3217626950dbSAlexandre Rames 3218626950dbSAlexandre Rames /* Fake a successfull reset, which will be performed later in efx_io_resume. */ 3219debd0034Sstephen hemminger static pci_ers_result_t efx_io_slot_reset(struct pci_dev *pdev) 3220626950dbSAlexandre Rames { 3221626950dbSAlexandre Rames struct efx_nic *efx = pci_get_drvdata(pdev); 3222626950dbSAlexandre Rames pci_ers_result_t status = PCI_ERS_RESULT_RECOVERED; 3223626950dbSAlexandre Rames int rc; 3224626950dbSAlexandre Rames 3225626950dbSAlexandre Rames if (pci_enable_device(pdev)) { 3226626950dbSAlexandre Rames netif_err(efx, hw, efx->net_dev, 3227626950dbSAlexandre Rames "Cannot re-enable PCI device after reset.\n"); 3228626950dbSAlexandre Rames status = PCI_ERS_RESULT_DISCONNECT; 3229626950dbSAlexandre Rames } 3230626950dbSAlexandre Rames 3231626950dbSAlexandre Rames rc = pci_cleanup_aer_uncorrect_error_status(pdev); 3232626950dbSAlexandre Rames if (rc) { 3233626950dbSAlexandre Rames netif_err(efx, hw, efx->net_dev, 3234626950dbSAlexandre Rames "pci_cleanup_aer_uncorrect_error_status failed (%d)\n", rc); 3235626950dbSAlexandre Rames /* Non-fatal error. Continue. */ 3236626950dbSAlexandre Rames } 3237626950dbSAlexandre Rames 3238626950dbSAlexandre Rames return status; 3239626950dbSAlexandre Rames } 3240626950dbSAlexandre Rames 3241626950dbSAlexandre Rames /* Perform the actual reset and resume I/O operations. */ 3242626950dbSAlexandre Rames static void efx_io_resume(struct pci_dev *pdev) 3243626950dbSAlexandre Rames { 3244626950dbSAlexandre Rames struct efx_nic *efx = pci_get_drvdata(pdev); 3245626950dbSAlexandre Rames int rc; 3246626950dbSAlexandre Rames 3247626950dbSAlexandre Rames rtnl_lock(); 3248626950dbSAlexandre Rames 3249626950dbSAlexandre Rames if (efx->state == STATE_DISABLED) 3250626950dbSAlexandre Rames goto out; 3251626950dbSAlexandre Rames 3252626950dbSAlexandre Rames rc = efx_reset(efx, RESET_TYPE_ALL); 3253626950dbSAlexandre Rames if (rc) { 3254626950dbSAlexandre Rames netif_err(efx, hw, efx->net_dev, 3255626950dbSAlexandre Rames "efx_reset failed after PCI error (%d)\n", rc); 3256626950dbSAlexandre Rames } else { 3257626950dbSAlexandre Rames efx->state = STATE_READY; 3258626950dbSAlexandre Rames netif_dbg(efx, hw, efx->net_dev, 3259626950dbSAlexandre Rames "Done resetting and resuming IO after PCI error.\n"); 3260626950dbSAlexandre Rames } 3261626950dbSAlexandre Rames 3262626950dbSAlexandre Rames out: 3263626950dbSAlexandre Rames rtnl_unlock(); 3264626950dbSAlexandre Rames } 3265626950dbSAlexandre Rames 3266626950dbSAlexandre Rames /* For simplicity and reliability, we always require a slot reset and try to 3267626950dbSAlexandre Rames * reset the hardware when a pci error affecting the device is detected. 3268626950dbSAlexandre Rames * We leave both the link_reset and mmio_enabled callback unimplemented: 3269626950dbSAlexandre Rames * with our request for slot reset the mmio_enabled callback will never be 3270626950dbSAlexandre Rames * called, and the link_reset callback is not used by AER or EEH mechanisms. 3271626950dbSAlexandre Rames */ 3272626950dbSAlexandre Rames static struct pci_error_handlers efx_err_handlers = { 3273626950dbSAlexandre Rames .error_detected = efx_io_error_detected, 3274626950dbSAlexandre Rames .slot_reset = efx_io_slot_reset, 3275626950dbSAlexandre Rames .resume = efx_io_resume, 3276626950dbSAlexandre Rames }; 3277626950dbSAlexandre Rames 3278874aeea5SJeff Kirsher static struct pci_driver efx_pci_driver = { 3279874aeea5SJeff Kirsher .name = KBUILD_MODNAME, 3280874aeea5SJeff Kirsher .id_table = efx_pci_table, 3281874aeea5SJeff Kirsher .probe = efx_pci_probe, 3282874aeea5SJeff Kirsher .remove = efx_pci_remove, 3283874aeea5SJeff Kirsher .driver.pm = &efx_pm_ops, 3284626950dbSAlexandre Rames .err_handler = &efx_err_handlers, 3285874aeea5SJeff Kirsher }; 3286874aeea5SJeff Kirsher 3287874aeea5SJeff Kirsher /************************************************************************** 3288874aeea5SJeff Kirsher * 3289874aeea5SJeff Kirsher * Kernel module interface 3290874aeea5SJeff Kirsher * 3291874aeea5SJeff Kirsher *************************************************************************/ 3292874aeea5SJeff Kirsher 3293874aeea5SJeff Kirsher module_param(interrupt_mode, uint, 0444); 3294874aeea5SJeff Kirsher MODULE_PARM_DESC(interrupt_mode, 3295874aeea5SJeff Kirsher "Interrupt mode (0=>MSIX 1=>MSI 2=>legacy)"); 3296874aeea5SJeff Kirsher 3297874aeea5SJeff Kirsher static int __init efx_init_module(void) 3298874aeea5SJeff Kirsher { 3299874aeea5SJeff Kirsher int rc; 3300874aeea5SJeff Kirsher 3301874aeea5SJeff Kirsher printk(KERN_INFO "Solarflare NET driver v" EFX_DRIVER_VERSION "\n"); 3302874aeea5SJeff Kirsher 3303874aeea5SJeff Kirsher rc = register_netdevice_notifier(&efx_netdev_notifier); 3304874aeea5SJeff Kirsher if (rc) 3305874aeea5SJeff Kirsher goto err_notifier; 3306874aeea5SJeff Kirsher 3307cd2d5b52SBen Hutchings rc = efx_init_sriov(); 3308cd2d5b52SBen Hutchings if (rc) 3309cd2d5b52SBen Hutchings goto err_sriov; 3310cd2d5b52SBen Hutchings 3311874aeea5SJeff Kirsher reset_workqueue = create_singlethread_workqueue("sfc_reset"); 3312874aeea5SJeff Kirsher if (!reset_workqueue) { 3313874aeea5SJeff Kirsher rc = -ENOMEM; 3314874aeea5SJeff Kirsher goto err_reset; 3315874aeea5SJeff Kirsher } 3316874aeea5SJeff Kirsher 3317874aeea5SJeff Kirsher rc = pci_register_driver(&efx_pci_driver); 3318874aeea5SJeff Kirsher if (rc < 0) 3319874aeea5SJeff Kirsher goto err_pci; 3320874aeea5SJeff Kirsher 3321874aeea5SJeff Kirsher return 0; 3322874aeea5SJeff Kirsher 3323874aeea5SJeff Kirsher err_pci: 3324874aeea5SJeff Kirsher destroy_workqueue(reset_workqueue); 3325874aeea5SJeff Kirsher err_reset: 3326cd2d5b52SBen Hutchings efx_fini_sriov(); 3327cd2d5b52SBen Hutchings err_sriov: 3328874aeea5SJeff Kirsher unregister_netdevice_notifier(&efx_netdev_notifier); 3329874aeea5SJeff Kirsher err_notifier: 3330874aeea5SJeff Kirsher return rc; 3331874aeea5SJeff Kirsher } 3332874aeea5SJeff Kirsher 3333874aeea5SJeff Kirsher static void __exit efx_exit_module(void) 3334874aeea5SJeff Kirsher { 3335874aeea5SJeff Kirsher printk(KERN_INFO "Solarflare NET driver unloading\n"); 3336874aeea5SJeff Kirsher 3337874aeea5SJeff Kirsher pci_unregister_driver(&efx_pci_driver); 3338874aeea5SJeff Kirsher destroy_workqueue(reset_workqueue); 3339cd2d5b52SBen Hutchings efx_fini_sriov(); 3340874aeea5SJeff Kirsher unregister_netdevice_notifier(&efx_netdev_notifier); 3341874aeea5SJeff Kirsher 3342874aeea5SJeff Kirsher } 3343874aeea5SJeff Kirsher 3344874aeea5SJeff Kirsher module_init(efx_init_module); 3345874aeea5SJeff Kirsher module_exit(efx_exit_module); 3346874aeea5SJeff Kirsher 3347874aeea5SJeff Kirsher MODULE_AUTHOR("Solarflare Communications and " 3348874aeea5SJeff Kirsher "Michael Brown <mbrown@fensystems.co.uk>"); 33496a350fdbSBen Hutchings MODULE_DESCRIPTION("Solarflare network driver"); 3350874aeea5SJeff Kirsher MODULE_LICENSE("GPL"); 3351874aeea5SJeff Kirsher MODULE_DEVICE_TABLE(pci, efx_pci_table); 3352