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" 297fa8d547SShradha Shah #include "sriov.h" 30874aeea5SJeff Kirsher 31874aeea5SJeff Kirsher #include "mcdi.h" 32874aeea5SJeff Kirsher #include "workarounds.h" 33874aeea5SJeff Kirsher 34874aeea5SJeff Kirsher /************************************************************************** 35874aeea5SJeff Kirsher * 36874aeea5SJeff Kirsher * Type name strings 37874aeea5SJeff Kirsher * 38874aeea5SJeff Kirsher ************************************************************************** 39874aeea5SJeff Kirsher */ 40874aeea5SJeff Kirsher 41874aeea5SJeff Kirsher /* Loopback mode names (see LOOPBACK_MODE()) */ 42874aeea5SJeff Kirsher const unsigned int efx_loopback_mode_max = LOOPBACK_MAX; 4318e83e4cSBen Hutchings const char *const efx_loopback_mode_names[] = { 44874aeea5SJeff Kirsher [LOOPBACK_NONE] = "NONE", 45874aeea5SJeff Kirsher [LOOPBACK_DATA] = "DATAPATH", 46874aeea5SJeff Kirsher [LOOPBACK_GMAC] = "GMAC", 47874aeea5SJeff Kirsher [LOOPBACK_XGMII] = "XGMII", 48874aeea5SJeff Kirsher [LOOPBACK_XGXS] = "XGXS", 49874aeea5SJeff Kirsher [LOOPBACK_XAUI] = "XAUI", 50874aeea5SJeff Kirsher [LOOPBACK_GMII] = "GMII", 51874aeea5SJeff Kirsher [LOOPBACK_SGMII] = "SGMII", 52874aeea5SJeff Kirsher [LOOPBACK_XGBR] = "XGBR", 53874aeea5SJeff Kirsher [LOOPBACK_XFI] = "XFI", 54874aeea5SJeff Kirsher [LOOPBACK_XAUI_FAR] = "XAUI_FAR", 55874aeea5SJeff Kirsher [LOOPBACK_GMII_FAR] = "GMII_FAR", 56874aeea5SJeff Kirsher [LOOPBACK_SGMII_FAR] = "SGMII_FAR", 57874aeea5SJeff Kirsher [LOOPBACK_XFI_FAR] = "XFI_FAR", 58874aeea5SJeff Kirsher [LOOPBACK_GPHY] = "GPHY", 59874aeea5SJeff Kirsher [LOOPBACK_PHYXS] = "PHYXS", 60874aeea5SJeff Kirsher [LOOPBACK_PCS] = "PCS", 61874aeea5SJeff Kirsher [LOOPBACK_PMAPMD] = "PMA/PMD", 62874aeea5SJeff Kirsher [LOOPBACK_XPORT] = "XPORT", 63874aeea5SJeff Kirsher [LOOPBACK_XGMII_WS] = "XGMII_WS", 64874aeea5SJeff Kirsher [LOOPBACK_XAUI_WS] = "XAUI_WS", 65874aeea5SJeff Kirsher [LOOPBACK_XAUI_WS_FAR] = "XAUI_WS_FAR", 66874aeea5SJeff Kirsher [LOOPBACK_XAUI_WS_NEAR] = "XAUI_WS_NEAR", 67874aeea5SJeff Kirsher [LOOPBACK_GMII_WS] = "GMII_WS", 68874aeea5SJeff Kirsher [LOOPBACK_XFI_WS] = "XFI_WS", 69874aeea5SJeff Kirsher [LOOPBACK_XFI_WS_FAR] = "XFI_WS_FAR", 70874aeea5SJeff Kirsher [LOOPBACK_PHYXS_WS] = "PHYXS_WS", 71874aeea5SJeff Kirsher }; 72874aeea5SJeff Kirsher 73874aeea5SJeff Kirsher const unsigned int efx_reset_type_max = RESET_TYPE_MAX; 7418e83e4cSBen Hutchings const char *const efx_reset_type_names[] = { 75874aeea5SJeff Kirsher [RESET_TYPE_INVISIBLE] = "INVISIBLE", 76874aeea5SJeff Kirsher [RESET_TYPE_ALL] = "ALL", 77626950dbSAlexandre Rames [RESET_TYPE_RECOVER_OR_ALL] = "RECOVER_OR_ALL", 78874aeea5SJeff Kirsher [RESET_TYPE_WORLD] = "WORLD", 79626950dbSAlexandre Rames [RESET_TYPE_RECOVER_OR_DISABLE] = "RECOVER_OR_DISABLE", 80087e9025SJon Cooper [RESET_TYPE_DATAPATH] = "DATAPATH", 81e283546cSEdward Cree [RESET_TYPE_MC_BIST] = "MC_BIST", 82874aeea5SJeff Kirsher [RESET_TYPE_DISABLE] = "DISABLE", 83874aeea5SJeff Kirsher [RESET_TYPE_TX_WATCHDOG] = "TX_WATCHDOG", 84874aeea5SJeff Kirsher [RESET_TYPE_INT_ERROR] = "INT_ERROR", 85874aeea5SJeff Kirsher [RESET_TYPE_RX_RECOVERY] = "RX_RECOVERY", 863de82b91SAlexandre Rames [RESET_TYPE_DMA_ERROR] = "DMA_ERROR", 87874aeea5SJeff Kirsher [RESET_TYPE_TX_SKIP] = "TX_SKIP", 88874aeea5SJeff Kirsher [RESET_TYPE_MC_FAILURE] = "MC_FAILURE", 89e283546cSEdward Cree [RESET_TYPE_MCDI_TIMEOUT] = "MCDI_TIMEOUT (FLR)", 90874aeea5SJeff Kirsher }; 91874aeea5SJeff Kirsher 92874aeea5SJeff Kirsher /* Reset workqueue. If any NIC has a hardware failure then a reset will be 93874aeea5SJeff Kirsher * queued onto this work queue. This is not a per-nic work queue, because 94874aeea5SJeff Kirsher * efx_reset_work() acquires the rtnl lock, so resets are naturally serialised. 95874aeea5SJeff Kirsher */ 96874aeea5SJeff Kirsher static struct workqueue_struct *reset_workqueue; 97874aeea5SJeff Kirsher 9874cd60a4SJon Cooper /* How often and how many times to poll for a reset while waiting for a 9974cd60a4SJon Cooper * BIST that another function started to complete. 10074cd60a4SJon Cooper */ 10174cd60a4SJon Cooper #define BIST_WAIT_DELAY_MS 100 10274cd60a4SJon Cooper #define BIST_WAIT_DELAY_COUNT 100 10374cd60a4SJon Cooper 104874aeea5SJeff Kirsher /************************************************************************** 105874aeea5SJeff Kirsher * 106874aeea5SJeff Kirsher * Configurable values 107874aeea5SJeff Kirsher * 108874aeea5SJeff Kirsher *************************************************************************/ 109874aeea5SJeff Kirsher 110874aeea5SJeff Kirsher /* 111874aeea5SJeff Kirsher * Use separate channels for TX and RX events 112874aeea5SJeff Kirsher * 113874aeea5SJeff Kirsher * Set this to 1 to use separate channels for TX and RX. It allows us 114874aeea5SJeff Kirsher * to control interrupt affinity separately for TX and RX. 115874aeea5SJeff Kirsher * 116874aeea5SJeff Kirsher * This is only used in MSI-X interrupt mode 117874aeea5SJeff Kirsher */ 118b0fbdae1SShradha Shah bool efx_separate_tx_channels; 119b0fbdae1SShradha Shah module_param(efx_separate_tx_channels, bool, 0444); 120b0fbdae1SShradha Shah MODULE_PARM_DESC(efx_separate_tx_channels, 121874aeea5SJeff Kirsher "Use separate channels for TX and RX"); 122874aeea5SJeff Kirsher 123874aeea5SJeff Kirsher /* This is the weight assigned to each of the (per-channel) virtual 124874aeea5SJeff Kirsher * NAPI devices. 125874aeea5SJeff Kirsher */ 126874aeea5SJeff Kirsher static int napi_weight = 64; 127874aeea5SJeff Kirsher 128874aeea5SJeff Kirsher /* This is the time (in jiffies) between invocations of the hardware 129626950dbSAlexandre Rames * monitor. 130626950dbSAlexandre Rames * On Falcon-based NICs, this will: 131874aeea5SJeff Kirsher * - Check the on-board hardware monitor; 132874aeea5SJeff Kirsher * - Poll the link state and reconfigure the hardware as necessary. 133626950dbSAlexandre Rames * On Siena-based NICs for power systems with EEH support, this will give EEH a 134626950dbSAlexandre Rames * chance to start. 135874aeea5SJeff Kirsher */ 136874aeea5SJeff Kirsher static unsigned int efx_monitor_interval = 1 * HZ; 137874aeea5SJeff Kirsher 138874aeea5SJeff Kirsher /* Initial interrupt moderation settings. They can be modified after 139874aeea5SJeff Kirsher * module load with ethtool. 140874aeea5SJeff Kirsher * 141874aeea5SJeff Kirsher * The default for RX should strike a balance between increasing the 142874aeea5SJeff Kirsher * round-trip latency and reducing overhead. 143874aeea5SJeff Kirsher */ 144874aeea5SJeff Kirsher static unsigned int rx_irq_mod_usec = 60; 145874aeea5SJeff Kirsher 146874aeea5SJeff Kirsher /* Initial interrupt moderation settings. They can be modified after 147874aeea5SJeff Kirsher * module load with ethtool. 148874aeea5SJeff Kirsher * 149874aeea5SJeff Kirsher * This default is chosen to ensure that a 10G link does not go idle 150874aeea5SJeff Kirsher * while a TX queue is stopped after it has become full. A queue is 151874aeea5SJeff Kirsher * restarted when it drops below half full. The time this takes (assuming 152874aeea5SJeff Kirsher * worst case 3 descriptors per packet and 1024 descriptors) is 153874aeea5SJeff Kirsher * 512 / 3 * 1.2 = 205 usec. 154874aeea5SJeff Kirsher */ 155874aeea5SJeff Kirsher static unsigned int tx_irq_mod_usec = 150; 156874aeea5SJeff Kirsher 157874aeea5SJeff Kirsher /* This is the first interrupt mode to try out of: 158874aeea5SJeff Kirsher * 0 => MSI-X 159874aeea5SJeff Kirsher * 1 => MSI 160874aeea5SJeff Kirsher * 2 => legacy 161874aeea5SJeff Kirsher */ 162874aeea5SJeff Kirsher static unsigned int interrupt_mode; 163874aeea5SJeff Kirsher 164874aeea5SJeff Kirsher /* This is the requested number of CPUs to use for Receive-Side Scaling (RSS), 165874aeea5SJeff Kirsher * i.e. the number of CPUs among which we may distribute simultaneous 166874aeea5SJeff Kirsher * interrupt handling. 167874aeea5SJeff Kirsher * 168874aeea5SJeff Kirsher * Cards without MSI-X will only target one CPU via legacy or MSI interrupt. 169cdb08f8fSBen Hutchings * The default (0) means to assign an interrupt to each core. 170874aeea5SJeff Kirsher */ 171874aeea5SJeff Kirsher static unsigned int rss_cpus; 172874aeea5SJeff Kirsher module_param(rss_cpus, uint, 0444); 173874aeea5SJeff Kirsher MODULE_PARM_DESC(rss_cpus, "Number of CPUs to use for Receive-Side Scaling"); 174874aeea5SJeff Kirsher 175b9cc977dSBen Hutchings static bool phy_flash_cfg; 176b9cc977dSBen Hutchings module_param(phy_flash_cfg, bool, 0644); 177874aeea5SJeff Kirsher MODULE_PARM_DESC(phy_flash_cfg, "Set PHYs into reflash mode initially"); 178874aeea5SJeff Kirsher 179e7bed9c8SBen Hutchings static unsigned irq_adapt_low_thresh = 8000; 180874aeea5SJeff Kirsher module_param(irq_adapt_low_thresh, uint, 0644); 181874aeea5SJeff Kirsher MODULE_PARM_DESC(irq_adapt_low_thresh, 182874aeea5SJeff Kirsher "Threshold score for reducing IRQ moderation"); 183874aeea5SJeff Kirsher 184e7bed9c8SBen Hutchings static unsigned irq_adapt_high_thresh = 16000; 185874aeea5SJeff Kirsher module_param(irq_adapt_high_thresh, uint, 0644); 186874aeea5SJeff Kirsher MODULE_PARM_DESC(irq_adapt_high_thresh, 187874aeea5SJeff Kirsher "Threshold score for increasing IRQ moderation"); 188874aeea5SJeff Kirsher 189874aeea5SJeff Kirsher static unsigned debug = (NETIF_MSG_DRV | NETIF_MSG_PROBE | 190874aeea5SJeff Kirsher NETIF_MSG_LINK | NETIF_MSG_IFDOWN | 191874aeea5SJeff Kirsher NETIF_MSG_IFUP | NETIF_MSG_RX_ERR | 192874aeea5SJeff Kirsher NETIF_MSG_TX_ERR | NETIF_MSG_HW); 193874aeea5SJeff Kirsher module_param(debug, uint, 0); 194874aeea5SJeff Kirsher MODULE_PARM_DESC(debug, "Bitmapped debugging message enable value"); 195874aeea5SJeff Kirsher 196874aeea5SJeff Kirsher /************************************************************************** 197874aeea5SJeff Kirsher * 198874aeea5SJeff Kirsher * Utility functions and prototypes 199874aeea5SJeff Kirsher * 200874aeea5SJeff Kirsher *************************************************************************/ 201874aeea5SJeff Kirsher 202261e4d96SJon Cooper static int efx_soft_enable_interrupts(struct efx_nic *efx); 203d8291187SBen Hutchings static void efx_soft_disable_interrupts(struct efx_nic *efx); 2047f967c01SBen Hutchings static void efx_remove_channel(struct efx_channel *channel); 205874aeea5SJeff Kirsher static void efx_remove_channels(struct efx_nic *efx); 2067f967c01SBen Hutchings static const struct efx_channel_type efx_default_channel_type; 207874aeea5SJeff Kirsher static void efx_remove_port(struct efx_nic *efx); 2087f967c01SBen Hutchings static void efx_init_napi_channel(struct efx_channel *channel); 209874aeea5SJeff Kirsher static void efx_fini_napi(struct efx_nic *efx); 210874aeea5SJeff Kirsher static void efx_fini_napi_channel(struct efx_channel *channel); 211874aeea5SJeff Kirsher static void efx_fini_struct(struct efx_nic *efx); 212874aeea5SJeff Kirsher static void efx_start_all(struct efx_nic *efx); 213874aeea5SJeff Kirsher static void efx_stop_all(struct efx_nic *efx); 214874aeea5SJeff Kirsher 215874aeea5SJeff Kirsher #define EFX_ASSERT_RESET_SERIALISED(efx) \ 216874aeea5SJeff Kirsher do { \ 217f16aeea0SBen Hutchings if ((efx->state == STATE_READY) || \ 218626950dbSAlexandre Rames (efx->state == STATE_RECOVERY) || \ 219874aeea5SJeff Kirsher (efx->state == STATE_DISABLED)) \ 220874aeea5SJeff Kirsher ASSERT_RTNL(); \ 221874aeea5SJeff Kirsher } while (0) 222874aeea5SJeff Kirsher 2238b7325b4SBen Hutchings static int efx_check_disabled(struct efx_nic *efx) 2248b7325b4SBen Hutchings { 225626950dbSAlexandre Rames if (efx->state == STATE_DISABLED || efx->state == STATE_RECOVERY) { 2268b7325b4SBen Hutchings netif_err(efx, drv, efx->net_dev, 2278b7325b4SBen Hutchings "device is disabled due to earlier errors\n"); 2288b7325b4SBen Hutchings return -EIO; 2298b7325b4SBen Hutchings } 2308b7325b4SBen Hutchings return 0; 2318b7325b4SBen Hutchings } 2328b7325b4SBen Hutchings 233874aeea5SJeff Kirsher /************************************************************************** 234874aeea5SJeff Kirsher * 235874aeea5SJeff Kirsher * Event queue processing 236874aeea5SJeff Kirsher * 237874aeea5SJeff Kirsher *************************************************************************/ 238874aeea5SJeff Kirsher 239874aeea5SJeff Kirsher /* Process channel's event queue 240874aeea5SJeff Kirsher * 241874aeea5SJeff Kirsher * This function is responsible for processing the event queue of a 242874aeea5SJeff Kirsher * single channel. The caller must guarantee that this function will 243874aeea5SJeff Kirsher * never be concurrently called more than once on the same channel, 244874aeea5SJeff Kirsher * though different channels may be being processed concurrently. 245874aeea5SJeff Kirsher */ 246874aeea5SJeff Kirsher static int efx_process_channel(struct efx_channel *channel, int budget) 247874aeea5SJeff Kirsher { 248c936835cSPeter Dunning struct efx_tx_queue *tx_queue; 249874aeea5SJeff Kirsher int spent; 250874aeea5SJeff Kirsher 2519f2cb71cSBen Hutchings if (unlikely(!channel->enabled)) 252874aeea5SJeff Kirsher return 0; 253874aeea5SJeff Kirsher 254c936835cSPeter Dunning efx_for_each_channel_tx_queue(tx_queue, channel) { 255c936835cSPeter Dunning tx_queue->pkts_compl = 0; 256c936835cSPeter Dunning tx_queue->bytes_compl = 0; 257c936835cSPeter Dunning } 258c936835cSPeter Dunning 259874aeea5SJeff Kirsher spent = efx_nic_process_eventq(channel, budget); 260d9ab7007SBen Hutchings if (spent && efx_channel_has_rx_queue(channel)) { 261d9ab7007SBen Hutchings struct efx_rx_queue *rx_queue = 262d9ab7007SBen Hutchings efx_channel_get_rx_queue(channel); 263874aeea5SJeff Kirsher 264ff734ef4SBen Hutchings efx_rx_flush_packet(channel); 265cce28794SJon Cooper efx_fast_push_rx_descriptors(rx_queue, true); 266d9ab7007SBen Hutchings } 267874aeea5SJeff Kirsher 268c936835cSPeter Dunning /* Update BQL */ 269c936835cSPeter Dunning efx_for_each_channel_tx_queue(tx_queue, channel) { 270c936835cSPeter Dunning if (tx_queue->bytes_compl) { 271c936835cSPeter Dunning netdev_tx_completed_queue(tx_queue->core_txq, 272c936835cSPeter Dunning tx_queue->pkts_compl, tx_queue->bytes_compl); 273c936835cSPeter Dunning } 274c936835cSPeter Dunning } 275c936835cSPeter Dunning 276874aeea5SJeff Kirsher return spent; 277874aeea5SJeff Kirsher } 278874aeea5SJeff Kirsher 279874aeea5SJeff Kirsher /* NAPI poll handler 280874aeea5SJeff Kirsher * 281874aeea5SJeff Kirsher * NAPI guarantees serialisation of polls of the same device, which 282874aeea5SJeff Kirsher * provides the guarantee required by efx_process_channel(). 283874aeea5SJeff Kirsher */ 284539de7c5SBert Kenward static void efx_update_irq_mod(struct efx_nic *efx, struct efx_channel *channel) 285539de7c5SBert Kenward { 286539de7c5SBert Kenward int step = efx->irq_mod_step_us; 287539de7c5SBert Kenward 288539de7c5SBert Kenward if (channel->irq_mod_score < irq_adapt_low_thresh) { 289539de7c5SBert Kenward if (channel->irq_moderation_us > step) { 290539de7c5SBert Kenward channel->irq_moderation_us -= step; 291539de7c5SBert Kenward efx->type->push_irq_moderation(channel); 292539de7c5SBert Kenward } 293539de7c5SBert Kenward } else if (channel->irq_mod_score > irq_adapt_high_thresh) { 294539de7c5SBert Kenward if (channel->irq_moderation_us < 295539de7c5SBert Kenward efx->irq_rx_moderation_us) { 296539de7c5SBert Kenward channel->irq_moderation_us += step; 297539de7c5SBert Kenward efx->type->push_irq_moderation(channel); 298539de7c5SBert Kenward } 299539de7c5SBert Kenward } 300539de7c5SBert Kenward 301539de7c5SBert Kenward channel->irq_count = 0; 302539de7c5SBert Kenward channel->irq_mod_score = 0; 303539de7c5SBert Kenward } 304539de7c5SBert Kenward 305874aeea5SJeff Kirsher static int efx_poll(struct napi_struct *napi, int budget) 306874aeea5SJeff Kirsher { 307874aeea5SJeff Kirsher struct efx_channel *channel = 308874aeea5SJeff Kirsher container_of(napi, struct efx_channel, napi_str); 309874aeea5SJeff Kirsher struct efx_nic *efx = channel->efx; 310874aeea5SJeff Kirsher int spent; 311874aeea5SJeff Kirsher 31236763266SAlexandre Rames if (!efx_channel_lock_napi(channel)) 31336763266SAlexandre Rames return budget; 31436763266SAlexandre Rames 315874aeea5SJeff Kirsher netif_vdbg(efx, intr, efx->net_dev, 316874aeea5SJeff Kirsher "channel %d NAPI poll executing on CPU %d\n", 317874aeea5SJeff Kirsher channel->channel, raw_smp_processor_id()); 318874aeea5SJeff Kirsher 319874aeea5SJeff Kirsher spent = efx_process_channel(channel, budget); 320874aeea5SJeff Kirsher 321874aeea5SJeff Kirsher if (spent < budget) { 3229d9a6973SBen Hutchings if (efx_channel_has_rx_queue(channel) && 323874aeea5SJeff Kirsher efx->irq_rx_adaptive && 324874aeea5SJeff Kirsher unlikely(++channel->irq_count == 1000)) { 325539de7c5SBert Kenward efx_update_irq_mod(efx, channel); 326874aeea5SJeff Kirsher } 327874aeea5SJeff Kirsher 328874aeea5SJeff Kirsher efx_filter_rfs_expire(channel); 329874aeea5SJeff Kirsher 330874aeea5SJeff Kirsher /* There is no race here; although napi_disable() will 331874aeea5SJeff Kirsher * only wait for napi_complete(), this isn't a problem 332514bedbcSBen Hutchings * since efx_nic_eventq_read_ack() will have no effect if 333874aeea5SJeff Kirsher * interrupts have already been disabled. 334874aeea5SJeff Kirsher */ 335874aeea5SJeff Kirsher napi_complete(napi); 336514bedbcSBen Hutchings efx_nic_eventq_read_ack(channel); 337874aeea5SJeff Kirsher } 338874aeea5SJeff Kirsher 33936763266SAlexandre Rames efx_channel_unlock_napi(channel); 340874aeea5SJeff Kirsher return spent; 341874aeea5SJeff Kirsher } 342874aeea5SJeff Kirsher 343874aeea5SJeff Kirsher /* Create event queue 344874aeea5SJeff Kirsher * Event queue memory allocations are done only once. If the channel 345874aeea5SJeff Kirsher * is reset, the memory buffer will be reused; this guards against 346874aeea5SJeff Kirsher * errors during channel reset and also simplifies interrupt handling. 347874aeea5SJeff Kirsher */ 348874aeea5SJeff Kirsher static int efx_probe_eventq(struct efx_channel *channel) 349874aeea5SJeff Kirsher { 350874aeea5SJeff Kirsher struct efx_nic *efx = channel->efx; 351874aeea5SJeff Kirsher unsigned long entries; 352874aeea5SJeff Kirsher 35386ee5302SBen Hutchings netif_dbg(efx, probe, efx->net_dev, 354874aeea5SJeff Kirsher "chan %d create event queue\n", channel->channel); 355874aeea5SJeff Kirsher 356874aeea5SJeff Kirsher /* Build an event queue with room for one event per tx and rx buffer, 357874aeea5SJeff Kirsher * plus some extra for link state events and MCDI completions. */ 358874aeea5SJeff Kirsher entries = roundup_pow_of_two(efx->rxq_entries + efx->txq_entries + 128); 359874aeea5SJeff Kirsher EFX_BUG_ON_PARANOID(entries > EFX_MAX_EVQ_SIZE); 360874aeea5SJeff Kirsher channel->eventq_mask = max(entries, EFX_MIN_EVQ_SIZE) - 1; 361874aeea5SJeff Kirsher 362874aeea5SJeff Kirsher return efx_nic_probe_eventq(channel); 363874aeea5SJeff Kirsher } 364874aeea5SJeff Kirsher 365874aeea5SJeff Kirsher /* Prepare channel's event queue */ 366261e4d96SJon Cooper static int efx_init_eventq(struct efx_channel *channel) 367874aeea5SJeff Kirsher { 36815acb1ceSBen Hutchings struct efx_nic *efx = channel->efx; 369261e4d96SJon Cooper int rc; 370261e4d96SJon Cooper 371261e4d96SJon Cooper EFX_WARN_ON_PARANOID(channel->eventq_init); 372261e4d96SJon Cooper 37315acb1ceSBen Hutchings netif_dbg(efx, drv, efx->net_dev, 374874aeea5SJeff Kirsher "chan %d init event queue\n", channel->channel); 375874aeea5SJeff Kirsher 376261e4d96SJon Cooper rc = efx_nic_init_eventq(channel); 377261e4d96SJon Cooper if (rc == 0) { 37815acb1ceSBen Hutchings efx->type->push_irq_moderation(channel); 379874aeea5SJeff Kirsher channel->eventq_read_ptr = 0; 380be3fc09cSBen Hutchings channel->eventq_init = true; 381874aeea5SJeff Kirsher } 382261e4d96SJon Cooper return rc; 383261e4d96SJon Cooper } 384874aeea5SJeff Kirsher 3859f2cb71cSBen Hutchings /* Enable event queue processing and NAPI */ 38636763266SAlexandre Rames void efx_start_eventq(struct efx_channel *channel) 3879f2cb71cSBen Hutchings { 3889f2cb71cSBen Hutchings netif_dbg(channel->efx, ifup, channel->efx->net_dev, 3899f2cb71cSBen Hutchings "chan %d start event queue\n", channel->channel); 3909f2cb71cSBen Hutchings 391514bedbcSBen Hutchings /* Make sure the NAPI handler sees the enabled flag set */ 3929f2cb71cSBen Hutchings channel->enabled = true; 3939f2cb71cSBen Hutchings smp_wmb(); 3949f2cb71cSBen Hutchings 39536763266SAlexandre Rames efx_channel_enable(channel); 3969f2cb71cSBen Hutchings napi_enable(&channel->napi_str); 3979f2cb71cSBen Hutchings efx_nic_eventq_read_ack(channel); 3989f2cb71cSBen Hutchings } 3999f2cb71cSBen Hutchings 4009f2cb71cSBen Hutchings /* Disable event queue processing and NAPI */ 40136763266SAlexandre Rames void efx_stop_eventq(struct efx_channel *channel) 4029f2cb71cSBen Hutchings { 4039f2cb71cSBen Hutchings if (!channel->enabled) 4049f2cb71cSBen Hutchings return; 4059f2cb71cSBen Hutchings 4069f2cb71cSBen Hutchings napi_disable(&channel->napi_str); 40736763266SAlexandre Rames while (!efx_channel_disable(channel)) 40836763266SAlexandre Rames usleep_range(1000, 20000); 4099f2cb71cSBen Hutchings channel->enabled = false; 4109f2cb71cSBen Hutchings } 4119f2cb71cSBen Hutchings 412874aeea5SJeff Kirsher static void efx_fini_eventq(struct efx_channel *channel) 413874aeea5SJeff Kirsher { 414be3fc09cSBen Hutchings if (!channel->eventq_init) 415be3fc09cSBen Hutchings return; 416be3fc09cSBen Hutchings 417874aeea5SJeff Kirsher netif_dbg(channel->efx, drv, channel->efx->net_dev, 418874aeea5SJeff Kirsher "chan %d fini event queue\n", channel->channel); 419874aeea5SJeff Kirsher 420874aeea5SJeff Kirsher efx_nic_fini_eventq(channel); 421be3fc09cSBen Hutchings channel->eventq_init = false; 422874aeea5SJeff Kirsher } 423874aeea5SJeff Kirsher 424874aeea5SJeff Kirsher static void efx_remove_eventq(struct efx_channel *channel) 425874aeea5SJeff Kirsher { 426874aeea5SJeff Kirsher netif_dbg(channel->efx, drv, channel->efx->net_dev, 427874aeea5SJeff Kirsher "chan %d remove event queue\n", channel->channel); 428874aeea5SJeff Kirsher 429874aeea5SJeff Kirsher efx_nic_remove_eventq(channel); 430874aeea5SJeff Kirsher } 431874aeea5SJeff Kirsher 432874aeea5SJeff Kirsher /************************************************************************** 433874aeea5SJeff Kirsher * 434874aeea5SJeff Kirsher * Channel handling 435874aeea5SJeff Kirsher * 436874aeea5SJeff Kirsher *************************************************************************/ 437874aeea5SJeff Kirsher 4387f967c01SBen Hutchings /* Allocate and initialise a channel structure. */ 439874aeea5SJeff Kirsher static struct efx_channel * 440874aeea5SJeff Kirsher efx_alloc_channel(struct efx_nic *efx, int i, struct efx_channel *old_channel) 441874aeea5SJeff Kirsher { 442874aeea5SJeff Kirsher struct efx_channel *channel; 443874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 444874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 445874aeea5SJeff Kirsher int j; 446874aeea5SJeff Kirsher 4477f967c01SBen Hutchings channel = kzalloc(sizeof(*channel), GFP_KERNEL); 4487f967c01SBen Hutchings if (!channel) 4497f967c01SBen Hutchings return NULL; 4507f967c01SBen Hutchings 4517f967c01SBen Hutchings channel->efx = efx; 4527f967c01SBen Hutchings channel->channel = i; 4537f967c01SBen Hutchings channel->type = &efx_default_channel_type; 4547f967c01SBen Hutchings 4557f967c01SBen Hutchings for (j = 0; j < EFX_TXQ_TYPES; j++) { 4567f967c01SBen Hutchings tx_queue = &channel->tx_queue[j]; 4577f967c01SBen Hutchings tx_queue->efx = efx; 4587f967c01SBen Hutchings tx_queue->queue = i * EFX_TXQ_TYPES + j; 4597f967c01SBen Hutchings tx_queue->channel = channel; 4607f967c01SBen Hutchings } 4617f967c01SBen Hutchings 4627f967c01SBen Hutchings rx_queue = &channel->rx_queue; 4637f967c01SBen Hutchings rx_queue->efx = efx; 4647f967c01SBen Hutchings setup_timer(&rx_queue->slow_fill, efx_rx_slow_fill, 4657f967c01SBen Hutchings (unsigned long)rx_queue); 4667f967c01SBen Hutchings 4677f967c01SBen Hutchings return channel; 4687f967c01SBen Hutchings } 4697f967c01SBen Hutchings 4707f967c01SBen Hutchings /* Allocate and initialise a channel structure, copying parameters 4717f967c01SBen Hutchings * (but not resources) from an old channel structure. 4727f967c01SBen Hutchings */ 4737f967c01SBen Hutchings static struct efx_channel * 4747f967c01SBen Hutchings efx_copy_channel(const struct efx_channel *old_channel) 4757f967c01SBen Hutchings { 4767f967c01SBen Hutchings struct efx_channel *channel; 4777f967c01SBen Hutchings struct efx_rx_queue *rx_queue; 4787f967c01SBen Hutchings struct efx_tx_queue *tx_queue; 4797f967c01SBen Hutchings int j; 4807f967c01SBen Hutchings 481874aeea5SJeff Kirsher channel = kmalloc(sizeof(*channel), GFP_KERNEL); 482874aeea5SJeff Kirsher if (!channel) 483874aeea5SJeff Kirsher return NULL; 484874aeea5SJeff Kirsher 485874aeea5SJeff Kirsher *channel = *old_channel; 486874aeea5SJeff Kirsher 487874aeea5SJeff Kirsher channel->napi_dev = NULL; 488874aeea5SJeff Kirsher memset(&channel->eventq, 0, sizeof(channel->eventq)); 489874aeea5SJeff Kirsher 490874aeea5SJeff Kirsher for (j = 0; j < EFX_TXQ_TYPES; j++) { 491874aeea5SJeff Kirsher tx_queue = &channel->tx_queue[j]; 492874aeea5SJeff Kirsher if (tx_queue->channel) 493874aeea5SJeff Kirsher tx_queue->channel = channel; 494874aeea5SJeff Kirsher tx_queue->buffer = NULL; 495874aeea5SJeff Kirsher memset(&tx_queue->txd, 0, sizeof(tx_queue->txd)); 496874aeea5SJeff Kirsher } 497874aeea5SJeff Kirsher 498874aeea5SJeff Kirsher rx_queue = &channel->rx_queue; 4997f967c01SBen Hutchings rx_queue->buffer = NULL; 5007f967c01SBen Hutchings memset(&rx_queue->rxd, 0, sizeof(rx_queue->rxd)); 501874aeea5SJeff Kirsher setup_timer(&rx_queue->slow_fill, efx_rx_slow_fill, 502874aeea5SJeff Kirsher (unsigned long)rx_queue); 503874aeea5SJeff Kirsher 504874aeea5SJeff Kirsher return channel; 505874aeea5SJeff Kirsher } 506874aeea5SJeff Kirsher 507874aeea5SJeff Kirsher static int efx_probe_channel(struct efx_channel *channel) 508874aeea5SJeff Kirsher { 509874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 510874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 511874aeea5SJeff Kirsher int rc; 512874aeea5SJeff Kirsher 513874aeea5SJeff Kirsher netif_dbg(channel->efx, probe, channel->efx->net_dev, 514874aeea5SJeff Kirsher "creating channel %d\n", channel->channel); 515874aeea5SJeff Kirsher 5167f967c01SBen Hutchings rc = channel->type->pre_probe(channel); 5177f967c01SBen Hutchings if (rc) 5187f967c01SBen Hutchings goto fail; 5197f967c01SBen Hutchings 520874aeea5SJeff Kirsher rc = efx_probe_eventq(channel); 521874aeea5SJeff Kirsher if (rc) 5227f967c01SBen Hutchings goto fail; 523874aeea5SJeff Kirsher 524874aeea5SJeff Kirsher efx_for_each_channel_tx_queue(tx_queue, channel) { 525874aeea5SJeff Kirsher rc = efx_probe_tx_queue(tx_queue); 526874aeea5SJeff Kirsher if (rc) 5277f967c01SBen Hutchings goto fail; 528874aeea5SJeff Kirsher } 529874aeea5SJeff Kirsher 530874aeea5SJeff Kirsher efx_for_each_channel_rx_queue(rx_queue, channel) { 531874aeea5SJeff Kirsher rc = efx_probe_rx_queue(rx_queue); 532874aeea5SJeff Kirsher if (rc) 5337f967c01SBen Hutchings goto fail; 534874aeea5SJeff Kirsher } 535874aeea5SJeff Kirsher 536874aeea5SJeff Kirsher return 0; 537874aeea5SJeff Kirsher 5387f967c01SBen Hutchings fail: 5397f967c01SBen Hutchings efx_remove_channel(channel); 540874aeea5SJeff Kirsher return rc; 541874aeea5SJeff Kirsher } 542874aeea5SJeff Kirsher 5437f967c01SBen Hutchings static void 5447f967c01SBen Hutchings efx_get_channel_name(struct efx_channel *channel, char *buf, size_t len) 5457f967c01SBen Hutchings { 5467f967c01SBen Hutchings struct efx_nic *efx = channel->efx; 5477f967c01SBen Hutchings const char *type; 5487f967c01SBen Hutchings int number; 5497f967c01SBen Hutchings 5507f967c01SBen Hutchings number = channel->channel; 5517f967c01SBen Hutchings if (efx->tx_channel_offset == 0) { 5527f967c01SBen Hutchings type = ""; 5537f967c01SBen Hutchings } else if (channel->channel < efx->tx_channel_offset) { 5547f967c01SBen Hutchings type = "-rx"; 5557f967c01SBen Hutchings } else { 5567f967c01SBen Hutchings type = "-tx"; 5577f967c01SBen Hutchings number -= efx->tx_channel_offset; 5587f967c01SBen Hutchings } 5597f967c01SBen Hutchings snprintf(buf, len, "%s%s-%d", efx->name, type, number); 5607f967c01SBen Hutchings } 561874aeea5SJeff Kirsher 562874aeea5SJeff Kirsher static void efx_set_channel_names(struct efx_nic *efx) 563874aeea5SJeff Kirsher { 564874aeea5SJeff Kirsher struct efx_channel *channel; 565874aeea5SJeff Kirsher 5667f967c01SBen Hutchings efx_for_each_channel(channel, efx) 5677f967c01SBen Hutchings channel->type->get_name(channel, 568d8291187SBen Hutchings efx->msi_context[channel->channel].name, 569d8291187SBen Hutchings sizeof(efx->msi_context[0].name)); 570874aeea5SJeff Kirsher } 571874aeea5SJeff Kirsher 572874aeea5SJeff Kirsher static int efx_probe_channels(struct efx_nic *efx) 573874aeea5SJeff Kirsher { 574874aeea5SJeff Kirsher struct efx_channel *channel; 575874aeea5SJeff Kirsher int rc; 576874aeea5SJeff Kirsher 577874aeea5SJeff Kirsher /* Restart special buffer allocation */ 578874aeea5SJeff Kirsher efx->next_buffer_table = 0; 579874aeea5SJeff Kirsher 580c92aaff1SBen Hutchings /* Probe channels in reverse, so that any 'extra' channels 581c92aaff1SBen Hutchings * use the start of the buffer table. This allows the traffic 582c92aaff1SBen Hutchings * channels to be resized without moving them or wasting the 583c92aaff1SBen Hutchings * entries before them. 584c92aaff1SBen Hutchings */ 585c92aaff1SBen Hutchings efx_for_each_channel_rev(channel, efx) { 586874aeea5SJeff Kirsher rc = efx_probe_channel(channel); 587874aeea5SJeff Kirsher if (rc) { 588874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 589874aeea5SJeff Kirsher "failed to create channel %d\n", 590874aeea5SJeff Kirsher channel->channel); 591874aeea5SJeff Kirsher goto fail; 592874aeea5SJeff Kirsher } 593874aeea5SJeff Kirsher } 594874aeea5SJeff Kirsher efx_set_channel_names(efx); 595874aeea5SJeff Kirsher 596874aeea5SJeff Kirsher return 0; 597874aeea5SJeff Kirsher 598874aeea5SJeff Kirsher fail: 599874aeea5SJeff Kirsher efx_remove_channels(efx); 600874aeea5SJeff Kirsher return rc; 601874aeea5SJeff Kirsher } 602874aeea5SJeff Kirsher 603874aeea5SJeff Kirsher /* Channels are shutdown and reinitialised whilst the NIC is running 604874aeea5SJeff Kirsher * to propagate configuration changes (mtu, checksum offload), or 605874aeea5SJeff Kirsher * to clear hardware error conditions 606874aeea5SJeff Kirsher */ 6079f2cb71cSBen Hutchings static void efx_start_datapath(struct efx_nic *efx) 608874aeea5SJeff Kirsher { 609ebfcd0fdSAndrew Rybchenko netdev_features_t old_features = efx->net_dev->features; 61085740cdfSBen Hutchings bool old_rx_scatter = efx->rx_scatter; 611874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 612874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 613874aeea5SJeff Kirsher struct efx_channel *channel; 61485740cdfSBen Hutchings size_t rx_buf_len; 615874aeea5SJeff Kirsher 616874aeea5SJeff Kirsher /* Calculate the rx buffer allocation parameters required to 617874aeea5SJeff Kirsher * support the current MTU, including padding for header 618874aeea5SJeff Kirsher * alignment and overruns. 619874aeea5SJeff Kirsher */ 62043a3739dSJon Cooper efx->rx_dma_len = (efx->rx_prefix_size + 621874aeea5SJeff Kirsher EFX_MAX_FRAME_LEN(efx->net_dev->mtu) + 622874aeea5SJeff Kirsher efx->type->rx_buffer_padding); 62385740cdfSBen Hutchings rx_buf_len = (sizeof(struct efx_rx_page_state) + 6242ec03014SAndrew Rybchenko efx->rx_ip_align + efx->rx_dma_len); 62585740cdfSBen Hutchings if (rx_buf_len <= PAGE_SIZE) { 626e8c68c0aSJon Cooper efx->rx_scatter = efx->type->always_rx_scatter; 62785740cdfSBen Hutchings efx->rx_buffer_order = 0; 62885740cdfSBen Hutchings } else if (efx->type->can_rx_scatter) { 629950c54dfSBen Hutchings BUILD_BUG_ON(EFX_RX_USR_BUF_SIZE % L1_CACHE_BYTES); 63085740cdfSBen Hutchings BUILD_BUG_ON(sizeof(struct efx_rx_page_state) + 631950c54dfSBen Hutchings 2 * ALIGN(NET_IP_ALIGN + EFX_RX_USR_BUF_SIZE, 632950c54dfSBen Hutchings EFX_RX_BUF_ALIGNMENT) > 633950c54dfSBen Hutchings PAGE_SIZE); 63485740cdfSBen Hutchings efx->rx_scatter = true; 63585740cdfSBen Hutchings efx->rx_dma_len = EFX_RX_USR_BUF_SIZE; 63685740cdfSBen Hutchings efx->rx_buffer_order = 0; 63785740cdfSBen Hutchings } else { 63885740cdfSBen Hutchings efx->rx_scatter = false; 63985740cdfSBen Hutchings efx->rx_buffer_order = get_order(rx_buf_len); 64085740cdfSBen Hutchings } 64185740cdfSBen Hutchings 6421648a23fSDaniel Pieczko efx_rx_config_page_split(efx); 6431648a23fSDaniel Pieczko if (efx->rx_buffer_order) 6441648a23fSDaniel Pieczko netif_dbg(efx, drv, efx->net_dev, 6451648a23fSDaniel Pieczko "RX buf len=%u; page order=%u batch=%u\n", 6461648a23fSDaniel Pieczko efx->rx_dma_len, efx->rx_buffer_order, 6471648a23fSDaniel Pieczko efx->rx_pages_per_batch); 6481648a23fSDaniel Pieczko else 6491648a23fSDaniel Pieczko netif_dbg(efx, drv, efx->net_dev, 6501648a23fSDaniel Pieczko "RX buf len=%u step=%u bpp=%u; page batch=%u\n", 6511648a23fSDaniel Pieczko efx->rx_dma_len, efx->rx_page_buf_step, 6521648a23fSDaniel Pieczko efx->rx_bufs_per_page, efx->rx_pages_per_batch); 6532768935aSDaniel Pieczko 654ebfcd0fdSAndrew Rybchenko /* Restore previously fixed features in hw_features and remove 655ebfcd0fdSAndrew Rybchenko * features which are fixed now 656ebfcd0fdSAndrew Rybchenko */ 657ebfcd0fdSAndrew Rybchenko efx->net_dev->hw_features |= efx->net_dev->features; 658ebfcd0fdSAndrew Rybchenko efx->net_dev->hw_features &= ~efx->fixed_features; 659ebfcd0fdSAndrew Rybchenko efx->net_dev->features |= efx->fixed_features; 660ebfcd0fdSAndrew Rybchenko if (efx->net_dev->features != old_features) 661ebfcd0fdSAndrew Rybchenko netdev_features_change(efx->net_dev); 662ebfcd0fdSAndrew Rybchenko 663e8c68c0aSJon Cooper /* RX filters may also have scatter-enabled flags */ 66485740cdfSBen Hutchings if (efx->rx_scatter != old_rx_scatter) 665add72477SBen Hutchings efx->type->filter_update_rx_scatter(efx); 666874aeea5SJeff Kirsher 66714bf718fSBen Hutchings /* We must keep at least one descriptor in a TX ring empty. 66814bf718fSBen Hutchings * We could avoid this when the queue size does not exactly 66914bf718fSBen Hutchings * match the hardware ring size, but it's not that important. 67014bf718fSBen Hutchings * Therefore we stop the queue when one more skb might fill 67114bf718fSBen Hutchings * the ring completely. We wake it when half way back to 67214bf718fSBen Hutchings * empty. 67314bf718fSBen Hutchings */ 67414bf718fSBen Hutchings efx->txq_stop_thresh = efx->txq_entries - efx_tx_max_skb_descs(efx); 67514bf718fSBen Hutchings efx->txq_wake_thresh = efx->txq_stop_thresh / 2; 67614bf718fSBen Hutchings 677874aeea5SJeff Kirsher /* Initialise the channels */ 678874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 6793881d8abSAlexandre Rames efx_for_each_channel_tx_queue(tx_queue, channel) { 680874aeea5SJeff Kirsher efx_init_tx_queue(tx_queue); 6813881d8abSAlexandre Rames atomic_inc(&efx->active_queues); 6823881d8abSAlexandre Rames } 683874aeea5SJeff Kirsher 6849f2cb71cSBen Hutchings efx_for_each_channel_rx_queue(rx_queue, channel) { 685874aeea5SJeff Kirsher efx_init_rx_queue(rx_queue); 6863881d8abSAlexandre Rames atomic_inc(&efx->active_queues); 687cce28794SJon Cooper efx_stop_eventq(channel); 688cce28794SJon Cooper efx_fast_push_rx_descriptors(rx_queue, false); 689cce28794SJon Cooper efx_start_eventq(channel); 6909f2cb71cSBen Hutchings } 691874aeea5SJeff Kirsher 69285740cdfSBen Hutchings WARN_ON(channel->rx_pkt_n_frags); 693874aeea5SJeff Kirsher } 6949f2cb71cSBen Hutchings 6952ea4dc28SAlexandre Rames efx_ptp_start_datapath(efx); 6962ea4dc28SAlexandre Rames 6979f2cb71cSBen Hutchings if (netif_device_present(efx->net_dev)) 6989f2cb71cSBen Hutchings netif_tx_wake_all_queues(efx->net_dev); 699874aeea5SJeff Kirsher } 700874aeea5SJeff Kirsher 7019f2cb71cSBen Hutchings static void efx_stop_datapath(struct efx_nic *efx) 702874aeea5SJeff Kirsher { 703874aeea5SJeff Kirsher struct efx_channel *channel; 704874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 705874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 706874aeea5SJeff Kirsher int rc; 707874aeea5SJeff Kirsher 708874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 709874aeea5SJeff Kirsher BUG_ON(efx->port_enabled); 710874aeea5SJeff Kirsher 7112ea4dc28SAlexandre Rames efx_ptp_stop_datapath(efx); 7122ea4dc28SAlexandre Rames 713d8aec745SBen Hutchings /* Stop RX refill */ 714d8aec745SBen Hutchings efx_for_each_channel(channel, efx) { 715d8aec745SBen Hutchings efx_for_each_channel_rx_queue(rx_queue, channel) 716d8aec745SBen Hutchings rx_queue->refill_enabled = false; 717d8aec745SBen Hutchings } 718d8aec745SBen Hutchings 719874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 7209f2cb71cSBen Hutchings /* RX packet processing is pipelined, so wait for the 7219f2cb71cSBen Hutchings * NAPI handler to complete. At least event queue 0 7229f2cb71cSBen Hutchings * might be kept active by non-data events, so don't 7239f2cb71cSBen Hutchings * use napi_synchronize() but actually disable NAPI 7249f2cb71cSBen Hutchings * temporarily. 7259f2cb71cSBen Hutchings */ 7269f2cb71cSBen Hutchings if (efx_channel_has_rx_queue(channel)) { 7279f2cb71cSBen Hutchings efx_stop_eventq(channel); 7289f2cb71cSBen Hutchings efx_start_eventq(channel); 7299f2cb71cSBen Hutchings } 730e42c3d85SBen Hutchings } 731874aeea5SJeff Kirsher 732e42c3d85SBen Hutchings rc = efx->type->fini_dmaq(efx); 733e42c3d85SBen Hutchings if (rc && EFX_WORKAROUND_7803(efx)) { 734e42c3d85SBen Hutchings /* Schedule a reset to recover from the flush failure. The 735e42c3d85SBen Hutchings * descriptor caches reference memory we're about to free, 736e42c3d85SBen Hutchings * but falcon_reconfigure_mac_wrapper() won't reconnect 737e42c3d85SBen Hutchings * the MACs because of the pending reset. 738e42c3d85SBen Hutchings */ 739e42c3d85SBen Hutchings netif_err(efx, drv, efx->net_dev, 740e42c3d85SBen Hutchings "Resetting to recover from flush failure\n"); 741e42c3d85SBen Hutchings efx_schedule_reset(efx, RESET_TYPE_ALL); 742e42c3d85SBen Hutchings } else if (rc) { 743e42c3d85SBen Hutchings netif_err(efx, drv, efx->net_dev, "failed to flush queues\n"); 744e42c3d85SBen Hutchings } else { 745e42c3d85SBen Hutchings netif_dbg(efx, drv, efx->net_dev, 746e42c3d85SBen Hutchings "successfully flushed all queues\n"); 747e42c3d85SBen Hutchings } 748e42c3d85SBen Hutchings 749e42c3d85SBen Hutchings efx_for_each_channel(channel, efx) { 750874aeea5SJeff Kirsher efx_for_each_channel_rx_queue(rx_queue, channel) 751874aeea5SJeff Kirsher efx_fini_rx_queue(rx_queue); 752874aeea5SJeff Kirsher efx_for_each_possible_channel_tx_queue(tx_queue, channel) 753874aeea5SJeff Kirsher efx_fini_tx_queue(tx_queue); 754874aeea5SJeff Kirsher } 755874aeea5SJeff Kirsher } 756874aeea5SJeff Kirsher 757874aeea5SJeff Kirsher static void efx_remove_channel(struct efx_channel *channel) 758874aeea5SJeff Kirsher { 759874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 760874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 761874aeea5SJeff Kirsher 762874aeea5SJeff Kirsher netif_dbg(channel->efx, drv, channel->efx->net_dev, 763874aeea5SJeff Kirsher "destroy chan %d\n", channel->channel); 764874aeea5SJeff Kirsher 765874aeea5SJeff Kirsher efx_for_each_channel_rx_queue(rx_queue, channel) 766874aeea5SJeff Kirsher efx_remove_rx_queue(rx_queue); 767874aeea5SJeff Kirsher efx_for_each_possible_channel_tx_queue(tx_queue, channel) 768874aeea5SJeff Kirsher efx_remove_tx_queue(tx_queue); 769874aeea5SJeff Kirsher efx_remove_eventq(channel); 770c31e5f9fSStuart Hodgson channel->type->post_remove(channel); 771874aeea5SJeff Kirsher } 772874aeea5SJeff Kirsher 773874aeea5SJeff Kirsher static void efx_remove_channels(struct efx_nic *efx) 774874aeea5SJeff Kirsher { 775874aeea5SJeff Kirsher struct efx_channel *channel; 776874aeea5SJeff Kirsher 777874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 778874aeea5SJeff Kirsher efx_remove_channel(channel); 779874aeea5SJeff Kirsher } 780874aeea5SJeff Kirsher 781874aeea5SJeff Kirsher int 782874aeea5SJeff Kirsher efx_realloc_channels(struct efx_nic *efx, u32 rxq_entries, u32 txq_entries) 783874aeea5SJeff Kirsher { 784874aeea5SJeff Kirsher struct efx_channel *other_channel[EFX_MAX_CHANNELS], *channel; 785874aeea5SJeff Kirsher u32 old_rxq_entries, old_txq_entries; 7867f967c01SBen Hutchings unsigned i, next_buffer_table = 0; 787261e4d96SJon Cooper int rc, rc2; 7888b7325b4SBen Hutchings 7898b7325b4SBen Hutchings rc = efx_check_disabled(efx); 7908b7325b4SBen Hutchings if (rc) 7918b7325b4SBen Hutchings return rc; 7927f967c01SBen Hutchings 7937f967c01SBen Hutchings /* Not all channels should be reallocated. We must avoid 7947f967c01SBen Hutchings * reallocating their buffer table entries. 7957f967c01SBen Hutchings */ 7967f967c01SBen Hutchings efx_for_each_channel(channel, efx) { 7977f967c01SBen Hutchings struct efx_rx_queue *rx_queue; 7987f967c01SBen Hutchings struct efx_tx_queue *tx_queue; 7997f967c01SBen Hutchings 8007f967c01SBen Hutchings if (channel->type->copy) 8017f967c01SBen Hutchings continue; 8027f967c01SBen Hutchings next_buffer_table = max(next_buffer_table, 8037f967c01SBen Hutchings channel->eventq.index + 8047f967c01SBen Hutchings channel->eventq.entries); 8057f967c01SBen Hutchings efx_for_each_channel_rx_queue(rx_queue, channel) 8067f967c01SBen Hutchings next_buffer_table = max(next_buffer_table, 8077f967c01SBen Hutchings rx_queue->rxd.index + 8087f967c01SBen Hutchings rx_queue->rxd.entries); 8097f967c01SBen Hutchings efx_for_each_channel_tx_queue(tx_queue, channel) 8107f967c01SBen Hutchings next_buffer_table = max(next_buffer_table, 8117f967c01SBen Hutchings tx_queue->txd.index + 8127f967c01SBen Hutchings tx_queue->txd.entries); 8137f967c01SBen Hutchings } 814874aeea5SJeff Kirsher 81529c69a48SBen Hutchings efx_device_detach_sync(efx); 816874aeea5SJeff Kirsher efx_stop_all(efx); 817d8291187SBen Hutchings efx_soft_disable_interrupts(efx); 818874aeea5SJeff Kirsher 8197f967c01SBen Hutchings /* Clone channels (where possible) */ 820874aeea5SJeff Kirsher memset(other_channel, 0, sizeof(other_channel)); 821874aeea5SJeff Kirsher for (i = 0; i < efx->n_channels; i++) { 8227f967c01SBen Hutchings channel = efx->channel[i]; 8237f967c01SBen Hutchings if (channel->type->copy) 8247f967c01SBen Hutchings channel = channel->type->copy(channel); 825874aeea5SJeff Kirsher if (!channel) { 826874aeea5SJeff Kirsher rc = -ENOMEM; 827874aeea5SJeff Kirsher goto out; 828874aeea5SJeff Kirsher } 829874aeea5SJeff Kirsher other_channel[i] = channel; 830874aeea5SJeff Kirsher } 831874aeea5SJeff Kirsher 832874aeea5SJeff Kirsher /* Swap entry counts and channel pointers */ 833874aeea5SJeff Kirsher old_rxq_entries = efx->rxq_entries; 834874aeea5SJeff Kirsher old_txq_entries = efx->txq_entries; 835874aeea5SJeff Kirsher efx->rxq_entries = rxq_entries; 836874aeea5SJeff Kirsher efx->txq_entries = txq_entries; 837874aeea5SJeff Kirsher for (i = 0; i < efx->n_channels; i++) { 838874aeea5SJeff Kirsher channel = efx->channel[i]; 839874aeea5SJeff Kirsher efx->channel[i] = other_channel[i]; 840874aeea5SJeff Kirsher other_channel[i] = channel; 841874aeea5SJeff Kirsher } 842874aeea5SJeff Kirsher 8437f967c01SBen Hutchings /* Restart buffer table allocation */ 8447f967c01SBen Hutchings efx->next_buffer_table = next_buffer_table; 8457f967c01SBen Hutchings 8467f967c01SBen Hutchings for (i = 0; i < efx->n_channels; i++) { 8477f967c01SBen Hutchings channel = efx->channel[i]; 8487f967c01SBen Hutchings if (!channel->type->copy) 8497f967c01SBen Hutchings continue; 8507f967c01SBen Hutchings rc = efx_probe_channel(channel); 851874aeea5SJeff Kirsher if (rc) 852874aeea5SJeff Kirsher goto rollback; 8537f967c01SBen Hutchings efx_init_napi_channel(efx->channel[i]); 854874aeea5SJeff Kirsher } 855874aeea5SJeff Kirsher 8567f967c01SBen Hutchings out: 8577f967c01SBen Hutchings /* Destroy unused channel structures */ 8587f967c01SBen Hutchings for (i = 0; i < efx->n_channels; i++) { 8597f967c01SBen Hutchings channel = other_channel[i]; 8607f967c01SBen Hutchings if (channel && channel->type->copy) { 8617f967c01SBen Hutchings efx_fini_napi_channel(channel); 8627f967c01SBen Hutchings efx_remove_channel(channel); 8637f967c01SBen Hutchings kfree(channel); 8647f967c01SBen Hutchings } 8657f967c01SBen Hutchings } 8667f967c01SBen Hutchings 867261e4d96SJon Cooper rc2 = efx_soft_enable_interrupts(efx); 868261e4d96SJon Cooper if (rc2) { 869261e4d96SJon Cooper rc = rc ? rc : rc2; 870261e4d96SJon Cooper netif_err(efx, drv, efx->net_dev, 871261e4d96SJon Cooper "unable to restart interrupts on channel reallocation\n"); 872261e4d96SJon Cooper efx_schedule_reset(efx, RESET_TYPE_DISABLE); 873261e4d96SJon Cooper } else { 874874aeea5SJeff Kirsher efx_start_all(efx); 87529c69a48SBen Hutchings netif_device_attach(efx->net_dev); 876261e4d96SJon Cooper } 877874aeea5SJeff Kirsher return rc; 878874aeea5SJeff Kirsher 879874aeea5SJeff Kirsher rollback: 880874aeea5SJeff Kirsher /* Swap back */ 881874aeea5SJeff Kirsher efx->rxq_entries = old_rxq_entries; 882874aeea5SJeff Kirsher efx->txq_entries = old_txq_entries; 883874aeea5SJeff Kirsher for (i = 0; i < efx->n_channels; i++) { 884874aeea5SJeff Kirsher channel = efx->channel[i]; 885874aeea5SJeff Kirsher efx->channel[i] = other_channel[i]; 886874aeea5SJeff Kirsher other_channel[i] = channel; 887874aeea5SJeff Kirsher } 888874aeea5SJeff Kirsher goto out; 889874aeea5SJeff Kirsher } 890874aeea5SJeff Kirsher 891874aeea5SJeff Kirsher void efx_schedule_slow_fill(struct efx_rx_queue *rx_queue) 892874aeea5SJeff Kirsher { 893874aeea5SJeff Kirsher mod_timer(&rx_queue->slow_fill, jiffies + msecs_to_jiffies(100)); 894874aeea5SJeff Kirsher } 895874aeea5SJeff Kirsher 8967f967c01SBen Hutchings static const struct efx_channel_type efx_default_channel_type = { 8977f967c01SBen Hutchings .pre_probe = efx_channel_dummy_op_int, 898c31e5f9fSStuart Hodgson .post_remove = efx_channel_dummy_op_void, 8997f967c01SBen Hutchings .get_name = efx_get_channel_name, 9007f967c01SBen Hutchings .copy = efx_copy_channel, 9017f967c01SBen Hutchings .keep_eventq = false, 9027f967c01SBen Hutchings }; 9037f967c01SBen Hutchings 9047f967c01SBen Hutchings int efx_channel_dummy_op_int(struct efx_channel *channel) 9057f967c01SBen Hutchings { 9067f967c01SBen Hutchings return 0; 9077f967c01SBen Hutchings } 9087f967c01SBen Hutchings 909c31e5f9fSStuart Hodgson void efx_channel_dummy_op_void(struct efx_channel *channel) 910c31e5f9fSStuart Hodgson { 911c31e5f9fSStuart Hodgson } 912c31e5f9fSStuart Hodgson 913874aeea5SJeff Kirsher /************************************************************************** 914874aeea5SJeff Kirsher * 915874aeea5SJeff Kirsher * Port handling 916874aeea5SJeff Kirsher * 917874aeea5SJeff Kirsher **************************************************************************/ 918874aeea5SJeff Kirsher 919874aeea5SJeff Kirsher /* This ensures that the kernel is kept informed (via 920874aeea5SJeff Kirsher * netif_carrier_on/off) of the link status, and also maintains the 921874aeea5SJeff Kirsher * link status's stop on the port's TX queue. 922874aeea5SJeff Kirsher */ 923874aeea5SJeff Kirsher void efx_link_status_changed(struct efx_nic *efx) 924874aeea5SJeff Kirsher { 925874aeea5SJeff Kirsher struct efx_link_state *link_state = &efx->link_state; 926874aeea5SJeff Kirsher 927874aeea5SJeff Kirsher /* SFC Bug 5356: A net_dev notifier is registered, so we must ensure 928874aeea5SJeff Kirsher * that no events are triggered between unregister_netdev() and the 929874aeea5SJeff Kirsher * driver unloading. A more general condition is that NETDEV_CHANGE 930874aeea5SJeff Kirsher * can only be generated between NETDEV_UP and NETDEV_DOWN */ 931874aeea5SJeff Kirsher if (!netif_running(efx->net_dev)) 932874aeea5SJeff Kirsher return; 933874aeea5SJeff Kirsher 934874aeea5SJeff Kirsher if (link_state->up != netif_carrier_ok(efx->net_dev)) { 935874aeea5SJeff Kirsher efx->n_link_state_changes++; 936874aeea5SJeff Kirsher 937874aeea5SJeff Kirsher if (link_state->up) 938874aeea5SJeff Kirsher netif_carrier_on(efx->net_dev); 939874aeea5SJeff Kirsher else 940874aeea5SJeff Kirsher netif_carrier_off(efx->net_dev); 941874aeea5SJeff Kirsher } 942874aeea5SJeff Kirsher 943874aeea5SJeff Kirsher /* Status message for kernel log */ 9442aa9ef11SBen Hutchings if (link_state->up) 945874aeea5SJeff Kirsher netif_info(efx, link, efx->net_dev, 946964e6135SBen Hutchings "link up at %uMbps %s-duplex (MTU %d)\n", 947874aeea5SJeff Kirsher link_state->speed, link_state->fd ? "full" : "half", 948964e6135SBen Hutchings efx->net_dev->mtu); 9492aa9ef11SBen Hutchings else 950874aeea5SJeff Kirsher netif_info(efx, link, efx->net_dev, "link down\n"); 951874aeea5SJeff Kirsher } 952874aeea5SJeff Kirsher 953874aeea5SJeff Kirsher void efx_link_set_advertising(struct efx_nic *efx, u32 advertising) 954874aeea5SJeff Kirsher { 955874aeea5SJeff Kirsher efx->link_advertising = advertising; 956874aeea5SJeff Kirsher if (advertising) { 957874aeea5SJeff Kirsher if (advertising & ADVERTISED_Pause) 958874aeea5SJeff Kirsher efx->wanted_fc |= (EFX_FC_TX | EFX_FC_RX); 959874aeea5SJeff Kirsher else 960874aeea5SJeff Kirsher efx->wanted_fc &= ~(EFX_FC_TX | EFX_FC_RX); 961874aeea5SJeff Kirsher if (advertising & ADVERTISED_Asym_Pause) 962874aeea5SJeff Kirsher efx->wanted_fc ^= EFX_FC_TX; 963874aeea5SJeff Kirsher } 964874aeea5SJeff Kirsher } 965874aeea5SJeff Kirsher 966874aeea5SJeff Kirsher void efx_link_set_wanted_fc(struct efx_nic *efx, u8 wanted_fc) 967874aeea5SJeff Kirsher { 968874aeea5SJeff Kirsher efx->wanted_fc = wanted_fc; 969874aeea5SJeff Kirsher if (efx->link_advertising) { 970874aeea5SJeff Kirsher if (wanted_fc & EFX_FC_RX) 971874aeea5SJeff Kirsher efx->link_advertising |= (ADVERTISED_Pause | 972874aeea5SJeff Kirsher ADVERTISED_Asym_Pause); 973874aeea5SJeff Kirsher else 974874aeea5SJeff Kirsher efx->link_advertising &= ~(ADVERTISED_Pause | 975874aeea5SJeff Kirsher ADVERTISED_Asym_Pause); 976874aeea5SJeff Kirsher if (wanted_fc & EFX_FC_TX) 977874aeea5SJeff Kirsher efx->link_advertising ^= ADVERTISED_Asym_Pause; 978874aeea5SJeff Kirsher } 979874aeea5SJeff Kirsher } 980874aeea5SJeff Kirsher 981874aeea5SJeff Kirsher static void efx_fini_port(struct efx_nic *efx); 982874aeea5SJeff Kirsher 9830d322413SEdward Cree /* We assume that efx->type->reconfigure_mac will always try to sync RX 9840d322413SEdward Cree * filters and therefore needs to read-lock the filter table against freeing 9850d322413SEdward Cree */ 9860d322413SEdward Cree void efx_mac_reconfigure(struct efx_nic *efx) 9870d322413SEdward Cree { 9880d322413SEdward Cree down_read(&efx->filter_sem); 9890d322413SEdward Cree efx->type->reconfigure_mac(efx); 9900d322413SEdward Cree up_read(&efx->filter_sem); 9910d322413SEdward Cree } 9920d322413SEdward Cree 993874aeea5SJeff Kirsher /* Push loopback/power/transmit disable settings to the PHY, and reconfigure 994874aeea5SJeff Kirsher * the MAC appropriately. All other PHY configuration changes are pushed 995874aeea5SJeff Kirsher * through phy_op->set_settings(), and pushed asynchronously to the MAC 996874aeea5SJeff Kirsher * through efx_monitor(). 997874aeea5SJeff Kirsher * 998874aeea5SJeff Kirsher * Callers must hold the mac_lock 999874aeea5SJeff Kirsher */ 1000874aeea5SJeff Kirsher int __efx_reconfigure_port(struct efx_nic *efx) 1001874aeea5SJeff Kirsher { 1002874aeea5SJeff Kirsher enum efx_phy_mode phy_mode; 1003874aeea5SJeff Kirsher int rc; 1004874aeea5SJeff Kirsher 1005874aeea5SJeff Kirsher WARN_ON(!mutex_is_locked(&efx->mac_lock)); 1006874aeea5SJeff Kirsher 1007874aeea5SJeff Kirsher /* Disable PHY transmit in mac level loopbacks */ 1008874aeea5SJeff Kirsher phy_mode = efx->phy_mode; 1009874aeea5SJeff Kirsher if (LOOPBACK_INTERNAL(efx)) 1010874aeea5SJeff Kirsher efx->phy_mode |= PHY_MODE_TX_DISABLED; 1011874aeea5SJeff Kirsher else 1012874aeea5SJeff Kirsher efx->phy_mode &= ~PHY_MODE_TX_DISABLED; 1013874aeea5SJeff Kirsher 1014874aeea5SJeff Kirsher rc = efx->type->reconfigure_port(efx); 1015874aeea5SJeff Kirsher 1016874aeea5SJeff Kirsher if (rc) 1017874aeea5SJeff Kirsher efx->phy_mode = phy_mode; 1018874aeea5SJeff Kirsher 1019874aeea5SJeff Kirsher return rc; 1020874aeea5SJeff Kirsher } 1021874aeea5SJeff Kirsher 1022874aeea5SJeff Kirsher /* Reinitialise the MAC to pick up new PHY settings, even if the port is 1023874aeea5SJeff Kirsher * disabled. */ 1024874aeea5SJeff Kirsher int efx_reconfigure_port(struct efx_nic *efx) 1025874aeea5SJeff Kirsher { 1026874aeea5SJeff Kirsher int rc; 1027874aeea5SJeff Kirsher 1028874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 1029874aeea5SJeff Kirsher 1030874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1031874aeea5SJeff Kirsher rc = __efx_reconfigure_port(efx); 1032874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1033874aeea5SJeff Kirsher 1034874aeea5SJeff Kirsher return rc; 1035874aeea5SJeff Kirsher } 1036874aeea5SJeff Kirsher 1037874aeea5SJeff Kirsher /* Asynchronous work item for changing MAC promiscuity and multicast 1038874aeea5SJeff Kirsher * hash. Avoid a drain/rx_ingress enable by reconfiguring the current 1039874aeea5SJeff Kirsher * MAC directly. */ 1040874aeea5SJeff Kirsher static void efx_mac_work(struct work_struct *data) 1041874aeea5SJeff Kirsher { 1042874aeea5SJeff Kirsher struct efx_nic *efx = container_of(data, struct efx_nic, mac_work); 1043874aeea5SJeff Kirsher 1044874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 104530b81cdaSBen Hutchings if (efx->port_enabled) 10460d322413SEdward Cree efx_mac_reconfigure(efx); 1047874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1048874aeea5SJeff Kirsher } 1049874aeea5SJeff Kirsher 1050874aeea5SJeff Kirsher static int efx_probe_port(struct efx_nic *efx) 1051874aeea5SJeff Kirsher { 1052874aeea5SJeff Kirsher int rc; 1053874aeea5SJeff Kirsher 1054874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "create port\n"); 1055874aeea5SJeff Kirsher 1056874aeea5SJeff Kirsher if (phy_flash_cfg) 1057874aeea5SJeff Kirsher efx->phy_mode = PHY_MODE_SPECIAL; 1058874aeea5SJeff Kirsher 1059874aeea5SJeff Kirsher /* Connect up MAC/PHY operations table */ 1060874aeea5SJeff Kirsher rc = efx->type->probe_port(efx); 1061874aeea5SJeff Kirsher if (rc) 1062874aeea5SJeff Kirsher return rc; 1063874aeea5SJeff Kirsher 1064e332bcb3SBen Hutchings /* Initialise MAC address to permanent address */ 1065cd84ff4dSEdward Cree ether_addr_copy(efx->net_dev->dev_addr, efx->net_dev->perm_addr); 1066874aeea5SJeff Kirsher 1067874aeea5SJeff Kirsher return 0; 1068874aeea5SJeff Kirsher } 1069874aeea5SJeff Kirsher 1070874aeea5SJeff Kirsher static int efx_init_port(struct efx_nic *efx) 1071874aeea5SJeff Kirsher { 1072874aeea5SJeff Kirsher int rc; 1073874aeea5SJeff Kirsher 1074874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "init port\n"); 1075874aeea5SJeff Kirsher 1076874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1077874aeea5SJeff Kirsher 1078874aeea5SJeff Kirsher rc = efx->phy_op->init(efx); 1079874aeea5SJeff Kirsher if (rc) 1080874aeea5SJeff Kirsher goto fail1; 1081874aeea5SJeff Kirsher 1082874aeea5SJeff Kirsher efx->port_initialized = true; 1083874aeea5SJeff Kirsher 1084874aeea5SJeff Kirsher /* Reconfigure the MAC before creating dma queues (required for 1085874aeea5SJeff Kirsher * Falcon/A1 where RX_INGR_EN/TX_DRAIN_EN isn't supported) */ 10860d322413SEdward Cree efx_mac_reconfigure(efx); 1087874aeea5SJeff Kirsher 1088874aeea5SJeff Kirsher /* Ensure the PHY advertises the correct flow control settings */ 1089874aeea5SJeff Kirsher rc = efx->phy_op->reconfigure(efx); 1090267d9d73SEdward Cree if (rc && rc != -EPERM) 1091874aeea5SJeff Kirsher goto fail2; 1092874aeea5SJeff Kirsher 1093874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1094874aeea5SJeff Kirsher return 0; 1095874aeea5SJeff Kirsher 1096874aeea5SJeff Kirsher fail2: 1097874aeea5SJeff Kirsher efx->phy_op->fini(efx); 1098874aeea5SJeff Kirsher fail1: 1099874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1100874aeea5SJeff Kirsher return rc; 1101874aeea5SJeff Kirsher } 1102874aeea5SJeff Kirsher 1103874aeea5SJeff Kirsher static void efx_start_port(struct efx_nic *efx) 1104874aeea5SJeff Kirsher { 1105874aeea5SJeff Kirsher netif_dbg(efx, ifup, efx->net_dev, "start port\n"); 1106874aeea5SJeff Kirsher BUG_ON(efx->port_enabled); 1107874aeea5SJeff Kirsher 1108874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1109874aeea5SJeff Kirsher efx->port_enabled = true; 1110874aeea5SJeff Kirsher 1111d615c039SBen Hutchings /* Ensure MAC ingress/egress is enabled */ 11120d322413SEdward Cree efx_mac_reconfigure(efx); 1113874aeea5SJeff Kirsher 1114874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1115874aeea5SJeff Kirsher } 1116874aeea5SJeff Kirsher 1117d615c039SBen Hutchings /* Cancel work for MAC reconfiguration, periodic hardware monitoring 1118d615c039SBen Hutchings * and the async self-test, wait for them to finish and prevent them 1119d615c039SBen Hutchings * being scheduled again. This doesn't cover online resets, which 1120d615c039SBen Hutchings * should only be cancelled when removing the device. 1121d615c039SBen Hutchings */ 1122874aeea5SJeff Kirsher static void efx_stop_port(struct efx_nic *efx) 1123874aeea5SJeff Kirsher { 1124874aeea5SJeff Kirsher netif_dbg(efx, ifdown, efx->net_dev, "stop port\n"); 1125874aeea5SJeff Kirsher 1126d615c039SBen Hutchings EFX_ASSERT_RESET_SERIALISED(efx); 1127d615c039SBen Hutchings 1128874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1129874aeea5SJeff Kirsher efx->port_enabled = false; 1130874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1131874aeea5SJeff Kirsher 1132874aeea5SJeff Kirsher /* Serialise against efx_set_multicast_list() */ 1133874aeea5SJeff Kirsher netif_addr_lock_bh(efx->net_dev); 1134874aeea5SJeff Kirsher netif_addr_unlock_bh(efx->net_dev); 1135d615c039SBen Hutchings 1136d615c039SBen Hutchings cancel_delayed_work_sync(&efx->monitor_work); 1137d615c039SBen Hutchings efx_selftest_async_cancel(efx); 1138d615c039SBen Hutchings cancel_work_sync(&efx->mac_work); 1139874aeea5SJeff Kirsher } 1140874aeea5SJeff Kirsher 1141874aeea5SJeff Kirsher static void efx_fini_port(struct efx_nic *efx) 1142874aeea5SJeff Kirsher { 1143874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "shut down port\n"); 1144874aeea5SJeff Kirsher 1145874aeea5SJeff Kirsher if (!efx->port_initialized) 1146874aeea5SJeff Kirsher return; 1147874aeea5SJeff Kirsher 1148874aeea5SJeff Kirsher efx->phy_op->fini(efx); 1149874aeea5SJeff Kirsher efx->port_initialized = false; 1150874aeea5SJeff Kirsher 1151874aeea5SJeff Kirsher efx->link_state.up = false; 1152874aeea5SJeff Kirsher efx_link_status_changed(efx); 1153874aeea5SJeff Kirsher } 1154874aeea5SJeff Kirsher 1155874aeea5SJeff Kirsher static void efx_remove_port(struct efx_nic *efx) 1156874aeea5SJeff Kirsher { 1157874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "destroying port\n"); 1158874aeea5SJeff Kirsher 1159874aeea5SJeff Kirsher efx->type->remove_port(efx); 1160874aeea5SJeff Kirsher } 1161874aeea5SJeff Kirsher 1162874aeea5SJeff Kirsher /************************************************************************** 1163874aeea5SJeff Kirsher * 1164874aeea5SJeff Kirsher * NIC handling 1165874aeea5SJeff Kirsher * 1166874aeea5SJeff Kirsher **************************************************************************/ 1167874aeea5SJeff Kirsher 11680bcf4a64SBen Hutchings static LIST_HEAD(efx_primary_list); 11690bcf4a64SBen Hutchings static LIST_HEAD(efx_unassociated_list); 11700bcf4a64SBen Hutchings 11710bcf4a64SBen Hutchings static bool efx_same_controller(struct efx_nic *left, struct efx_nic *right) 11720bcf4a64SBen Hutchings { 11730bcf4a64SBen Hutchings return left->type == right->type && 11740bcf4a64SBen Hutchings left->vpd_sn && right->vpd_sn && 11750bcf4a64SBen Hutchings !strcmp(left->vpd_sn, right->vpd_sn); 11760bcf4a64SBen Hutchings } 11770bcf4a64SBen Hutchings 11780bcf4a64SBen Hutchings static void efx_associate(struct efx_nic *efx) 11790bcf4a64SBen Hutchings { 11800bcf4a64SBen Hutchings struct efx_nic *other, *next; 11810bcf4a64SBen Hutchings 11820bcf4a64SBen Hutchings if (efx->primary == efx) { 11830bcf4a64SBen Hutchings /* Adding primary function; look for secondaries */ 11840bcf4a64SBen Hutchings 11850bcf4a64SBen Hutchings netif_dbg(efx, probe, efx->net_dev, "adding to primary list\n"); 11860bcf4a64SBen Hutchings list_add_tail(&efx->node, &efx_primary_list); 11870bcf4a64SBen Hutchings 11880bcf4a64SBen Hutchings list_for_each_entry_safe(other, next, &efx_unassociated_list, 11890bcf4a64SBen Hutchings node) { 11900bcf4a64SBen Hutchings if (efx_same_controller(efx, other)) { 11910bcf4a64SBen Hutchings list_del(&other->node); 11920bcf4a64SBen Hutchings netif_dbg(other, probe, other->net_dev, 11930bcf4a64SBen Hutchings "moving to secondary list of %s %s\n", 11940bcf4a64SBen Hutchings pci_name(efx->pci_dev), 11950bcf4a64SBen Hutchings efx->net_dev->name); 11960bcf4a64SBen Hutchings list_add_tail(&other->node, 11970bcf4a64SBen Hutchings &efx->secondary_list); 11980bcf4a64SBen Hutchings other->primary = efx; 11990bcf4a64SBen Hutchings } 12000bcf4a64SBen Hutchings } 12010bcf4a64SBen Hutchings } else { 12020bcf4a64SBen Hutchings /* Adding secondary function; look for primary */ 12030bcf4a64SBen Hutchings 12040bcf4a64SBen Hutchings list_for_each_entry(other, &efx_primary_list, node) { 12050bcf4a64SBen Hutchings if (efx_same_controller(efx, other)) { 12060bcf4a64SBen Hutchings netif_dbg(efx, probe, efx->net_dev, 12070bcf4a64SBen Hutchings "adding to secondary list of %s %s\n", 12080bcf4a64SBen Hutchings pci_name(other->pci_dev), 12090bcf4a64SBen Hutchings other->net_dev->name); 12100bcf4a64SBen Hutchings list_add_tail(&efx->node, 12110bcf4a64SBen Hutchings &other->secondary_list); 12120bcf4a64SBen Hutchings efx->primary = other; 12130bcf4a64SBen Hutchings return; 12140bcf4a64SBen Hutchings } 12150bcf4a64SBen Hutchings } 12160bcf4a64SBen Hutchings 12170bcf4a64SBen Hutchings netif_dbg(efx, probe, efx->net_dev, 12180bcf4a64SBen Hutchings "adding to unassociated list\n"); 12190bcf4a64SBen Hutchings list_add_tail(&efx->node, &efx_unassociated_list); 12200bcf4a64SBen Hutchings } 12210bcf4a64SBen Hutchings } 12220bcf4a64SBen Hutchings 12230bcf4a64SBen Hutchings static void efx_dissociate(struct efx_nic *efx) 12240bcf4a64SBen Hutchings { 12250bcf4a64SBen Hutchings struct efx_nic *other, *next; 12260bcf4a64SBen Hutchings 12270bcf4a64SBen Hutchings list_del(&efx->node); 12280bcf4a64SBen Hutchings efx->primary = NULL; 12290bcf4a64SBen Hutchings 12300bcf4a64SBen Hutchings list_for_each_entry_safe(other, next, &efx->secondary_list, node) { 12310bcf4a64SBen Hutchings list_del(&other->node); 12320bcf4a64SBen Hutchings netif_dbg(other, probe, other->net_dev, 12330bcf4a64SBen Hutchings "moving to unassociated list\n"); 12340bcf4a64SBen Hutchings list_add_tail(&other->node, &efx_unassociated_list); 12350bcf4a64SBen Hutchings other->primary = NULL; 12360bcf4a64SBen Hutchings } 12370bcf4a64SBen Hutchings } 12380bcf4a64SBen Hutchings 1239874aeea5SJeff Kirsher /* This configures the PCI device to enable I/O and DMA. */ 1240874aeea5SJeff Kirsher static int efx_init_io(struct efx_nic *efx) 1241874aeea5SJeff Kirsher { 1242874aeea5SJeff Kirsher struct pci_dev *pci_dev = efx->pci_dev; 1243874aeea5SJeff Kirsher dma_addr_t dma_mask = efx->type->max_dma_mask; 1244b105798fSBen Hutchings unsigned int mem_map_size = efx->type->mem_map_size(efx); 124502246a7fSShradha Shah int rc, bar; 1246874aeea5SJeff Kirsher 1247874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "initialising I/O\n"); 1248874aeea5SJeff Kirsher 124902246a7fSShradha Shah bar = efx->type->mem_bar; 125002246a7fSShradha Shah 1251874aeea5SJeff Kirsher rc = pci_enable_device(pci_dev); 1252874aeea5SJeff Kirsher if (rc) { 1253874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1254874aeea5SJeff Kirsher "failed to enable PCI device\n"); 1255874aeea5SJeff Kirsher goto fail1; 1256874aeea5SJeff Kirsher } 1257874aeea5SJeff Kirsher 1258874aeea5SJeff Kirsher pci_set_master(pci_dev); 1259874aeea5SJeff Kirsher 1260874aeea5SJeff Kirsher /* Set the PCI DMA mask. Try all possibilities from our 1261874aeea5SJeff Kirsher * genuine mask down to 32 bits, because some architectures 1262874aeea5SJeff Kirsher * (e.g. x86_64 with iommu_sac_force set) will allow 40 bit 1263874aeea5SJeff Kirsher * masks event though they reject 46 bit masks. 1264874aeea5SJeff Kirsher */ 1265874aeea5SJeff Kirsher while (dma_mask > 0x7fffffffUL) { 12669663dedaSRussell King rc = dma_set_mask_and_coherent(&pci_dev->dev, dma_mask); 1267e9e01846SBen Hutchings if (rc == 0) 1268874aeea5SJeff Kirsher break; 1269874aeea5SJeff Kirsher dma_mask >>= 1; 1270874aeea5SJeff Kirsher } 1271874aeea5SJeff Kirsher if (rc) { 1272874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1273874aeea5SJeff Kirsher "could not find a suitable DMA mask\n"); 1274874aeea5SJeff Kirsher goto fail2; 1275874aeea5SJeff Kirsher } 1276874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, 1277874aeea5SJeff Kirsher "using DMA mask %llx\n", (unsigned long long) dma_mask); 1278874aeea5SJeff Kirsher 127902246a7fSShradha Shah efx->membase_phys = pci_resource_start(efx->pci_dev, bar); 128002246a7fSShradha Shah rc = pci_request_region(pci_dev, bar, "sfc"); 1281874aeea5SJeff Kirsher if (rc) { 1282874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1283874aeea5SJeff Kirsher "request for memory BAR failed\n"); 1284874aeea5SJeff Kirsher rc = -EIO; 1285874aeea5SJeff Kirsher goto fail3; 1286874aeea5SJeff Kirsher } 1287b105798fSBen Hutchings efx->membase = ioremap_nocache(efx->membase_phys, mem_map_size); 1288874aeea5SJeff Kirsher if (!efx->membase) { 1289874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1290874aeea5SJeff Kirsher "could not map memory BAR at %llx+%x\n", 1291b105798fSBen Hutchings (unsigned long long)efx->membase_phys, mem_map_size); 1292874aeea5SJeff Kirsher rc = -ENOMEM; 1293874aeea5SJeff Kirsher goto fail4; 1294874aeea5SJeff Kirsher } 1295874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, 1296874aeea5SJeff Kirsher "memory BAR at %llx+%x (virtual %p)\n", 1297b105798fSBen Hutchings (unsigned long long)efx->membase_phys, mem_map_size, 1298b105798fSBen Hutchings efx->membase); 1299874aeea5SJeff Kirsher 1300874aeea5SJeff Kirsher return 0; 1301874aeea5SJeff Kirsher 1302874aeea5SJeff Kirsher fail4: 130302246a7fSShradha Shah pci_release_region(efx->pci_dev, bar); 1304874aeea5SJeff Kirsher fail3: 1305874aeea5SJeff Kirsher efx->membase_phys = 0; 1306874aeea5SJeff Kirsher fail2: 1307874aeea5SJeff Kirsher pci_disable_device(efx->pci_dev); 1308874aeea5SJeff Kirsher fail1: 1309874aeea5SJeff Kirsher return rc; 1310874aeea5SJeff Kirsher } 1311874aeea5SJeff Kirsher 1312874aeea5SJeff Kirsher static void efx_fini_io(struct efx_nic *efx) 1313874aeea5SJeff Kirsher { 131402246a7fSShradha Shah int bar; 131502246a7fSShradha Shah 1316874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "shutting down I/O\n"); 1317874aeea5SJeff Kirsher 1318874aeea5SJeff Kirsher if (efx->membase) { 1319874aeea5SJeff Kirsher iounmap(efx->membase); 1320874aeea5SJeff Kirsher efx->membase = NULL; 1321874aeea5SJeff Kirsher } 1322874aeea5SJeff Kirsher 1323874aeea5SJeff Kirsher if (efx->membase_phys) { 132402246a7fSShradha Shah bar = efx->type->mem_bar; 132502246a7fSShradha Shah pci_release_region(efx->pci_dev, bar); 1326874aeea5SJeff Kirsher efx->membase_phys = 0; 1327874aeea5SJeff Kirsher } 1328874aeea5SJeff Kirsher 13296598dad2SDaniel Pieczko /* Don't disable bus-mastering if VFs are assigned */ 13306598dad2SDaniel Pieczko if (!pci_vfs_assigned(efx->pci_dev)) 1331874aeea5SJeff Kirsher pci_disable_device(efx->pci_dev); 1332874aeea5SJeff Kirsher } 1333874aeea5SJeff Kirsher 1334267c0157SJon Cooper void efx_set_default_rx_indir_table(struct efx_nic *efx) 1335267c0157SJon Cooper { 1336267c0157SJon Cooper size_t i; 1337267c0157SJon Cooper 1338267c0157SJon Cooper for (i = 0; i < ARRAY_SIZE(efx->rx_indir_table); i++) 1339267c0157SJon Cooper efx->rx_indir_table[i] = 1340267c0157SJon Cooper ethtool_rxfh_indir_default(i, efx->rss_spread); 1341267c0157SJon Cooper } 1342267c0157SJon Cooper 1343a9a52506SBen Hutchings static unsigned int efx_wanted_parallelism(struct efx_nic *efx) 1344874aeea5SJeff Kirsher { 1345cdb08f8fSBen Hutchings cpumask_var_t thread_mask; 1346a16e5b24SBen Hutchings unsigned int count; 1347874aeea5SJeff Kirsher int cpu; 1348874aeea5SJeff Kirsher 1349cd2d5b52SBen Hutchings if (rss_cpus) { 1350cd2d5b52SBen Hutchings count = rss_cpus; 1351cd2d5b52SBen Hutchings } else { 1352cdb08f8fSBen Hutchings if (unlikely(!zalloc_cpumask_var(&thread_mask, GFP_KERNEL))) { 1353a9a52506SBen Hutchings netif_warn(efx, probe, efx->net_dev, 1354a9a52506SBen Hutchings "RSS disabled due to allocation failure\n"); 1355874aeea5SJeff Kirsher return 1; 1356874aeea5SJeff Kirsher } 1357874aeea5SJeff Kirsher 1358874aeea5SJeff Kirsher count = 0; 1359874aeea5SJeff Kirsher for_each_online_cpu(cpu) { 1360cdb08f8fSBen Hutchings if (!cpumask_test_cpu(cpu, thread_mask)) { 1361874aeea5SJeff Kirsher ++count; 1362cdb08f8fSBen Hutchings cpumask_or(thread_mask, thread_mask, 136306931e62SBartosz Golaszewski topology_sibling_cpumask(cpu)); 1364874aeea5SJeff Kirsher } 1365874aeea5SJeff Kirsher } 1366874aeea5SJeff Kirsher 1367cdb08f8fSBen Hutchings free_cpumask_var(thread_mask); 1368cd2d5b52SBen Hutchings } 1369cd2d5b52SBen Hutchings 1370cd2d5b52SBen Hutchings /* If RSS is requested for the PF *and* VFs then we can't write RSS 1371cd2d5b52SBen Hutchings * table entries that are inaccessible to VFs 1372cd2d5b52SBen Hutchings */ 13737fa8d547SShradha Shah #ifdef CONFIG_SFC_SRIOV 13747fa8d547SShradha Shah if (efx->type->sriov_wanted) { 1375d98a4ffeSShradha Shah if (efx->type->sriov_wanted(efx) && efx_vf_size(efx) > 1 && 1376cd2d5b52SBen Hutchings count > efx_vf_size(efx)) { 1377cd2d5b52SBen Hutchings netif_warn(efx, probe, efx->net_dev, 1378cd2d5b52SBen Hutchings "Reducing number of RSS channels from %u to %u for " 1379cd2d5b52SBen Hutchings "VF support. Increase vf-msix-limit to use more " 1380cd2d5b52SBen Hutchings "channels on the PF.\n", 1381cd2d5b52SBen Hutchings count, efx_vf_size(efx)); 1382cd2d5b52SBen Hutchings count = efx_vf_size(efx); 1383cd2d5b52SBen Hutchings } 13847fa8d547SShradha Shah } 13857fa8d547SShradha Shah #endif 1386cd2d5b52SBen Hutchings 1387874aeea5SJeff Kirsher return count; 1388874aeea5SJeff Kirsher } 1389874aeea5SJeff Kirsher 1390874aeea5SJeff Kirsher /* Probe the number and type of interrupts we are able to obtain, and 1391874aeea5SJeff Kirsher * the resulting numbers of channels and RX queues. 1392874aeea5SJeff Kirsher */ 1393874aeea5SJeff Kirsher static int efx_probe_interrupts(struct efx_nic *efx) 1394874aeea5SJeff Kirsher { 13957f967c01SBen Hutchings unsigned int extra_channels = 0; 13967f967c01SBen Hutchings unsigned int i, j; 1397a16e5b24SBen Hutchings int rc; 1398874aeea5SJeff Kirsher 13997f967c01SBen Hutchings for (i = 0; i < EFX_MAX_EXTRA_CHANNELS; i++) 14007f967c01SBen Hutchings if (efx->extra_channel_type[i]) 14017f967c01SBen Hutchings ++extra_channels; 14027f967c01SBen Hutchings 1403874aeea5SJeff Kirsher if (efx->interrupt_mode == EFX_INT_MODE_MSIX) { 1404874aeea5SJeff Kirsher struct msix_entry xentries[EFX_MAX_CHANNELS]; 1405a16e5b24SBen Hutchings unsigned int n_channels; 1406874aeea5SJeff Kirsher 1407a9a52506SBen Hutchings n_channels = efx_wanted_parallelism(efx); 1408b0fbdae1SShradha Shah if (efx_separate_tx_channels) 1409874aeea5SJeff Kirsher n_channels *= 2; 14107f967c01SBen Hutchings n_channels += extra_channels; 1411b105798fSBen Hutchings n_channels = min(n_channels, efx->max_channels); 1412874aeea5SJeff Kirsher 1413874aeea5SJeff Kirsher for (i = 0; i < n_channels; i++) 1414874aeea5SJeff Kirsher xentries[i].entry = i; 1415184603d8SAlexander Gordeev rc = pci_enable_msix_range(efx->pci_dev, 1416184603d8SAlexander Gordeev xentries, 1, n_channels); 1417184603d8SAlexander Gordeev if (rc < 0) { 1418184603d8SAlexander Gordeev /* Fall back to single channel MSI */ 1419184603d8SAlexander Gordeev efx->interrupt_mode = EFX_INT_MODE_MSI; 1420184603d8SAlexander Gordeev netif_err(efx, drv, efx->net_dev, 1421184603d8SAlexander Gordeev "could not enable MSI-X\n"); 1422184603d8SAlexander Gordeev } else if (rc < n_channels) { 1423874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 1424874aeea5SJeff Kirsher "WARNING: Insufficient MSI-X vectors" 1425a16e5b24SBen Hutchings " available (%d < %u).\n", rc, n_channels); 1426874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 1427874aeea5SJeff Kirsher "WARNING: Performance may be reduced.\n"); 1428874aeea5SJeff Kirsher n_channels = rc; 1429874aeea5SJeff Kirsher } 1430874aeea5SJeff Kirsher 1431184603d8SAlexander Gordeev if (rc > 0) { 1432874aeea5SJeff Kirsher efx->n_channels = n_channels; 14337f967c01SBen Hutchings if (n_channels > extra_channels) 14347f967c01SBen Hutchings n_channels -= extra_channels; 1435b0fbdae1SShradha Shah if (efx_separate_tx_channels) { 1436b0fbdae1SShradha Shah efx->n_tx_channels = min(max(n_channels / 2, 1437b0fbdae1SShradha Shah 1U), 1438b0fbdae1SShradha Shah efx->max_tx_channels); 14397f967c01SBen Hutchings efx->n_rx_channels = max(n_channels - 14407f967c01SBen Hutchings efx->n_tx_channels, 14417f967c01SBen Hutchings 1U); 1442874aeea5SJeff Kirsher } else { 1443b0fbdae1SShradha Shah efx->n_tx_channels = min(n_channels, 1444b0fbdae1SShradha Shah efx->max_tx_channels); 14457f967c01SBen Hutchings efx->n_rx_channels = n_channels; 1446874aeea5SJeff Kirsher } 14477f967c01SBen Hutchings for (i = 0; i < efx->n_channels; i++) 1448874aeea5SJeff Kirsher efx_get_channel(efx, i)->irq = 1449874aeea5SJeff Kirsher xentries[i].vector; 1450874aeea5SJeff Kirsher } 1451874aeea5SJeff Kirsher } 1452874aeea5SJeff Kirsher 1453874aeea5SJeff Kirsher /* Try single interrupt MSI */ 1454874aeea5SJeff Kirsher if (efx->interrupt_mode == EFX_INT_MODE_MSI) { 1455874aeea5SJeff Kirsher efx->n_channels = 1; 1456874aeea5SJeff Kirsher efx->n_rx_channels = 1; 1457874aeea5SJeff Kirsher efx->n_tx_channels = 1; 1458874aeea5SJeff Kirsher rc = pci_enable_msi(efx->pci_dev); 1459874aeea5SJeff Kirsher if (rc == 0) { 1460874aeea5SJeff Kirsher efx_get_channel(efx, 0)->irq = efx->pci_dev->irq; 1461874aeea5SJeff Kirsher } else { 1462874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 1463874aeea5SJeff Kirsher "could not enable MSI\n"); 1464874aeea5SJeff Kirsher efx->interrupt_mode = EFX_INT_MODE_LEGACY; 1465874aeea5SJeff Kirsher } 1466874aeea5SJeff Kirsher } 1467874aeea5SJeff Kirsher 1468874aeea5SJeff Kirsher /* Assume legacy interrupts */ 1469874aeea5SJeff Kirsher if (efx->interrupt_mode == EFX_INT_MODE_LEGACY) { 1470b0fbdae1SShradha Shah efx->n_channels = 1 + (efx_separate_tx_channels ? 1 : 0); 1471874aeea5SJeff Kirsher efx->n_rx_channels = 1; 1472874aeea5SJeff Kirsher efx->n_tx_channels = 1; 1473874aeea5SJeff Kirsher efx->legacy_irq = efx->pci_dev->irq; 1474874aeea5SJeff Kirsher } 1475874aeea5SJeff Kirsher 14767f967c01SBen Hutchings /* Assign extra channels if possible */ 14777f967c01SBen Hutchings j = efx->n_channels; 14787f967c01SBen Hutchings for (i = 0; i < EFX_MAX_EXTRA_CHANNELS; i++) { 14797f967c01SBen Hutchings if (!efx->extra_channel_type[i]) 14807f967c01SBen Hutchings continue; 14817f967c01SBen Hutchings if (efx->interrupt_mode != EFX_INT_MODE_MSIX || 14827f967c01SBen Hutchings efx->n_channels <= extra_channels) { 14837f967c01SBen Hutchings efx->extra_channel_type[i]->handle_no_channel(efx); 14847f967c01SBen Hutchings } else { 14857f967c01SBen Hutchings --j; 14867f967c01SBen Hutchings efx_get_channel(efx, j)->type = 14877f967c01SBen Hutchings efx->extra_channel_type[i]; 14887f967c01SBen Hutchings } 14897f967c01SBen Hutchings } 14907f967c01SBen Hutchings 1491cd2d5b52SBen Hutchings /* RSS might be usable on VFs even if it is disabled on the PF */ 14927fa8d547SShradha Shah #ifdef CONFIG_SFC_SRIOV 14937fa8d547SShradha Shah if (efx->type->sriov_wanted) { 1494327c685eSShradha Shah efx->rss_spread = ((efx->n_rx_channels > 1 || 1495d98a4ffeSShradha Shah !efx->type->sriov_wanted(efx)) ? 1496cd2d5b52SBen Hutchings efx->n_rx_channels : efx_vf_size(efx)); 14977fa8d547SShradha Shah return 0; 14987fa8d547SShradha Shah } 14997fa8d547SShradha Shah #endif 15007fa8d547SShradha Shah efx->rss_spread = efx->n_rx_channels; 1501cd2d5b52SBen Hutchings 1502874aeea5SJeff Kirsher return 0; 1503874aeea5SJeff Kirsher } 1504874aeea5SJeff Kirsher 1505261e4d96SJon Cooper static int efx_soft_enable_interrupts(struct efx_nic *efx) 1506d8291187SBen Hutchings { 1507261e4d96SJon Cooper struct efx_channel *channel, *end_channel; 1508261e4d96SJon Cooper int rc; 1509d8291187SBen Hutchings 1510d8291187SBen Hutchings BUG_ON(efx->state == STATE_DISABLED); 1511d8291187SBen Hutchings 1512d8291187SBen Hutchings efx->irq_soft_enabled = true; 1513d8291187SBen Hutchings smp_wmb(); 1514d8291187SBen Hutchings 1515d8291187SBen Hutchings efx_for_each_channel(channel, efx) { 1516261e4d96SJon Cooper if (!channel->type->keep_eventq) { 1517261e4d96SJon Cooper rc = efx_init_eventq(channel); 1518261e4d96SJon Cooper if (rc) 1519261e4d96SJon Cooper goto fail; 1520261e4d96SJon Cooper } 1521d8291187SBen Hutchings efx_start_eventq(channel); 1522d8291187SBen Hutchings } 1523d8291187SBen Hutchings 1524d8291187SBen Hutchings efx_mcdi_mode_event(efx); 1525261e4d96SJon Cooper 1526261e4d96SJon Cooper return 0; 1527261e4d96SJon Cooper fail: 1528261e4d96SJon Cooper end_channel = channel; 1529261e4d96SJon Cooper efx_for_each_channel(channel, efx) { 1530261e4d96SJon Cooper if (channel == end_channel) 1531261e4d96SJon Cooper break; 1532261e4d96SJon Cooper efx_stop_eventq(channel); 1533261e4d96SJon Cooper if (!channel->type->keep_eventq) 1534261e4d96SJon Cooper efx_fini_eventq(channel); 1535261e4d96SJon Cooper } 1536261e4d96SJon Cooper 1537261e4d96SJon Cooper return rc; 1538d8291187SBen Hutchings } 1539d8291187SBen Hutchings 1540d8291187SBen Hutchings static void efx_soft_disable_interrupts(struct efx_nic *efx) 1541d8291187SBen Hutchings { 1542d8291187SBen Hutchings struct efx_channel *channel; 1543d8291187SBen Hutchings 1544d8291187SBen Hutchings if (efx->state == STATE_DISABLED) 1545d8291187SBen Hutchings return; 1546d8291187SBen Hutchings 1547d8291187SBen Hutchings efx_mcdi_mode_poll(efx); 1548d8291187SBen Hutchings 1549d8291187SBen Hutchings efx->irq_soft_enabled = false; 1550d8291187SBen Hutchings smp_wmb(); 1551d8291187SBen Hutchings 1552d8291187SBen Hutchings if (efx->legacy_irq) 1553d8291187SBen Hutchings synchronize_irq(efx->legacy_irq); 1554d8291187SBen Hutchings 1555d8291187SBen Hutchings efx_for_each_channel(channel, efx) { 1556d8291187SBen Hutchings if (channel->irq) 1557d8291187SBen Hutchings synchronize_irq(channel->irq); 1558d8291187SBen Hutchings 1559d8291187SBen Hutchings efx_stop_eventq(channel); 1560d8291187SBen Hutchings if (!channel->type->keep_eventq) 1561d8291187SBen Hutchings efx_fini_eventq(channel); 1562d8291187SBen Hutchings } 1563cade715fSBen Hutchings 1564cade715fSBen Hutchings /* Flush the asynchronous MCDI request queue */ 1565cade715fSBen Hutchings efx_mcdi_flush_async(efx); 1566d8291187SBen Hutchings } 1567d8291187SBen Hutchings 1568261e4d96SJon Cooper static int efx_enable_interrupts(struct efx_nic *efx) 15699f2cb71cSBen Hutchings { 1570261e4d96SJon Cooper struct efx_channel *channel, *end_channel; 1571261e4d96SJon Cooper int rc; 15729f2cb71cSBen Hutchings 15738b7325b4SBen Hutchings BUG_ON(efx->state == STATE_DISABLED); 15748b7325b4SBen Hutchings 1575b28405b0SAlexandre Rames if (efx->eeh_disabled_legacy_irq) { 1576b28405b0SAlexandre Rames enable_irq(efx->legacy_irq); 1577b28405b0SAlexandre Rames efx->eeh_disabled_legacy_irq = false; 1578b28405b0SAlexandre Rames } 1579d8291187SBen Hutchings 158086094f7fSBen Hutchings efx->type->irq_enable_master(efx); 15819f2cb71cSBen Hutchings 15829f2cb71cSBen Hutchings efx_for_each_channel(channel, efx) { 1583261e4d96SJon Cooper if (channel->type->keep_eventq) { 1584261e4d96SJon Cooper rc = efx_init_eventq(channel); 1585261e4d96SJon Cooper if (rc) 1586261e4d96SJon Cooper goto fail; 1587261e4d96SJon Cooper } 15889f2cb71cSBen Hutchings } 15899f2cb71cSBen Hutchings 1590261e4d96SJon Cooper rc = efx_soft_enable_interrupts(efx); 1591261e4d96SJon Cooper if (rc) 1592261e4d96SJon Cooper goto fail; 1593261e4d96SJon Cooper 1594261e4d96SJon Cooper return 0; 1595261e4d96SJon Cooper 1596261e4d96SJon Cooper fail: 1597261e4d96SJon Cooper end_channel = channel; 1598261e4d96SJon Cooper efx_for_each_channel(channel, efx) { 1599261e4d96SJon Cooper if (channel == end_channel) 1600261e4d96SJon Cooper break; 1601261e4d96SJon Cooper if (channel->type->keep_eventq) 1602261e4d96SJon Cooper efx_fini_eventq(channel); 1603261e4d96SJon Cooper } 1604261e4d96SJon Cooper 1605261e4d96SJon Cooper efx->type->irq_disable_non_ev(efx); 1606261e4d96SJon Cooper 1607261e4d96SJon Cooper return rc; 16089f2cb71cSBen Hutchings } 16099f2cb71cSBen Hutchings 1610d8291187SBen Hutchings static void efx_disable_interrupts(struct efx_nic *efx) 16119f2cb71cSBen Hutchings { 16129f2cb71cSBen Hutchings struct efx_channel *channel; 16139f2cb71cSBen Hutchings 1614d8291187SBen Hutchings efx_soft_disable_interrupts(efx); 16159f2cb71cSBen Hutchings 16169f2cb71cSBen Hutchings efx_for_each_channel(channel, efx) { 1617d8291187SBen Hutchings if (channel->type->keep_eventq) 16189f2cb71cSBen Hutchings efx_fini_eventq(channel); 16199f2cb71cSBen Hutchings } 1620d8291187SBen Hutchings 162186094f7fSBen Hutchings efx->type->irq_disable_non_ev(efx); 16229f2cb71cSBen Hutchings } 16239f2cb71cSBen Hutchings 1624874aeea5SJeff Kirsher static void efx_remove_interrupts(struct efx_nic *efx) 1625874aeea5SJeff Kirsher { 1626874aeea5SJeff Kirsher struct efx_channel *channel; 1627874aeea5SJeff Kirsher 1628874aeea5SJeff Kirsher /* Remove MSI/MSI-X interrupts */ 1629874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 1630874aeea5SJeff Kirsher channel->irq = 0; 1631874aeea5SJeff Kirsher pci_disable_msi(efx->pci_dev); 1632874aeea5SJeff Kirsher pci_disable_msix(efx->pci_dev); 1633874aeea5SJeff Kirsher 1634874aeea5SJeff Kirsher /* Remove legacy interrupt */ 1635874aeea5SJeff Kirsher efx->legacy_irq = 0; 1636874aeea5SJeff Kirsher } 1637874aeea5SJeff Kirsher 1638874aeea5SJeff Kirsher static void efx_set_channels(struct efx_nic *efx) 1639874aeea5SJeff Kirsher { 1640874aeea5SJeff Kirsher struct efx_channel *channel; 1641874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 1642874aeea5SJeff Kirsher 1643874aeea5SJeff Kirsher efx->tx_channel_offset = 1644b0fbdae1SShradha Shah efx_separate_tx_channels ? 1645b0fbdae1SShradha Shah efx->n_channels - efx->n_tx_channels : 0; 1646874aeea5SJeff Kirsher 164779d68b37SStuart Hodgson /* We need to mark which channels really have RX and TX 164879d68b37SStuart Hodgson * queues, and adjust the TX queue numbers if we have separate 1649874aeea5SJeff Kirsher * RX-only and TX-only channels. 1650874aeea5SJeff Kirsher */ 1651874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 165279d68b37SStuart Hodgson if (channel->channel < efx->n_rx_channels) 165379d68b37SStuart Hodgson channel->rx_queue.core_index = channel->channel; 165479d68b37SStuart Hodgson else 165579d68b37SStuart Hodgson channel->rx_queue.core_index = -1; 165679d68b37SStuart Hodgson 1657874aeea5SJeff Kirsher efx_for_each_channel_tx_queue(tx_queue, channel) 1658874aeea5SJeff Kirsher tx_queue->queue -= (efx->tx_channel_offset * 1659874aeea5SJeff Kirsher EFX_TXQ_TYPES); 1660874aeea5SJeff Kirsher } 1661874aeea5SJeff Kirsher } 1662874aeea5SJeff Kirsher 1663874aeea5SJeff Kirsher static int efx_probe_nic(struct efx_nic *efx) 1664874aeea5SJeff Kirsher { 1665874aeea5SJeff Kirsher int rc; 1666874aeea5SJeff Kirsher 1667874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "creating NIC\n"); 1668874aeea5SJeff Kirsher 1669874aeea5SJeff Kirsher /* Carry out hardware-type specific initialisation */ 1670874aeea5SJeff Kirsher rc = efx->type->probe(efx); 1671874aeea5SJeff Kirsher if (rc) 1672874aeea5SJeff Kirsher return rc; 1673874aeea5SJeff Kirsher 1674b0fbdae1SShradha Shah do { 1675b0fbdae1SShradha Shah if (!efx->max_channels || !efx->max_tx_channels) { 1676b0fbdae1SShradha Shah netif_err(efx, drv, efx->net_dev, 1677b0fbdae1SShradha Shah "Insufficient resources to allocate" 1678b0fbdae1SShradha Shah " any channels\n"); 1679b0fbdae1SShradha Shah rc = -ENOSPC; 1680b0fbdae1SShradha Shah goto fail1; 1681b0fbdae1SShradha Shah } 1682b0fbdae1SShradha Shah 1683b0fbdae1SShradha Shah /* Determine the number of channels and queues by trying 1684b0fbdae1SShradha Shah * to hook in MSI-X interrupts. 1685b0fbdae1SShradha Shah */ 1686874aeea5SJeff Kirsher rc = efx_probe_interrupts(efx); 1687874aeea5SJeff Kirsher if (rc) 1688c15eed22SBen Hutchings goto fail1; 1689874aeea5SJeff Kirsher 169052ad762bSDaniel Pieczko efx_set_channels(efx); 169152ad762bSDaniel Pieczko 1692b0fbdae1SShradha Shah /* dimension_resources can fail with EAGAIN */ 1693c15eed22SBen Hutchings rc = efx->type->dimension_resources(efx); 1694b0fbdae1SShradha Shah if (rc != 0 && rc != -EAGAIN) 1695c15eed22SBen Hutchings goto fail2; 169628e47c49SBen Hutchings 1697b0fbdae1SShradha Shah if (rc == -EAGAIN) 1698b0fbdae1SShradha Shah /* try again with new max_channels */ 1699b0fbdae1SShradha Shah efx_remove_interrupts(efx); 1700b0fbdae1SShradha Shah 1701b0fbdae1SShradha Shah } while (rc == -EAGAIN); 1702b0fbdae1SShradha Shah 1703874aeea5SJeff Kirsher if (efx->n_channels > 1) 1704267c0157SJon Cooper netdev_rss_key_fill(&efx->rx_hash_key, 1705267c0157SJon Cooper sizeof(efx->rx_hash_key)); 1706267c0157SJon Cooper efx_set_default_rx_indir_table(efx); 1707874aeea5SJeff Kirsher 1708874aeea5SJeff Kirsher netif_set_real_num_tx_queues(efx->net_dev, efx->n_tx_channels); 1709874aeea5SJeff Kirsher netif_set_real_num_rx_queues(efx->net_dev, efx->n_rx_channels); 1710874aeea5SJeff Kirsher 1711874aeea5SJeff Kirsher /* Initialise the interrupt moderation settings */ 1712539de7c5SBert Kenward efx->irq_mod_step_us = DIV_ROUND_UP(efx->timer_quantum_ns, 1000); 17139e393b30SBen Hutchings efx_init_irq_moderation(efx, tx_irq_mod_usec, rx_irq_mod_usec, true, 17149e393b30SBen Hutchings true); 1715874aeea5SJeff Kirsher 1716874aeea5SJeff Kirsher return 0; 1717874aeea5SJeff Kirsher 1718c15eed22SBen Hutchings fail2: 1719c15eed22SBen Hutchings efx_remove_interrupts(efx); 1720c15eed22SBen Hutchings fail1: 1721874aeea5SJeff Kirsher efx->type->remove(efx); 1722874aeea5SJeff Kirsher return rc; 1723874aeea5SJeff Kirsher } 1724874aeea5SJeff Kirsher 1725874aeea5SJeff Kirsher static void efx_remove_nic(struct efx_nic *efx) 1726874aeea5SJeff Kirsher { 1727874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "destroying NIC\n"); 1728874aeea5SJeff Kirsher 1729874aeea5SJeff Kirsher efx_remove_interrupts(efx); 1730874aeea5SJeff Kirsher efx->type->remove(efx); 1731874aeea5SJeff Kirsher } 1732874aeea5SJeff Kirsher 1733add72477SBen Hutchings static int efx_probe_filters(struct efx_nic *efx) 1734add72477SBen Hutchings { 1735add72477SBen Hutchings int rc; 1736add72477SBen Hutchings 1737add72477SBen Hutchings spin_lock_init(&efx->filter_lock); 17380d322413SEdward Cree init_rwsem(&efx->filter_sem); 1739d248953aSMartin Habets mutex_lock(&efx->mac_lock); 17400d322413SEdward Cree down_write(&efx->filter_sem); 1741add72477SBen Hutchings rc = efx->type->filter_table_probe(efx); 1742add72477SBen Hutchings if (rc) 17430d322413SEdward Cree goto out_unlock; 1744add72477SBen Hutchings 1745add72477SBen Hutchings #ifdef CONFIG_RFS_ACCEL 1746add72477SBen Hutchings if (efx->type->offload_features & NETIF_F_NTUPLE) { 1747faf8dcc1SJon Cooper struct efx_channel *channel; 1748faf8dcc1SJon Cooper int i, success = 1; 1749faf8dcc1SJon Cooper 1750faf8dcc1SJon Cooper efx_for_each_channel(channel, efx) { 1751faf8dcc1SJon Cooper channel->rps_flow_id = 1752faf8dcc1SJon Cooper kcalloc(efx->type->max_rx_ip_filters, 1753faf8dcc1SJon Cooper sizeof(*channel->rps_flow_id), 1754add72477SBen Hutchings GFP_KERNEL); 1755faf8dcc1SJon Cooper if (!channel->rps_flow_id) 1756faf8dcc1SJon Cooper success = 0; 1757faf8dcc1SJon Cooper else 1758faf8dcc1SJon Cooper for (i = 0; 1759faf8dcc1SJon Cooper i < efx->type->max_rx_ip_filters; 1760faf8dcc1SJon Cooper ++i) 1761faf8dcc1SJon Cooper channel->rps_flow_id[i] = 1762faf8dcc1SJon Cooper RPS_FLOW_ID_INVALID; 1763faf8dcc1SJon Cooper } 1764faf8dcc1SJon Cooper 1765faf8dcc1SJon Cooper if (!success) { 1766faf8dcc1SJon Cooper efx_for_each_channel(channel, efx) 1767faf8dcc1SJon Cooper kfree(channel->rps_flow_id); 1768add72477SBen Hutchings efx->type->filter_table_remove(efx); 17690d322413SEdward Cree rc = -ENOMEM; 17700d322413SEdward Cree goto out_unlock; 1771add72477SBen Hutchings } 1772faf8dcc1SJon Cooper 1773faf8dcc1SJon Cooper efx->rps_expire_index = efx->rps_expire_channel = 0; 1774add72477SBen Hutchings } 1775add72477SBen Hutchings #endif 17760d322413SEdward Cree out_unlock: 17770d322413SEdward Cree up_write(&efx->filter_sem); 1778d248953aSMartin Habets mutex_unlock(&efx->mac_lock); 17790d322413SEdward Cree return rc; 1780add72477SBen Hutchings } 1781add72477SBen Hutchings 1782add72477SBen Hutchings static void efx_remove_filters(struct efx_nic *efx) 1783add72477SBen Hutchings { 1784add72477SBen Hutchings #ifdef CONFIG_RFS_ACCEL 1785faf8dcc1SJon Cooper struct efx_channel *channel; 1786faf8dcc1SJon Cooper 1787faf8dcc1SJon Cooper efx_for_each_channel(channel, efx) 1788faf8dcc1SJon Cooper kfree(channel->rps_flow_id); 1789add72477SBen Hutchings #endif 17900d322413SEdward Cree down_write(&efx->filter_sem); 1791add72477SBen Hutchings efx->type->filter_table_remove(efx); 17920d322413SEdward Cree up_write(&efx->filter_sem); 1793add72477SBen Hutchings } 1794add72477SBen Hutchings 1795add72477SBen Hutchings static void efx_restore_filters(struct efx_nic *efx) 1796add72477SBen Hutchings { 17970d322413SEdward Cree down_read(&efx->filter_sem); 1798add72477SBen Hutchings efx->type->filter_table_restore(efx); 17990d322413SEdward Cree up_read(&efx->filter_sem); 1800add72477SBen Hutchings } 1801add72477SBen Hutchings 1802874aeea5SJeff Kirsher /************************************************************************** 1803874aeea5SJeff Kirsher * 1804874aeea5SJeff Kirsher * NIC startup/shutdown 1805874aeea5SJeff Kirsher * 1806874aeea5SJeff Kirsher *************************************************************************/ 1807874aeea5SJeff Kirsher 1808874aeea5SJeff Kirsher static int efx_probe_all(struct efx_nic *efx) 1809874aeea5SJeff Kirsher { 1810874aeea5SJeff Kirsher int rc; 1811874aeea5SJeff Kirsher 1812874aeea5SJeff Kirsher rc = efx_probe_nic(efx); 1813874aeea5SJeff Kirsher if (rc) { 1814874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, "failed to create NIC\n"); 1815874aeea5SJeff Kirsher goto fail1; 1816874aeea5SJeff Kirsher } 1817874aeea5SJeff Kirsher 1818874aeea5SJeff Kirsher rc = efx_probe_port(efx); 1819874aeea5SJeff Kirsher if (rc) { 1820874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, "failed to create port\n"); 1821874aeea5SJeff Kirsher goto fail2; 1822874aeea5SJeff Kirsher } 1823874aeea5SJeff Kirsher 18247e6d06f0SBen Hutchings BUILD_BUG_ON(EFX_DEFAULT_DMAQ_SIZE < EFX_RXQ_MIN_ENT); 18257e6d06f0SBen Hutchings if (WARN_ON(EFX_DEFAULT_DMAQ_SIZE < EFX_TXQ_MIN_ENT(efx))) { 18267e6d06f0SBen Hutchings rc = -EINVAL; 18277e6d06f0SBen Hutchings goto fail3; 18287e6d06f0SBen Hutchings } 1829874aeea5SJeff Kirsher efx->rxq_entries = efx->txq_entries = EFX_DEFAULT_DMAQ_SIZE; 1830874aeea5SJeff Kirsher 18316d8aaaf6SDaniel Pieczko #ifdef CONFIG_SFC_SRIOV 18326d8aaaf6SDaniel Pieczko rc = efx->type->vswitching_probe(efx); 18336d8aaaf6SDaniel Pieczko if (rc) /* not fatal; the PF will still work fine */ 18346d8aaaf6SDaniel Pieczko netif_warn(efx, probe, efx->net_dev, 18356d8aaaf6SDaniel Pieczko "failed to setup vswitching rc=%d;" 18366d8aaaf6SDaniel Pieczko " VFs may not function\n", rc); 18376d8aaaf6SDaniel Pieczko #endif 18386d8aaaf6SDaniel Pieczko 1839874aeea5SJeff Kirsher rc = efx_probe_filters(efx); 1840874aeea5SJeff Kirsher if (rc) { 1841874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1842874aeea5SJeff Kirsher "failed to create filter tables\n"); 18436d8aaaf6SDaniel Pieczko goto fail4; 1844874aeea5SJeff Kirsher } 1845874aeea5SJeff Kirsher 18467f967c01SBen Hutchings rc = efx_probe_channels(efx); 18477f967c01SBen Hutchings if (rc) 18486d8aaaf6SDaniel Pieczko goto fail5; 18497f967c01SBen Hutchings 1850874aeea5SJeff Kirsher return 0; 1851874aeea5SJeff Kirsher 18526d8aaaf6SDaniel Pieczko fail5: 18537f967c01SBen Hutchings efx_remove_filters(efx); 18546d8aaaf6SDaniel Pieczko fail4: 18556d8aaaf6SDaniel Pieczko #ifdef CONFIG_SFC_SRIOV 18566d8aaaf6SDaniel Pieczko efx->type->vswitching_remove(efx); 18576d8aaaf6SDaniel Pieczko #endif 1858874aeea5SJeff Kirsher fail3: 1859874aeea5SJeff Kirsher efx_remove_port(efx); 1860874aeea5SJeff Kirsher fail2: 1861874aeea5SJeff Kirsher efx_remove_nic(efx); 1862874aeea5SJeff Kirsher fail1: 1863874aeea5SJeff Kirsher return rc; 1864874aeea5SJeff Kirsher } 1865874aeea5SJeff Kirsher 18668b7325b4SBen Hutchings /* If the interface is supposed to be running but is not, start 18678b7325b4SBen Hutchings * the hardware and software data path, regular activity for the port 18688b7325b4SBen Hutchings * (MAC statistics, link polling, etc.) and schedule the port to be 18698b7325b4SBen Hutchings * reconfigured. Interrupts must already be enabled. This function 18708b7325b4SBen Hutchings * is safe to call multiple times, so long as the NIC is not disabled. 18718b7325b4SBen Hutchings * Requires the RTNL lock. 18729f2cb71cSBen Hutchings */ 1873874aeea5SJeff Kirsher static void efx_start_all(struct efx_nic *efx) 1874874aeea5SJeff Kirsher { 1875874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 18768b7325b4SBen Hutchings BUG_ON(efx->state == STATE_DISABLED); 1877874aeea5SJeff Kirsher 1878874aeea5SJeff Kirsher /* Check that it is appropriate to restart the interface. All 1879874aeea5SJeff Kirsher * of these flags are safe to read under just the rtnl lock */ 1880e283546cSEdward Cree if (efx->port_enabled || !netif_running(efx->net_dev) || 1881e283546cSEdward Cree efx->reset_pending) 1882874aeea5SJeff Kirsher return; 1883874aeea5SJeff Kirsher 1884874aeea5SJeff Kirsher efx_start_port(efx); 18859f2cb71cSBen Hutchings efx_start_datapath(efx); 1886874aeea5SJeff Kirsher 1887626950dbSAlexandre Rames /* Start the hardware monitor if there is one */ 1888626950dbSAlexandre Rames if (efx->type->monitor != NULL) 1889874aeea5SJeff Kirsher queue_delayed_work(efx->workqueue, &efx->monitor_work, 1890874aeea5SJeff Kirsher efx_monitor_interval); 1891626950dbSAlexandre Rames 1892626950dbSAlexandre Rames /* If link state detection is normally event-driven, we have 1893626950dbSAlexandre Rames * to poll now because we could have missed a change 1894626950dbSAlexandre Rames */ 1895626950dbSAlexandre Rames if (efx_nic_rev(efx) >= EFX_REV_SIENA_A0) { 1896874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1897874aeea5SJeff Kirsher if (efx->phy_op->poll(efx)) 1898874aeea5SJeff Kirsher efx_link_status_changed(efx); 1899874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1900874aeea5SJeff Kirsher } 1901874aeea5SJeff Kirsher 1902874aeea5SJeff Kirsher efx->type->start_stats(efx); 1903f8f3b5aeSJon Cooper efx->type->pull_stats(efx); 1904f8f3b5aeSJon Cooper spin_lock_bh(&efx->stats_lock); 1905f8f3b5aeSJon Cooper efx->type->update_stats(efx, NULL, NULL); 1906f8f3b5aeSJon Cooper spin_unlock_bh(&efx->stats_lock); 1907874aeea5SJeff Kirsher } 1908874aeea5SJeff Kirsher 19098b7325b4SBen Hutchings /* Quiesce the hardware and software data path, and regular activity 19108b7325b4SBen Hutchings * for the port without bringing the link down. Safe to call multiple 19118b7325b4SBen Hutchings * times with the NIC in almost any state, but interrupts should be 19128b7325b4SBen Hutchings * enabled. Requires the RTNL lock. 19138b7325b4SBen Hutchings */ 1914874aeea5SJeff Kirsher static void efx_stop_all(struct efx_nic *efx) 1915874aeea5SJeff Kirsher { 1916874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 1917874aeea5SJeff Kirsher 1918874aeea5SJeff Kirsher /* port_enabled can be read safely under the rtnl lock */ 1919874aeea5SJeff Kirsher if (!efx->port_enabled) 1920874aeea5SJeff Kirsher return; 1921874aeea5SJeff Kirsher 1922f8f3b5aeSJon Cooper /* update stats before we go down so we can accurately count 1923f8f3b5aeSJon Cooper * rx_nodesc_drops 1924f8f3b5aeSJon Cooper */ 1925f8f3b5aeSJon Cooper efx->type->pull_stats(efx); 1926f8f3b5aeSJon Cooper spin_lock_bh(&efx->stats_lock); 1927f8f3b5aeSJon Cooper efx->type->update_stats(efx, NULL, NULL); 1928f8f3b5aeSJon Cooper spin_unlock_bh(&efx->stats_lock); 1929874aeea5SJeff Kirsher efx->type->stop_stats(efx); 1930874aeea5SJeff Kirsher efx_stop_port(efx); 1931874aeea5SJeff Kirsher 193229c69a48SBen Hutchings /* Stop the kernel transmit interface. This is only valid if 193329c69a48SBen Hutchings * the device is stopped or detached; otherwise the watchdog 193429c69a48SBen Hutchings * may fire immediately. 193529c69a48SBen Hutchings */ 193629c69a48SBen Hutchings WARN_ON(netif_running(efx->net_dev) && 193729c69a48SBen Hutchings netif_device_present(efx->net_dev)); 19389f2cb71cSBen Hutchings netif_tx_disable(efx->net_dev); 19399f2cb71cSBen Hutchings 19409f2cb71cSBen Hutchings efx_stop_datapath(efx); 1941874aeea5SJeff Kirsher } 1942874aeea5SJeff Kirsher 1943874aeea5SJeff Kirsher static void efx_remove_all(struct efx_nic *efx) 1944874aeea5SJeff Kirsher { 1945874aeea5SJeff Kirsher efx_remove_channels(efx); 19467f967c01SBen Hutchings efx_remove_filters(efx); 19476d8aaaf6SDaniel Pieczko #ifdef CONFIG_SFC_SRIOV 19486d8aaaf6SDaniel Pieczko efx->type->vswitching_remove(efx); 19496d8aaaf6SDaniel Pieczko #endif 1950874aeea5SJeff Kirsher efx_remove_port(efx); 1951874aeea5SJeff Kirsher efx_remove_nic(efx); 1952874aeea5SJeff Kirsher } 1953874aeea5SJeff Kirsher 1954874aeea5SJeff Kirsher /************************************************************************** 1955874aeea5SJeff Kirsher * 1956874aeea5SJeff Kirsher * Interrupt moderation 1957874aeea5SJeff Kirsher * 1958874aeea5SJeff Kirsher **************************************************************************/ 1959539de7c5SBert Kenward unsigned int efx_usecs_to_ticks(struct efx_nic *efx, unsigned int usecs) 1960874aeea5SJeff Kirsher { 1961b548f976SBen Hutchings if (usecs == 0) 1962b548f976SBen Hutchings return 0; 1963539de7c5SBert Kenward if (usecs * 1000 < efx->timer_quantum_ns) 1964874aeea5SJeff Kirsher return 1; /* never round down to 0 */ 1965539de7c5SBert Kenward return usecs * 1000 / efx->timer_quantum_ns; 1966539de7c5SBert Kenward } 1967539de7c5SBert Kenward 1968539de7c5SBert Kenward unsigned int efx_ticks_to_usecs(struct efx_nic *efx, unsigned int ticks) 1969539de7c5SBert Kenward { 1970539de7c5SBert Kenward /* We must round up when converting ticks to microseconds 1971539de7c5SBert Kenward * because we round down when converting the other way. 1972539de7c5SBert Kenward */ 1973539de7c5SBert Kenward return DIV_ROUND_UP(ticks * efx->timer_quantum_ns, 1000); 1974874aeea5SJeff Kirsher } 1975874aeea5SJeff Kirsher 1976874aeea5SJeff Kirsher /* Set interrupt moderation parameters */ 19779e393b30SBen Hutchings int efx_init_irq_moderation(struct efx_nic *efx, unsigned int tx_usecs, 19789e393b30SBen Hutchings unsigned int rx_usecs, bool rx_adaptive, 19799e393b30SBen Hutchings bool rx_may_override_tx) 1980874aeea5SJeff Kirsher { 1981874aeea5SJeff Kirsher struct efx_channel *channel; 1982d95e329aSBert Kenward unsigned int timer_max_us; 1983d95e329aSBert Kenward 1984874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 1985874aeea5SJeff Kirsher 1986d95e329aSBert Kenward timer_max_us = efx->timer_max_ns / 1000; 1987d95e329aSBert Kenward 1988d95e329aSBert Kenward if (tx_usecs > timer_max_us || rx_usecs > timer_max_us) 19899e393b30SBen Hutchings return -EINVAL; 19909e393b30SBen Hutchings 1991539de7c5SBert Kenward if (tx_usecs != rx_usecs && efx->tx_channel_offset == 0 && 19929e393b30SBen Hutchings !rx_may_override_tx) { 19939e393b30SBen Hutchings netif_err(efx, drv, efx->net_dev, "Channels are shared. " 19949e393b30SBen Hutchings "RX and TX IRQ moderation must be equal\n"); 19959e393b30SBen Hutchings return -EINVAL; 19969e393b30SBen Hutchings } 19979e393b30SBen Hutchings 1998874aeea5SJeff Kirsher efx->irq_rx_adaptive = rx_adaptive; 1999539de7c5SBert Kenward efx->irq_rx_moderation_us = rx_usecs; 2000874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 2001874aeea5SJeff Kirsher if (efx_channel_has_rx_queue(channel)) 2002539de7c5SBert Kenward channel->irq_moderation_us = rx_usecs; 2003874aeea5SJeff Kirsher else if (efx_channel_has_tx_queues(channel)) 2004539de7c5SBert Kenward channel->irq_moderation_us = tx_usecs; 2005874aeea5SJeff Kirsher } 20069e393b30SBen Hutchings 20079e393b30SBen Hutchings return 0; 2008874aeea5SJeff Kirsher } 2009874aeea5SJeff Kirsher 2010a0c4faf5SBen Hutchings void efx_get_irq_moderation(struct efx_nic *efx, unsigned int *tx_usecs, 2011a0c4faf5SBen Hutchings unsigned int *rx_usecs, bool *rx_adaptive) 2012a0c4faf5SBen Hutchings { 2013a0c4faf5SBen Hutchings *rx_adaptive = efx->irq_rx_adaptive; 2014539de7c5SBert Kenward *rx_usecs = efx->irq_rx_moderation_us; 2015a0c4faf5SBen Hutchings 2016a0c4faf5SBen Hutchings /* If channels are shared between RX and TX, so is IRQ 2017a0c4faf5SBen Hutchings * moderation. Otherwise, IRQ moderation is the same for all 2018a0c4faf5SBen Hutchings * TX channels and is not adaptive. 2019a0c4faf5SBen Hutchings */ 2020539de7c5SBert Kenward if (efx->tx_channel_offset == 0) { 2021a0c4faf5SBen Hutchings *tx_usecs = *rx_usecs; 2022539de7c5SBert Kenward } else { 2023539de7c5SBert Kenward struct efx_channel *tx_channel; 2024539de7c5SBert Kenward 2025539de7c5SBert Kenward tx_channel = efx->channel[efx->tx_channel_offset]; 2026539de7c5SBert Kenward *tx_usecs = tx_channel->irq_moderation_us; 2027539de7c5SBert Kenward } 2028a0c4faf5SBen Hutchings } 2029a0c4faf5SBen Hutchings 2030874aeea5SJeff Kirsher /************************************************************************** 2031874aeea5SJeff Kirsher * 2032874aeea5SJeff Kirsher * Hardware monitor 2033874aeea5SJeff Kirsher * 2034874aeea5SJeff Kirsher **************************************************************************/ 2035874aeea5SJeff Kirsher 2036874aeea5SJeff Kirsher /* Run periodically off the general workqueue */ 2037874aeea5SJeff Kirsher static void efx_monitor(struct work_struct *data) 2038874aeea5SJeff Kirsher { 2039874aeea5SJeff Kirsher struct efx_nic *efx = container_of(data, struct efx_nic, 2040874aeea5SJeff Kirsher monitor_work.work); 2041874aeea5SJeff Kirsher 2042874aeea5SJeff Kirsher netif_vdbg(efx, timer, efx->net_dev, 2043874aeea5SJeff Kirsher "hardware monitor executing on CPU %d\n", 2044874aeea5SJeff Kirsher raw_smp_processor_id()); 2045874aeea5SJeff Kirsher BUG_ON(efx->type->monitor == NULL); 2046874aeea5SJeff Kirsher 2047874aeea5SJeff Kirsher /* If the mac_lock is already held then it is likely a port 2048874aeea5SJeff Kirsher * reconfiguration is already in place, which will likely do 2049874aeea5SJeff Kirsher * most of the work of monitor() anyway. */ 2050874aeea5SJeff Kirsher if (mutex_trylock(&efx->mac_lock)) { 2051874aeea5SJeff Kirsher if (efx->port_enabled) 2052874aeea5SJeff Kirsher efx->type->monitor(efx); 2053874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2054874aeea5SJeff Kirsher } 2055874aeea5SJeff Kirsher 2056874aeea5SJeff Kirsher queue_delayed_work(efx->workqueue, &efx->monitor_work, 2057874aeea5SJeff Kirsher efx_monitor_interval); 2058874aeea5SJeff Kirsher } 2059874aeea5SJeff Kirsher 2060874aeea5SJeff Kirsher /************************************************************************** 2061874aeea5SJeff Kirsher * 2062874aeea5SJeff Kirsher * ioctls 2063874aeea5SJeff Kirsher * 2064874aeea5SJeff Kirsher *************************************************************************/ 2065874aeea5SJeff Kirsher 2066874aeea5SJeff Kirsher /* Net device ioctl 2067874aeea5SJeff Kirsher * Context: process, rtnl_lock() held. 2068874aeea5SJeff Kirsher */ 2069874aeea5SJeff Kirsher static int efx_ioctl(struct net_device *net_dev, struct ifreq *ifr, int cmd) 2070874aeea5SJeff Kirsher { 2071874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2072874aeea5SJeff Kirsher struct mii_ioctl_data *data = if_mii(ifr); 2073874aeea5SJeff Kirsher 20747c236c43SStuart Hodgson if (cmd == SIOCSHWTSTAMP) 2075433dc9b3SBen Hutchings return efx_ptp_set_ts_config(efx, ifr); 2076433dc9b3SBen Hutchings if (cmd == SIOCGHWTSTAMP) 2077433dc9b3SBen Hutchings return efx_ptp_get_ts_config(efx, ifr); 20787c236c43SStuart Hodgson 2079874aeea5SJeff Kirsher /* Convert phy_id from older PRTAD/DEVAD format */ 2080874aeea5SJeff Kirsher if ((cmd == SIOCGMIIREG || cmd == SIOCSMIIREG) && 2081874aeea5SJeff Kirsher (data->phy_id & 0xfc00) == 0x0400) 2082874aeea5SJeff Kirsher data->phy_id ^= MDIO_PHY_ID_C45 | 0x0400; 2083874aeea5SJeff Kirsher 2084874aeea5SJeff Kirsher return mdio_mii_ioctl(&efx->mdio, data, cmd); 2085874aeea5SJeff Kirsher } 2086874aeea5SJeff Kirsher 2087874aeea5SJeff Kirsher /************************************************************************** 2088874aeea5SJeff Kirsher * 2089874aeea5SJeff Kirsher * NAPI interface 2090874aeea5SJeff Kirsher * 2091874aeea5SJeff Kirsher **************************************************************************/ 2092874aeea5SJeff Kirsher 20937f967c01SBen Hutchings static void efx_init_napi_channel(struct efx_channel *channel) 2094874aeea5SJeff Kirsher { 20957f967c01SBen Hutchings struct efx_nic *efx = channel->efx; 2096874aeea5SJeff Kirsher 2097874aeea5SJeff Kirsher channel->napi_dev = efx->net_dev; 2098874aeea5SJeff Kirsher netif_napi_add(channel->napi_dev, &channel->napi_str, 2099874aeea5SJeff Kirsher efx_poll, napi_weight); 2100c0f9c7e4SBert Kenward efx_channel_busy_poll_init(channel); 2101874aeea5SJeff Kirsher } 21027f967c01SBen Hutchings 21037f967c01SBen Hutchings static void efx_init_napi(struct efx_nic *efx) 21047f967c01SBen Hutchings { 21057f967c01SBen Hutchings struct efx_channel *channel; 21067f967c01SBen Hutchings 21077f967c01SBen Hutchings efx_for_each_channel(channel, efx) 21087f967c01SBen Hutchings efx_init_napi_channel(channel); 2109874aeea5SJeff Kirsher } 2110874aeea5SJeff Kirsher 2111874aeea5SJeff Kirsher static void efx_fini_napi_channel(struct efx_channel *channel) 2112874aeea5SJeff Kirsher { 211336763266SAlexandre Rames if (channel->napi_dev) { 2114874aeea5SJeff Kirsher netif_napi_del(&channel->napi_str); 211536763266SAlexandre Rames napi_hash_del(&channel->napi_str); 211636763266SAlexandre Rames } 2117874aeea5SJeff Kirsher channel->napi_dev = NULL; 2118874aeea5SJeff Kirsher } 2119874aeea5SJeff Kirsher 2120874aeea5SJeff Kirsher static void efx_fini_napi(struct efx_nic *efx) 2121874aeea5SJeff Kirsher { 2122874aeea5SJeff Kirsher struct efx_channel *channel; 2123874aeea5SJeff Kirsher 2124874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 2125874aeea5SJeff Kirsher efx_fini_napi_channel(channel); 2126874aeea5SJeff Kirsher } 2127874aeea5SJeff Kirsher 2128874aeea5SJeff Kirsher /************************************************************************** 2129874aeea5SJeff Kirsher * 2130874aeea5SJeff Kirsher * Kernel netpoll interface 2131874aeea5SJeff Kirsher * 2132874aeea5SJeff Kirsher *************************************************************************/ 2133874aeea5SJeff Kirsher 2134874aeea5SJeff Kirsher #ifdef CONFIG_NET_POLL_CONTROLLER 2135874aeea5SJeff Kirsher 2136874aeea5SJeff Kirsher /* Although in the common case interrupts will be disabled, this is not 2137874aeea5SJeff Kirsher * guaranteed. However, all our work happens inside the NAPI callback, 2138874aeea5SJeff Kirsher * so no locking is required. 2139874aeea5SJeff Kirsher */ 2140874aeea5SJeff Kirsher static void efx_netpoll(struct net_device *net_dev) 2141874aeea5SJeff Kirsher { 2142874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2143874aeea5SJeff Kirsher struct efx_channel *channel; 2144874aeea5SJeff Kirsher 2145874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 2146874aeea5SJeff Kirsher efx_schedule_channel(channel); 2147874aeea5SJeff Kirsher } 2148874aeea5SJeff Kirsher 2149874aeea5SJeff Kirsher #endif 2150874aeea5SJeff Kirsher 215136763266SAlexandre Rames #ifdef CONFIG_NET_RX_BUSY_POLL 215236763266SAlexandre Rames static int efx_busy_poll(struct napi_struct *napi) 215336763266SAlexandre Rames { 215436763266SAlexandre Rames struct efx_channel *channel = 215536763266SAlexandre Rames container_of(napi, struct efx_channel, napi_str); 215636763266SAlexandre Rames struct efx_nic *efx = channel->efx; 215736763266SAlexandre Rames int budget = 4; 215836763266SAlexandre Rames int old_rx_packets, rx_packets; 215936763266SAlexandre Rames 216036763266SAlexandre Rames if (!netif_running(efx->net_dev)) 216136763266SAlexandre Rames return LL_FLUSH_FAILED; 216236763266SAlexandre Rames 2163c0f9c7e4SBert Kenward if (!efx_channel_try_lock_poll(channel)) 216436763266SAlexandre Rames return LL_FLUSH_BUSY; 216536763266SAlexandre Rames 216636763266SAlexandre Rames old_rx_packets = channel->rx_queue.rx_packets; 216736763266SAlexandre Rames efx_process_channel(channel, budget); 216836763266SAlexandre Rames 216936763266SAlexandre Rames rx_packets = channel->rx_queue.rx_packets - old_rx_packets; 217036763266SAlexandre Rames 217136763266SAlexandre Rames /* There is no race condition with NAPI here. 217236763266SAlexandre Rames * NAPI will automatically be rescheduled if it yielded during busy 217336763266SAlexandre Rames * polling, because it was not able to take the lock and thus returned 217436763266SAlexandre Rames * the full budget. 217536763266SAlexandre Rames */ 217636763266SAlexandre Rames efx_channel_unlock_poll(channel); 217736763266SAlexandre Rames 217836763266SAlexandre Rames return rx_packets; 217936763266SAlexandre Rames } 218036763266SAlexandre Rames #endif 218136763266SAlexandre Rames 2182874aeea5SJeff Kirsher /************************************************************************** 2183874aeea5SJeff Kirsher * 2184874aeea5SJeff Kirsher * Kernel net device interface 2185874aeea5SJeff Kirsher * 2186874aeea5SJeff Kirsher *************************************************************************/ 2187874aeea5SJeff Kirsher 2188874aeea5SJeff Kirsher /* Context: process, rtnl_lock() held. */ 2189e340be92SShradha Shah int efx_net_open(struct net_device *net_dev) 2190874aeea5SJeff Kirsher { 2191874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 21928b7325b4SBen Hutchings int rc; 21938b7325b4SBen Hutchings 2194874aeea5SJeff Kirsher netif_dbg(efx, ifup, efx->net_dev, "opening device on CPU %d\n", 2195874aeea5SJeff Kirsher raw_smp_processor_id()); 2196874aeea5SJeff Kirsher 21978b7325b4SBen Hutchings rc = efx_check_disabled(efx); 21988b7325b4SBen Hutchings if (rc) 21998b7325b4SBen Hutchings return rc; 2200874aeea5SJeff Kirsher if (efx->phy_mode & PHY_MODE_SPECIAL) 2201874aeea5SJeff Kirsher return -EBUSY; 2202874aeea5SJeff Kirsher if (efx_mcdi_poll_reboot(efx) && efx_reset(efx, RESET_TYPE_ALL)) 2203874aeea5SJeff Kirsher return -EIO; 2204874aeea5SJeff Kirsher 2205874aeea5SJeff Kirsher /* Notify the kernel of the link state polled during driver load, 2206874aeea5SJeff Kirsher * before the monitor starts running */ 2207874aeea5SJeff Kirsher efx_link_status_changed(efx); 2208874aeea5SJeff Kirsher 2209874aeea5SJeff Kirsher efx_start_all(efx); 2210dd40781eSBen Hutchings efx_selftest_async_start(efx); 2211874aeea5SJeff Kirsher return 0; 2212874aeea5SJeff Kirsher } 2213874aeea5SJeff Kirsher 2214874aeea5SJeff Kirsher /* Context: process, rtnl_lock() held. 2215874aeea5SJeff Kirsher * Note that the kernel will ignore our return code; this method 2216874aeea5SJeff Kirsher * should really be a void. 2217874aeea5SJeff Kirsher */ 2218e340be92SShradha Shah int efx_net_stop(struct net_device *net_dev) 2219874aeea5SJeff Kirsher { 2220874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2221874aeea5SJeff Kirsher 2222874aeea5SJeff Kirsher netif_dbg(efx, ifdown, efx->net_dev, "closing on CPU %d\n", 2223874aeea5SJeff Kirsher raw_smp_processor_id()); 2224874aeea5SJeff Kirsher 2225874aeea5SJeff Kirsher /* Stop the device and flush all the channels */ 2226874aeea5SJeff Kirsher efx_stop_all(efx); 2227874aeea5SJeff Kirsher 2228874aeea5SJeff Kirsher return 0; 2229874aeea5SJeff Kirsher } 2230874aeea5SJeff Kirsher 2231874aeea5SJeff Kirsher /* Context: process, dev_base_lock or RTNL held, non-blocking. */ 22322aa9ef11SBen Hutchings static struct rtnl_link_stats64 *efx_net_stats(struct net_device *net_dev, 22332aa9ef11SBen Hutchings struct rtnl_link_stats64 *stats) 2234874aeea5SJeff Kirsher { 2235874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2236874aeea5SJeff Kirsher 2237874aeea5SJeff Kirsher spin_lock_bh(&efx->stats_lock); 2238cd0ecc9aSBen Hutchings efx->type->update_stats(efx, NULL, stats); 22391cb34522SBen Hutchings spin_unlock_bh(&efx->stats_lock); 22401cb34522SBen Hutchings 2241874aeea5SJeff Kirsher return stats; 2242874aeea5SJeff Kirsher } 2243874aeea5SJeff Kirsher 2244874aeea5SJeff Kirsher /* Context: netif_tx_lock held, BHs disabled. */ 2245874aeea5SJeff Kirsher static void efx_watchdog(struct net_device *net_dev) 2246874aeea5SJeff Kirsher { 2247874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2248874aeea5SJeff Kirsher 2249874aeea5SJeff Kirsher netif_err(efx, tx_err, efx->net_dev, 2250874aeea5SJeff Kirsher "TX stuck with port_enabled=%d: resetting channels\n", 2251874aeea5SJeff Kirsher efx->port_enabled); 2252874aeea5SJeff Kirsher 2253874aeea5SJeff Kirsher efx_schedule_reset(efx, RESET_TYPE_TX_WATCHDOG); 2254874aeea5SJeff Kirsher } 2255874aeea5SJeff Kirsher 2256874aeea5SJeff Kirsher 2257874aeea5SJeff Kirsher /* Context: process, rtnl_lock() held. */ 2258874aeea5SJeff Kirsher static int efx_change_mtu(struct net_device *net_dev, int new_mtu) 2259874aeea5SJeff Kirsher { 2260874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 22618b7325b4SBen Hutchings int rc; 2262874aeea5SJeff Kirsher 22638b7325b4SBen Hutchings rc = efx_check_disabled(efx); 22648b7325b4SBen Hutchings if (rc) 22658b7325b4SBen Hutchings return rc; 2266874aeea5SJeff Kirsher if (new_mtu > EFX_MAX_MTU) 2267874aeea5SJeff Kirsher return -EINVAL; 2268874aeea5SJeff Kirsher 2269874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "changing MTU to %d\n", new_mtu); 2270874aeea5SJeff Kirsher 227129c69a48SBen Hutchings efx_device_detach_sync(efx); 227229c69a48SBen Hutchings efx_stop_all(efx); 227329c69a48SBen Hutchings 2274874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 2275874aeea5SJeff Kirsher net_dev->mtu = new_mtu; 22760d322413SEdward Cree efx_mac_reconfigure(efx); 2277874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2278874aeea5SJeff Kirsher 2279874aeea5SJeff Kirsher efx_start_all(efx); 228029c69a48SBen Hutchings netif_device_attach(efx->net_dev); 22816c8eef4aSBen Hutchings return 0; 2282874aeea5SJeff Kirsher } 2283874aeea5SJeff Kirsher 2284874aeea5SJeff Kirsher static int efx_set_mac_address(struct net_device *net_dev, void *data) 2285874aeea5SJeff Kirsher { 2286874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2287874aeea5SJeff Kirsher struct sockaddr *addr = data; 2288e0b3ae30SBen Hutchings u8 *new_addr = addr->sa_data; 2289cfc77c2fSShradha Shah u8 old_addr[6]; 2290cfc77c2fSShradha Shah int rc; 2291874aeea5SJeff Kirsher 2292874aeea5SJeff Kirsher if (!is_valid_ether_addr(new_addr)) { 2293874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 2294874aeea5SJeff Kirsher "invalid ethernet MAC address requested: %pM\n", 2295874aeea5SJeff Kirsher new_addr); 2296504f9b5aSDanny Kukawka return -EADDRNOTAVAIL; 2297874aeea5SJeff Kirsher } 2298874aeea5SJeff Kirsher 2299cfc77c2fSShradha Shah /* save old address */ 2300cfc77c2fSShradha Shah ether_addr_copy(old_addr, net_dev->dev_addr); 2301cd84ff4dSEdward Cree ether_addr_copy(net_dev->dev_addr, new_addr); 2302910c8789SShradha Shah if (efx->type->set_mac_address) { 2303910c8789SShradha Shah rc = efx->type->set_mac_address(efx); 2304cfc77c2fSShradha Shah if (rc) { 2305cfc77c2fSShradha Shah ether_addr_copy(net_dev->dev_addr, old_addr); 2306cfc77c2fSShradha Shah return rc; 2307cfc77c2fSShradha Shah } 2308cfc77c2fSShradha Shah } 2309874aeea5SJeff Kirsher 2310874aeea5SJeff Kirsher /* Reconfigure the MAC */ 2311874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 23120d322413SEdward Cree efx_mac_reconfigure(efx); 2313874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2314874aeea5SJeff Kirsher 2315874aeea5SJeff Kirsher return 0; 2316874aeea5SJeff Kirsher } 2317874aeea5SJeff Kirsher 2318874aeea5SJeff Kirsher /* Context: netif_addr_lock held, BHs disabled. */ 23190fca8c97SBen Hutchings static void efx_set_rx_mode(struct net_device *net_dev) 2320874aeea5SJeff Kirsher { 2321874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2322874aeea5SJeff Kirsher 2323874aeea5SJeff Kirsher if (efx->port_enabled) 2324874aeea5SJeff Kirsher queue_work(efx->workqueue, &efx->mac_work); 2325874aeea5SJeff Kirsher /* Otherwise efx_start_port() will do this */ 2326874aeea5SJeff Kirsher } 2327874aeea5SJeff Kirsher 2328c8f44affSMichał Mirosław static int efx_set_features(struct net_device *net_dev, netdev_features_t data) 2329874aeea5SJeff Kirsher { 2330874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 23314a53ea8aSAndrew Rybchenko int rc; 2332874aeea5SJeff Kirsher 2333874aeea5SJeff Kirsher /* If disabling RX n-tuple filtering, clear existing filters */ 23344a53ea8aSAndrew Rybchenko if (net_dev->features & ~data & NETIF_F_NTUPLE) { 23354a53ea8aSAndrew Rybchenko rc = efx->type->filter_clear_rx(efx, EFX_FILTER_PRI_MANUAL); 23364a53ea8aSAndrew Rybchenko if (rc) 23374a53ea8aSAndrew Rybchenko return rc; 23384a53ea8aSAndrew Rybchenko } 23394a53ea8aSAndrew Rybchenko 23404a53ea8aSAndrew Rybchenko /* If Rx VLAN filter is changed, update filters via mac_reconfigure */ 23414a53ea8aSAndrew Rybchenko if ((net_dev->features ^ data) & NETIF_F_HW_VLAN_CTAG_FILTER) { 23424a53ea8aSAndrew Rybchenko /* efx_set_rx_mode() will schedule MAC work to update filters 23434a53ea8aSAndrew Rybchenko * when a new features are finally set in net_dev. 23444a53ea8aSAndrew Rybchenko */ 23454a53ea8aSAndrew Rybchenko efx_set_rx_mode(net_dev); 23464a53ea8aSAndrew Rybchenko } 2347874aeea5SJeff Kirsher 2348874aeea5SJeff Kirsher return 0; 2349874aeea5SJeff Kirsher } 2350874aeea5SJeff Kirsher 23514a53ea8aSAndrew Rybchenko static int efx_vlan_rx_add_vid(struct net_device *net_dev, __be16 proto, u16 vid) 23524a53ea8aSAndrew Rybchenko { 23534a53ea8aSAndrew Rybchenko struct efx_nic *efx = netdev_priv(net_dev); 23544a53ea8aSAndrew Rybchenko 23554a53ea8aSAndrew Rybchenko if (efx->type->vlan_rx_add_vid) 23564a53ea8aSAndrew Rybchenko return efx->type->vlan_rx_add_vid(efx, proto, vid); 23574a53ea8aSAndrew Rybchenko else 23584a53ea8aSAndrew Rybchenko return -EOPNOTSUPP; 23594a53ea8aSAndrew Rybchenko } 23604a53ea8aSAndrew Rybchenko 23614a53ea8aSAndrew Rybchenko static int efx_vlan_rx_kill_vid(struct net_device *net_dev, __be16 proto, u16 vid) 23624a53ea8aSAndrew Rybchenko { 23634a53ea8aSAndrew Rybchenko struct efx_nic *efx = netdev_priv(net_dev); 23644a53ea8aSAndrew Rybchenko 23654a53ea8aSAndrew Rybchenko if (efx->type->vlan_rx_kill_vid) 23664a53ea8aSAndrew Rybchenko return efx->type->vlan_rx_kill_vid(efx, proto, vid); 23674a53ea8aSAndrew Rybchenko else 23684a53ea8aSAndrew Rybchenko return -EOPNOTSUPP; 23694a53ea8aSAndrew Rybchenko } 23704a53ea8aSAndrew Rybchenko 23717fa8d547SShradha Shah static const struct net_device_ops efx_netdev_ops = { 2372874aeea5SJeff Kirsher .ndo_open = efx_net_open, 2373874aeea5SJeff Kirsher .ndo_stop = efx_net_stop, 2374874aeea5SJeff Kirsher .ndo_get_stats64 = efx_net_stats, 2375874aeea5SJeff Kirsher .ndo_tx_timeout = efx_watchdog, 2376874aeea5SJeff Kirsher .ndo_start_xmit = efx_hard_start_xmit, 2377874aeea5SJeff Kirsher .ndo_validate_addr = eth_validate_addr, 2378874aeea5SJeff Kirsher .ndo_do_ioctl = efx_ioctl, 2379874aeea5SJeff Kirsher .ndo_change_mtu = efx_change_mtu, 2380874aeea5SJeff Kirsher .ndo_set_mac_address = efx_set_mac_address, 23810fca8c97SBen Hutchings .ndo_set_rx_mode = efx_set_rx_mode, 2382874aeea5SJeff Kirsher .ndo_set_features = efx_set_features, 23834a53ea8aSAndrew Rybchenko .ndo_vlan_rx_add_vid = efx_vlan_rx_add_vid, 23844a53ea8aSAndrew Rybchenko .ndo_vlan_rx_kill_vid = efx_vlan_rx_kill_vid, 2385cd2d5b52SBen Hutchings #ifdef CONFIG_SFC_SRIOV 23867fa8d547SShradha Shah .ndo_set_vf_mac = efx_sriov_set_vf_mac, 23877fa8d547SShradha Shah .ndo_set_vf_vlan = efx_sriov_set_vf_vlan, 23887fa8d547SShradha Shah .ndo_set_vf_spoofchk = efx_sriov_set_vf_spoofchk, 23897fa8d547SShradha Shah .ndo_get_vf_config = efx_sriov_get_vf_config, 23904392dc69SEdward Cree .ndo_set_vf_link_state = efx_sriov_set_vf_link_state, 23911d051e00SShradha Shah .ndo_get_phys_port_id = efx_sriov_get_phys_port_id, 2392cd2d5b52SBen Hutchings #endif 2393874aeea5SJeff Kirsher #ifdef CONFIG_NET_POLL_CONTROLLER 2394874aeea5SJeff Kirsher .ndo_poll_controller = efx_netpoll, 2395874aeea5SJeff Kirsher #endif 2396874aeea5SJeff Kirsher .ndo_setup_tc = efx_setup_tc, 239736763266SAlexandre Rames #ifdef CONFIG_NET_RX_BUSY_POLL 239836763266SAlexandre Rames .ndo_busy_poll = efx_busy_poll, 239936763266SAlexandre Rames #endif 2400874aeea5SJeff Kirsher #ifdef CONFIG_RFS_ACCEL 2401874aeea5SJeff Kirsher .ndo_rx_flow_steer = efx_filter_rfs, 2402874aeea5SJeff Kirsher #endif 2403874aeea5SJeff Kirsher }; 2404874aeea5SJeff Kirsher 2405874aeea5SJeff Kirsher static void efx_update_name(struct efx_nic *efx) 2406874aeea5SJeff Kirsher { 2407874aeea5SJeff Kirsher strcpy(efx->name, efx->net_dev->name); 2408874aeea5SJeff Kirsher efx_mtd_rename(efx); 2409874aeea5SJeff Kirsher efx_set_channel_names(efx); 2410874aeea5SJeff Kirsher } 2411874aeea5SJeff Kirsher 2412874aeea5SJeff Kirsher static int efx_netdev_event(struct notifier_block *this, 2413874aeea5SJeff Kirsher unsigned long event, void *ptr) 2414874aeea5SJeff Kirsher { 2415351638e7SJiri Pirko struct net_device *net_dev = netdev_notifier_info_to_dev(ptr); 2416874aeea5SJeff Kirsher 24177fa8d547SShradha Shah if ((net_dev->netdev_ops == &efx_netdev_ops) && 2418874aeea5SJeff Kirsher event == NETDEV_CHANGENAME) 2419874aeea5SJeff Kirsher efx_update_name(netdev_priv(net_dev)); 2420874aeea5SJeff Kirsher 2421874aeea5SJeff Kirsher return NOTIFY_DONE; 2422874aeea5SJeff Kirsher } 2423874aeea5SJeff Kirsher 2424874aeea5SJeff Kirsher static struct notifier_block efx_netdev_notifier = { 2425874aeea5SJeff Kirsher .notifier_call = efx_netdev_event, 2426874aeea5SJeff Kirsher }; 2427874aeea5SJeff Kirsher 2428874aeea5SJeff Kirsher static ssize_t 2429874aeea5SJeff Kirsher show_phy_type(struct device *dev, struct device_attribute *attr, char *buf) 2430874aeea5SJeff Kirsher { 2431874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); 2432874aeea5SJeff Kirsher return sprintf(buf, "%d\n", efx->phy_type); 2433874aeea5SJeff Kirsher } 2434776fbcc9SBen Hutchings static DEVICE_ATTR(phy_type, 0444, show_phy_type, NULL); 2435874aeea5SJeff Kirsher 2436e7fef9b4SEdward Cree #ifdef CONFIG_SFC_MCDI_LOGGING 2437e7fef9b4SEdward Cree static ssize_t show_mcdi_log(struct device *dev, struct device_attribute *attr, 2438e7fef9b4SEdward Cree char *buf) 2439e7fef9b4SEdward Cree { 2440e7fef9b4SEdward Cree struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); 2441e7fef9b4SEdward Cree struct efx_mcdi_iface *mcdi = efx_mcdi(efx); 2442e7fef9b4SEdward Cree 2443e7fef9b4SEdward Cree return scnprintf(buf, PAGE_SIZE, "%d\n", mcdi->logging_enabled); 2444e7fef9b4SEdward Cree } 2445e7fef9b4SEdward Cree static ssize_t set_mcdi_log(struct device *dev, struct device_attribute *attr, 2446e7fef9b4SEdward Cree const char *buf, size_t count) 2447e7fef9b4SEdward Cree { 2448e7fef9b4SEdward Cree struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); 2449e7fef9b4SEdward Cree struct efx_mcdi_iface *mcdi = efx_mcdi(efx); 2450e7fef9b4SEdward Cree bool enable = count > 0 && *buf != '0'; 2451e7fef9b4SEdward Cree 2452e7fef9b4SEdward Cree mcdi->logging_enabled = enable; 2453e7fef9b4SEdward Cree return count; 2454e7fef9b4SEdward Cree } 2455e7fef9b4SEdward Cree static DEVICE_ATTR(mcdi_logging, 0644, show_mcdi_log, set_mcdi_log); 2456e7fef9b4SEdward Cree #endif 2457e7fef9b4SEdward Cree 2458874aeea5SJeff Kirsher static int efx_register_netdev(struct efx_nic *efx) 2459874aeea5SJeff Kirsher { 2460874aeea5SJeff Kirsher struct net_device *net_dev = efx->net_dev; 2461874aeea5SJeff Kirsher struct efx_channel *channel; 2462874aeea5SJeff Kirsher int rc; 2463874aeea5SJeff Kirsher 2464874aeea5SJeff Kirsher net_dev->watchdog_timeo = 5 * HZ; 2465874aeea5SJeff Kirsher net_dev->irq = efx->pci_dev->irq; 24667fa8d547SShradha Shah net_dev->netdev_ops = &efx_netdev_ops; 24677fa8d547SShradha Shah if (efx_nic_rev(efx) >= EFX_REV_HUNT_A0) 24688127d661SBen Hutchings net_dev->priv_flags |= IFF_UNICAST_FLT; 24697ad24ea4SWilfried Klaebe net_dev->ethtool_ops = &efx_ethtool_ops; 24707e6d06f0SBen Hutchings net_dev->gso_max_segs = EFX_TSO_MAX_SEGS; 2471874aeea5SJeff Kirsher 2472874aeea5SJeff Kirsher rtnl_lock(); 2473874aeea5SJeff Kirsher 24747153f623SBen Hutchings /* Enable resets to be scheduled and check whether any were 24757153f623SBen Hutchings * already requested. If so, the NIC is probably hosed so we 24767153f623SBen Hutchings * abort. 24777153f623SBen Hutchings */ 24787153f623SBen Hutchings efx->state = STATE_READY; 24797153f623SBen Hutchings smp_mb(); /* ensure we change state before checking reset_pending */ 24807153f623SBen Hutchings if (efx->reset_pending) { 24817153f623SBen Hutchings netif_err(efx, probe, efx->net_dev, 24827153f623SBen Hutchings "aborting probe due to scheduled reset\n"); 24837153f623SBen Hutchings rc = -EIO; 24847153f623SBen Hutchings goto fail_locked; 24857153f623SBen Hutchings } 24867153f623SBen Hutchings 2487874aeea5SJeff Kirsher rc = dev_alloc_name(net_dev, net_dev->name); 2488874aeea5SJeff Kirsher if (rc < 0) 2489874aeea5SJeff Kirsher goto fail_locked; 2490874aeea5SJeff Kirsher efx_update_name(efx); 2491874aeea5SJeff Kirsher 24928f8b3d51SBen Hutchings /* Always start with carrier off; PHY events will detect the link */ 24938f8b3d51SBen Hutchings netif_carrier_off(net_dev); 24948f8b3d51SBen Hutchings 2495874aeea5SJeff Kirsher rc = register_netdevice(net_dev); 2496874aeea5SJeff Kirsher if (rc) 2497874aeea5SJeff Kirsher goto fail_locked; 2498874aeea5SJeff Kirsher 2499874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 2500874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 2501874aeea5SJeff Kirsher efx_for_each_channel_tx_queue(tx_queue, channel) 2502874aeea5SJeff Kirsher efx_init_tx_queue_core_txq(tx_queue); 2503874aeea5SJeff Kirsher } 2504874aeea5SJeff Kirsher 25050bcf4a64SBen Hutchings efx_associate(efx); 25060bcf4a64SBen Hutchings 2507874aeea5SJeff Kirsher rtnl_unlock(); 2508874aeea5SJeff Kirsher 2509874aeea5SJeff Kirsher rc = device_create_file(&efx->pci_dev->dev, &dev_attr_phy_type); 2510874aeea5SJeff Kirsher if (rc) { 2511874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 2512874aeea5SJeff Kirsher "failed to init net dev attributes\n"); 2513874aeea5SJeff Kirsher goto fail_registered; 2514874aeea5SJeff Kirsher } 2515e7fef9b4SEdward Cree #ifdef CONFIG_SFC_MCDI_LOGGING 2516e7fef9b4SEdward Cree rc = device_create_file(&efx->pci_dev->dev, &dev_attr_mcdi_logging); 2517e7fef9b4SEdward Cree if (rc) { 2518e7fef9b4SEdward Cree netif_err(efx, drv, efx->net_dev, 2519e7fef9b4SEdward Cree "failed to init net dev attributes\n"); 2520e7fef9b4SEdward Cree goto fail_attr_mcdi_logging; 2521e7fef9b4SEdward Cree } 2522e7fef9b4SEdward Cree #endif 2523874aeea5SJeff Kirsher 2524874aeea5SJeff Kirsher return 0; 2525874aeea5SJeff Kirsher 2526e7fef9b4SEdward Cree #ifdef CONFIG_SFC_MCDI_LOGGING 2527e7fef9b4SEdward Cree fail_attr_mcdi_logging: 2528e7fef9b4SEdward Cree device_remove_file(&efx->pci_dev->dev, &dev_attr_phy_type); 2529e7fef9b4SEdward Cree #endif 25307153f623SBen Hutchings fail_registered: 25317153f623SBen Hutchings rtnl_lock(); 25320bcf4a64SBen Hutchings efx_dissociate(efx); 25337153f623SBen Hutchings unregister_netdevice(net_dev); 2534874aeea5SJeff Kirsher fail_locked: 25357153f623SBen Hutchings efx->state = STATE_UNINIT; 2536874aeea5SJeff Kirsher rtnl_unlock(); 2537874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "could not register net dev\n"); 2538874aeea5SJeff Kirsher return rc; 2539874aeea5SJeff Kirsher } 2540874aeea5SJeff Kirsher 2541874aeea5SJeff Kirsher static void efx_unregister_netdev(struct efx_nic *efx) 2542874aeea5SJeff Kirsher { 2543874aeea5SJeff Kirsher if (!efx->net_dev) 2544874aeea5SJeff Kirsher return; 2545874aeea5SJeff Kirsher 2546874aeea5SJeff Kirsher BUG_ON(netdev_priv(efx->net_dev) != efx); 2547874aeea5SJeff Kirsher 2548e7fef9b4SEdward Cree if (efx_dev_registered(efx)) { 2549874aeea5SJeff Kirsher strlcpy(efx->name, pci_name(efx->pci_dev), sizeof(efx->name)); 2550e7fef9b4SEdward Cree #ifdef CONFIG_SFC_MCDI_LOGGING 2551e7fef9b4SEdward Cree device_remove_file(&efx->pci_dev->dev, &dev_attr_mcdi_logging); 2552e7fef9b4SEdward Cree #endif 2553874aeea5SJeff Kirsher device_remove_file(&efx->pci_dev->dev, &dev_attr_phy_type); 2554e7fef9b4SEdward Cree unregister_netdev(efx->net_dev); 2555e7fef9b4SEdward Cree } 2556874aeea5SJeff Kirsher } 2557874aeea5SJeff Kirsher 2558874aeea5SJeff Kirsher /************************************************************************** 2559874aeea5SJeff Kirsher * 2560874aeea5SJeff Kirsher * Device reset and suspend 2561874aeea5SJeff Kirsher * 2562874aeea5SJeff Kirsher **************************************************************************/ 2563874aeea5SJeff Kirsher 2564874aeea5SJeff Kirsher /* Tears down the entire software state and most of the hardware state 2565874aeea5SJeff Kirsher * before reset. */ 2566874aeea5SJeff Kirsher void efx_reset_down(struct efx_nic *efx, enum reset_type method) 2567874aeea5SJeff Kirsher { 2568874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 2569874aeea5SJeff Kirsher 2570e283546cSEdward Cree if (method == RESET_TYPE_MCDI_TIMEOUT) 2571e283546cSEdward Cree efx->type->prepare_flr(efx); 2572e283546cSEdward Cree 2573874aeea5SJeff Kirsher efx_stop_all(efx); 2574d8291187SBen Hutchings efx_disable_interrupts(efx); 25755642ceefSBen Hutchings 25765642ceefSBen Hutchings mutex_lock(&efx->mac_lock); 2577087e9025SJon Cooper if (efx->port_initialized && method != RESET_TYPE_INVISIBLE && 2578087e9025SJon Cooper method != RESET_TYPE_DATAPATH) 2579874aeea5SJeff Kirsher efx->phy_op->fini(efx); 2580874aeea5SJeff Kirsher efx->type->fini(efx); 2581874aeea5SJeff Kirsher } 2582874aeea5SJeff Kirsher 2583874aeea5SJeff Kirsher /* This function will always ensure that the locks acquired in 2584874aeea5SJeff Kirsher * efx_reset_down() are released. A failure return code indicates 2585874aeea5SJeff Kirsher * that we were unable to reinitialise the hardware, and the 2586874aeea5SJeff Kirsher * driver should be disabled. If ok is false, then the rx and tx 2587874aeea5SJeff Kirsher * engines are not restarted, pending a RESET_DISABLE. */ 2588874aeea5SJeff Kirsher int efx_reset_up(struct efx_nic *efx, enum reset_type method, bool ok) 2589874aeea5SJeff Kirsher { 2590874aeea5SJeff Kirsher int rc; 2591874aeea5SJeff Kirsher 2592874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 2593874aeea5SJeff Kirsher 2594e283546cSEdward Cree if (method == RESET_TYPE_MCDI_TIMEOUT) 2595e283546cSEdward Cree efx->type->finish_flr(efx); 2596e283546cSEdward Cree 2597e283546cSEdward Cree /* Ensure that SRAM is initialised even if we're disabling the device */ 2598874aeea5SJeff Kirsher rc = efx->type->init(efx); 2599874aeea5SJeff Kirsher if (rc) { 2600874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "failed to initialise NIC\n"); 2601874aeea5SJeff Kirsher goto fail; 2602874aeea5SJeff Kirsher } 2603874aeea5SJeff Kirsher 2604874aeea5SJeff Kirsher if (!ok) 2605874aeea5SJeff Kirsher goto fail; 2606874aeea5SJeff Kirsher 2607087e9025SJon Cooper if (efx->port_initialized && method != RESET_TYPE_INVISIBLE && 2608087e9025SJon Cooper method != RESET_TYPE_DATAPATH) { 2609874aeea5SJeff Kirsher rc = efx->phy_op->init(efx); 2610874aeea5SJeff Kirsher if (rc) 2611874aeea5SJeff Kirsher goto fail; 2612267d9d73SEdward Cree rc = efx->phy_op->reconfigure(efx); 2613267d9d73SEdward Cree if (rc && rc != -EPERM) 2614874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 2615874aeea5SJeff Kirsher "could not restore PHY settings\n"); 2616874aeea5SJeff Kirsher } 2617874aeea5SJeff Kirsher 2618261e4d96SJon Cooper rc = efx_enable_interrupts(efx); 2619261e4d96SJon Cooper if (rc) 2620261e4d96SJon Cooper goto fail; 26216d8aaaf6SDaniel Pieczko 26226d8aaaf6SDaniel Pieczko #ifdef CONFIG_SFC_SRIOV 26236d8aaaf6SDaniel Pieczko rc = efx->type->vswitching_restore(efx); 26246d8aaaf6SDaniel Pieczko if (rc) /* not fatal; the PF will still work fine */ 26256d8aaaf6SDaniel Pieczko netif_warn(efx, probe, efx->net_dev, 26266d8aaaf6SDaniel Pieczko "failed to restore vswitching rc=%d;" 26276d8aaaf6SDaniel Pieczko " VFs may not function\n", rc); 26286d8aaaf6SDaniel Pieczko #endif 26296d8aaaf6SDaniel Pieczko 26300d322413SEdward Cree down_read(&efx->filter_sem); 2631874aeea5SJeff Kirsher efx_restore_filters(efx); 26320d322413SEdward Cree up_read(&efx->filter_sem); 26337fa8d547SShradha Shah if (efx->type->sriov_reset) 2634d98a4ffeSShradha Shah efx->type->sriov_reset(efx); 2635874aeea5SJeff Kirsher 2636874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2637874aeea5SJeff Kirsher 2638874aeea5SJeff Kirsher efx_start_all(efx); 2639874aeea5SJeff Kirsher 2640874aeea5SJeff Kirsher return 0; 2641874aeea5SJeff Kirsher 2642874aeea5SJeff Kirsher fail: 2643874aeea5SJeff Kirsher efx->port_initialized = false; 2644874aeea5SJeff Kirsher 2645874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2646874aeea5SJeff Kirsher 2647874aeea5SJeff Kirsher return rc; 2648874aeea5SJeff Kirsher } 2649874aeea5SJeff Kirsher 2650874aeea5SJeff Kirsher /* Reset the NIC using the specified method. Note that the reset may 2651874aeea5SJeff Kirsher * fail, in which case the card will be left in an unusable state. 2652874aeea5SJeff Kirsher * 2653874aeea5SJeff Kirsher * Caller must hold the rtnl_lock. 2654874aeea5SJeff Kirsher */ 2655874aeea5SJeff Kirsher int efx_reset(struct efx_nic *efx, enum reset_type method) 2656874aeea5SJeff Kirsher { 2657874aeea5SJeff Kirsher int rc, rc2; 2658874aeea5SJeff Kirsher bool disabled; 2659874aeea5SJeff Kirsher 2660874aeea5SJeff Kirsher netif_info(efx, drv, efx->net_dev, "resetting (%s)\n", 2661874aeea5SJeff Kirsher RESET_TYPE(method)); 2662874aeea5SJeff Kirsher 2663c2f3b8e3SDaniel Pieczko efx_device_detach_sync(efx); 2664874aeea5SJeff Kirsher efx_reset_down(efx, method); 2665874aeea5SJeff Kirsher 2666874aeea5SJeff Kirsher rc = efx->type->reset(efx, method); 2667874aeea5SJeff Kirsher if (rc) { 2668874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "failed to reset hardware\n"); 2669874aeea5SJeff Kirsher goto out; 2670874aeea5SJeff Kirsher } 2671874aeea5SJeff Kirsher 2672874aeea5SJeff Kirsher /* Clear flags for the scopes we covered. We assume the NIC and 2673874aeea5SJeff Kirsher * driver are now quiescent so that there is no race here. 2674874aeea5SJeff Kirsher */ 2675e283546cSEdward Cree if (method < RESET_TYPE_MAX_METHOD) 2676874aeea5SJeff Kirsher efx->reset_pending &= -(1 << (method + 1)); 2677e283546cSEdward Cree else /* it doesn't fit into the well-ordered scope hierarchy */ 2678e283546cSEdward Cree __clear_bit(method, &efx->reset_pending); 2679874aeea5SJeff Kirsher 2680874aeea5SJeff Kirsher /* Reinitialise bus-mastering, which may have been turned off before 2681874aeea5SJeff Kirsher * the reset was scheduled. This is still appropriate, even in the 2682874aeea5SJeff Kirsher * RESET_TYPE_DISABLE since this driver generally assumes the hardware 2683874aeea5SJeff Kirsher * can respond to requests. */ 2684874aeea5SJeff Kirsher pci_set_master(efx->pci_dev); 2685874aeea5SJeff Kirsher 2686874aeea5SJeff Kirsher out: 2687874aeea5SJeff Kirsher /* Leave device stopped if necessary */ 2688626950dbSAlexandre Rames disabled = rc || 2689626950dbSAlexandre Rames method == RESET_TYPE_DISABLE || 2690626950dbSAlexandre Rames method == RESET_TYPE_RECOVER_OR_DISABLE; 2691874aeea5SJeff Kirsher rc2 = efx_reset_up(efx, method, !disabled); 2692874aeea5SJeff Kirsher if (rc2) { 2693874aeea5SJeff Kirsher disabled = true; 2694874aeea5SJeff Kirsher if (!rc) 2695874aeea5SJeff Kirsher rc = rc2; 2696874aeea5SJeff Kirsher } 2697874aeea5SJeff Kirsher 2698874aeea5SJeff Kirsher if (disabled) { 2699874aeea5SJeff Kirsher dev_close(efx->net_dev); 2700874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "has been disabled\n"); 2701874aeea5SJeff Kirsher efx->state = STATE_DISABLED; 2702874aeea5SJeff Kirsher } else { 2703874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "reset complete\n"); 2704874aeea5SJeff Kirsher netif_device_attach(efx->net_dev); 2705874aeea5SJeff Kirsher } 2706874aeea5SJeff Kirsher return rc; 2707874aeea5SJeff Kirsher } 2708874aeea5SJeff Kirsher 2709626950dbSAlexandre Rames /* Try recovery mechanisms. 2710626950dbSAlexandre Rames * For now only EEH is supported. 2711626950dbSAlexandre Rames * Returns 0 if the recovery mechanisms are unsuccessful. 2712626950dbSAlexandre Rames * Returns a non-zero value otherwise. 2713626950dbSAlexandre Rames */ 2714b28405b0SAlexandre Rames int efx_try_recovery(struct efx_nic *efx) 2715626950dbSAlexandre Rames { 2716626950dbSAlexandre Rames #ifdef CONFIG_EEH 2717626950dbSAlexandre Rames /* A PCI error can occur and not be seen by EEH because nothing 2718626950dbSAlexandre Rames * happens on the PCI bus. In this case the driver may fail and 2719626950dbSAlexandre Rames * schedule a 'recover or reset', leading to this recovery handler. 2720626950dbSAlexandre Rames * Manually call the eeh failure check function. 2721626950dbSAlexandre Rames */ 272212a89dbaSBenjamin Herrenschmidt struct eeh_dev *eehdev = pci_dev_to_eeh_dev(efx->pci_dev); 2723626950dbSAlexandre Rames if (eeh_dev_check_failure(eehdev)) { 2724626950dbSAlexandre Rames /* The EEH mechanisms will handle the error and reset the 2725626950dbSAlexandre Rames * device if necessary. 2726626950dbSAlexandre Rames */ 2727626950dbSAlexandre Rames return 1; 2728626950dbSAlexandre Rames } 2729626950dbSAlexandre Rames #endif 2730626950dbSAlexandre Rames return 0; 2731626950dbSAlexandre Rames } 2732626950dbSAlexandre Rames 273374cd60a4SJon Cooper static void efx_wait_for_bist_end(struct efx_nic *efx) 273474cd60a4SJon Cooper { 273574cd60a4SJon Cooper int i; 273674cd60a4SJon Cooper 273774cd60a4SJon Cooper for (i = 0; i < BIST_WAIT_DELAY_COUNT; ++i) { 273874cd60a4SJon Cooper if (efx_mcdi_poll_reboot(efx)) 273974cd60a4SJon Cooper goto out; 274074cd60a4SJon Cooper msleep(BIST_WAIT_DELAY_MS); 274174cd60a4SJon Cooper } 274274cd60a4SJon Cooper 274374cd60a4SJon Cooper netif_err(efx, drv, efx->net_dev, "Warning: No MC reboot after BIST mode\n"); 274474cd60a4SJon Cooper out: 274574cd60a4SJon Cooper /* Either way unset the BIST flag. If we found no reboot we probably 274674cd60a4SJon Cooper * won't recover, but we should try. 274774cd60a4SJon Cooper */ 274874cd60a4SJon Cooper efx->mc_bist_for_other_fn = false; 274974cd60a4SJon Cooper } 275074cd60a4SJon Cooper 2751874aeea5SJeff Kirsher /* The worker thread exists so that code that cannot sleep can 2752874aeea5SJeff Kirsher * schedule a reset for later. 2753874aeea5SJeff Kirsher */ 2754874aeea5SJeff Kirsher static void efx_reset_work(struct work_struct *data) 2755874aeea5SJeff Kirsher { 2756874aeea5SJeff Kirsher struct efx_nic *efx = container_of(data, struct efx_nic, reset_work); 2757626950dbSAlexandre Rames unsigned long pending; 2758626950dbSAlexandre Rames enum reset_type method; 2759626950dbSAlexandre Rames 2760626950dbSAlexandre Rames pending = ACCESS_ONCE(efx->reset_pending); 2761626950dbSAlexandre Rames method = fls(pending) - 1; 2762626950dbSAlexandre Rames 276374cd60a4SJon Cooper if (method == RESET_TYPE_MC_BIST) 276474cd60a4SJon Cooper efx_wait_for_bist_end(efx); 276574cd60a4SJon Cooper 2766626950dbSAlexandre Rames if ((method == RESET_TYPE_RECOVER_OR_DISABLE || 2767626950dbSAlexandre Rames method == RESET_TYPE_RECOVER_OR_ALL) && 2768626950dbSAlexandre Rames efx_try_recovery(efx)) 2769626950dbSAlexandre Rames return; 2770874aeea5SJeff Kirsher 2771874aeea5SJeff Kirsher if (!pending) 2772874aeea5SJeff Kirsher return; 2773874aeea5SJeff Kirsher 2774874aeea5SJeff Kirsher rtnl_lock(); 27757153f623SBen Hutchings 27767153f623SBen Hutchings /* We checked the state in efx_schedule_reset() but it may 27777153f623SBen Hutchings * have changed by now. Now that we have the RTNL lock, 27787153f623SBen Hutchings * it cannot change again. 27797153f623SBen Hutchings */ 27807153f623SBen Hutchings if (efx->state == STATE_READY) 2781626950dbSAlexandre Rames (void)efx_reset(efx, method); 27827153f623SBen Hutchings 2783874aeea5SJeff Kirsher rtnl_unlock(); 2784874aeea5SJeff Kirsher } 2785874aeea5SJeff Kirsher 2786874aeea5SJeff Kirsher void efx_schedule_reset(struct efx_nic *efx, enum reset_type type) 2787874aeea5SJeff Kirsher { 2788874aeea5SJeff Kirsher enum reset_type method; 2789874aeea5SJeff Kirsher 2790626950dbSAlexandre Rames if (efx->state == STATE_RECOVERY) { 2791626950dbSAlexandre Rames netif_dbg(efx, drv, efx->net_dev, 2792626950dbSAlexandre Rames "recovering: skip scheduling %s reset\n", 2793626950dbSAlexandre Rames RESET_TYPE(type)); 2794626950dbSAlexandre Rames return; 2795626950dbSAlexandre Rames } 2796626950dbSAlexandre Rames 2797874aeea5SJeff Kirsher switch (type) { 2798874aeea5SJeff Kirsher case RESET_TYPE_INVISIBLE: 2799874aeea5SJeff Kirsher case RESET_TYPE_ALL: 2800626950dbSAlexandre Rames case RESET_TYPE_RECOVER_OR_ALL: 2801874aeea5SJeff Kirsher case RESET_TYPE_WORLD: 2802874aeea5SJeff Kirsher case RESET_TYPE_DISABLE: 2803626950dbSAlexandre Rames case RESET_TYPE_RECOVER_OR_DISABLE: 2804087e9025SJon Cooper case RESET_TYPE_DATAPATH: 280574cd60a4SJon Cooper case RESET_TYPE_MC_BIST: 2806e283546cSEdward Cree case RESET_TYPE_MCDI_TIMEOUT: 2807874aeea5SJeff Kirsher method = type; 2808874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "scheduling %s reset\n", 2809874aeea5SJeff Kirsher RESET_TYPE(method)); 2810874aeea5SJeff Kirsher break; 2811874aeea5SJeff Kirsher default: 2812874aeea5SJeff Kirsher method = efx->type->map_reset_reason(type); 2813874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, 2814874aeea5SJeff Kirsher "scheduling %s reset for %s\n", 2815874aeea5SJeff Kirsher RESET_TYPE(method), RESET_TYPE(type)); 2816874aeea5SJeff Kirsher break; 2817874aeea5SJeff Kirsher } 2818874aeea5SJeff Kirsher 2819874aeea5SJeff Kirsher set_bit(method, &efx->reset_pending); 28207153f623SBen Hutchings smp_mb(); /* ensure we change reset_pending before checking state */ 28217153f623SBen Hutchings 28227153f623SBen Hutchings /* If we're not READY then just leave the flags set as the cue 28237153f623SBen Hutchings * to abort probing or reschedule the reset later. 28247153f623SBen Hutchings */ 28257153f623SBen Hutchings if (ACCESS_ONCE(efx->state) != STATE_READY) 28267153f623SBen Hutchings return; 2827874aeea5SJeff Kirsher 2828874aeea5SJeff Kirsher /* efx_process_channel() will no longer read events once a 2829874aeea5SJeff Kirsher * reset is scheduled. So switch back to poll'd MCDI completions. */ 2830874aeea5SJeff Kirsher efx_mcdi_mode_poll(efx); 2831874aeea5SJeff Kirsher 2832874aeea5SJeff Kirsher queue_work(reset_workqueue, &efx->reset_work); 2833874aeea5SJeff Kirsher } 2834874aeea5SJeff Kirsher 2835874aeea5SJeff Kirsher /************************************************************************** 2836874aeea5SJeff Kirsher * 2837874aeea5SJeff Kirsher * List of NICs we support 2838874aeea5SJeff Kirsher * 2839874aeea5SJeff Kirsher **************************************************************************/ 2840874aeea5SJeff Kirsher 2841874aeea5SJeff Kirsher /* PCI device ID table */ 28429baa3c34SBenoit Taine static const struct pci_device_id efx_pci_table[] = { 28430e59e7e7SLinus Torvalds {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 28440e59e7e7SLinus Torvalds PCI_DEVICE_ID_SOLARFLARE_SFC4000A_0), 2845874aeea5SJeff Kirsher .driver_data = (unsigned long) &falcon_a1_nic_type}, 28460e59e7e7SLinus Torvalds {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 28470e59e7e7SLinus Torvalds PCI_DEVICE_ID_SOLARFLARE_SFC4000B), 2848874aeea5SJeff Kirsher .driver_data = (unsigned long) &falcon_b0_nic_type}, 2849547c474fSBen Hutchings {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x0803), /* SFC9020 */ 2850874aeea5SJeff Kirsher .driver_data = (unsigned long) &siena_a0_nic_type}, 2851547c474fSBen Hutchings {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x0813), /* SFL9021 */ 2852874aeea5SJeff Kirsher .driver_data = (unsigned long) &siena_a0_nic_type}, 28538127d661SBen Hutchings {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x0903), /* SFC9120 PF */ 28548127d661SBen Hutchings .driver_data = (unsigned long) &efx_hunt_a0_nic_type}, 28556f7f8aa6SShradha Shah {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x1903), /* SFC9120 VF */ 28566f7f8aa6SShradha Shah .driver_data = (unsigned long) &efx_hunt_a0_vf_nic_type}, 28573b06a00eSMateusz Wrzesinski {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x0923), /* SFC9140 PF */ 28583b06a00eSMateusz Wrzesinski .driver_data = (unsigned long) &efx_hunt_a0_nic_type}, 2859dd248f1bSBert Kenward {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x1923), /* SFC9140 VF */ 2860dd248f1bSBert Kenward .driver_data = (unsigned long) &efx_hunt_a0_vf_nic_type}, 2861dd248f1bSBert Kenward {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x0a03), /* SFC9220 PF */ 2862dd248f1bSBert Kenward .driver_data = (unsigned long) &efx_hunt_a0_nic_type}, 2863dd248f1bSBert Kenward {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x1a03), /* SFC9220 VF */ 2864dd248f1bSBert Kenward .driver_data = (unsigned long) &efx_hunt_a0_vf_nic_type}, 2865874aeea5SJeff Kirsher {0} /* end of list */ 2866874aeea5SJeff Kirsher }; 2867874aeea5SJeff Kirsher 2868874aeea5SJeff Kirsher /************************************************************************** 2869874aeea5SJeff Kirsher * 2870874aeea5SJeff Kirsher * Dummy PHY/MAC operations 2871874aeea5SJeff Kirsher * 2872874aeea5SJeff Kirsher * Can be used for some unimplemented operations 2873874aeea5SJeff Kirsher * Needed so all function pointers are valid and do not have to be tested 2874874aeea5SJeff Kirsher * before use 2875874aeea5SJeff Kirsher * 2876874aeea5SJeff Kirsher **************************************************************************/ 2877874aeea5SJeff Kirsher int efx_port_dummy_op_int(struct efx_nic *efx) 2878874aeea5SJeff Kirsher { 2879874aeea5SJeff Kirsher return 0; 2880874aeea5SJeff Kirsher } 2881874aeea5SJeff Kirsher void efx_port_dummy_op_void(struct efx_nic *efx) {} 2882874aeea5SJeff Kirsher 2883874aeea5SJeff Kirsher static bool efx_port_dummy_op_poll(struct efx_nic *efx) 2884874aeea5SJeff Kirsher { 2885874aeea5SJeff Kirsher return false; 2886874aeea5SJeff Kirsher } 2887874aeea5SJeff Kirsher 2888874aeea5SJeff Kirsher static const struct efx_phy_operations efx_dummy_phy_operations = { 2889874aeea5SJeff Kirsher .init = efx_port_dummy_op_int, 2890874aeea5SJeff Kirsher .reconfigure = efx_port_dummy_op_int, 2891874aeea5SJeff Kirsher .poll = efx_port_dummy_op_poll, 2892874aeea5SJeff Kirsher .fini = efx_port_dummy_op_void, 2893874aeea5SJeff Kirsher }; 2894874aeea5SJeff Kirsher 2895874aeea5SJeff Kirsher /************************************************************************** 2896874aeea5SJeff Kirsher * 2897874aeea5SJeff Kirsher * Data housekeeping 2898874aeea5SJeff Kirsher * 2899874aeea5SJeff Kirsher **************************************************************************/ 2900874aeea5SJeff Kirsher 2901874aeea5SJeff Kirsher /* This zeroes out and then fills in the invariants in a struct 2902874aeea5SJeff Kirsher * efx_nic (including all sub-structures). 2903874aeea5SJeff Kirsher */ 2904adeb15aaSBen Hutchings static int efx_init_struct(struct efx_nic *efx, 2905874aeea5SJeff Kirsher struct pci_dev *pci_dev, struct net_device *net_dev) 2906874aeea5SJeff Kirsher { 2907874aeea5SJeff Kirsher int i; 2908874aeea5SJeff Kirsher 2909874aeea5SJeff Kirsher /* Initialise common structures */ 29100bcf4a64SBen Hutchings INIT_LIST_HEAD(&efx->node); 29110bcf4a64SBen Hutchings INIT_LIST_HEAD(&efx->secondary_list); 2912874aeea5SJeff Kirsher spin_lock_init(&efx->biu_lock); 2913874aeea5SJeff Kirsher #ifdef CONFIG_SFC_MTD 2914874aeea5SJeff Kirsher INIT_LIST_HEAD(&efx->mtd_list); 2915874aeea5SJeff Kirsher #endif 2916874aeea5SJeff Kirsher INIT_WORK(&efx->reset_work, efx_reset_work); 2917874aeea5SJeff Kirsher INIT_DELAYED_WORK(&efx->monitor_work, efx_monitor); 2918dd40781eSBen Hutchings INIT_DELAYED_WORK(&efx->selftest_work, efx_selftest_async_work); 2919874aeea5SJeff Kirsher efx->pci_dev = pci_dev; 2920874aeea5SJeff Kirsher efx->msg_enable = debug; 2921f16aeea0SBen Hutchings efx->state = STATE_UNINIT; 2922874aeea5SJeff Kirsher strlcpy(efx->name, pci_name(pci_dev), sizeof(efx->name)); 2923874aeea5SJeff Kirsher 2924874aeea5SJeff Kirsher efx->net_dev = net_dev; 292543a3739dSJon Cooper efx->rx_prefix_size = efx->type->rx_prefix_size; 29262ec03014SAndrew Rybchenko efx->rx_ip_align = 29272ec03014SAndrew Rybchenko NET_IP_ALIGN ? (efx->rx_prefix_size + NET_IP_ALIGN) % 4 : 0; 292843a3739dSJon Cooper efx->rx_packet_hash_offset = 292943a3739dSJon Cooper efx->type->rx_hash_offset - efx->type->rx_prefix_size; 2930bd9a265dSJon Cooper efx->rx_packet_ts_offset = 2931bd9a265dSJon Cooper efx->type->rx_ts_offset - efx->type->rx_prefix_size; 2932874aeea5SJeff Kirsher spin_lock_init(&efx->stats_lock); 2933874aeea5SJeff Kirsher mutex_init(&efx->mac_lock); 2934874aeea5SJeff Kirsher efx->phy_op = &efx_dummy_phy_operations; 2935874aeea5SJeff Kirsher efx->mdio.dev = net_dev; 2936874aeea5SJeff Kirsher INIT_WORK(&efx->mac_work, efx_mac_work); 29379f2cb71cSBen Hutchings init_waitqueue_head(&efx->flush_wq); 2938874aeea5SJeff Kirsher 2939874aeea5SJeff Kirsher for (i = 0; i < EFX_MAX_CHANNELS; i++) { 2940874aeea5SJeff Kirsher efx->channel[i] = efx_alloc_channel(efx, i, NULL); 2941874aeea5SJeff Kirsher if (!efx->channel[i]) 2942874aeea5SJeff Kirsher goto fail; 2943d8291187SBen Hutchings efx->msi_context[i].efx = efx; 2944d8291187SBen Hutchings efx->msi_context[i].index = i; 2945874aeea5SJeff Kirsher } 2946874aeea5SJeff Kirsher 2947874aeea5SJeff Kirsher /* Higher numbered interrupt modes are less capable! */ 2948874aeea5SJeff Kirsher efx->interrupt_mode = max(efx->type->max_interrupt_mode, 2949874aeea5SJeff Kirsher interrupt_mode); 2950874aeea5SJeff Kirsher 2951874aeea5SJeff Kirsher /* Would be good to use the net_dev name, but we're too early */ 2952874aeea5SJeff Kirsher snprintf(efx->workqueue_name, sizeof(efx->workqueue_name), "sfc%s", 2953874aeea5SJeff Kirsher pci_name(pci_dev)); 2954874aeea5SJeff Kirsher efx->workqueue = create_singlethread_workqueue(efx->workqueue_name); 2955874aeea5SJeff Kirsher if (!efx->workqueue) 2956874aeea5SJeff Kirsher goto fail; 2957874aeea5SJeff Kirsher 2958874aeea5SJeff Kirsher return 0; 2959874aeea5SJeff Kirsher 2960874aeea5SJeff Kirsher fail: 2961874aeea5SJeff Kirsher efx_fini_struct(efx); 2962874aeea5SJeff Kirsher return -ENOMEM; 2963874aeea5SJeff Kirsher } 2964874aeea5SJeff Kirsher 2965874aeea5SJeff Kirsher static void efx_fini_struct(struct efx_nic *efx) 2966874aeea5SJeff Kirsher { 2967874aeea5SJeff Kirsher int i; 2968874aeea5SJeff Kirsher 2969874aeea5SJeff Kirsher for (i = 0; i < EFX_MAX_CHANNELS; i++) 2970874aeea5SJeff Kirsher kfree(efx->channel[i]); 2971874aeea5SJeff Kirsher 2972ef215e64SBen Hutchings kfree(efx->vpd_sn); 2973ef215e64SBen Hutchings 2974874aeea5SJeff Kirsher if (efx->workqueue) { 2975874aeea5SJeff Kirsher destroy_workqueue(efx->workqueue); 2976874aeea5SJeff Kirsher efx->workqueue = NULL; 2977874aeea5SJeff Kirsher } 2978874aeea5SJeff Kirsher } 2979874aeea5SJeff Kirsher 2980e4d112e4SEdward Cree void efx_update_sw_stats(struct efx_nic *efx, u64 *stats) 2981e4d112e4SEdward Cree { 2982e4d112e4SEdward Cree u64 n_rx_nodesc_trunc = 0; 2983e4d112e4SEdward Cree struct efx_channel *channel; 2984e4d112e4SEdward Cree 2985e4d112e4SEdward Cree efx_for_each_channel(channel, efx) 2986e4d112e4SEdward Cree n_rx_nodesc_trunc += channel->n_rx_nodesc_trunc; 2987e4d112e4SEdward Cree stats[GENERIC_STAT_rx_nodesc_trunc] = n_rx_nodesc_trunc; 2988e4d112e4SEdward Cree stats[GENERIC_STAT_rx_noskb_drops] = atomic_read(&efx->n_rx_noskb_drops); 2989e4d112e4SEdward Cree } 2990e4d112e4SEdward Cree 2991874aeea5SJeff Kirsher /************************************************************************** 2992874aeea5SJeff Kirsher * 2993874aeea5SJeff Kirsher * PCI interface 2994874aeea5SJeff Kirsher * 2995874aeea5SJeff Kirsher **************************************************************************/ 2996874aeea5SJeff Kirsher 2997874aeea5SJeff Kirsher /* Main body of final NIC shutdown code 2998874aeea5SJeff Kirsher * This is called only at module unload (or hotplug removal). 2999874aeea5SJeff Kirsher */ 3000874aeea5SJeff Kirsher static void efx_pci_remove_main(struct efx_nic *efx) 3001874aeea5SJeff Kirsher { 30027153f623SBen Hutchings /* Flush reset_work. It can no longer be scheduled since we 30037153f623SBen Hutchings * are not READY. 30047153f623SBen Hutchings */ 30057153f623SBen Hutchings BUG_ON(efx->state == STATE_READY); 30067153f623SBen Hutchings cancel_work_sync(&efx->reset_work); 30077153f623SBen Hutchings 3008d8291187SBen Hutchings efx_disable_interrupts(efx); 3009874aeea5SJeff Kirsher efx_nic_fini_interrupt(efx); 3010874aeea5SJeff Kirsher efx_fini_port(efx); 3011874aeea5SJeff Kirsher efx->type->fini(efx); 3012874aeea5SJeff Kirsher efx_fini_napi(efx); 3013874aeea5SJeff Kirsher efx_remove_all(efx); 3014874aeea5SJeff Kirsher } 3015874aeea5SJeff Kirsher 3016874aeea5SJeff Kirsher /* Final NIC shutdown 30172a3fc311SDaniel Pieczko * This is called only at module unload (or hotplug removal). A PF can call 30182a3fc311SDaniel Pieczko * this on its VFs to ensure they are unbound first. 3019874aeea5SJeff Kirsher */ 3020874aeea5SJeff Kirsher static void efx_pci_remove(struct pci_dev *pci_dev) 3021874aeea5SJeff Kirsher { 3022874aeea5SJeff Kirsher struct efx_nic *efx; 3023874aeea5SJeff Kirsher 3024874aeea5SJeff Kirsher efx = pci_get_drvdata(pci_dev); 3025874aeea5SJeff Kirsher if (!efx) 3026874aeea5SJeff Kirsher return; 3027874aeea5SJeff Kirsher 3028874aeea5SJeff Kirsher /* Mark the NIC as fini, then stop the interface */ 3029874aeea5SJeff Kirsher rtnl_lock(); 30300bcf4a64SBen Hutchings efx_dissociate(efx); 3031874aeea5SJeff Kirsher dev_close(efx->net_dev); 3032d8291187SBen Hutchings efx_disable_interrupts(efx); 3033ea6bb99eSEdward Cree efx->state = STATE_UNINIT; 3034874aeea5SJeff Kirsher rtnl_unlock(); 3035874aeea5SJeff Kirsher 30367fa8d547SShradha Shah if (efx->type->sriov_fini) 3037d98a4ffeSShradha Shah efx->type->sriov_fini(efx); 30387fa8d547SShradha Shah 3039874aeea5SJeff Kirsher efx_unregister_netdev(efx); 3040874aeea5SJeff Kirsher 3041874aeea5SJeff Kirsher efx_mtd_remove(efx); 3042874aeea5SJeff Kirsher 3043874aeea5SJeff Kirsher efx_pci_remove_main(efx); 3044874aeea5SJeff Kirsher 3045874aeea5SJeff Kirsher efx_fini_io(efx); 3046874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "shutdown successful\n"); 3047874aeea5SJeff Kirsher 3048874aeea5SJeff Kirsher efx_fini_struct(efx); 3049874aeea5SJeff Kirsher free_netdev(efx->net_dev); 3050626950dbSAlexandre Rames 3051626950dbSAlexandre Rames pci_disable_pcie_error_reporting(pci_dev); 3052874aeea5SJeff Kirsher }; 3053874aeea5SJeff Kirsher 3054460eeaa0SBen Hutchings /* NIC VPD information 3055460eeaa0SBen Hutchings * Called during probe to display the part number of the 3056460eeaa0SBen Hutchings * installed NIC. VPD is potentially very large but this should 3057460eeaa0SBen Hutchings * always appear within the first 512 bytes. 3058460eeaa0SBen Hutchings */ 3059460eeaa0SBen Hutchings #define SFC_VPD_LEN 512 3060ef215e64SBen Hutchings static void efx_probe_vpd_strings(struct efx_nic *efx) 3061460eeaa0SBen Hutchings { 3062460eeaa0SBen Hutchings struct pci_dev *dev = efx->pci_dev; 3063460eeaa0SBen Hutchings char vpd_data[SFC_VPD_LEN]; 3064460eeaa0SBen Hutchings ssize_t vpd_size; 3065ef215e64SBen Hutchings int ro_start, ro_size, i, j; 3066460eeaa0SBen Hutchings 3067460eeaa0SBen Hutchings /* Get the vpd data from the device */ 3068460eeaa0SBen Hutchings vpd_size = pci_read_vpd(dev, 0, sizeof(vpd_data), vpd_data); 3069460eeaa0SBen Hutchings if (vpd_size <= 0) { 3070460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "Unable to read VPD\n"); 3071460eeaa0SBen Hutchings return; 3072460eeaa0SBen Hutchings } 3073460eeaa0SBen Hutchings 3074460eeaa0SBen Hutchings /* Get the Read only section */ 3075ef215e64SBen Hutchings ro_start = pci_vpd_find_tag(vpd_data, 0, vpd_size, PCI_VPD_LRDT_RO_DATA); 3076ef215e64SBen Hutchings if (ro_start < 0) { 3077460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "VPD Read-only not found\n"); 3078460eeaa0SBen Hutchings return; 3079460eeaa0SBen Hutchings } 3080460eeaa0SBen Hutchings 3081ef215e64SBen Hutchings ro_size = pci_vpd_lrdt_size(&vpd_data[ro_start]); 3082ef215e64SBen Hutchings j = ro_size; 3083ef215e64SBen Hutchings i = ro_start + PCI_VPD_LRDT_TAG_SIZE; 3084460eeaa0SBen Hutchings if (i + j > vpd_size) 3085460eeaa0SBen Hutchings j = vpd_size - i; 3086460eeaa0SBen Hutchings 3087460eeaa0SBen Hutchings /* Get the Part number */ 3088460eeaa0SBen Hutchings i = pci_vpd_find_info_keyword(vpd_data, i, j, "PN"); 3089460eeaa0SBen Hutchings if (i < 0) { 3090460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "Part number not found\n"); 3091460eeaa0SBen Hutchings return; 3092460eeaa0SBen Hutchings } 3093460eeaa0SBen Hutchings 3094460eeaa0SBen Hutchings j = pci_vpd_info_field_size(&vpd_data[i]); 3095460eeaa0SBen Hutchings i += PCI_VPD_INFO_FLD_HDR_SIZE; 3096460eeaa0SBen Hutchings if (i + j > vpd_size) { 3097460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "Incomplete part number\n"); 3098460eeaa0SBen Hutchings return; 3099460eeaa0SBen Hutchings } 3100460eeaa0SBen Hutchings 3101460eeaa0SBen Hutchings netif_info(efx, drv, efx->net_dev, 3102460eeaa0SBen Hutchings "Part Number : %.*s\n", j, &vpd_data[i]); 3103ef215e64SBen Hutchings 3104ef215e64SBen Hutchings i = ro_start + PCI_VPD_LRDT_TAG_SIZE; 3105ef215e64SBen Hutchings j = ro_size; 3106ef215e64SBen Hutchings i = pci_vpd_find_info_keyword(vpd_data, i, j, "SN"); 3107ef215e64SBen Hutchings if (i < 0) { 3108ef215e64SBen Hutchings netif_err(efx, drv, efx->net_dev, "Serial number not found\n"); 3109ef215e64SBen Hutchings return; 3110ef215e64SBen Hutchings } 3111ef215e64SBen Hutchings 3112ef215e64SBen Hutchings j = pci_vpd_info_field_size(&vpd_data[i]); 3113ef215e64SBen Hutchings i += PCI_VPD_INFO_FLD_HDR_SIZE; 3114ef215e64SBen Hutchings if (i + j > vpd_size) { 3115ef215e64SBen Hutchings netif_err(efx, drv, efx->net_dev, "Incomplete serial number\n"); 3116ef215e64SBen Hutchings return; 3117ef215e64SBen Hutchings } 3118ef215e64SBen Hutchings 3119ef215e64SBen Hutchings efx->vpd_sn = kmalloc(j + 1, GFP_KERNEL); 3120ef215e64SBen Hutchings if (!efx->vpd_sn) 3121ef215e64SBen Hutchings return; 3122ef215e64SBen Hutchings 3123ef215e64SBen Hutchings snprintf(efx->vpd_sn, j + 1, "%s", &vpd_data[i]); 3124460eeaa0SBen Hutchings } 3125460eeaa0SBen Hutchings 3126460eeaa0SBen Hutchings 3127874aeea5SJeff Kirsher /* Main body of NIC initialisation 3128874aeea5SJeff Kirsher * This is called at module load (or hotplug insertion, theoretically). 3129874aeea5SJeff Kirsher */ 3130874aeea5SJeff Kirsher static int efx_pci_probe_main(struct efx_nic *efx) 3131874aeea5SJeff Kirsher { 3132874aeea5SJeff Kirsher int rc; 3133874aeea5SJeff Kirsher 3134874aeea5SJeff Kirsher /* Do start-of-day initialisation */ 3135874aeea5SJeff Kirsher rc = efx_probe_all(efx); 3136874aeea5SJeff Kirsher if (rc) 3137874aeea5SJeff Kirsher goto fail1; 3138874aeea5SJeff Kirsher 3139874aeea5SJeff Kirsher efx_init_napi(efx); 3140874aeea5SJeff Kirsher 3141874aeea5SJeff Kirsher rc = efx->type->init(efx); 3142874aeea5SJeff Kirsher if (rc) { 3143874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 3144874aeea5SJeff Kirsher "failed to initialise NIC\n"); 3145874aeea5SJeff Kirsher goto fail3; 3146874aeea5SJeff Kirsher } 3147874aeea5SJeff Kirsher 3148874aeea5SJeff Kirsher rc = efx_init_port(efx); 3149874aeea5SJeff Kirsher if (rc) { 3150874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 3151874aeea5SJeff Kirsher "failed to initialise port\n"); 3152874aeea5SJeff Kirsher goto fail4; 3153874aeea5SJeff Kirsher } 3154874aeea5SJeff Kirsher 3155874aeea5SJeff Kirsher rc = efx_nic_init_interrupt(efx); 3156874aeea5SJeff Kirsher if (rc) 3157874aeea5SJeff Kirsher goto fail5; 3158261e4d96SJon Cooper rc = efx_enable_interrupts(efx); 3159261e4d96SJon Cooper if (rc) 3160261e4d96SJon Cooper goto fail6; 3161874aeea5SJeff Kirsher 3162874aeea5SJeff Kirsher return 0; 3163874aeea5SJeff Kirsher 3164261e4d96SJon Cooper fail6: 3165261e4d96SJon Cooper efx_nic_fini_interrupt(efx); 3166874aeea5SJeff Kirsher fail5: 3167874aeea5SJeff Kirsher efx_fini_port(efx); 3168874aeea5SJeff Kirsher fail4: 3169874aeea5SJeff Kirsher efx->type->fini(efx); 3170874aeea5SJeff Kirsher fail3: 3171874aeea5SJeff Kirsher efx_fini_napi(efx); 3172874aeea5SJeff Kirsher efx_remove_all(efx); 3173874aeea5SJeff Kirsher fail1: 3174874aeea5SJeff Kirsher return rc; 3175874aeea5SJeff Kirsher } 3176874aeea5SJeff Kirsher 3177874aeea5SJeff Kirsher /* NIC initialisation 3178874aeea5SJeff Kirsher * 3179874aeea5SJeff Kirsher * This is called at module load (or hotplug insertion, 318073ba7b68SBen Hutchings * theoretically). It sets up PCI mappings, resets the NIC, 3181874aeea5SJeff Kirsher * sets up and registers the network devices with the kernel and hooks 3182874aeea5SJeff Kirsher * the interrupt service routine. It does not prepare the device for 3183874aeea5SJeff Kirsher * transmission; this is left to the first time one of the network 3184874aeea5SJeff Kirsher * interfaces is brought up (i.e. efx_net_open). 3185874aeea5SJeff Kirsher */ 318687d1fc11SBill Pemberton static int efx_pci_probe(struct pci_dev *pci_dev, 3187874aeea5SJeff Kirsher const struct pci_device_id *entry) 3188874aeea5SJeff Kirsher { 3189874aeea5SJeff Kirsher struct net_device *net_dev; 3190874aeea5SJeff Kirsher struct efx_nic *efx; 3191fadac6aaSBen Hutchings int rc; 3192874aeea5SJeff Kirsher 3193874aeea5SJeff Kirsher /* Allocate and initialise a struct net_device and struct efx_nic */ 3194874aeea5SJeff Kirsher net_dev = alloc_etherdev_mqs(sizeof(*efx), EFX_MAX_CORE_TX_QUEUES, 3195874aeea5SJeff Kirsher EFX_MAX_RX_QUEUES); 3196874aeea5SJeff Kirsher if (!net_dev) 3197874aeea5SJeff Kirsher return -ENOMEM; 3198adeb15aaSBen Hutchings efx = netdev_priv(net_dev); 3199adeb15aaSBen Hutchings efx->type = (const struct efx_nic_type *) entry->driver_data; 3200ebfcd0fdSAndrew Rybchenko efx->fixed_features |= NETIF_F_HIGHDMA; 3201adeb15aaSBen Hutchings net_dev->features |= (efx->type->offload_features | NETIF_F_SG | 3202ebfcd0fdSAndrew Rybchenko NETIF_F_TSO | NETIF_F_RXCSUM); 3203c8cd0989STom Herbert if (efx->type->offload_features & (NETIF_F_IPV6_CSUM | NETIF_F_HW_CSUM)) 3204874aeea5SJeff Kirsher net_dev->features |= NETIF_F_TSO6; 3205874aeea5SJeff Kirsher /* Mask for features that also apply to VLAN devices */ 3206a188222bSTom Herbert net_dev->vlan_features |= (NETIF_F_HW_CSUM | NETIF_F_SG | 3207874aeea5SJeff Kirsher NETIF_F_HIGHDMA | NETIF_F_ALL_TSO | 3208874aeea5SJeff Kirsher NETIF_F_RXCSUM); 3209eb7cfd8cSAndrew Rybchenko 3210ebfcd0fdSAndrew Rybchenko net_dev->hw_features = net_dev->features & ~efx->fixed_features; 3211eb7cfd8cSAndrew Rybchenko 3212eb7cfd8cSAndrew Rybchenko /* Disable VLAN filtering by default. It may be enforced if 3213eb7cfd8cSAndrew Rybchenko * the feature is fixed (i.e. VLAN filters are required to 3214eb7cfd8cSAndrew Rybchenko * receive VLAN tagged packets due to vPort restrictions). 3215eb7cfd8cSAndrew Rybchenko */ 3216eb7cfd8cSAndrew Rybchenko net_dev->features &= ~NETIF_F_HW_VLAN_CTAG_FILTER; 3217eb7cfd8cSAndrew Rybchenko net_dev->features |= efx->fixed_features; 3218eb7cfd8cSAndrew Rybchenko 3219874aeea5SJeff Kirsher pci_set_drvdata(pci_dev, efx); 3220874aeea5SJeff Kirsher SET_NETDEV_DEV(net_dev, &pci_dev->dev); 3221adeb15aaSBen Hutchings rc = efx_init_struct(efx, pci_dev, net_dev); 3222874aeea5SJeff Kirsher if (rc) 3223874aeea5SJeff Kirsher goto fail1; 3224874aeea5SJeff Kirsher 3225874aeea5SJeff Kirsher netif_info(efx, probe, efx->net_dev, 3226874aeea5SJeff Kirsher "Solarflare NIC detected\n"); 3227874aeea5SJeff Kirsher 32286f7f8aa6SShradha Shah if (!efx->type->is_vf) 3229ef215e64SBen Hutchings efx_probe_vpd_strings(efx); 3230460eeaa0SBen Hutchings 3231874aeea5SJeff Kirsher /* Set up basic I/O (BAR mappings etc) */ 3232874aeea5SJeff Kirsher rc = efx_init_io(efx); 3233874aeea5SJeff Kirsher if (rc) 3234874aeea5SJeff Kirsher goto fail2; 3235874aeea5SJeff Kirsher 3236874aeea5SJeff Kirsher rc = efx_pci_probe_main(efx); 3237fadac6aaSBen Hutchings if (rc) 3238874aeea5SJeff Kirsher goto fail3; 3239874aeea5SJeff Kirsher 3240874aeea5SJeff Kirsher rc = efx_register_netdev(efx); 3241874aeea5SJeff Kirsher if (rc) 3242fadac6aaSBen Hutchings goto fail4; 3243874aeea5SJeff Kirsher 32447fa8d547SShradha Shah if (efx->type->sriov_init) { 3245d98a4ffeSShradha Shah rc = efx->type->sriov_init(efx); 3246cd2d5b52SBen Hutchings if (rc) 3247cd2d5b52SBen Hutchings netif_err(efx, probe, efx->net_dev, 3248cd2d5b52SBen Hutchings "SR-IOV can't be enabled rc %d\n", rc); 32497fa8d547SShradha Shah } 3250cd2d5b52SBen Hutchings 3251874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "initialisation successful\n"); 3252874aeea5SJeff Kirsher 32537c43161cSBen Hutchings /* Try to create MTDs, but allow this to fail */ 3254874aeea5SJeff Kirsher rtnl_lock(); 32557c43161cSBen Hutchings rc = efx_mtd_probe(efx); 3256874aeea5SJeff Kirsher rtnl_unlock(); 325709a04204SBert Kenward if (rc && rc != -EPERM) 32587c43161cSBen Hutchings netif_warn(efx, probe, efx->net_dev, 32597c43161cSBen Hutchings "failed to create MTDs (%d)\n", rc); 32607c43161cSBen Hutchings 3261626950dbSAlexandre Rames rc = pci_enable_pcie_error_reporting(pci_dev); 3262626950dbSAlexandre Rames if (rc && rc != -EINVAL) 326309a04204SBert Kenward netif_notice(efx, probe, efx->net_dev, 326409a04204SBert Kenward "PCIE error reporting unavailable (%d).\n", 326509a04204SBert Kenward rc); 3266626950dbSAlexandre Rames 3267874aeea5SJeff Kirsher return 0; 3268874aeea5SJeff Kirsher 3269874aeea5SJeff Kirsher fail4: 3270fadac6aaSBen Hutchings efx_pci_remove_main(efx); 3271874aeea5SJeff Kirsher fail3: 3272874aeea5SJeff Kirsher efx_fini_io(efx); 3273874aeea5SJeff Kirsher fail2: 3274874aeea5SJeff Kirsher efx_fini_struct(efx); 3275874aeea5SJeff Kirsher fail1: 3276874aeea5SJeff Kirsher WARN_ON(rc > 0); 3277874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "initialisation failed. rc=%d\n", rc); 3278874aeea5SJeff Kirsher free_netdev(net_dev); 3279874aeea5SJeff Kirsher return rc; 3280874aeea5SJeff Kirsher } 3281874aeea5SJeff Kirsher 3282834e23ddSShradha Shah /* efx_pci_sriov_configure returns the actual number of Virtual Functions 3283834e23ddSShradha Shah * enabled on success 3284834e23ddSShradha Shah */ 3285834e23ddSShradha Shah #ifdef CONFIG_SFC_SRIOV 3286834e23ddSShradha Shah static int efx_pci_sriov_configure(struct pci_dev *dev, int num_vfs) 3287834e23ddSShradha Shah { 3288834e23ddSShradha Shah int rc; 3289834e23ddSShradha Shah struct efx_nic *efx = pci_get_drvdata(dev); 3290834e23ddSShradha Shah 3291834e23ddSShradha Shah if (efx->type->sriov_configure) { 3292834e23ddSShradha Shah rc = efx->type->sriov_configure(efx, num_vfs); 3293834e23ddSShradha Shah if (rc) 3294834e23ddSShradha Shah return rc; 3295834e23ddSShradha Shah else 3296834e23ddSShradha Shah return num_vfs; 3297834e23ddSShradha Shah } else 3298834e23ddSShradha Shah return -EOPNOTSUPP; 3299834e23ddSShradha Shah } 3300834e23ddSShradha Shah #endif 3301834e23ddSShradha Shah 3302874aeea5SJeff Kirsher static int efx_pm_freeze(struct device *dev) 3303874aeea5SJeff Kirsher { 3304874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); 3305874aeea5SJeff Kirsher 330661da026dSBen Hutchings rtnl_lock(); 330761da026dSBen Hutchings 33086032fb56SBen Hutchings if (efx->state != STATE_DISABLED) { 3309f16aeea0SBen Hutchings efx->state = STATE_UNINIT; 3310874aeea5SJeff Kirsher 3311c2f3b8e3SDaniel Pieczko efx_device_detach_sync(efx); 3312874aeea5SJeff Kirsher 3313874aeea5SJeff Kirsher efx_stop_all(efx); 3314d8291187SBen Hutchings efx_disable_interrupts(efx); 33156032fb56SBen Hutchings } 3316874aeea5SJeff Kirsher 331761da026dSBen Hutchings rtnl_unlock(); 331861da026dSBen Hutchings 3319874aeea5SJeff Kirsher return 0; 3320874aeea5SJeff Kirsher } 3321874aeea5SJeff Kirsher 3322874aeea5SJeff Kirsher static int efx_pm_thaw(struct device *dev) 3323874aeea5SJeff Kirsher { 3324261e4d96SJon Cooper int rc; 3325874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); 3326874aeea5SJeff Kirsher 332761da026dSBen Hutchings rtnl_lock(); 332861da026dSBen Hutchings 33296032fb56SBen Hutchings if (efx->state != STATE_DISABLED) { 3330261e4d96SJon Cooper rc = efx_enable_interrupts(efx); 3331261e4d96SJon Cooper if (rc) 3332261e4d96SJon Cooper goto fail; 3333874aeea5SJeff Kirsher 3334874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 3335874aeea5SJeff Kirsher efx->phy_op->reconfigure(efx); 3336874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 3337874aeea5SJeff Kirsher 3338874aeea5SJeff Kirsher efx_start_all(efx); 3339874aeea5SJeff Kirsher 3340874aeea5SJeff Kirsher netif_device_attach(efx->net_dev); 3341874aeea5SJeff Kirsher 3342f16aeea0SBen Hutchings efx->state = STATE_READY; 3343874aeea5SJeff Kirsher 3344874aeea5SJeff Kirsher efx->type->resume_wol(efx); 33456032fb56SBen Hutchings } 3346874aeea5SJeff Kirsher 334761da026dSBen Hutchings rtnl_unlock(); 334861da026dSBen Hutchings 3349874aeea5SJeff Kirsher /* Reschedule any quenched resets scheduled during efx_pm_freeze() */ 3350874aeea5SJeff Kirsher queue_work(reset_workqueue, &efx->reset_work); 3351874aeea5SJeff Kirsher 3352874aeea5SJeff Kirsher return 0; 3353261e4d96SJon Cooper 3354261e4d96SJon Cooper fail: 3355261e4d96SJon Cooper rtnl_unlock(); 3356261e4d96SJon Cooper 3357261e4d96SJon Cooper return rc; 3358874aeea5SJeff Kirsher } 3359874aeea5SJeff Kirsher 3360874aeea5SJeff Kirsher static int efx_pm_poweroff(struct device *dev) 3361874aeea5SJeff Kirsher { 3362874aeea5SJeff Kirsher struct pci_dev *pci_dev = to_pci_dev(dev); 3363874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(pci_dev); 3364874aeea5SJeff Kirsher 3365874aeea5SJeff Kirsher efx->type->fini(efx); 3366874aeea5SJeff Kirsher 3367874aeea5SJeff Kirsher efx->reset_pending = 0; 3368874aeea5SJeff Kirsher 3369874aeea5SJeff Kirsher pci_save_state(pci_dev); 3370874aeea5SJeff Kirsher return pci_set_power_state(pci_dev, PCI_D3hot); 3371874aeea5SJeff Kirsher } 3372874aeea5SJeff Kirsher 3373874aeea5SJeff Kirsher /* Used for both resume and restore */ 3374874aeea5SJeff Kirsher static int efx_pm_resume(struct device *dev) 3375874aeea5SJeff Kirsher { 3376874aeea5SJeff Kirsher struct pci_dev *pci_dev = to_pci_dev(dev); 3377874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(pci_dev); 3378874aeea5SJeff Kirsher int rc; 3379874aeea5SJeff Kirsher 3380874aeea5SJeff Kirsher rc = pci_set_power_state(pci_dev, PCI_D0); 3381874aeea5SJeff Kirsher if (rc) 3382874aeea5SJeff Kirsher return rc; 3383874aeea5SJeff Kirsher pci_restore_state(pci_dev); 3384874aeea5SJeff Kirsher rc = pci_enable_device(pci_dev); 3385874aeea5SJeff Kirsher if (rc) 3386874aeea5SJeff Kirsher return rc; 3387874aeea5SJeff Kirsher pci_set_master(efx->pci_dev); 3388874aeea5SJeff Kirsher rc = efx->type->reset(efx, RESET_TYPE_ALL); 3389874aeea5SJeff Kirsher if (rc) 3390874aeea5SJeff Kirsher return rc; 3391874aeea5SJeff Kirsher rc = efx->type->init(efx); 3392874aeea5SJeff Kirsher if (rc) 3393874aeea5SJeff Kirsher return rc; 3394261e4d96SJon Cooper rc = efx_pm_thaw(dev); 3395261e4d96SJon Cooper return rc; 3396874aeea5SJeff Kirsher } 3397874aeea5SJeff Kirsher 3398874aeea5SJeff Kirsher static int efx_pm_suspend(struct device *dev) 3399874aeea5SJeff Kirsher { 3400874aeea5SJeff Kirsher int rc; 3401874aeea5SJeff Kirsher 3402874aeea5SJeff Kirsher efx_pm_freeze(dev); 3403874aeea5SJeff Kirsher rc = efx_pm_poweroff(dev); 3404874aeea5SJeff Kirsher if (rc) 3405874aeea5SJeff Kirsher efx_pm_resume(dev); 3406874aeea5SJeff Kirsher return rc; 3407874aeea5SJeff Kirsher } 3408874aeea5SJeff Kirsher 340918e83e4cSBen Hutchings static const struct dev_pm_ops efx_pm_ops = { 3410874aeea5SJeff Kirsher .suspend = efx_pm_suspend, 3411874aeea5SJeff Kirsher .resume = efx_pm_resume, 3412874aeea5SJeff Kirsher .freeze = efx_pm_freeze, 3413874aeea5SJeff Kirsher .thaw = efx_pm_thaw, 3414874aeea5SJeff Kirsher .poweroff = efx_pm_poweroff, 3415874aeea5SJeff Kirsher .restore = efx_pm_resume, 3416874aeea5SJeff Kirsher }; 3417874aeea5SJeff Kirsher 3418626950dbSAlexandre Rames /* A PCI error affecting this device was detected. 3419626950dbSAlexandre Rames * At this point MMIO and DMA may be disabled. 3420626950dbSAlexandre Rames * Stop the software path and request a slot reset. 3421626950dbSAlexandre Rames */ 3422debd0034Sstephen hemminger static pci_ers_result_t efx_io_error_detected(struct pci_dev *pdev, 3423626950dbSAlexandre Rames enum pci_channel_state state) 3424626950dbSAlexandre Rames { 3425626950dbSAlexandre Rames pci_ers_result_t status = PCI_ERS_RESULT_RECOVERED; 3426626950dbSAlexandre Rames struct efx_nic *efx = pci_get_drvdata(pdev); 3427626950dbSAlexandre Rames 3428626950dbSAlexandre Rames if (state == pci_channel_io_perm_failure) 3429626950dbSAlexandre Rames return PCI_ERS_RESULT_DISCONNECT; 3430626950dbSAlexandre Rames 3431626950dbSAlexandre Rames rtnl_lock(); 3432626950dbSAlexandre Rames 3433626950dbSAlexandre Rames if (efx->state != STATE_DISABLED) { 3434626950dbSAlexandre Rames efx->state = STATE_RECOVERY; 3435626950dbSAlexandre Rames efx->reset_pending = 0; 3436626950dbSAlexandre Rames 3437626950dbSAlexandre Rames efx_device_detach_sync(efx); 3438626950dbSAlexandre Rames 3439626950dbSAlexandre Rames efx_stop_all(efx); 3440d8291187SBen Hutchings efx_disable_interrupts(efx); 3441626950dbSAlexandre Rames 3442626950dbSAlexandre Rames status = PCI_ERS_RESULT_NEED_RESET; 3443626950dbSAlexandre Rames } else { 3444626950dbSAlexandre Rames /* If the interface is disabled we don't want to do anything 3445626950dbSAlexandre Rames * with it. 3446626950dbSAlexandre Rames */ 3447626950dbSAlexandre Rames status = PCI_ERS_RESULT_RECOVERED; 3448626950dbSAlexandre Rames } 3449626950dbSAlexandre Rames 3450626950dbSAlexandre Rames rtnl_unlock(); 3451626950dbSAlexandre Rames 3452626950dbSAlexandre Rames pci_disable_device(pdev); 3453626950dbSAlexandre Rames 3454626950dbSAlexandre Rames return status; 3455626950dbSAlexandre Rames } 3456626950dbSAlexandre Rames 3457dbedd44eSJoe Perches /* Fake a successful reset, which will be performed later in efx_io_resume. */ 3458debd0034Sstephen hemminger static pci_ers_result_t efx_io_slot_reset(struct pci_dev *pdev) 3459626950dbSAlexandre Rames { 3460626950dbSAlexandre Rames struct efx_nic *efx = pci_get_drvdata(pdev); 3461626950dbSAlexandre Rames pci_ers_result_t status = PCI_ERS_RESULT_RECOVERED; 3462626950dbSAlexandre Rames int rc; 3463626950dbSAlexandre Rames 3464626950dbSAlexandre Rames if (pci_enable_device(pdev)) { 3465626950dbSAlexandre Rames netif_err(efx, hw, efx->net_dev, 3466626950dbSAlexandre Rames "Cannot re-enable PCI device after reset.\n"); 3467626950dbSAlexandre Rames status = PCI_ERS_RESULT_DISCONNECT; 3468626950dbSAlexandre Rames } 3469626950dbSAlexandre Rames 3470626950dbSAlexandre Rames rc = pci_cleanup_aer_uncorrect_error_status(pdev); 3471626950dbSAlexandre Rames if (rc) { 3472626950dbSAlexandre Rames netif_err(efx, hw, efx->net_dev, 3473626950dbSAlexandre Rames "pci_cleanup_aer_uncorrect_error_status failed (%d)\n", rc); 3474626950dbSAlexandre Rames /* Non-fatal error. Continue. */ 3475626950dbSAlexandre Rames } 3476626950dbSAlexandre Rames 3477626950dbSAlexandre Rames return status; 3478626950dbSAlexandre Rames } 3479626950dbSAlexandre Rames 3480626950dbSAlexandre Rames /* Perform the actual reset and resume I/O operations. */ 3481626950dbSAlexandre Rames static void efx_io_resume(struct pci_dev *pdev) 3482626950dbSAlexandre Rames { 3483626950dbSAlexandre Rames struct efx_nic *efx = pci_get_drvdata(pdev); 3484626950dbSAlexandre Rames int rc; 3485626950dbSAlexandre Rames 3486626950dbSAlexandre Rames rtnl_lock(); 3487626950dbSAlexandre Rames 3488626950dbSAlexandre Rames if (efx->state == STATE_DISABLED) 3489626950dbSAlexandre Rames goto out; 3490626950dbSAlexandre Rames 3491626950dbSAlexandre Rames rc = efx_reset(efx, RESET_TYPE_ALL); 3492626950dbSAlexandre Rames if (rc) { 3493626950dbSAlexandre Rames netif_err(efx, hw, efx->net_dev, 3494626950dbSAlexandre Rames "efx_reset failed after PCI error (%d)\n", rc); 3495626950dbSAlexandre Rames } else { 3496626950dbSAlexandre Rames efx->state = STATE_READY; 3497626950dbSAlexandre Rames netif_dbg(efx, hw, efx->net_dev, 3498626950dbSAlexandre Rames "Done resetting and resuming IO after PCI error.\n"); 3499626950dbSAlexandre Rames } 3500626950dbSAlexandre Rames 3501626950dbSAlexandre Rames out: 3502626950dbSAlexandre Rames rtnl_unlock(); 3503626950dbSAlexandre Rames } 3504626950dbSAlexandre Rames 3505626950dbSAlexandre Rames /* For simplicity and reliability, we always require a slot reset and try to 3506626950dbSAlexandre Rames * reset the hardware when a pci error affecting the device is detected. 3507626950dbSAlexandre Rames * We leave both the link_reset and mmio_enabled callback unimplemented: 3508626950dbSAlexandre Rames * with our request for slot reset the mmio_enabled callback will never be 3509626950dbSAlexandre Rames * called, and the link_reset callback is not used by AER or EEH mechanisms. 3510626950dbSAlexandre Rames */ 3511c300366bSJulia Lawall static const struct pci_error_handlers efx_err_handlers = { 3512626950dbSAlexandre Rames .error_detected = efx_io_error_detected, 3513626950dbSAlexandre Rames .slot_reset = efx_io_slot_reset, 3514626950dbSAlexandre Rames .resume = efx_io_resume, 3515626950dbSAlexandre Rames }; 3516626950dbSAlexandre Rames 3517874aeea5SJeff Kirsher static struct pci_driver efx_pci_driver = { 3518874aeea5SJeff Kirsher .name = KBUILD_MODNAME, 3519874aeea5SJeff Kirsher .id_table = efx_pci_table, 3520874aeea5SJeff Kirsher .probe = efx_pci_probe, 3521874aeea5SJeff Kirsher .remove = efx_pci_remove, 3522874aeea5SJeff Kirsher .driver.pm = &efx_pm_ops, 3523626950dbSAlexandre Rames .err_handler = &efx_err_handlers, 3524834e23ddSShradha Shah #ifdef CONFIG_SFC_SRIOV 3525834e23ddSShradha Shah .sriov_configure = efx_pci_sriov_configure, 3526834e23ddSShradha Shah #endif 3527874aeea5SJeff Kirsher }; 3528874aeea5SJeff Kirsher 3529874aeea5SJeff Kirsher /************************************************************************** 3530874aeea5SJeff Kirsher * 3531874aeea5SJeff Kirsher * Kernel module interface 3532874aeea5SJeff Kirsher * 3533874aeea5SJeff Kirsher *************************************************************************/ 3534874aeea5SJeff Kirsher 3535874aeea5SJeff Kirsher module_param(interrupt_mode, uint, 0444); 3536874aeea5SJeff Kirsher MODULE_PARM_DESC(interrupt_mode, 3537874aeea5SJeff Kirsher "Interrupt mode (0=>MSIX 1=>MSI 2=>legacy)"); 3538874aeea5SJeff Kirsher 3539874aeea5SJeff Kirsher static int __init efx_init_module(void) 3540874aeea5SJeff Kirsher { 3541874aeea5SJeff Kirsher int rc; 3542874aeea5SJeff Kirsher 3543874aeea5SJeff Kirsher printk(KERN_INFO "Solarflare NET driver v" EFX_DRIVER_VERSION "\n"); 3544874aeea5SJeff Kirsher 3545874aeea5SJeff Kirsher rc = register_netdevice_notifier(&efx_netdev_notifier); 3546874aeea5SJeff Kirsher if (rc) 3547874aeea5SJeff Kirsher goto err_notifier; 3548874aeea5SJeff Kirsher 35497fa8d547SShradha Shah #ifdef CONFIG_SFC_SRIOV 3550cd2d5b52SBen Hutchings rc = efx_init_sriov(); 3551cd2d5b52SBen Hutchings if (rc) 3552cd2d5b52SBen Hutchings goto err_sriov; 35537fa8d547SShradha Shah #endif 3554cd2d5b52SBen Hutchings 3555874aeea5SJeff Kirsher reset_workqueue = create_singlethread_workqueue("sfc_reset"); 3556874aeea5SJeff Kirsher if (!reset_workqueue) { 3557874aeea5SJeff Kirsher rc = -ENOMEM; 3558874aeea5SJeff Kirsher goto err_reset; 3559874aeea5SJeff Kirsher } 3560874aeea5SJeff Kirsher 3561874aeea5SJeff Kirsher rc = pci_register_driver(&efx_pci_driver); 3562874aeea5SJeff Kirsher if (rc < 0) 3563874aeea5SJeff Kirsher goto err_pci; 3564874aeea5SJeff Kirsher 3565874aeea5SJeff Kirsher return 0; 3566874aeea5SJeff Kirsher 3567874aeea5SJeff Kirsher err_pci: 3568874aeea5SJeff Kirsher destroy_workqueue(reset_workqueue); 3569874aeea5SJeff Kirsher err_reset: 35707fa8d547SShradha Shah #ifdef CONFIG_SFC_SRIOV 3571cd2d5b52SBen Hutchings efx_fini_sriov(); 3572cd2d5b52SBen Hutchings err_sriov: 35737fa8d547SShradha Shah #endif 3574874aeea5SJeff Kirsher unregister_netdevice_notifier(&efx_netdev_notifier); 3575874aeea5SJeff Kirsher err_notifier: 3576874aeea5SJeff Kirsher return rc; 3577874aeea5SJeff Kirsher } 3578874aeea5SJeff Kirsher 3579874aeea5SJeff Kirsher static void __exit efx_exit_module(void) 3580874aeea5SJeff Kirsher { 3581874aeea5SJeff Kirsher printk(KERN_INFO "Solarflare NET driver unloading\n"); 3582874aeea5SJeff Kirsher 3583874aeea5SJeff Kirsher pci_unregister_driver(&efx_pci_driver); 3584874aeea5SJeff Kirsher destroy_workqueue(reset_workqueue); 35857fa8d547SShradha Shah #ifdef CONFIG_SFC_SRIOV 3586cd2d5b52SBen Hutchings efx_fini_sriov(); 35877fa8d547SShradha Shah #endif 3588874aeea5SJeff Kirsher unregister_netdevice_notifier(&efx_netdev_notifier); 3589874aeea5SJeff Kirsher 3590874aeea5SJeff Kirsher } 3591874aeea5SJeff Kirsher 3592874aeea5SJeff Kirsher module_init(efx_init_module); 3593874aeea5SJeff Kirsher module_exit(efx_exit_module); 3594874aeea5SJeff Kirsher 3595874aeea5SJeff Kirsher MODULE_AUTHOR("Solarflare Communications and " 3596874aeea5SJeff Kirsher "Michael Brown <mbrown@fensystems.co.uk>"); 35976a350fdbSBen Hutchings MODULE_DESCRIPTION("Solarflare network driver"); 3598874aeea5SJeff Kirsher MODULE_LICENSE("GPL"); 3599874aeea5SJeff Kirsher MODULE_DEVICE_TABLE(pci, efx_pci_table); 3600