1874aeea5SJeff Kirsher /**************************************************************************** 2874aeea5SJeff Kirsher * Driver for Solarflare Solarstorm network controllers and boards 3874aeea5SJeff Kirsher * Copyright 2005-2006 Fen Systems Ltd. 4874aeea5SJeff Kirsher * Copyright 2005-2011 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/crc32.h> 21874aeea5SJeff Kirsher #include <linux/ethtool.h> 22874aeea5SJeff Kirsher #include <linux/topology.h> 23874aeea5SJeff Kirsher #include <linux/gfp.h> 24626950dbSAlexandre Rames #include <linux/aer.h> 25b28405b0SAlexandre Rames #include <linux/interrupt.h> 26874aeea5SJeff Kirsher #include "net_driver.h" 27874aeea5SJeff Kirsher #include "efx.h" 28874aeea5SJeff Kirsher #include "nic.h" 29dd40781eSBen Hutchings #include "selftest.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", 80874aeea5SJeff Kirsher [RESET_TYPE_DISABLE] = "DISABLE", 81874aeea5SJeff Kirsher [RESET_TYPE_TX_WATCHDOG] = "TX_WATCHDOG", 82874aeea5SJeff Kirsher [RESET_TYPE_INT_ERROR] = "INT_ERROR", 83874aeea5SJeff Kirsher [RESET_TYPE_RX_RECOVERY] = "RX_RECOVERY", 84874aeea5SJeff Kirsher [RESET_TYPE_RX_DESC_FETCH] = "RX_DESC_FETCH", 85874aeea5SJeff Kirsher [RESET_TYPE_TX_DESC_FETCH] = "TX_DESC_FETCH", 86874aeea5SJeff Kirsher [RESET_TYPE_TX_SKIP] = "TX_SKIP", 87874aeea5SJeff Kirsher [RESET_TYPE_MC_FAILURE] = "MC_FAILURE", 88874aeea5SJeff Kirsher }; 89874aeea5SJeff Kirsher 90874aeea5SJeff Kirsher /* Reset workqueue. If any NIC has a hardware failure then a reset will be 91874aeea5SJeff Kirsher * queued onto this work queue. This is not a per-nic work queue, because 92874aeea5SJeff Kirsher * efx_reset_work() acquires the rtnl lock, so resets are naturally serialised. 93874aeea5SJeff Kirsher */ 94874aeea5SJeff Kirsher static struct workqueue_struct *reset_workqueue; 95874aeea5SJeff Kirsher 96874aeea5SJeff Kirsher /************************************************************************** 97874aeea5SJeff Kirsher * 98874aeea5SJeff Kirsher * Configurable values 99874aeea5SJeff Kirsher * 100874aeea5SJeff Kirsher *************************************************************************/ 101874aeea5SJeff Kirsher 102874aeea5SJeff Kirsher /* 103874aeea5SJeff Kirsher * Use separate channels for TX and RX events 104874aeea5SJeff Kirsher * 105874aeea5SJeff Kirsher * Set this to 1 to use separate channels for TX and RX. It allows us 106874aeea5SJeff Kirsher * to control interrupt affinity separately for TX and RX. 107874aeea5SJeff Kirsher * 108874aeea5SJeff Kirsher * This is only used in MSI-X interrupt mode 109874aeea5SJeff Kirsher */ 110b9cc977dSBen Hutchings static bool separate_tx_channels; 111b9cc977dSBen Hutchings module_param(separate_tx_channels, bool, 0444); 112874aeea5SJeff Kirsher MODULE_PARM_DESC(separate_tx_channels, 113874aeea5SJeff Kirsher "Use separate channels for TX and RX"); 114874aeea5SJeff Kirsher 115874aeea5SJeff Kirsher /* This is the weight assigned to each of the (per-channel) virtual 116874aeea5SJeff Kirsher * NAPI devices. 117874aeea5SJeff Kirsher */ 118874aeea5SJeff Kirsher static int napi_weight = 64; 119874aeea5SJeff Kirsher 120874aeea5SJeff Kirsher /* This is the time (in jiffies) between invocations of the hardware 121626950dbSAlexandre Rames * monitor. 122626950dbSAlexandre Rames * On Falcon-based NICs, this will: 123874aeea5SJeff Kirsher * - Check the on-board hardware monitor; 124874aeea5SJeff Kirsher * - Poll the link state and reconfigure the hardware as necessary. 125626950dbSAlexandre Rames * On Siena-based NICs for power systems with EEH support, this will give EEH a 126626950dbSAlexandre Rames * chance to start. 127874aeea5SJeff Kirsher */ 128874aeea5SJeff Kirsher static unsigned int efx_monitor_interval = 1 * HZ; 129874aeea5SJeff Kirsher 130874aeea5SJeff Kirsher /* Initial interrupt moderation settings. They can be modified after 131874aeea5SJeff Kirsher * module load with ethtool. 132874aeea5SJeff Kirsher * 133874aeea5SJeff Kirsher * The default for RX should strike a balance between increasing the 134874aeea5SJeff Kirsher * round-trip latency and reducing overhead. 135874aeea5SJeff Kirsher */ 136874aeea5SJeff Kirsher static unsigned int rx_irq_mod_usec = 60; 137874aeea5SJeff Kirsher 138874aeea5SJeff Kirsher /* Initial interrupt moderation settings. They can be modified after 139874aeea5SJeff Kirsher * module load with ethtool. 140874aeea5SJeff Kirsher * 141874aeea5SJeff Kirsher * This default is chosen to ensure that a 10G link does not go idle 142874aeea5SJeff Kirsher * while a TX queue is stopped after it has become full. A queue is 143874aeea5SJeff Kirsher * restarted when it drops below half full. The time this takes (assuming 144874aeea5SJeff Kirsher * worst case 3 descriptors per packet and 1024 descriptors) is 145874aeea5SJeff Kirsher * 512 / 3 * 1.2 = 205 usec. 146874aeea5SJeff Kirsher */ 147874aeea5SJeff Kirsher static unsigned int tx_irq_mod_usec = 150; 148874aeea5SJeff Kirsher 149874aeea5SJeff Kirsher /* This is the first interrupt mode to try out of: 150874aeea5SJeff Kirsher * 0 => MSI-X 151874aeea5SJeff Kirsher * 1 => MSI 152874aeea5SJeff Kirsher * 2 => legacy 153874aeea5SJeff Kirsher */ 154874aeea5SJeff Kirsher static unsigned int interrupt_mode; 155874aeea5SJeff Kirsher 156874aeea5SJeff Kirsher /* This is the requested number of CPUs to use for Receive-Side Scaling (RSS), 157874aeea5SJeff Kirsher * i.e. the number of CPUs among which we may distribute simultaneous 158874aeea5SJeff Kirsher * interrupt handling. 159874aeea5SJeff Kirsher * 160874aeea5SJeff Kirsher * Cards without MSI-X will only target one CPU via legacy or MSI interrupt. 161cdb08f8fSBen Hutchings * The default (0) means to assign an interrupt to each core. 162874aeea5SJeff Kirsher */ 163874aeea5SJeff Kirsher static unsigned int rss_cpus; 164874aeea5SJeff Kirsher module_param(rss_cpus, uint, 0444); 165874aeea5SJeff Kirsher MODULE_PARM_DESC(rss_cpus, "Number of CPUs to use for Receive-Side Scaling"); 166874aeea5SJeff Kirsher 167b9cc977dSBen Hutchings static bool phy_flash_cfg; 168b9cc977dSBen Hutchings module_param(phy_flash_cfg, bool, 0644); 169874aeea5SJeff Kirsher MODULE_PARM_DESC(phy_flash_cfg, "Set PHYs into reflash mode initially"); 170874aeea5SJeff Kirsher 171e7bed9c8SBen Hutchings static unsigned irq_adapt_low_thresh = 8000; 172874aeea5SJeff Kirsher module_param(irq_adapt_low_thresh, uint, 0644); 173874aeea5SJeff Kirsher MODULE_PARM_DESC(irq_adapt_low_thresh, 174874aeea5SJeff Kirsher "Threshold score for reducing IRQ moderation"); 175874aeea5SJeff Kirsher 176e7bed9c8SBen Hutchings static unsigned irq_adapt_high_thresh = 16000; 177874aeea5SJeff Kirsher module_param(irq_adapt_high_thresh, uint, 0644); 178874aeea5SJeff Kirsher MODULE_PARM_DESC(irq_adapt_high_thresh, 179874aeea5SJeff Kirsher "Threshold score for increasing IRQ moderation"); 180874aeea5SJeff Kirsher 181874aeea5SJeff Kirsher static unsigned debug = (NETIF_MSG_DRV | NETIF_MSG_PROBE | 182874aeea5SJeff Kirsher NETIF_MSG_LINK | NETIF_MSG_IFDOWN | 183874aeea5SJeff Kirsher NETIF_MSG_IFUP | NETIF_MSG_RX_ERR | 184874aeea5SJeff Kirsher NETIF_MSG_TX_ERR | NETIF_MSG_HW); 185874aeea5SJeff Kirsher module_param(debug, uint, 0); 186874aeea5SJeff Kirsher MODULE_PARM_DESC(debug, "Bitmapped debugging message enable value"); 187874aeea5SJeff Kirsher 188874aeea5SJeff Kirsher /************************************************************************** 189874aeea5SJeff Kirsher * 190874aeea5SJeff Kirsher * Utility functions and prototypes 191874aeea5SJeff Kirsher * 192874aeea5SJeff Kirsher *************************************************************************/ 193874aeea5SJeff Kirsher 194d8291187SBen Hutchings static void efx_soft_enable_interrupts(struct efx_nic *efx); 195d8291187SBen Hutchings static void efx_soft_disable_interrupts(struct efx_nic *efx); 1967f967c01SBen Hutchings static void efx_remove_channel(struct efx_channel *channel); 197874aeea5SJeff Kirsher static void efx_remove_channels(struct efx_nic *efx); 1987f967c01SBen Hutchings static const struct efx_channel_type efx_default_channel_type; 199874aeea5SJeff Kirsher static void efx_remove_port(struct efx_nic *efx); 2007f967c01SBen Hutchings static void efx_init_napi_channel(struct efx_channel *channel); 201874aeea5SJeff Kirsher static void efx_fini_napi(struct efx_nic *efx); 202874aeea5SJeff Kirsher static void efx_fini_napi_channel(struct efx_channel *channel); 203874aeea5SJeff Kirsher static void efx_fini_struct(struct efx_nic *efx); 204874aeea5SJeff Kirsher static void efx_start_all(struct efx_nic *efx); 205874aeea5SJeff Kirsher static void efx_stop_all(struct efx_nic *efx); 206874aeea5SJeff Kirsher 207874aeea5SJeff Kirsher #define EFX_ASSERT_RESET_SERIALISED(efx) \ 208874aeea5SJeff Kirsher do { \ 209f16aeea0SBen Hutchings if ((efx->state == STATE_READY) || \ 210626950dbSAlexandre Rames (efx->state == STATE_RECOVERY) || \ 211874aeea5SJeff Kirsher (efx->state == STATE_DISABLED)) \ 212874aeea5SJeff Kirsher ASSERT_RTNL(); \ 213874aeea5SJeff Kirsher } while (0) 214874aeea5SJeff Kirsher 2158b7325b4SBen Hutchings static int efx_check_disabled(struct efx_nic *efx) 2168b7325b4SBen Hutchings { 217626950dbSAlexandre Rames if (efx->state == STATE_DISABLED || efx->state == STATE_RECOVERY) { 2188b7325b4SBen Hutchings netif_err(efx, drv, efx->net_dev, 2198b7325b4SBen Hutchings "device is disabled due to earlier errors\n"); 2208b7325b4SBen Hutchings return -EIO; 2218b7325b4SBen Hutchings } 2228b7325b4SBen Hutchings return 0; 2238b7325b4SBen Hutchings } 2248b7325b4SBen Hutchings 225874aeea5SJeff Kirsher /************************************************************************** 226874aeea5SJeff Kirsher * 227874aeea5SJeff Kirsher * Event queue processing 228874aeea5SJeff Kirsher * 229874aeea5SJeff Kirsher *************************************************************************/ 230874aeea5SJeff Kirsher 231874aeea5SJeff Kirsher /* Process channel's event queue 232874aeea5SJeff Kirsher * 233874aeea5SJeff Kirsher * This function is responsible for processing the event queue of a 234874aeea5SJeff Kirsher * single channel. The caller must guarantee that this function will 235874aeea5SJeff Kirsher * never be concurrently called more than once on the same channel, 236874aeea5SJeff Kirsher * though different channels may be being processed concurrently. 237874aeea5SJeff Kirsher */ 238874aeea5SJeff Kirsher static int efx_process_channel(struct efx_channel *channel, int budget) 239874aeea5SJeff Kirsher { 240874aeea5SJeff Kirsher int spent; 241874aeea5SJeff Kirsher 2429f2cb71cSBen Hutchings if (unlikely(!channel->enabled)) 243874aeea5SJeff Kirsher return 0; 244874aeea5SJeff Kirsher 245874aeea5SJeff Kirsher spent = efx_nic_process_eventq(channel, budget); 246d9ab7007SBen Hutchings if (spent && efx_channel_has_rx_queue(channel)) { 247d9ab7007SBen Hutchings struct efx_rx_queue *rx_queue = 248d9ab7007SBen Hutchings efx_channel_get_rx_queue(channel); 249874aeea5SJeff Kirsher 250ff734ef4SBen Hutchings efx_rx_flush_packet(channel); 251d9ab7007SBen Hutchings efx_fast_push_rx_descriptors(rx_queue); 252d9ab7007SBen Hutchings } 253874aeea5SJeff Kirsher 254874aeea5SJeff Kirsher return spent; 255874aeea5SJeff Kirsher } 256874aeea5SJeff Kirsher 257874aeea5SJeff Kirsher /* NAPI poll handler 258874aeea5SJeff Kirsher * 259874aeea5SJeff Kirsher * NAPI guarantees serialisation of polls of the same device, which 260874aeea5SJeff Kirsher * provides the guarantee required by efx_process_channel(). 261874aeea5SJeff Kirsher */ 262874aeea5SJeff Kirsher static int efx_poll(struct napi_struct *napi, int budget) 263874aeea5SJeff Kirsher { 264874aeea5SJeff Kirsher struct efx_channel *channel = 265874aeea5SJeff Kirsher container_of(napi, struct efx_channel, napi_str); 266874aeea5SJeff Kirsher struct efx_nic *efx = channel->efx; 267874aeea5SJeff Kirsher int spent; 268874aeea5SJeff Kirsher 269874aeea5SJeff Kirsher netif_vdbg(efx, intr, efx->net_dev, 270874aeea5SJeff Kirsher "channel %d NAPI poll executing on CPU %d\n", 271874aeea5SJeff Kirsher channel->channel, raw_smp_processor_id()); 272874aeea5SJeff Kirsher 273874aeea5SJeff Kirsher spent = efx_process_channel(channel, budget); 274874aeea5SJeff Kirsher 275874aeea5SJeff Kirsher if (spent < budget) { 2769d9a6973SBen Hutchings if (efx_channel_has_rx_queue(channel) && 277874aeea5SJeff Kirsher efx->irq_rx_adaptive && 278874aeea5SJeff Kirsher unlikely(++channel->irq_count == 1000)) { 279874aeea5SJeff Kirsher if (unlikely(channel->irq_mod_score < 280874aeea5SJeff Kirsher irq_adapt_low_thresh)) { 281874aeea5SJeff Kirsher if (channel->irq_moderation > 1) { 282874aeea5SJeff Kirsher channel->irq_moderation -= 1; 283874aeea5SJeff Kirsher efx->type->push_irq_moderation(channel); 284874aeea5SJeff Kirsher } 285874aeea5SJeff Kirsher } else if (unlikely(channel->irq_mod_score > 286874aeea5SJeff Kirsher irq_adapt_high_thresh)) { 287874aeea5SJeff Kirsher if (channel->irq_moderation < 288874aeea5SJeff Kirsher efx->irq_rx_moderation) { 289874aeea5SJeff Kirsher channel->irq_moderation += 1; 290874aeea5SJeff Kirsher efx->type->push_irq_moderation(channel); 291874aeea5SJeff Kirsher } 292874aeea5SJeff Kirsher } 293874aeea5SJeff Kirsher channel->irq_count = 0; 294874aeea5SJeff Kirsher channel->irq_mod_score = 0; 295874aeea5SJeff Kirsher } 296874aeea5SJeff Kirsher 297874aeea5SJeff Kirsher efx_filter_rfs_expire(channel); 298874aeea5SJeff Kirsher 299874aeea5SJeff Kirsher /* There is no race here; although napi_disable() will 300874aeea5SJeff Kirsher * only wait for napi_complete(), this isn't a problem 301514bedbcSBen Hutchings * since efx_nic_eventq_read_ack() will have no effect if 302874aeea5SJeff Kirsher * interrupts have already been disabled. 303874aeea5SJeff Kirsher */ 304874aeea5SJeff Kirsher napi_complete(napi); 305514bedbcSBen Hutchings efx_nic_eventq_read_ack(channel); 306874aeea5SJeff Kirsher } 307874aeea5SJeff Kirsher 308874aeea5SJeff Kirsher return spent; 309874aeea5SJeff Kirsher } 310874aeea5SJeff Kirsher 311874aeea5SJeff Kirsher /* Create event queue 312874aeea5SJeff Kirsher * Event queue memory allocations are done only once. If the channel 313874aeea5SJeff Kirsher * is reset, the memory buffer will be reused; this guards against 314874aeea5SJeff Kirsher * errors during channel reset and also simplifies interrupt handling. 315874aeea5SJeff Kirsher */ 316874aeea5SJeff Kirsher static int efx_probe_eventq(struct efx_channel *channel) 317874aeea5SJeff Kirsher { 318874aeea5SJeff Kirsher struct efx_nic *efx = channel->efx; 319874aeea5SJeff Kirsher unsigned long entries; 320874aeea5SJeff Kirsher 32186ee5302SBen Hutchings netif_dbg(efx, probe, efx->net_dev, 322874aeea5SJeff Kirsher "chan %d create event queue\n", channel->channel); 323874aeea5SJeff Kirsher 324874aeea5SJeff Kirsher /* Build an event queue with room for one event per tx and rx buffer, 325874aeea5SJeff Kirsher * plus some extra for link state events and MCDI completions. */ 326874aeea5SJeff Kirsher entries = roundup_pow_of_two(efx->rxq_entries + efx->txq_entries + 128); 327874aeea5SJeff Kirsher EFX_BUG_ON_PARANOID(entries > EFX_MAX_EVQ_SIZE); 328874aeea5SJeff Kirsher channel->eventq_mask = max(entries, EFX_MIN_EVQ_SIZE) - 1; 329874aeea5SJeff Kirsher 330874aeea5SJeff Kirsher return efx_nic_probe_eventq(channel); 331874aeea5SJeff Kirsher } 332874aeea5SJeff Kirsher 333874aeea5SJeff Kirsher /* Prepare channel's event queue */ 334874aeea5SJeff Kirsher static void efx_init_eventq(struct efx_channel *channel) 335874aeea5SJeff Kirsher { 336874aeea5SJeff Kirsher netif_dbg(channel->efx, drv, channel->efx->net_dev, 337874aeea5SJeff Kirsher "chan %d init event queue\n", channel->channel); 338874aeea5SJeff Kirsher 339874aeea5SJeff Kirsher channel->eventq_read_ptr = 0; 340874aeea5SJeff Kirsher 341874aeea5SJeff Kirsher efx_nic_init_eventq(channel); 342874aeea5SJeff Kirsher } 343874aeea5SJeff Kirsher 3449f2cb71cSBen Hutchings /* Enable event queue processing and NAPI */ 3459f2cb71cSBen Hutchings static void efx_start_eventq(struct efx_channel *channel) 3469f2cb71cSBen Hutchings { 3479f2cb71cSBen Hutchings netif_dbg(channel->efx, ifup, channel->efx->net_dev, 3489f2cb71cSBen Hutchings "chan %d start event queue\n", channel->channel); 3499f2cb71cSBen Hutchings 350514bedbcSBen Hutchings /* Make sure the NAPI handler sees the enabled flag set */ 3519f2cb71cSBen Hutchings channel->enabled = true; 3529f2cb71cSBen Hutchings smp_wmb(); 3539f2cb71cSBen Hutchings 3549f2cb71cSBen Hutchings napi_enable(&channel->napi_str); 3559f2cb71cSBen Hutchings efx_nic_eventq_read_ack(channel); 3569f2cb71cSBen Hutchings } 3579f2cb71cSBen Hutchings 3589f2cb71cSBen Hutchings /* Disable event queue processing and NAPI */ 3599f2cb71cSBen Hutchings static void efx_stop_eventq(struct efx_channel *channel) 3609f2cb71cSBen Hutchings { 3619f2cb71cSBen Hutchings if (!channel->enabled) 3629f2cb71cSBen Hutchings return; 3639f2cb71cSBen Hutchings 3649f2cb71cSBen Hutchings napi_disable(&channel->napi_str); 3659f2cb71cSBen Hutchings channel->enabled = false; 3669f2cb71cSBen Hutchings } 3679f2cb71cSBen Hutchings 368874aeea5SJeff Kirsher static void efx_fini_eventq(struct efx_channel *channel) 369874aeea5SJeff Kirsher { 370874aeea5SJeff Kirsher netif_dbg(channel->efx, drv, channel->efx->net_dev, 371874aeea5SJeff Kirsher "chan %d fini event queue\n", channel->channel); 372874aeea5SJeff Kirsher 373874aeea5SJeff Kirsher efx_nic_fini_eventq(channel); 374874aeea5SJeff Kirsher } 375874aeea5SJeff Kirsher 376874aeea5SJeff Kirsher static void efx_remove_eventq(struct efx_channel *channel) 377874aeea5SJeff Kirsher { 378874aeea5SJeff Kirsher netif_dbg(channel->efx, drv, channel->efx->net_dev, 379874aeea5SJeff Kirsher "chan %d remove event queue\n", channel->channel); 380874aeea5SJeff Kirsher 381874aeea5SJeff Kirsher efx_nic_remove_eventq(channel); 382874aeea5SJeff Kirsher } 383874aeea5SJeff Kirsher 384874aeea5SJeff Kirsher /************************************************************************** 385874aeea5SJeff Kirsher * 386874aeea5SJeff Kirsher * Channel handling 387874aeea5SJeff Kirsher * 388874aeea5SJeff Kirsher *************************************************************************/ 389874aeea5SJeff Kirsher 3907f967c01SBen Hutchings /* Allocate and initialise a channel structure. */ 391874aeea5SJeff Kirsher static struct efx_channel * 392874aeea5SJeff Kirsher efx_alloc_channel(struct efx_nic *efx, int i, struct efx_channel *old_channel) 393874aeea5SJeff Kirsher { 394874aeea5SJeff Kirsher struct efx_channel *channel; 395874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 396874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 397874aeea5SJeff Kirsher int j; 398874aeea5SJeff Kirsher 3997f967c01SBen Hutchings channel = kzalloc(sizeof(*channel), GFP_KERNEL); 4007f967c01SBen Hutchings if (!channel) 4017f967c01SBen Hutchings return NULL; 4027f967c01SBen Hutchings 4037f967c01SBen Hutchings channel->efx = efx; 4047f967c01SBen Hutchings channel->channel = i; 4057f967c01SBen Hutchings channel->type = &efx_default_channel_type; 4067f967c01SBen Hutchings 4077f967c01SBen Hutchings for (j = 0; j < EFX_TXQ_TYPES; j++) { 4087f967c01SBen Hutchings tx_queue = &channel->tx_queue[j]; 4097f967c01SBen Hutchings tx_queue->efx = efx; 4107f967c01SBen Hutchings tx_queue->queue = i * EFX_TXQ_TYPES + j; 4117f967c01SBen Hutchings tx_queue->channel = channel; 4127f967c01SBen Hutchings } 4137f967c01SBen Hutchings 4147f967c01SBen Hutchings rx_queue = &channel->rx_queue; 4157f967c01SBen Hutchings rx_queue->efx = efx; 4167f967c01SBen Hutchings setup_timer(&rx_queue->slow_fill, efx_rx_slow_fill, 4177f967c01SBen Hutchings (unsigned long)rx_queue); 4187f967c01SBen Hutchings 4197f967c01SBen Hutchings return channel; 4207f967c01SBen Hutchings } 4217f967c01SBen Hutchings 4227f967c01SBen Hutchings /* Allocate and initialise a channel structure, copying parameters 4237f967c01SBen Hutchings * (but not resources) from an old channel structure. 4247f967c01SBen Hutchings */ 4257f967c01SBen Hutchings static struct efx_channel * 4267f967c01SBen Hutchings efx_copy_channel(const struct efx_channel *old_channel) 4277f967c01SBen Hutchings { 4287f967c01SBen Hutchings struct efx_channel *channel; 4297f967c01SBen Hutchings struct efx_rx_queue *rx_queue; 4307f967c01SBen Hutchings struct efx_tx_queue *tx_queue; 4317f967c01SBen Hutchings int j; 4327f967c01SBen Hutchings 433874aeea5SJeff Kirsher channel = kmalloc(sizeof(*channel), GFP_KERNEL); 434874aeea5SJeff Kirsher if (!channel) 435874aeea5SJeff Kirsher return NULL; 436874aeea5SJeff Kirsher 437874aeea5SJeff Kirsher *channel = *old_channel; 438874aeea5SJeff Kirsher 439874aeea5SJeff Kirsher channel->napi_dev = NULL; 440874aeea5SJeff Kirsher memset(&channel->eventq, 0, sizeof(channel->eventq)); 441874aeea5SJeff Kirsher 442874aeea5SJeff Kirsher for (j = 0; j < EFX_TXQ_TYPES; j++) { 443874aeea5SJeff Kirsher tx_queue = &channel->tx_queue[j]; 444874aeea5SJeff Kirsher if (tx_queue->channel) 445874aeea5SJeff Kirsher tx_queue->channel = channel; 446874aeea5SJeff Kirsher tx_queue->buffer = NULL; 447874aeea5SJeff Kirsher memset(&tx_queue->txd, 0, sizeof(tx_queue->txd)); 448874aeea5SJeff Kirsher } 449874aeea5SJeff Kirsher 450874aeea5SJeff Kirsher rx_queue = &channel->rx_queue; 4517f967c01SBen Hutchings rx_queue->buffer = NULL; 4527f967c01SBen Hutchings memset(&rx_queue->rxd, 0, sizeof(rx_queue->rxd)); 453874aeea5SJeff Kirsher setup_timer(&rx_queue->slow_fill, efx_rx_slow_fill, 454874aeea5SJeff Kirsher (unsigned long)rx_queue); 455874aeea5SJeff Kirsher 456874aeea5SJeff Kirsher return channel; 457874aeea5SJeff Kirsher } 458874aeea5SJeff Kirsher 459874aeea5SJeff Kirsher static int efx_probe_channel(struct efx_channel *channel) 460874aeea5SJeff Kirsher { 461874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 462874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 463874aeea5SJeff Kirsher int rc; 464874aeea5SJeff Kirsher 465874aeea5SJeff Kirsher netif_dbg(channel->efx, probe, channel->efx->net_dev, 466874aeea5SJeff Kirsher "creating channel %d\n", channel->channel); 467874aeea5SJeff Kirsher 4687f967c01SBen Hutchings rc = channel->type->pre_probe(channel); 4697f967c01SBen Hutchings if (rc) 4707f967c01SBen Hutchings goto fail; 4717f967c01SBen Hutchings 472874aeea5SJeff Kirsher rc = efx_probe_eventq(channel); 473874aeea5SJeff Kirsher if (rc) 4747f967c01SBen Hutchings goto fail; 475874aeea5SJeff Kirsher 476874aeea5SJeff Kirsher efx_for_each_channel_tx_queue(tx_queue, channel) { 477874aeea5SJeff Kirsher rc = efx_probe_tx_queue(tx_queue); 478874aeea5SJeff Kirsher if (rc) 4797f967c01SBen Hutchings goto fail; 480874aeea5SJeff Kirsher } 481874aeea5SJeff Kirsher 482874aeea5SJeff Kirsher efx_for_each_channel_rx_queue(rx_queue, channel) { 483874aeea5SJeff Kirsher rc = efx_probe_rx_queue(rx_queue); 484874aeea5SJeff Kirsher if (rc) 4857f967c01SBen Hutchings goto fail; 486874aeea5SJeff Kirsher } 487874aeea5SJeff Kirsher 488874aeea5SJeff Kirsher channel->n_rx_frm_trunc = 0; 489874aeea5SJeff Kirsher 490874aeea5SJeff Kirsher return 0; 491874aeea5SJeff Kirsher 4927f967c01SBen Hutchings fail: 4937f967c01SBen Hutchings efx_remove_channel(channel); 494874aeea5SJeff Kirsher return rc; 495874aeea5SJeff Kirsher } 496874aeea5SJeff Kirsher 4977f967c01SBen Hutchings static void 4987f967c01SBen Hutchings efx_get_channel_name(struct efx_channel *channel, char *buf, size_t len) 4997f967c01SBen Hutchings { 5007f967c01SBen Hutchings struct efx_nic *efx = channel->efx; 5017f967c01SBen Hutchings const char *type; 5027f967c01SBen Hutchings int number; 5037f967c01SBen Hutchings 5047f967c01SBen Hutchings number = channel->channel; 5057f967c01SBen Hutchings if (efx->tx_channel_offset == 0) { 5067f967c01SBen Hutchings type = ""; 5077f967c01SBen Hutchings } else if (channel->channel < efx->tx_channel_offset) { 5087f967c01SBen Hutchings type = "-rx"; 5097f967c01SBen Hutchings } else { 5107f967c01SBen Hutchings type = "-tx"; 5117f967c01SBen Hutchings number -= efx->tx_channel_offset; 5127f967c01SBen Hutchings } 5137f967c01SBen Hutchings snprintf(buf, len, "%s%s-%d", efx->name, type, number); 5147f967c01SBen Hutchings } 515874aeea5SJeff Kirsher 516874aeea5SJeff Kirsher static void efx_set_channel_names(struct efx_nic *efx) 517874aeea5SJeff Kirsher { 518874aeea5SJeff Kirsher struct efx_channel *channel; 519874aeea5SJeff Kirsher 5207f967c01SBen Hutchings efx_for_each_channel(channel, efx) 5217f967c01SBen Hutchings channel->type->get_name(channel, 522d8291187SBen Hutchings efx->msi_context[channel->channel].name, 523d8291187SBen Hutchings sizeof(efx->msi_context[0].name)); 524874aeea5SJeff Kirsher } 525874aeea5SJeff Kirsher 526874aeea5SJeff Kirsher static int efx_probe_channels(struct efx_nic *efx) 527874aeea5SJeff Kirsher { 528874aeea5SJeff Kirsher struct efx_channel *channel; 529874aeea5SJeff Kirsher int rc; 530874aeea5SJeff Kirsher 531874aeea5SJeff Kirsher /* Restart special buffer allocation */ 532874aeea5SJeff Kirsher efx->next_buffer_table = 0; 533874aeea5SJeff Kirsher 534c92aaff1SBen Hutchings /* Probe channels in reverse, so that any 'extra' channels 535c92aaff1SBen Hutchings * use the start of the buffer table. This allows the traffic 536c92aaff1SBen Hutchings * channels to be resized without moving them or wasting the 537c92aaff1SBen Hutchings * entries before them. 538c92aaff1SBen Hutchings */ 539c92aaff1SBen Hutchings efx_for_each_channel_rev(channel, efx) { 540874aeea5SJeff Kirsher rc = efx_probe_channel(channel); 541874aeea5SJeff Kirsher if (rc) { 542874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 543874aeea5SJeff Kirsher "failed to create channel %d\n", 544874aeea5SJeff Kirsher channel->channel); 545874aeea5SJeff Kirsher goto fail; 546874aeea5SJeff Kirsher } 547874aeea5SJeff Kirsher } 548874aeea5SJeff Kirsher efx_set_channel_names(efx); 549874aeea5SJeff Kirsher 550874aeea5SJeff Kirsher return 0; 551874aeea5SJeff Kirsher 552874aeea5SJeff Kirsher fail: 553874aeea5SJeff Kirsher efx_remove_channels(efx); 554874aeea5SJeff Kirsher return rc; 555874aeea5SJeff Kirsher } 556874aeea5SJeff Kirsher 557874aeea5SJeff Kirsher /* Channels are shutdown and reinitialised whilst the NIC is running 558874aeea5SJeff Kirsher * to propagate configuration changes (mtu, checksum offload), or 559874aeea5SJeff Kirsher * to clear hardware error conditions 560874aeea5SJeff Kirsher */ 5619f2cb71cSBen Hutchings static void efx_start_datapath(struct efx_nic *efx) 562874aeea5SJeff Kirsher { 56385740cdfSBen Hutchings bool old_rx_scatter = efx->rx_scatter; 564874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 565874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 566874aeea5SJeff Kirsher struct efx_channel *channel; 56785740cdfSBen Hutchings size_t rx_buf_len; 568874aeea5SJeff Kirsher 569874aeea5SJeff Kirsher /* Calculate the rx buffer allocation parameters required to 570874aeea5SJeff Kirsher * support the current MTU, including padding for header 571874aeea5SJeff Kirsher * alignment and overruns. 572874aeea5SJeff Kirsher */ 573272baeebSBen Hutchings efx->rx_dma_len = (efx->type->rx_buffer_hash_size + 574874aeea5SJeff Kirsher EFX_MAX_FRAME_LEN(efx->net_dev->mtu) + 575874aeea5SJeff Kirsher efx->type->rx_buffer_padding); 57685740cdfSBen Hutchings rx_buf_len = (sizeof(struct efx_rx_page_state) + 577c14ff2eaSBen Hutchings NET_IP_ALIGN + efx->rx_dma_len); 57885740cdfSBen Hutchings if (rx_buf_len <= PAGE_SIZE) { 57985740cdfSBen Hutchings efx->rx_scatter = false; 58085740cdfSBen Hutchings efx->rx_buffer_order = 0; 58185740cdfSBen Hutchings } else if (efx->type->can_rx_scatter) { 582950c54dfSBen Hutchings BUILD_BUG_ON(EFX_RX_USR_BUF_SIZE % L1_CACHE_BYTES); 58385740cdfSBen Hutchings BUILD_BUG_ON(sizeof(struct efx_rx_page_state) + 584950c54dfSBen Hutchings 2 * ALIGN(NET_IP_ALIGN + EFX_RX_USR_BUF_SIZE, 585950c54dfSBen Hutchings EFX_RX_BUF_ALIGNMENT) > 586950c54dfSBen Hutchings PAGE_SIZE); 58785740cdfSBen Hutchings efx->rx_scatter = true; 58885740cdfSBen Hutchings efx->rx_dma_len = EFX_RX_USR_BUF_SIZE; 58985740cdfSBen Hutchings efx->rx_buffer_order = 0; 59085740cdfSBen Hutchings } else { 59185740cdfSBen Hutchings efx->rx_scatter = false; 59285740cdfSBen Hutchings efx->rx_buffer_order = get_order(rx_buf_len); 59385740cdfSBen Hutchings } 59485740cdfSBen Hutchings 5951648a23fSDaniel Pieczko efx_rx_config_page_split(efx); 5961648a23fSDaniel Pieczko if (efx->rx_buffer_order) 5971648a23fSDaniel Pieczko netif_dbg(efx, drv, efx->net_dev, 5981648a23fSDaniel Pieczko "RX buf len=%u; page order=%u batch=%u\n", 5991648a23fSDaniel Pieczko efx->rx_dma_len, efx->rx_buffer_order, 6001648a23fSDaniel Pieczko efx->rx_pages_per_batch); 6011648a23fSDaniel Pieczko else 6021648a23fSDaniel Pieczko netif_dbg(efx, drv, efx->net_dev, 6031648a23fSDaniel Pieczko "RX buf len=%u step=%u bpp=%u; page batch=%u\n", 6041648a23fSDaniel Pieczko efx->rx_dma_len, efx->rx_page_buf_step, 6051648a23fSDaniel Pieczko efx->rx_bufs_per_page, efx->rx_pages_per_batch); 6062768935aSDaniel Pieczko 60785740cdfSBen Hutchings /* RX filters also have scatter-enabled flags */ 60885740cdfSBen Hutchings if (efx->rx_scatter != old_rx_scatter) 60985740cdfSBen Hutchings efx_filter_update_rx_scatter(efx); 610874aeea5SJeff Kirsher 61114bf718fSBen Hutchings /* We must keep at least one descriptor in a TX ring empty. 61214bf718fSBen Hutchings * We could avoid this when the queue size does not exactly 61314bf718fSBen Hutchings * match the hardware ring size, but it's not that important. 61414bf718fSBen Hutchings * Therefore we stop the queue when one more skb might fill 61514bf718fSBen Hutchings * the ring completely. We wake it when half way back to 61614bf718fSBen Hutchings * empty. 61714bf718fSBen Hutchings */ 61814bf718fSBen Hutchings efx->txq_stop_thresh = efx->txq_entries - efx_tx_max_skb_descs(efx); 61914bf718fSBen Hutchings efx->txq_wake_thresh = efx->txq_stop_thresh / 2; 62014bf718fSBen Hutchings 621874aeea5SJeff Kirsher /* Initialise the channels */ 622874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 623874aeea5SJeff Kirsher efx_for_each_channel_tx_queue(tx_queue, channel) 624874aeea5SJeff Kirsher efx_init_tx_queue(tx_queue); 625874aeea5SJeff Kirsher 6269f2cb71cSBen Hutchings efx_for_each_channel_rx_queue(rx_queue, channel) { 627874aeea5SJeff Kirsher efx_init_rx_queue(rx_queue); 6289f2cb71cSBen Hutchings efx_nic_generate_fill_event(rx_queue); 6299f2cb71cSBen Hutchings } 630874aeea5SJeff Kirsher 63185740cdfSBen Hutchings WARN_ON(channel->rx_pkt_n_frags); 632874aeea5SJeff Kirsher } 6339f2cb71cSBen Hutchings 6349f2cb71cSBen Hutchings if (netif_device_present(efx->net_dev)) 6359f2cb71cSBen Hutchings netif_tx_wake_all_queues(efx->net_dev); 636874aeea5SJeff Kirsher } 637874aeea5SJeff Kirsher 6389f2cb71cSBen Hutchings static void efx_stop_datapath(struct efx_nic *efx) 639874aeea5SJeff Kirsher { 640874aeea5SJeff Kirsher struct efx_channel *channel; 641874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 642874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 643874aeea5SJeff Kirsher int rc; 644874aeea5SJeff Kirsher 645874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 646874aeea5SJeff Kirsher BUG_ON(efx->port_enabled); 647874aeea5SJeff Kirsher 648d8aec745SBen Hutchings /* Stop RX refill */ 649d8aec745SBen Hutchings efx_for_each_channel(channel, efx) { 650d8aec745SBen Hutchings efx_for_each_channel_rx_queue(rx_queue, channel) 651d8aec745SBen Hutchings rx_queue->refill_enabled = false; 652d8aec745SBen Hutchings } 653d8aec745SBen Hutchings 654874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 6559f2cb71cSBen Hutchings /* RX packet processing is pipelined, so wait for the 6569f2cb71cSBen Hutchings * NAPI handler to complete. At least event queue 0 6579f2cb71cSBen Hutchings * might be kept active by non-data events, so don't 6589f2cb71cSBen Hutchings * use napi_synchronize() but actually disable NAPI 6599f2cb71cSBen Hutchings * temporarily. 6609f2cb71cSBen Hutchings */ 6619f2cb71cSBen Hutchings if (efx_channel_has_rx_queue(channel)) { 6629f2cb71cSBen Hutchings efx_stop_eventq(channel); 6639f2cb71cSBen Hutchings efx_start_eventq(channel); 6649f2cb71cSBen Hutchings } 665e42c3d85SBen Hutchings } 666874aeea5SJeff Kirsher 667e42c3d85SBen Hutchings rc = efx->type->fini_dmaq(efx); 668e42c3d85SBen Hutchings if (rc && EFX_WORKAROUND_7803(efx)) { 669e42c3d85SBen Hutchings /* Schedule a reset to recover from the flush failure. The 670e42c3d85SBen Hutchings * descriptor caches reference memory we're about to free, 671e42c3d85SBen Hutchings * but falcon_reconfigure_mac_wrapper() won't reconnect 672e42c3d85SBen Hutchings * the MACs because of the pending reset. 673e42c3d85SBen Hutchings */ 674e42c3d85SBen Hutchings netif_err(efx, drv, efx->net_dev, 675e42c3d85SBen Hutchings "Resetting to recover from flush failure\n"); 676e42c3d85SBen Hutchings efx_schedule_reset(efx, RESET_TYPE_ALL); 677e42c3d85SBen Hutchings } else if (rc) { 678e42c3d85SBen Hutchings netif_err(efx, drv, efx->net_dev, "failed to flush queues\n"); 679e42c3d85SBen Hutchings } else { 680e42c3d85SBen Hutchings netif_dbg(efx, drv, efx->net_dev, 681e42c3d85SBen Hutchings "successfully flushed all queues\n"); 682e42c3d85SBen Hutchings } 683e42c3d85SBen Hutchings 684e42c3d85SBen Hutchings efx_for_each_channel(channel, efx) { 685874aeea5SJeff Kirsher efx_for_each_channel_rx_queue(rx_queue, channel) 686874aeea5SJeff Kirsher efx_fini_rx_queue(rx_queue); 687874aeea5SJeff Kirsher efx_for_each_possible_channel_tx_queue(tx_queue, channel) 688874aeea5SJeff Kirsher efx_fini_tx_queue(tx_queue); 689874aeea5SJeff Kirsher } 690874aeea5SJeff Kirsher } 691874aeea5SJeff Kirsher 692874aeea5SJeff Kirsher static void efx_remove_channel(struct efx_channel *channel) 693874aeea5SJeff Kirsher { 694874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 695874aeea5SJeff Kirsher struct efx_rx_queue *rx_queue; 696874aeea5SJeff Kirsher 697874aeea5SJeff Kirsher netif_dbg(channel->efx, drv, channel->efx->net_dev, 698874aeea5SJeff Kirsher "destroy chan %d\n", channel->channel); 699874aeea5SJeff Kirsher 700874aeea5SJeff Kirsher efx_for_each_channel_rx_queue(rx_queue, channel) 701874aeea5SJeff Kirsher efx_remove_rx_queue(rx_queue); 702874aeea5SJeff Kirsher efx_for_each_possible_channel_tx_queue(tx_queue, channel) 703874aeea5SJeff Kirsher efx_remove_tx_queue(tx_queue); 704874aeea5SJeff Kirsher efx_remove_eventq(channel); 705c31e5f9fSStuart Hodgson channel->type->post_remove(channel); 706874aeea5SJeff Kirsher } 707874aeea5SJeff Kirsher 708874aeea5SJeff Kirsher static void efx_remove_channels(struct efx_nic *efx) 709874aeea5SJeff Kirsher { 710874aeea5SJeff Kirsher struct efx_channel *channel; 711874aeea5SJeff Kirsher 712874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 713874aeea5SJeff Kirsher efx_remove_channel(channel); 714874aeea5SJeff Kirsher } 715874aeea5SJeff Kirsher 716874aeea5SJeff Kirsher int 717874aeea5SJeff Kirsher efx_realloc_channels(struct efx_nic *efx, u32 rxq_entries, u32 txq_entries) 718874aeea5SJeff Kirsher { 719874aeea5SJeff Kirsher struct efx_channel *other_channel[EFX_MAX_CHANNELS], *channel; 720874aeea5SJeff Kirsher u32 old_rxq_entries, old_txq_entries; 7217f967c01SBen Hutchings unsigned i, next_buffer_table = 0; 7228b7325b4SBen Hutchings int rc; 7238b7325b4SBen Hutchings 7248b7325b4SBen Hutchings rc = efx_check_disabled(efx); 7258b7325b4SBen Hutchings if (rc) 7268b7325b4SBen Hutchings return rc; 7277f967c01SBen Hutchings 7287f967c01SBen Hutchings /* Not all channels should be reallocated. We must avoid 7297f967c01SBen Hutchings * reallocating their buffer table entries. 7307f967c01SBen Hutchings */ 7317f967c01SBen Hutchings efx_for_each_channel(channel, efx) { 7327f967c01SBen Hutchings struct efx_rx_queue *rx_queue; 7337f967c01SBen Hutchings struct efx_tx_queue *tx_queue; 7347f967c01SBen Hutchings 7357f967c01SBen Hutchings if (channel->type->copy) 7367f967c01SBen Hutchings continue; 7377f967c01SBen Hutchings next_buffer_table = max(next_buffer_table, 7387f967c01SBen Hutchings channel->eventq.index + 7397f967c01SBen Hutchings channel->eventq.entries); 7407f967c01SBen Hutchings efx_for_each_channel_rx_queue(rx_queue, channel) 7417f967c01SBen Hutchings next_buffer_table = max(next_buffer_table, 7427f967c01SBen Hutchings rx_queue->rxd.index + 7437f967c01SBen Hutchings rx_queue->rxd.entries); 7447f967c01SBen Hutchings efx_for_each_channel_tx_queue(tx_queue, channel) 7457f967c01SBen Hutchings next_buffer_table = max(next_buffer_table, 7467f967c01SBen Hutchings tx_queue->txd.index + 7477f967c01SBen Hutchings tx_queue->txd.entries); 7487f967c01SBen Hutchings } 749874aeea5SJeff Kirsher 75029c69a48SBen Hutchings efx_device_detach_sync(efx); 751874aeea5SJeff Kirsher efx_stop_all(efx); 752d8291187SBen Hutchings efx_soft_disable_interrupts(efx); 753874aeea5SJeff Kirsher 7547f967c01SBen Hutchings /* Clone channels (where possible) */ 755874aeea5SJeff Kirsher memset(other_channel, 0, sizeof(other_channel)); 756874aeea5SJeff Kirsher for (i = 0; i < efx->n_channels; i++) { 7577f967c01SBen Hutchings channel = efx->channel[i]; 7587f967c01SBen Hutchings if (channel->type->copy) 7597f967c01SBen Hutchings channel = channel->type->copy(channel); 760874aeea5SJeff Kirsher if (!channel) { 761874aeea5SJeff Kirsher rc = -ENOMEM; 762874aeea5SJeff Kirsher goto out; 763874aeea5SJeff Kirsher } 764874aeea5SJeff Kirsher other_channel[i] = channel; 765874aeea5SJeff Kirsher } 766874aeea5SJeff Kirsher 767874aeea5SJeff Kirsher /* Swap entry counts and channel pointers */ 768874aeea5SJeff Kirsher old_rxq_entries = efx->rxq_entries; 769874aeea5SJeff Kirsher old_txq_entries = efx->txq_entries; 770874aeea5SJeff Kirsher efx->rxq_entries = rxq_entries; 771874aeea5SJeff Kirsher efx->txq_entries = txq_entries; 772874aeea5SJeff Kirsher for (i = 0; i < efx->n_channels; i++) { 773874aeea5SJeff Kirsher channel = efx->channel[i]; 774874aeea5SJeff Kirsher efx->channel[i] = other_channel[i]; 775874aeea5SJeff Kirsher other_channel[i] = channel; 776874aeea5SJeff Kirsher } 777874aeea5SJeff Kirsher 7787f967c01SBen Hutchings /* Restart buffer table allocation */ 7797f967c01SBen Hutchings efx->next_buffer_table = next_buffer_table; 7807f967c01SBen Hutchings 7817f967c01SBen Hutchings for (i = 0; i < efx->n_channels; i++) { 7827f967c01SBen Hutchings channel = efx->channel[i]; 7837f967c01SBen Hutchings if (!channel->type->copy) 7847f967c01SBen Hutchings continue; 7857f967c01SBen Hutchings rc = efx_probe_channel(channel); 786874aeea5SJeff Kirsher if (rc) 787874aeea5SJeff Kirsher goto rollback; 7887f967c01SBen Hutchings efx_init_napi_channel(efx->channel[i]); 789874aeea5SJeff Kirsher } 790874aeea5SJeff Kirsher 7917f967c01SBen Hutchings out: 7927f967c01SBen Hutchings /* Destroy unused channel structures */ 7937f967c01SBen Hutchings for (i = 0; i < efx->n_channels; i++) { 7947f967c01SBen Hutchings channel = other_channel[i]; 7957f967c01SBen Hutchings if (channel && channel->type->copy) { 7967f967c01SBen Hutchings efx_fini_napi_channel(channel); 7977f967c01SBen Hutchings efx_remove_channel(channel); 7987f967c01SBen Hutchings kfree(channel); 7997f967c01SBen Hutchings } 8007f967c01SBen Hutchings } 8017f967c01SBen Hutchings 802d8291187SBen Hutchings efx_soft_enable_interrupts(efx); 803874aeea5SJeff Kirsher efx_start_all(efx); 80429c69a48SBen Hutchings netif_device_attach(efx->net_dev); 805874aeea5SJeff Kirsher return rc; 806874aeea5SJeff Kirsher 807874aeea5SJeff Kirsher rollback: 808874aeea5SJeff Kirsher /* Swap back */ 809874aeea5SJeff Kirsher efx->rxq_entries = old_rxq_entries; 810874aeea5SJeff Kirsher efx->txq_entries = old_txq_entries; 811874aeea5SJeff Kirsher for (i = 0; i < efx->n_channels; i++) { 812874aeea5SJeff Kirsher channel = efx->channel[i]; 813874aeea5SJeff Kirsher efx->channel[i] = other_channel[i]; 814874aeea5SJeff Kirsher other_channel[i] = channel; 815874aeea5SJeff Kirsher } 816874aeea5SJeff Kirsher goto out; 817874aeea5SJeff Kirsher } 818874aeea5SJeff Kirsher 819874aeea5SJeff Kirsher void efx_schedule_slow_fill(struct efx_rx_queue *rx_queue) 820874aeea5SJeff Kirsher { 821874aeea5SJeff Kirsher mod_timer(&rx_queue->slow_fill, jiffies + msecs_to_jiffies(100)); 822874aeea5SJeff Kirsher } 823874aeea5SJeff Kirsher 8247f967c01SBen Hutchings static const struct efx_channel_type efx_default_channel_type = { 8257f967c01SBen Hutchings .pre_probe = efx_channel_dummy_op_int, 826c31e5f9fSStuart Hodgson .post_remove = efx_channel_dummy_op_void, 8277f967c01SBen Hutchings .get_name = efx_get_channel_name, 8287f967c01SBen Hutchings .copy = efx_copy_channel, 8297f967c01SBen Hutchings .keep_eventq = false, 8307f967c01SBen Hutchings }; 8317f967c01SBen Hutchings 8327f967c01SBen Hutchings int efx_channel_dummy_op_int(struct efx_channel *channel) 8337f967c01SBen Hutchings { 8347f967c01SBen Hutchings return 0; 8357f967c01SBen Hutchings } 8367f967c01SBen Hutchings 837c31e5f9fSStuart Hodgson void efx_channel_dummy_op_void(struct efx_channel *channel) 838c31e5f9fSStuart Hodgson { 839c31e5f9fSStuart Hodgson } 840c31e5f9fSStuart Hodgson 841874aeea5SJeff Kirsher /************************************************************************** 842874aeea5SJeff Kirsher * 843874aeea5SJeff Kirsher * Port handling 844874aeea5SJeff Kirsher * 845874aeea5SJeff Kirsher **************************************************************************/ 846874aeea5SJeff Kirsher 847874aeea5SJeff Kirsher /* This ensures that the kernel is kept informed (via 848874aeea5SJeff Kirsher * netif_carrier_on/off) of the link status, and also maintains the 849874aeea5SJeff Kirsher * link status's stop on the port's TX queue. 850874aeea5SJeff Kirsher */ 851874aeea5SJeff Kirsher void efx_link_status_changed(struct efx_nic *efx) 852874aeea5SJeff Kirsher { 853874aeea5SJeff Kirsher struct efx_link_state *link_state = &efx->link_state; 854874aeea5SJeff Kirsher 855874aeea5SJeff Kirsher /* SFC Bug 5356: A net_dev notifier is registered, so we must ensure 856874aeea5SJeff Kirsher * that no events are triggered between unregister_netdev() and the 857874aeea5SJeff Kirsher * driver unloading. A more general condition is that NETDEV_CHANGE 858874aeea5SJeff Kirsher * can only be generated between NETDEV_UP and NETDEV_DOWN */ 859874aeea5SJeff Kirsher if (!netif_running(efx->net_dev)) 860874aeea5SJeff Kirsher return; 861874aeea5SJeff Kirsher 862874aeea5SJeff Kirsher if (link_state->up != netif_carrier_ok(efx->net_dev)) { 863874aeea5SJeff Kirsher efx->n_link_state_changes++; 864874aeea5SJeff Kirsher 865874aeea5SJeff Kirsher if (link_state->up) 866874aeea5SJeff Kirsher netif_carrier_on(efx->net_dev); 867874aeea5SJeff Kirsher else 868874aeea5SJeff Kirsher netif_carrier_off(efx->net_dev); 869874aeea5SJeff Kirsher } 870874aeea5SJeff Kirsher 871874aeea5SJeff Kirsher /* Status message for kernel log */ 8722aa9ef11SBen Hutchings if (link_state->up) 873874aeea5SJeff Kirsher netif_info(efx, link, efx->net_dev, 874874aeea5SJeff Kirsher "link up at %uMbps %s-duplex (MTU %d)%s\n", 875874aeea5SJeff Kirsher link_state->speed, link_state->fd ? "full" : "half", 876874aeea5SJeff Kirsher efx->net_dev->mtu, 877874aeea5SJeff Kirsher (efx->promiscuous ? " [PROMISC]" : "")); 8782aa9ef11SBen Hutchings else 879874aeea5SJeff Kirsher netif_info(efx, link, efx->net_dev, "link down\n"); 880874aeea5SJeff Kirsher } 881874aeea5SJeff Kirsher 882874aeea5SJeff Kirsher void efx_link_set_advertising(struct efx_nic *efx, u32 advertising) 883874aeea5SJeff Kirsher { 884874aeea5SJeff Kirsher efx->link_advertising = advertising; 885874aeea5SJeff Kirsher if (advertising) { 886874aeea5SJeff Kirsher if (advertising & ADVERTISED_Pause) 887874aeea5SJeff Kirsher efx->wanted_fc |= (EFX_FC_TX | EFX_FC_RX); 888874aeea5SJeff Kirsher else 889874aeea5SJeff Kirsher efx->wanted_fc &= ~(EFX_FC_TX | EFX_FC_RX); 890874aeea5SJeff Kirsher if (advertising & ADVERTISED_Asym_Pause) 891874aeea5SJeff Kirsher efx->wanted_fc ^= EFX_FC_TX; 892874aeea5SJeff Kirsher } 893874aeea5SJeff Kirsher } 894874aeea5SJeff Kirsher 895874aeea5SJeff Kirsher void efx_link_set_wanted_fc(struct efx_nic *efx, u8 wanted_fc) 896874aeea5SJeff Kirsher { 897874aeea5SJeff Kirsher efx->wanted_fc = wanted_fc; 898874aeea5SJeff Kirsher if (efx->link_advertising) { 899874aeea5SJeff Kirsher if (wanted_fc & EFX_FC_RX) 900874aeea5SJeff Kirsher efx->link_advertising |= (ADVERTISED_Pause | 901874aeea5SJeff Kirsher ADVERTISED_Asym_Pause); 902874aeea5SJeff Kirsher else 903874aeea5SJeff Kirsher efx->link_advertising &= ~(ADVERTISED_Pause | 904874aeea5SJeff Kirsher ADVERTISED_Asym_Pause); 905874aeea5SJeff Kirsher if (wanted_fc & EFX_FC_TX) 906874aeea5SJeff Kirsher efx->link_advertising ^= ADVERTISED_Asym_Pause; 907874aeea5SJeff Kirsher } 908874aeea5SJeff Kirsher } 909874aeea5SJeff Kirsher 910874aeea5SJeff Kirsher static void efx_fini_port(struct efx_nic *efx); 911874aeea5SJeff Kirsher 912874aeea5SJeff Kirsher /* Push loopback/power/transmit disable settings to the PHY, and reconfigure 913874aeea5SJeff Kirsher * the MAC appropriately. All other PHY configuration changes are pushed 914874aeea5SJeff Kirsher * through phy_op->set_settings(), and pushed asynchronously to the MAC 915874aeea5SJeff Kirsher * through efx_monitor(). 916874aeea5SJeff Kirsher * 917874aeea5SJeff Kirsher * Callers must hold the mac_lock 918874aeea5SJeff Kirsher */ 919874aeea5SJeff Kirsher int __efx_reconfigure_port(struct efx_nic *efx) 920874aeea5SJeff Kirsher { 921874aeea5SJeff Kirsher enum efx_phy_mode phy_mode; 922874aeea5SJeff Kirsher int rc; 923874aeea5SJeff Kirsher 924874aeea5SJeff Kirsher WARN_ON(!mutex_is_locked(&efx->mac_lock)); 925874aeea5SJeff Kirsher 9260fca8c97SBen Hutchings /* Serialise the promiscuous flag with efx_set_rx_mode. */ 927874aeea5SJeff Kirsher netif_addr_lock_bh(efx->net_dev); 928874aeea5SJeff Kirsher netif_addr_unlock_bh(efx->net_dev); 929874aeea5SJeff Kirsher 930874aeea5SJeff Kirsher /* Disable PHY transmit in mac level loopbacks */ 931874aeea5SJeff Kirsher phy_mode = efx->phy_mode; 932874aeea5SJeff Kirsher if (LOOPBACK_INTERNAL(efx)) 933874aeea5SJeff Kirsher efx->phy_mode |= PHY_MODE_TX_DISABLED; 934874aeea5SJeff Kirsher else 935874aeea5SJeff Kirsher efx->phy_mode &= ~PHY_MODE_TX_DISABLED; 936874aeea5SJeff Kirsher 937874aeea5SJeff Kirsher rc = efx->type->reconfigure_port(efx); 938874aeea5SJeff Kirsher 939874aeea5SJeff Kirsher if (rc) 940874aeea5SJeff Kirsher efx->phy_mode = phy_mode; 941874aeea5SJeff Kirsher 942874aeea5SJeff Kirsher return rc; 943874aeea5SJeff Kirsher } 944874aeea5SJeff Kirsher 945874aeea5SJeff Kirsher /* Reinitialise the MAC to pick up new PHY settings, even if the port is 946874aeea5SJeff Kirsher * disabled. */ 947874aeea5SJeff Kirsher int efx_reconfigure_port(struct efx_nic *efx) 948874aeea5SJeff Kirsher { 949874aeea5SJeff Kirsher int rc; 950874aeea5SJeff Kirsher 951874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 952874aeea5SJeff Kirsher 953874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 954874aeea5SJeff Kirsher rc = __efx_reconfigure_port(efx); 955874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 956874aeea5SJeff Kirsher 957874aeea5SJeff Kirsher return rc; 958874aeea5SJeff Kirsher } 959874aeea5SJeff Kirsher 960874aeea5SJeff Kirsher /* Asynchronous work item for changing MAC promiscuity and multicast 961874aeea5SJeff Kirsher * hash. Avoid a drain/rx_ingress enable by reconfiguring the current 962874aeea5SJeff Kirsher * MAC directly. */ 963874aeea5SJeff Kirsher static void efx_mac_work(struct work_struct *data) 964874aeea5SJeff Kirsher { 965874aeea5SJeff Kirsher struct efx_nic *efx = container_of(data, struct efx_nic, mac_work); 966874aeea5SJeff Kirsher 967874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 96830b81cdaSBen Hutchings if (efx->port_enabled) 969710b208dSBen Hutchings efx->type->reconfigure_mac(efx); 970874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 971874aeea5SJeff Kirsher } 972874aeea5SJeff Kirsher 973874aeea5SJeff Kirsher static int efx_probe_port(struct efx_nic *efx) 974874aeea5SJeff Kirsher { 975874aeea5SJeff Kirsher int rc; 976874aeea5SJeff Kirsher 977874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "create port\n"); 978874aeea5SJeff Kirsher 979874aeea5SJeff Kirsher if (phy_flash_cfg) 980874aeea5SJeff Kirsher efx->phy_mode = PHY_MODE_SPECIAL; 981874aeea5SJeff Kirsher 982874aeea5SJeff Kirsher /* Connect up MAC/PHY operations table */ 983874aeea5SJeff Kirsher rc = efx->type->probe_port(efx); 984874aeea5SJeff Kirsher if (rc) 985874aeea5SJeff Kirsher return rc; 986874aeea5SJeff Kirsher 987e332bcb3SBen Hutchings /* Initialise MAC address to permanent address */ 988e332bcb3SBen Hutchings memcpy(efx->net_dev->dev_addr, efx->net_dev->perm_addr, ETH_ALEN); 989874aeea5SJeff Kirsher 990874aeea5SJeff Kirsher return 0; 991874aeea5SJeff Kirsher } 992874aeea5SJeff Kirsher 993874aeea5SJeff Kirsher static int efx_init_port(struct efx_nic *efx) 994874aeea5SJeff Kirsher { 995874aeea5SJeff Kirsher int rc; 996874aeea5SJeff Kirsher 997874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "init port\n"); 998874aeea5SJeff Kirsher 999874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1000874aeea5SJeff Kirsher 1001874aeea5SJeff Kirsher rc = efx->phy_op->init(efx); 1002874aeea5SJeff Kirsher if (rc) 1003874aeea5SJeff Kirsher goto fail1; 1004874aeea5SJeff Kirsher 1005874aeea5SJeff Kirsher efx->port_initialized = true; 1006874aeea5SJeff Kirsher 1007874aeea5SJeff Kirsher /* Reconfigure the MAC before creating dma queues (required for 1008874aeea5SJeff Kirsher * Falcon/A1 where RX_INGR_EN/TX_DRAIN_EN isn't supported) */ 1009710b208dSBen Hutchings efx->type->reconfigure_mac(efx); 1010874aeea5SJeff Kirsher 1011874aeea5SJeff Kirsher /* Ensure the PHY advertises the correct flow control settings */ 1012874aeea5SJeff Kirsher rc = efx->phy_op->reconfigure(efx); 1013874aeea5SJeff Kirsher if (rc) 1014874aeea5SJeff Kirsher goto fail2; 1015874aeea5SJeff Kirsher 1016874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1017874aeea5SJeff Kirsher return 0; 1018874aeea5SJeff Kirsher 1019874aeea5SJeff Kirsher fail2: 1020874aeea5SJeff Kirsher efx->phy_op->fini(efx); 1021874aeea5SJeff Kirsher fail1: 1022874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1023874aeea5SJeff Kirsher return rc; 1024874aeea5SJeff Kirsher } 1025874aeea5SJeff Kirsher 1026874aeea5SJeff Kirsher static void efx_start_port(struct efx_nic *efx) 1027874aeea5SJeff Kirsher { 1028874aeea5SJeff Kirsher netif_dbg(efx, ifup, efx->net_dev, "start port\n"); 1029874aeea5SJeff Kirsher BUG_ON(efx->port_enabled); 1030874aeea5SJeff Kirsher 1031874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1032874aeea5SJeff Kirsher efx->port_enabled = true; 1033874aeea5SJeff Kirsher 1034874aeea5SJeff Kirsher /* efx_mac_work() might have been scheduled after efx_stop_port(), 1035874aeea5SJeff Kirsher * and then cancelled by efx_flush_all() */ 1036710b208dSBen Hutchings efx->type->reconfigure_mac(efx); 1037874aeea5SJeff Kirsher 1038874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1039874aeea5SJeff Kirsher } 1040874aeea5SJeff Kirsher 1041874aeea5SJeff Kirsher /* Prevent efx_mac_work() and efx_monitor() from working */ 1042874aeea5SJeff Kirsher static void efx_stop_port(struct efx_nic *efx) 1043874aeea5SJeff Kirsher { 1044874aeea5SJeff Kirsher netif_dbg(efx, ifdown, efx->net_dev, "stop port\n"); 1045874aeea5SJeff Kirsher 1046874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1047874aeea5SJeff Kirsher efx->port_enabled = false; 1048874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1049874aeea5SJeff Kirsher 1050874aeea5SJeff Kirsher /* Serialise against efx_set_multicast_list() */ 1051874aeea5SJeff Kirsher netif_addr_lock_bh(efx->net_dev); 1052874aeea5SJeff Kirsher netif_addr_unlock_bh(efx->net_dev); 1053874aeea5SJeff Kirsher } 1054874aeea5SJeff Kirsher 1055874aeea5SJeff Kirsher static void efx_fini_port(struct efx_nic *efx) 1056874aeea5SJeff Kirsher { 1057874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "shut down port\n"); 1058874aeea5SJeff Kirsher 1059874aeea5SJeff Kirsher if (!efx->port_initialized) 1060874aeea5SJeff Kirsher return; 1061874aeea5SJeff Kirsher 1062874aeea5SJeff Kirsher efx->phy_op->fini(efx); 1063874aeea5SJeff Kirsher efx->port_initialized = false; 1064874aeea5SJeff Kirsher 1065874aeea5SJeff Kirsher efx->link_state.up = false; 1066874aeea5SJeff Kirsher efx_link_status_changed(efx); 1067874aeea5SJeff Kirsher } 1068874aeea5SJeff Kirsher 1069874aeea5SJeff Kirsher static void efx_remove_port(struct efx_nic *efx) 1070874aeea5SJeff Kirsher { 1071874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "destroying port\n"); 1072874aeea5SJeff Kirsher 1073874aeea5SJeff Kirsher efx->type->remove_port(efx); 1074874aeea5SJeff Kirsher } 1075874aeea5SJeff Kirsher 1076874aeea5SJeff Kirsher /************************************************************************** 1077874aeea5SJeff Kirsher * 1078874aeea5SJeff Kirsher * NIC handling 1079874aeea5SJeff Kirsher * 1080874aeea5SJeff Kirsher **************************************************************************/ 1081874aeea5SJeff Kirsher 1082874aeea5SJeff Kirsher /* This configures the PCI device to enable I/O and DMA. */ 1083874aeea5SJeff Kirsher static int efx_init_io(struct efx_nic *efx) 1084874aeea5SJeff Kirsher { 1085874aeea5SJeff Kirsher struct pci_dev *pci_dev = efx->pci_dev; 1086874aeea5SJeff Kirsher dma_addr_t dma_mask = efx->type->max_dma_mask; 1087874aeea5SJeff Kirsher int rc; 1088874aeea5SJeff Kirsher 1089874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "initialising I/O\n"); 1090874aeea5SJeff Kirsher 1091874aeea5SJeff Kirsher rc = pci_enable_device(pci_dev); 1092874aeea5SJeff Kirsher if (rc) { 1093874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1094874aeea5SJeff Kirsher "failed to enable PCI device\n"); 1095874aeea5SJeff Kirsher goto fail1; 1096874aeea5SJeff Kirsher } 1097874aeea5SJeff Kirsher 1098874aeea5SJeff Kirsher pci_set_master(pci_dev); 1099874aeea5SJeff Kirsher 1100874aeea5SJeff Kirsher /* Set the PCI DMA mask. Try all possibilities from our 1101874aeea5SJeff Kirsher * genuine mask down to 32 bits, because some architectures 1102874aeea5SJeff Kirsher * (e.g. x86_64 with iommu_sac_force set) will allow 40 bit 1103874aeea5SJeff Kirsher * masks event though they reject 46 bit masks. 1104874aeea5SJeff Kirsher */ 1105874aeea5SJeff Kirsher while (dma_mask > 0x7fffffffUL) { 11060e33d870SBen Hutchings if (dma_supported(&pci_dev->dev, dma_mask)) { 11070e33d870SBen Hutchings rc = dma_set_mask(&pci_dev->dev, dma_mask); 1108e9e01846SBen Hutchings if (rc == 0) 1109874aeea5SJeff Kirsher break; 1110e9e01846SBen Hutchings } 1111874aeea5SJeff Kirsher dma_mask >>= 1; 1112874aeea5SJeff Kirsher } 1113874aeea5SJeff Kirsher if (rc) { 1114874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1115874aeea5SJeff Kirsher "could not find a suitable DMA mask\n"); 1116874aeea5SJeff Kirsher goto fail2; 1117874aeea5SJeff Kirsher } 1118874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, 1119874aeea5SJeff Kirsher "using DMA mask %llx\n", (unsigned long long) dma_mask); 11200e33d870SBen Hutchings rc = dma_set_coherent_mask(&pci_dev->dev, dma_mask); 1121874aeea5SJeff Kirsher if (rc) { 11220e33d870SBen Hutchings /* dma_set_coherent_mask() is not *allowed* to 11230e33d870SBen Hutchings * fail with a mask that dma_set_mask() accepted, 1124874aeea5SJeff Kirsher * but just in case... 1125874aeea5SJeff Kirsher */ 1126874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1127874aeea5SJeff Kirsher "failed to set consistent DMA mask\n"); 1128874aeea5SJeff Kirsher goto fail2; 1129874aeea5SJeff Kirsher } 1130874aeea5SJeff Kirsher 1131874aeea5SJeff Kirsher efx->membase_phys = pci_resource_start(efx->pci_dev, EFX_MEM_BAR); 1132874aeea5SJeff Kirsher rc = pci_request_region(pci_dev, EFX_MEM_BAR, "sfc"); 1133874aeea5SJeff Kirsher if (rc) { 1134874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1135874aeea5SJeff Kirsher "request for memory BAR failed\n"); 1136874aeea5SJeff Kirsher rc = -EIO; 1137874aeea5SJeff Kirsher goto fail3; 1138874aeea5SJeff Kirsher } 1139874aeea5SJeff Kirsher efx->membase = ioremap_nocache(efx->membase_phys, 1140874aeea5SJeff Kirsher efx->type->mem_map_size); 1141874aeea5SJeff Kirsher if (!efx->membase) { 1142874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1143874aeea5SJeff Kirsher "could not map memory BAR at %llx+%x\n", 1144874aeea5SJeff Kirsher (unsigned long long)efx->membase_phys, 1145874aeea5SJeff Kirsher efx->type->mem_map_size); 1146874aeea5SJeff Kirsher rc = -ENOMEM; 1147874aeea5SJeff Kirsher goto fail4; 1148874aeea5SJeff Kirsher } 1149874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, 1150874aeea5SJeff Kirsher "memory BAR at %llx+%x (virtual %p)\n", 1151874aeea5SJeff Kirsher (unsigned long long)efx->membase_phys, 1152874aeea5SJeff Kirsher efx->type->mem_map_size, efx->membase); 1153874aeea5SJeff Kirsher 1154874aeea5SJeff Kirsher return 0; 1155874aeea5SJeff Kirsher 1156874aeea5SJeff Kirsher fail4: 1157874aeea5SJeff Kirsher pci_release_region(efx->pci_dev, EFX_MEM_BAR); 1158874aeea5SJeff Kirsher fail3: 1159874aeea5SJeff Kirsher efx->membase_phys = 0; 1160874aeea5SJeff Kirsher fail2: 1161874aeea5SJeff Kirsher pci_disable_device(efx->pci_dev); 1162874aeea5SJeff Kirsher fail1: 1163874aeea5SJeff Kirsher return rc; 1164874aeea5SJeff Kirsher } 1165874aeea5SJeff Kirsher 1166874aeea5SJeff Kirsher static void efx_fini_io(struct efx_nic *efx) 1167874aeea5SJeff Kirsher { 1168874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "shutting down I/O\n"); 1169874aeea5SJeff Kirsher 1170874aeea5SJeff Kirsher if (efx->membase) { 1171874aeea5SJeff Kirsher iounmap(efx->membase); 1172874aeea5SJeff Kirsher efx->membase = NULL; 1173874aeea5SJeff Kirsher } 1174874aeea5SJeff Kirsher 1175874aeea5SJeff Kirsher if (efx->membase_phys) { 1176874aeea5SJeff Kirsher pci_release_region(efx->pci_dev, EFX_MEM_BAR); 1177874aeea5SJeff Kirsher efx->membase_phys = 0; 1178874aeea5SJeff Kirsher } 1179874aeea5SJeff Kirsher 1180874aeea5SJeff Kirsher pci_disable_device(efx->pci_dev); 1181874aeea5SJeff Kirsher } 1182874aeea5SJeff Kirsher 1183a9a52506SBen Hutchings static unsigned int efx_wanted_parallelism(struct efx_nic *efx) 1184874aeea5SJeff Kirsher { 1185cdb08f8fSBen Hutchings cpumask_var_t thread_mask; 1186a16e5b24SBen Hutchings unsigned int count; 1187874aeea5SJeff Kirsher int cpu; 1188874aeea5SJeff Kirsher 1189cd2d5b52SBen Hutchings if (rss_cpus) { 1190cd2d5b52SBen Hutchings count = rss_cpus; 1191cd2d5b52SBen Hutchings } else { 1192cdb08f8fSBen Hutchings if (unlikely(!zalloc_cpumask_var(&thread_mask, GFP_KERNEL))) { 1193a9a52506SBen Hutchings netif_warn(efx, probe, efx->net_dev, 1194a9a52506SBen Hutchings "RSS disabled due to allocation failure\n"); 1195874aeea5SJeff Kirsher return 1; 1196874aeea5SJeff Kirsher } 1197874aeea5SJeff Kirsher 1198874aeea5SJeff Kirsher count = 0; 1199874aeea5SJeff Kirsher for_each_online_cpu(cpu) { 1200cdb08f8fSBen Hutchings if (!cpumask_test_cpu(cpu, thread_mask)) { 1201874aeea5SJeff Kirsher ++count; 1202cdb08f8fSBen Hutchings cpumask_or(thread_mask, thread_mask, 1203cdb08f8fSBen Hutchings topology_thread_cpumask(cpu)); 1204874aeea5SJeff Kirsher } 1205874aeea5SJeff Kirsher } 1206874aeea5SJeff Kirsher 1207cdb08f8fSBen Hutchings free_cpumask_var(thread_mask); 1208cd2d5b52SBen Hutchings } 1209cd2d5b52SBen Hutchings 1210cd2d5b52SBen Hutchings /* If RSS is requested for the PF *and* VFs then we can't write RSS 1211cd2d5b52SBen Hutchings * table entries that are inaccessible to VFs 1212cd2d5b52SBen Hutchings */ 1213cd2d5b52SBen Hutchings if (efx_sriov_wanted(efx) && efx_vf_size(efx) > 1 && 1214cd2d5b52SBen Hutchings count > efx_vf_size(efx)) { 1215cd2d5b52SBen Hutchings netif_warn(efx, probe, efx->net_dev, 1216cd2d5b52SBen Hutchings "Reducing number of RSS channels from %u to %u for " 1217cd2d5b52SBen Hutchings "VF support. Increase vf-msix-limit to use more " 1218cd2d5b52SBen Hutchings "channels on the PF.\n", 1219cd2d5b52SBen Hutchings count, efx_vf_size(efx)); 1220cd2d5b52SBen Hutchings count = efx_vf_size(efx); 1221cd2d5b52SBen Hutchings } 1222cd2d5b52SBen Hutchings 1223874aeea5SJeff Kirsher return count; 1224874aeea5SJeff Kirsher } 1225874aeea5SJeff Kirsher 1226874aeea5SJeff Kirsher /* Probe the number and type of interrupts we are able to obtain, and 1227874aeea5SJeff Kirsher * the resulting numbers of channels and RX queues. 1228874aeea5SJeff Kirsher */ 1229874aeea5SJeff Kirsher static int efx_probe_interrupts(struct efx_nic *efx) 1230874aeea5SJeff Kirsher { 1231a16e5b24SBen Hutchings unsigned int max_channels = 1232a16e5b24SBen Hutchings min(efx->type->phys_addr_channels, EFX_MAX_CHANNELS); 12337f967c01SBen Hutchings unsigned int extra_channels = 0; 12347f967c01SBen Hutchings unsigned int i, j; 1235a16e5b24SBen Hutchings int rc; 1236874aeea5SJeff Kirsher 12377f967c01SBen Hutchings for (i = 0; i < EFX_MAX_EXTRA_CHANNELS; i++) 12387f967c01SBen Hutchings if (efx->extra_channel_type[i]) 12397f967c01SBen Hutchings ++extra_channels; 12407f967c01SBen Hutchings 1241874aeea5SJeff Kirsher if (efx->interrupt_mode == EFX_INT_MODE_MSIX) { 1242874aeea5SJeff Kirsher struct msix_entry xentries[EFX_MAX_CHANNELS]; 1243a16e5b24SBen Hutchings unsigned int n_channels; 1244874aeea5SJeff Kirsher 1245a9a52506SBen Hutchings n_channels = efx_wanted_parallelism(efx); 1246874aeea5SJeff Kirsher if (separate_tx_channels) 1247874aeea5SJeff Kirsher n_channels *= 2; 12487f967c01SBen Hutchings n_channels += extra_channels; 1249874aeea5SJeff Kirsher n_channels = min(n_channels, max_channels); 1250874aeea5SJeff Kirsher 1251874aeea5SJeff Kirsher for (i = 0; i < n_channels; i++) 1252874aeea5SJeff Kirsher xentries[i].entry = i; 1253874aeea5SJeff Kirsher rc = pci_enable_msix(efx->pci_dev, xentries, n_channels); 1254874aeea5SJeff Kirsher if (rc > 0) { 1255874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 1256874aeea5SJeff Kirsher "WARNING: Insufficient MSI-X vectors" 1257a16e5b24SBen Hutchings " available (%d < %u).\n", rc, n_channels); 1258874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 1259874aeea5SJeff Kirsher "WARNING: Performance may be reduced.\n"); 1260874aeea5SJeff Kirsher EFX_BUG_ON_PARANOID(rc >= n_channels); 1261874aeea5SJeff Kirsher n_channels = rc; 1262874aeea5SJeff Kirsher rc = pci_enable_msix(efx->pci_dev, xentries, 1263874aeea5SJeff Kirsher n_channels); 1264874aeea5SJeff Kirsher } 1265874aeea5SJeff Kirsher 1266874aeea5SJeff Kirsher if (rc == 0) { 1267874aeea5SJeff Kirsher efx->n_channels = n_channels; 12687f967c01SBen Hutchings if (n_channels > extra_channels) 12697f967c01SBen Hutchings n_channels -= extra_channels; 1270874aeea5SJeff Kirsher if (separate_tx_channels) { 12717f967c01SBen Hutchings efx->n_tx_channels = max(n_channels / 2, 1U); 12727f967c01SBen Hutchings efx->n_rx_channels = max(n_channels - 12737f967c01SBen Hutchings efx->n_tx_channels, 12747f967c01SBen Hutchings 1U); 1275874aeea5SJeff Kirsher } else { 12767f967c01SBen Hutchings efx->n_tx_channels = n_channels; 12777f967c01SBen Hutchings efx->n_rx_channels = n_channels; 1278874aeea5SJeff Kirsher } 12797f967c01SBen Hutchings for (i = 0; i < efx->n_channels; i++) 1280874aeea5SJeff Kirsher efx_get_channel(efx, i)->irq = 1281874aeea5SJeff Kirsher xentries[i].vector; 1282874aeea5SJeff Kirsher } else { 1283874aeea5SJeff Kirsher /* Fall back to single channel MSI */ 1284874aeea5SJeff Kirsher efx->interrupt_mode = EFX_INT_MODE_MSI; 1285874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 1286874aeea5SJeff Kirsher "could not enable MSI-X\n"); 1287874aeea5SJeff Kirsher } 1288874aeea5SJeff Kirsher } 1289874aeea5SJeff Kirsher 1290874aeea5SJeff Kirsher /* Try single interrupt MSI */ 1291874aeea5SJeff Kirsher if (efx->interrupt_mode == EFX_INT_MODE_MSI) { 1292874aeea5SJeff Kirsher efx->n_channels = 1; 1293874aeea5SJeff Kirsher efx->n_rx_channels = 1; 1294874aeea5SJeff Kirsher efx->n_tx_channels = 1; 1295874aeea5SJeff Kirsher rc = pci_enable_msi(efx->pci_dev); 1296874aeea5SJeff Kirsher if (rc == 0) { 1297874aeea5SJeff Kirsher efx_get_channel(efx, 0)->irq = efx->pci_dev->irq; 1298874aeea5SJeff Kirsher } else { 1299874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 1300874aeea5SJeff Kirsher "could not enable MSI\n"); 1301874aeea5SJeff Kirsher efx->interrupt_mode = EFX_INT_MODE_LEGACY; 1302874aeea5SJeff Kirsher } 1303874aeea5SJeff Kirsher } 1304874aeea5SJeff Kirsher 1305874aeea5SJeff Kirsher /* Assume legacy interrupts */ 1306874aeea5SJeff Kirsher if (efx->interrupt_mode == EFX_INT_MODE_LEGACY) { 1307874aeea5SJeff Kirsher efx->n_channels = 1 + (separate_tx_channels ? 1 : 0); 1308874aeea5SJeff Kirsher efx->n_rx_channels = 1; 1309874aeea5SJeff Kirsher efx->n_tx_channels = 1; 1310874aeea5SJeff Kirsher efx->legacy_irq = efx->pci_dev->irq; 1311874aeea5SJeff Kirsher } 1312874aeea5SJeff Kirsher 13137f967c01SBen Hutchings /* Assign extra channels if possible */ 13147f967c01SBen Hutchings j = efx->n_channels; 13157f967c01SBen Hutchings for (i = 0; i < EFX_MAX_EXTRA_CHANNELS; i++) { 13167f967c01SBen Hutchings if (!efx->extra_channel_type[i]) 13177f967c01SBen Hutchings continue; 13187f967c01SBen Hutchings if (efx->interrupt_mode != EFX_INT_MODE_MSIX || 13197f967c01SBen Hutchings efx->n_channels <= extra_channels) { 13207f967c01SBen Hutchings efx->extra_channel_type[i]->handle_no_channel(efx); 13217f967c01SBen Hutchings } else { 13227f967c01SBen Hutchings --j; 13237f967c01SBen Hutchings efx_get_channel(efx, j)->type = 13247f967c01SBen Hutchings efx->extra_channel_type[i]; 13257f967c01SBen Hutchings } 13267f967c01SBen Hutchings } 13277f967c01SBen Hutchings 1328cd2d5b52SBen Hutchings /* RSS might be usable on VFs even if it is disabled on the PF */ 13293132d282SBen Hutchings efx->rss_spread = ((efx->n_rx_channels > 1 || !efx_sriov_wanted(efx)) ? 1330cd2d5b52SBen Hutchings efx->n_rx_channels : efx_vf_size(efx)); 1331cd2d5b52SBen Hutchings 1332874aeea5SJeff Kirsher return 0; 1333874aeea5SJeff Kirsher } 1334874aeea5SJeff Kirsher 1335d8291187SBen Hutchings static void efx_soft_enable_interrupts(struct efx_nic *efx) 1336d8291187SBen Hutchings { 1337d8291187SBen Hutchings struct efx_channel *channel; 1338d8291187SBen Hutchings 1339d8291187SBen Hutchings BUG_ON(efx->state == STATE_DISABLED); 1340d8291187SBen Hutchings 1341d8291187SBen Hutchings efx->irq_soft_enabled = true; 1342d8291187SBen Hutchings smp_wmb(); 1343d8291187SBen Hutchings 1344d8291187SBen Hutchings efx_for_each_channel(channel, efx) { 1345d8291187SBen Hutchings if (!channel->type->keep_eventq) 1346d8291187SBen Hutchings efx_init_eventq(channel); 1347d8291187SBen Hutchings efx_start_eventq(channel); 1348d8291187SBen Hutchings } 1349d8291187SBen Hutchings 1350d8291187SBen Hutchings efx_mcdi_mode_event(efx); 1351d8291187SBen Hutchings } 1352d8291187SBen Hutchings 1353d8291187SBen Hutchings static void efx_soft_disable_interrupts(struct efx_nic *efx) 1354d8291187SBen Hutchings { 1355d8291187SBen Hutchings struct efx_channel *channel; 1356d8291187SBen Hutchings 1357d8291187SBen Hutchings if (efx->state == STATE_DISABLED) 1358d8291187SBen Hutchings return; 1359d8291187SBen Hutchings 1360d8291187SBen Hutchings efx_mcdi_mode_poll(efx); 1361d8291187SBen Hutchings 1362d8291187SBen Hutchings efx->irq_soft_enabled = false; 1363d8291187SBen Hutchings smp_wmb(); 1364d8291187SBen Hutchings 1365d8291187SBen Hutchings if (efx->legacy_irq) 1366d8291187SBen Hutchings synchronize_irq(efx->legacy_irq); 1367d8291187SBen Hutchings 1368d8291187SBen Hutchings efx_for_each_channel(channel, efx) { 1369d8291187SBen Hutchings if (channel->irq) 1370d8291187SBen Hutchings synchronize_irq(channel->irq); 1371d8291187SBen Hutchings 1372d8291187SBen Hutchings efx_stop_eventq(channel); 1373d8291187SBen Hutchings if (!channel->type->keep_eventq) 1374d8291187SBen Hutchings efx_fini_eventq(channel); 1375d8291187SBen Hutchings } 1376d8291187SBen Hutchings } 1377d8291187SBen Hutchings 1378d8291187SBen Hutchings static void efx_enable_interrupts(struct efx_nic *efx) 13799f2cb71cSBen Hutchings { 13809f2cb71cSBen Hutchings struct efx_channel *channel; 13819f2cb71cSBen Hutchings 13828b7325b4SBen Hutchings BUG_ON(efx->state == STATE_DISABLED); 13838b7325b4SBen Hutchings 1384b28405b0SAlexandre Rames if (efx->eeh_disabled_legacy_irq) { 1385b28405b0SAlexandre Rames enable_irq(efx->legacy_irq); 1386b28405b0SAlexandre Rames efx->eeh_disabled_legacy_irq = false; 1387b28405b0SAlexandre Rames } 1388d8291187SBen Hutchings 138986094f7fSBen Hutchings efx->type->irq_enable_master(efx); 13909f2cb71cSBen Hutchings 13919f2cb71cSBen Hutchings efx_for_each_channel(channel, efx) { 1392d8291187SBen Hutchings if (channel->type->keep_eventq) 13939f2cb71cSBen Hutchings efx_init_eventq(channel); 13949f2cb71cSBen Hutchings } 13959f2cb71cSBen Hutchings 1396d8291187SBen Hutchings efx_soft_enable_interrupts(efx); 13979f2cb71cSBen Hutchings } 13989f2cb71cSBen Hutchings 1399d8291187SBen Hutchings static void efx_disable_interrupts(struct efx_nic *efx) 14009f2cb71cSBen Hutchings { 14019f2cb71cSBen Hutchings struct efx_channel *channel; 14029f2cb71cSBen Hutchings 1403d8291187SBen Hutchings efx_soft_disable_interrupts(efx); 14049f2cb71cSBen Hutchings 14059f2cb71cSBen Hutchings efx_for_each_channel(channel, efx) { 1406d8291187SBen Hutchings if (channel->type->keep_eventq) 14079f2cb71cSBen Hutchings efx_fini_eventq(channel); 14089f2cb71cSBen Hutchings } 1409d8291187SBen Hutchings 141086094f7fSBen Hutchings efx->type->irq_disable_non_ev(efx); 14119f2cb71cSBen Hutchings } 14129f2cb71cSBen Hutchings 1413874aeea5SJeff Kirsher static void efx_remove_interrupts(struct efx_nic *efx) 1414874aeea5SJeff Kirsher { 1415874aeea5SJeff Kirsher struct efx_channel *channel; 1416874aeea5SJeff Kirsher 1417874aeea5SJeff Kirsher /* Remove MSI/MSI-X interrupts */ 1418874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 1419874aeea5SJeff Kirsher channel->irq = 0; 1420874aeea5SJeff Kirsher pci_disable_msi(efx->pci_dev); 1421874aeea5SJeff Kirsher pci_disable_msix(efx->pci_dev); 1422874aeea5SJeff Kirsher 1423874aeea5SJeff Kirsher /* Remove legacy interrupt */ 1424874aeea5SJeff Kirsher efx->legacy_irq = 0; 1425874aeea5SJeff Kirsher } 1426874aeea5SJeff Kirsher 1427874aeea5SJeff Kirsher static void efx_set_channels(struct efx_nic *efx) 1428874aeea5SJeff Kirsher { 1429874aeea5SJeff Kirsher struct efx_channel *channel; 1430874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 1431874aeea5SJeff Kirsher 1432874aeea5SJeff Kirsher efx->tx_channel_offset = 1433874aeea5SJeff Kirsher separate_tx_channels ? efx->n_channels - efx->n_tx_channels : 0; 1434874aeea5SJeff Kirsher 143579d68b37SStuart Hodgson /* We need to mark which channels really have RX and TX 143679d68b37SStuart Hodgson * queues, and adjust the TX queue numbers if we have separate 1437874aeea5SJeff Kirsher * RX-only and TX-only channels. 1438874aeea5SJeff Kirsher */ 1439874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 144079d68b37SStuart Hodgson if (channel->channel < efx->n_rx_channels) 144179d68b37SStuart Hodgson channel->rx_queue.core_index = channel->channel; 144279d68b37SStuart Hodgson else 144379d68b37SStuart Hodgson channel->rx_queue.core_index = -1; 144479d68b37SStuart Hodgson 1445874aeea5SJeff Kirsher efx_for_each_channel_tx_queue(tx_queue, channel) 1446874aeea5SJeff Kirsher tx_queue->queue -= (efx->tx_channel_offset * 1447874aeea5SJeff Kirsher EFX_TXQ_TYPES); 1448874aeea5SJeff Kirsher } 1449874aeea5SJeff Kirsher } 1450874aeea5SJeff Kirsher 1451874aeea5SJeff Kirsher static int efx_probe_nic(struct efx_nic *efx) 1452874aeea5SJeff Kirsher { 1453874aeea5SJeff Kirsher size_t i; 1454874aeea5SJeff Kirsher int rc; 1455874aeea5SJeff Kirsher 1456874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "creating NIC\n"); 1457874aeea5SJeff Kirsher 1458874aeea5SJeff Kirsher /* Carry out hardware-type specific initialisation */ 1459874aeea5SJeff Kirsher rc = efx->type->probe(efx); 1460874aeea5SJeff Kirsher if (rc) 1461874aeea5SJeff Kirsher return rc; 1462874aeea5SJeff Kirsher 1463874aeea5SJeff Kirsher /* Determine the number of channels and queues by trying to hook 1464874aeea5SJeff Kirsher * in MSI-X interrupts. */ 1465874aeea5SJeff Kirsher rc = efx_probe_interrupts(efx); 1466874aeea5SJeff Kirsher if (rc) 1467874aeea5SJeff Kirsher goto fail; 1468874aeea5SJeff Kirsher 146928e47c49SBen Hutchings efx->type->dimension_resources(efx); 147028e47c49SBen Hutchings 1471874aeea5SJeff Kirsher if (efx->n_channels > 1) 1472874aeea5SJeff Kirsher get_random_bytes(&efx->rx_hash_key, sizeof(efx->rx_hash_key)); 1473874aeea5SJeff Kirsher for (i = 0; i < ARRAY_SIZE(efx->rx_indir_table); i++) 1474278bc429SBen Hutchings efx->rx_indir_table[i] = 1475cd2d5b52SBen Hutchings ethtool_rxfh_indir_default(i, efx->rss_spread); 1476874aeea5SJeff Kirsher 1477874aeea5SJeff Kirsher efx_set_channels(efx); 1478874aeea5SJeff Kirsher netif_set_real_num_tx_queues(efx->net_dev, efx->n_tx_channels); 1479874aeea5SJeff Kirsher netif_set_real_num_rx_queues(efx->net_dev, efx->n_rx_channels); 1480874aeea5SJeff Kirsher 1481874aeea5SJeff Kirsher /* Initialise the interrupt moderation settings */ 14829e393b30SBen Hutchings efx_init_irq_moderation(efx, tx_irq_mod_usec, rx_irq_mod_usec, true, 14839e393b30SBen Hutchings true); 1484874aeea5SJeff Kirsher 1485874aeea5SJeff Kirsher return 0; 1486874aeea5SJeff Kirsher 1487874aeea5SJeff Kirsher fail: 1488874aeea5SJeff Kirsher efx->type->remove(efx); 1489874aeea5SJeff Kirsher return rc; 1490874aeea5SJeff Kirsher } 1491874aeea5SJeff Kirsher 1492874aeea5SJeff Kirsher static void efx_remove_nic(struct efx_nic *efx) 1493874aeea5SJeff Kirsher { 1494874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "destroying NIC\n"); 1495874aeea5SJeff Kirsher 1496874aeea5SJeff Kirsher efx_remove_interrupts(efx); 1497874aeea5SJeff Kirsher efx->type->remove(efx); 1498874aeea5SJeff Kirsher } 1499874aeea5SJeff Kirsher 1500874aeea5SJeff Kirsher /************************************************************************** 1501874aeea5SJeff Kirsher * 1502874aeea5SJeff Kirsher * NIC startup/shutdown 1503874aeea5SJeff Kirsher * 1504874aeea5SJeff Kirsher *************************************************************************/ 1505874aeea5SJeff Kirsher 1506874aeea5SJeff Kirsher static int efx_probe_all(struct efx_nic *efx) 1507874aeea5SJeff Kirsher { 1508874aeea5SJeff Kirsher int rc; 1509874aeea5SJeff Kirsher 1510874aeea5SJeff Kirsher rc = efx_probe_nic(efx); 1511874aeea5SJeff Kirsher if (rc) { 1512874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, "failed to create NIC\n"); 1513874aeea5SJeff Kirsher goto fail1; 1514874aeea5SJeff Kirsher } 1515874aeea5SJeff Kirsher 1516874aeea5SJeff Kirsher rc = efx_probe_port(efx); 1517874aeea5SJeff Kirsher if (rc) { 1518874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, "failed to create port\n"); 1519874aeea5SJeff Kirsher goto fail2; 1520874aeea5SJeff Kirsher } 1521874aeea5SJeff Kirsher 15227e6d06f0SBen Hutchings BUILD_BUG_ON(EFX_DEFAULT_DMAQ_SIZE < EFX_RXQ_MIN_ENT); 15237e6d06f0SBen Hutchings if (WARN_ON(EFX_DEFAULT_DMAQ_SIZE < EFX_TXQ_MIN_ENT(efx))) { 15247e6d06f0SBen Hutchings rc = -EINVAL; 15257e6d06f0SBen Hutchings goto fail3; 15267e6d06f0SBen Hutchings } 1527874aeea5SJeff Kirsher efx->rxq_entries = efx->txq_entries = EFX_DEFAULT_DMAQ_SIZE; 1528874aeea5SJeff Kirsher 1529874aeea5SJeff Kirsher rc = efx_probe_filters(efx); 1530874aeea5SJeff Kirsher if (rc) { 1531874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 1532874aeea5SJeff Kirsher "failed to create filter tables\n"); 15337f967c01SBen Hutchings goto fail3; 1534874aeea5SJeff Kirsher } 1535874aeea5SJeff Kirsher 15367f967c01SBen Hutchings rc = efx_probe_channels(efx); 15377f967c01SBen Hutchings if (rc) 15387f967c01SBen Hutchings goto fail4; 15397f967c01SBen Hutchings 1540874aeea5SJeff Kirsher return 0; 1541874aeea5SJeff Kirsher 1542874aeea5SJeff Kirsher fail4: 15437f967c01SBen Hutchings efx_remove_filters(efx); 1544874aeea5SJeff Kirsher fail3: 1545874aeea5SJeff Kirsher efx_remove_port(efx); 1546874aeea5SJeff Kirsher fail2: 1547874aeea5SJeff Kirsher efx_remove_nic(efx); 1548874aeea5SJeff Kirsher fail1: 1549874aeea5SJeff Kirsher return rc; 1550874aeea5SJeff Kirsher } 1551874aeea5SJeff Kirsher 15528b7325b4SBen Hutchings /* If the interface is supposed to be running but is not, start 15538b7325b4SBen Hutchings * the hardware and software data path, regular activity for the port 15548b7325b4SBen Hutchings * (MAC statistics, link polling, etc.) and schedule the port to be 15558b7325b4SBen Hutchings * reconfigured. Interrupts must already be enabled. This function 15568b7325b4SBen Hutchings * is safe to call multiple times, so long as the NIC is not disabled. 15578b7325b4SBen Hutchings * Requires the RTNL lock. 15589f2cb71cSBen Hutchings */ 1559874aeea5SJeff Kirsher static void efx_start_all(struct efx_nic *efx) 1560874aeea5SJeff Kirsher { 1561874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 15628b7325b4SBen Hutchings BUG_ON(efx->state == STATE_DISABLED); 1563874aeea5SJeff Kirsher 1564874aeea5SJeff Kirsher /* Check that it is appropriate to restart the interface. All 1565874aeea5SJeff Kirsher * of these flags are safe to read under just the rtnl lock */ 15668b7325b4SBen Hutchings if (efx->port_enabled || !netif_running(efx->net_dev)) 1567874aeea5SJeff Kirsher return; 1568874aeea5SJeff Kirsher 1569874aeea5SJeff Kirsher efx_start_port(efx); 15709f2cb71cSBen Hutchings efx_start_datapath(efx); 1571874aeea5SJeff Kirsher 1572626950dbSAlexandre Rames /* Start the hardware monitor if there is one */ 1573626950dbSAlexandre Rames if (efx->type->monitor != NULL) 1574874aeea5SJeff Kirsher queue_delayed_work(efx->workqueue, &efx->monitor_work, 1575874aeea5SJeff Kirsher efx_monitor_interval); 1576626950dbSAlexandre Rames 1577626950dbSAlexandre Rames /* If link state detection is normally event-driven, we have 1578626950dbSAlexandre Rames * to poll now because we could have missed a change 1579626950dbSAlexandre Rames */ 1580626950dbSAlexandre Rames if (efx_nic_rev(efx) >= EFX_REV_SIENA_A0) { 1581874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1582874aeea5SJeff Kirsher if (efx->phy_op->poll(efx)) 1583874aeea5SJeff Kirsher efx_link_status_changed(efx); 1584874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1585874aeea5SJeff Kirsher } 1586874aeea5SJeff Kirsher 1587874aeea5SJeff Kirsher efx->type->start_stats(efx); 1588874aeea5SJeff Kirsher } 1589874aeea5SJeff Kirsher 1590874aeea5SJeff Kirsher /* Flush all delayed work. Should only be called when no more delayed work 1591874aeea5SJeff Kirsher * will be scheduled. This doesn't flush pending online resets (efx_reset), 1592874aeea5SJeff Kirsher * since we're holding the rtnl_lock at this point. */ 1593874aeea5SJeff Kirsher static void efx_flush_all(struct efx_nic *efx) 1594874aeea5SJeff Kirsher { 1595dd40781eSBen Hutchings /* Make sure the hardware monitor and event self-test are stopped */ 1596874aeea5SJeff Kirsher cancel_delayed_work_sync(&efx->monitor_work); 1597dd40781eSBen Hutchings efx_selftest_async_cancel(efx); 1598874aeea5SJeff Kirsher /* Stop scheduled port reconfigurations */ 1599874aeea5SJeff Kirsher cancel_work_sync(&efx->mac_work); 1600874aeea5SJeff Kirsher } 1601874aeea5SJeff Kirsher 16028b7325b4SBen Hutchings /* Quiesce the hardware and software data path, and regular activity 16038b7325b4SBen Hutchings * for the port without bringing the link down. Safe to call multiple 16048b7325b4SBen Hutchings * times with the NIC in almost any state, but interrupts should be 16058b7325b4SBen Hutchings * enabled. Requires the RTNL lock. 16068b7325b4SBen Hutchings */ 1607874aeea5SJeff Kirsher static void efx_stop_all(struct efx_nic *efx) 1608874aeea5SJeff Kirsher { 1609874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 1610874aeea5SJeff Kirsher 1611874aeea5SJeff Kirsher /* port_enabled can be read safely under the rtnl lock */ 1612874aeea5SJeff Kirsher if (!efx->port_enabled) 1613874aeea5SJeff Kirsher return; 1614874aeea5SJeff Kirsher 1615874aeea5SJeff Kirsher efx->type->stop_stats(efx); 1616874aeea5SJeff Kirsher efx_stop_port(efx); 1617874aeea5SJeff Kirsher 1618874aeea5SJeff Kirsher /* Flush efx_mac_work(), refill_workqueue, monitor_work */ 1619874aeea5SJeff Kirsher efx_flush_all(efx); 1620874aeea5SJeff Kirsher 162129c69a48SBen Hutchings /* Stop the kernel transmit interface. This is only valid if 162229c69a48SBen Hutchings * the device is stopped or detached; otherwise the watchdog 162329c69a48SBen Hutchings * may fire immediately. 162429c69a48SBen Hutchings */ 162529c69a48SBen Hutchings WARN_ON(netif_running(efx->net_dev) && 162629c69a48SBen Hutchings netif_device_present(efx->net_dev)); 16279f2cb71cSBen Hutchings netif_tx_disable(efx->net_dev); 16289f2cb71cSBen Hutchings 16299f2cb71cSBen Hutchings efx_stop_datapath(efx); 1630874aeea5SJeff Kirsher } 1631874aeea5SJeff Kirsher 1632874aeea5SJeff Kirsher static void efx_remove_all(struct efx_nic *efx) 1633874aeea5SJeff Kirsher { 1634874aeea5SJeff Kirsher efx_remove_channels(efx); 16357f967c01SBen Hutchings efx_remove_filters(efx); 1636874aeea5SJeff Kirsher efx_remove_port(efx); 1637874aeea5SJeff Kirsher efx_remove_nic(efx); 1638874aeea5SJeff Kirsher } 1639874aeea5SJeff Kirsher 1640874aeea5SJeff Kirsher /************************************************************************** 1641874aeea5SJeff Kirsher * 1642874aeea5SJeff Kirsher * Interrupt moderation 1643874aeea5SJeff Kirsher * 1644874aeea5SJeff Kirsher **************************************************************************/ 1645874aeea5SJeff Kirsher 1646cc180b69SBen Hutchings static unsigned int irq_mod_ticks(unsigned int usecs, unsigned int quantum_ns) 1647874aeea5SJeff Kirsher { 1648b548f976SBen Hutchings if (usecs == 0) 1649b548f976SBen Hutchings return 0; 1650cc180b69SBen Hutchings if (usecs * 1000 < quantum_ns) 1651874aeea5SJeff Kirsher return 1; /* never round down to 0 */ 1652cc180b69SBen Hutchings return usecs * 1000 / quantum_ns; 1653874aeea5SJeff Kirsher } 1654874aeea5SJeff Kirsher 1655874aeea5SJeff Kirsher /* Set interrupt moderation parameters */ 16569e393b30SBen Hutchings int efx_init_irq_moderation(struct efx_nic *efx, unsigned int tx_usecs, 16579e393b30SBen Hutchings unsigned int rx_usecs, bool rx_adaptive, 16589e393b30SBen Hutchings bool rx_may_override_tx) 1659874aeea5SJeff Kirsher { 1660874aeea5SJeff Kirsher struct efx_channel *channel; 1661cc180b69SBen Hutchings unsigned int irq_mod_max = DIV_ROUND_UP(efx->type->timer_period_max * 1662cc180b69SBen Hutchings efx->timer_quantum_ns, 1663cc180b69SBen Hutchings 1000); 1664cc180b69SBen Hutchings unsigned int tx_ticks; 1665cc180b69SBen Hutchings unsigned int rx_ticks; 1666874aeea5SJeff Kirsher 1667874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 1668874aeea5SJeff Kirsher 1669cc180b69SBen Hutchings if (tx_usecs > irq_mod_max || rx_usecs > irq_mod_max) 16709e393b30SBen Hutchings return -EINVAL; 16719e393b30SBen Hutchings 1672cc180b69SBen Hutchings tx_ticks = irq_mod_ticks(tx_usecs, efx->timer_quantum_ns); 1673cc180b69SBen Hutchings rx_ticks = irq_mod_ticks(rx_usecs, efx->timer_quantum_ns); 1674cc180b69SBen Hutchings 16759e393b30SBen Hutchings if (tx_ticks != rx_ticks && efx->tx_channel_offset == 0 && 16769e393b30SBen Hutchings !rx_may_override_tx) { 16779e393b30SBen Hutchings netif_err(efx, drv, efx->net_dev, "Channels are shared. " 16789e393b30SBen Hutchings "RX and TX IRQ moderation must be equal\n"); 16799e393b30SBen Hutchings return -EINVAL; 16809e393b30SBen Hutchings } 16819e393b30SBen Hutchings 1682874aeea5SJeff Kirsher efx->irq_rx_adaptive = rx_adaptive; 1683874aeea5SJeff Kirsher efx->irq_rx_moderation = rx_ticks; 1684874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 1685874aeea5SJeff Kirsher if (efx_channel_has_rx_queue(channel)) 1686874aeea5SJeff Kirsher channel->irq_moderation = rx_ticks; 1687874aeea5SJeff Kirsher else if (efx_channel_has_tx_queues(channel)) 1688874aeea5SJeff Kirsher channel->irq_moderation = tx_ticks; 1689874aeea5SJeff Kirsher } 16909e393b30SBen Hutchings 16919e393b30SBen Hutchings return 0; 1692874aeea5SJeff Kirsher } 1693874aeea5SJeff Kirsher 1694a0c4faf5SBen Hutchings void efx_get_irq_moderation(struct efx_nic *efx, unsigned int *tx_usecs, 1695a0c4faf5SBen Hutchings unsigned int *rx_usecs, bool *rx_adaptive) 1696a0c4faf5SBen Hutchings { 1697cc180b69SBen Hutchings /* We must round up when converting ticks to microseconds 1698cc180b69SBen Hutchings * because we round down when converting the other way. 1699cc180b69SBen Hutchings */ 1700cc180b69SBen Hutchings 1701a0c4faf5SBen Hutchings *rx_adaptive = efx->irq_rx_adaptive; 1702cc180b69SBen Hutchings *rx_usecs = DIV_ROUND_UP(efx->irq_rx_moderation * 1703cc180b69SBen Hutchings efx->timer_quantum_ns, 1704cc180b69SBen Hutchings 1000); 1705a0c4faf5SBen Hutchings 1706a0c4faf5SBen Hutchings /* If channels are shared between RX and TX, so is IRQ 1707a0c4faf5SBen Hutchings * moderation. Otherwise, IRQ moderation is the same for all 1708a0c4faf5SBen Hutchings * TX channels and is not adaptive. 1709a0c4faf5SBen Hutchings */ 1710a0c4faf5SBen Hutchings if (efx->tx_channel_offset == 0) 1711a0c4faf5SBen Hutchings *tx_usecs = *rx_usecs; 1712a0c4faf5SBen Hutchings else 1713cc180b69SBen Hutchings *tx_usecs = DIV_ROUND_UP( 1714a0c4faf5SBen Hutchings efx->channel[efx->tx_channel_offset]->irq_moderation * 1715cc180b69SBen Hutchings efx->timer_quantum_ns, 1716cc180b69SBen Hutchings 1000); 1717a0c4faf5SBen Hutchings } 1718a0c4faf5SBen Hutchings 1719874aeea5SJeff Kirsher /************************************************************************** 1720874aeea5SJeff Kirsher * 1721874aeea5SJeff Kirsher * Hardware monitor 1722874aeea5SJeff Kirsher * 1723874aeea5SJeff Kirsher **************************************************************************/ 1724874aeea5SJeff Kirsher 1725874aeea5SJeff Kirsher /* Run periodically off the general workqueue */ 1726874aeea5SJeff Kirsher static void efx_monitor(struct work_struct *data) 1727874aeea5SJeff Kirsher { 1728874aeea5SJeff Kirsher struct efx_nic *efx = container_of(data, struct efx_nic, 1729874aeea5SJeff Kirsher monitor_work.work); 1730874aeea5SJeff Kirsher 1731874aeea5SJeff Kirsher netif_vdbg(efx, timer, efx->net_dev, 1732874aeea5SJeff Kirsher "hardware monitor executing on CPU %d\n", 1733874aeea5SJeff Kirsher raw_smp_processor_id()); 1734874aeea5SJeff Kirsher BUG_ON(efx->type->monitor == NULL); 1735874aeea5SJeff Kirsher 1736874aeea5SJeff Kirsher /* If the mac_lock is already held then it is likely a port 1737874aeea5SJeff Kirsher * reconfiguration is already in place, which will likely do 1738874aeea5SJeff Kirsher * most of the work of monitor() anyway. */ 1739874aeea5SJeff Kirsher if (mutex_trylock(&efx->mac_lock)) { 1740874aeea5SJeff Kirsher if (efx->port_enabled) 1741874aeea5SJeff Kirsher efx->type->monitor(efx); 1742874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1743874aeea5SJeff Kirsher } 1744874aeea5SJeff Kirsher 1745874aeea5SJeff Kirsher queue_delayed_work(efx->workqueue, &efx->monitor_work, 1746874aeea5SJeff Kirsher efx_monitor_interval); 1747874aeea5SJeff Kirsher } 1748874aeea5SJeff Kirsher 1749874aeea5SJeff Kirsher /************************************************************************** 1750874aeea5SJeff Kirsher * 1751874aeea5SJeff Kirsher * ioctls 1752874aeea5SJeff Kirsher * 1753874aeea5SJeff Kirsher *************************************************************************/ 1754874aeea5SJeff Kirsher 1755874aeea5SJeff Kirsher /* Net device ioctl 1756874aeea5SJeff Kirsher * Context: process, rtnl_lock() held. 1757874aeea5SJeff Kirsher */ 1758874aeea5SJeff Kirsher static int efx_ioctl(struct net_device *net_dev, struct ifreq *ifr, int cmd) 1759874aeea5SJeff Kirsher { 1760874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 1761874aeea5SJeff Kirsher struct mii_ioctl_data *data = if_mii(ifr); 1762874aeea5SJeff Kirsher 17637c236c43SStuart Hodgson if (cmd == SIOCSHWTSTAMP) 17647c236c43SStuart Hodgson return efx_ptp_ioctl(efx, ifr, cmd); 17657c236c43SStuart Hodgson 1766874aeea5SJeff Kirsher /* Convert phy_id from older PRTAD/DEVAD format */ 1767874aeea5SJeff Kirsher if ((cmd == SIOCGMIIREG || cmd == SIOCSMIIREG) && 1768874aeea5SJeff Kirsher (data->phy_id & 0xfc00) == 0x0400) 1769874aeea5SJeff Kirsher data->phy_id ^= MDIO_PHY_ID_C45 | 0x0400; 1770874aeea5SJeff Kirsher 1771874aeea5SJeff Kirsher return mdio_mii_ioctl(&efx->mdio, data, cmd); 1772874aeea5SJeff Kirsher } 1773874aeea5SJeff Kirsher 1774874aeea5SJeff Kirsher /************************************************************************** 1775874aeea5SJeff Kirsher * 1776874aeea5SJeff Kirsher * NAPI interface 1777874aeea5SJeff Kirsher * 1778874aeea5SJeff Kirsher **************************************************************************/ 1779874aeea5SJeff Kirsher 17807f967c01SBen Hutchings static void efx_init_napi_channel(struct efx_channel *channel) 1781874aeea5SJeff Kirsher { 17827f967c01SBen Hutchings struct efx_nic *efx = channel->efx; 1783874aeea5SJeff Kirsher 1784874aeea5SJeff Kirsher channel->napi_dev = efx->net_dev; 1785874aeea5SJeff Kirsher netif_napi_add(channel->napi_dev, &channel->napi_str, 1786874aeea5SJeff Kirsher efx_poll, napi_weight); 1787874aeea5SJeff Kirsher } 17887f967c01SBen Hutchings 17897f967c01SBen Hutchings static void efx_init_napi(struct efx_nic *efx) 17907f967c01SBen Hutchings { 17917f967c01SBen Hutchings struct efx_channel *channel; 17927f967c01SBen Hutchings 17937f967c01SBen Hutchings efx_for_each_channel(channel, efx) 17947f967c01SBen Hutchings efx_init_napi_channel(channel); 1795874aeea5SJeff Kirsher } 1796874aeea5SJeff Kirsher 1797874aeea5SJeff Kirsher static void efx_fini_napi_channel(struct efx_channel *channel) 1798874aeea5SJeff Kirsher { 1799874aeea5SJeff Kirsher if (channel->napi_dev) 1800874aeea5SJeff Kirsher netif_napi_del(&channel->napi_str); 1801874aeea5SJeff Kirsher channel->napi_dev = NULL; 1802874aeea5SJeff Kirsher } 1803874aeea5SJeff Kirsher 1804874aeea5SJeff Kirsher static void efx_fini_napi(struct efx_nic *efx) 1805874aeea5SJeff Kirsher { 1806874aeea5SJeff Kirsher struct efx_channel *channel; 1807874aeea5SJeff Kirsher 1808874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 1809874aeea5SJeff Kirsher efx_fini_napi_channel(channel); 1810874aeea5SJeff Kirsher } 1811874aeea5SJeff Kirsher 1812874aeea5SJeff Kirsher /************************************************************************** 1813874aeea5SJeff Kirsher * 1814874aeea5SJeff Kirsher * Kernel netpoll interface 1815874aeea5SJeff Kirsher * 1816874aeea5SJeff Kirsher *************************************************************************/ 1817874aeea5SJeff Kirsher 1818874aeea5SJeff Kirsher #ifdef CONFIG_NET_POLL_CONTROLLER 1819874aeea5SJeff Kirsher 1820874aeea5SJeff Kirsher /* Although in the common case interrupts will be disabled, this is not 1821874aeea5SJeff Kirsher * guaranteed. However, all our work happens inside the NAPI callback, 1822874aeea5SJeff Kirsher * so no locking is required. 1823874aeea5SJeff Kirsher */ 1824874aeea5SJeff Kirsher static void efx_netpoll(struct net_device *net_dev) 1825874aeea5SJeff Kirsher { 1826874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 1827874aeea5SJeff Kirsher struct efx_channel *channel; 1828874aeea5SJeff Kirsher 1829874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) 1830874aeea5SJeff Kirsher efx_schedule_channel(channel); 1831874aeea5SJeff Kirsher } 1832874aeea5SJeff Kirsher 1833874aeea5SJeff Kirsher #endif 1834874aeea5SJeff Kirsher 1835874aeea5SJeff Kirsher /************************************************************************** 1836874aeea5SJeff Kirsher * 1837874aeea5SJeff Kirsher * Kernel net device interface 1838874aeea5SJeff Kirsher * 1839874aeea5SJeff Kirsher *************************************************************************/ 1840874aeea5SJeff Kirsher 1841874aeea5SJeff Kirsher /* Context: process, rtnl_lock() held. */ 1842874aeea5SJeff Kirsher static int efx_net_open(struct net_device *net_dev) 1843874aeea5SJeff Kirsher { 1844874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 18458b7325b4SBen Hutchings int rc; 18468b7325b4SBen Hutchings 1847874aeea5SJeff Kirsher netif_dbg(efx, ifup, efx->net_dev, "opening device on CPU %d\n", 1848874aeea5SJeff Kirsher raw_smp_processor_id()); 1849874aeea5SJeff Kirsher 18508b7325b4SBen Hutchings rc = efx_check_disabled(efx); 18518b7325b4SBen Hutchings if (rc) 18528b7325b4SBen Hutchings return rc; 1853874aeea5SJeff Kirsher if (efx->phy_mode & PHY_MODE_SPECIAL) 1854874aeea5SJeff Kirsher return -EBUSY; 1855874aeea5SJeff Kirsher if (efx_mcdi_poll_reboot(efx) && efx_reset(efx, RESET_TYPE_ALL)) 1856874aeea5SJeff Kirsher return -EIO; 1857874aeea5SJeff Kirsher 1858874aeea5SJeff Kirsher /* Notify the kernel of the link state polled during driver load, 1859874aeea5SJeff Kirsher * before the monitor starts running */ 1860874aeea5SJeff Kirsher efx_link_status_changed(efx); 1861874aeea5SJeff Kirsher 1862874aeea5SJeff Kirsher efx_start_all(efx); 1863dd40781eSBen Hutchings efx_selftest_async_start(efx); 1864874aeea5SJeff Kirsher return 0; 1865874aeea5SJeff Kirsher } 1866874aeea5SJeff Kirsher 1867874aeea5SJeff Kirsher /* Context: process, rtnl_lock() held. 1868874aeea5SJeff Kirsher * Note that the kernel will ignore our return code; this method 1869874aeea5SJeff Kirsher * should really be a void. 1870874aeea5SJeff Kirsher */ 1871874aeea5SJeff Kirsher static int efx_net_stop(struct net_device *net_dev) 1872874aeea5SJeff Kirsher { 1873874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 1874874aeea5SJeff Kirsher 1875874aeea5SJeff Kirsher netif_dbg(efx, ifdown, efx->net_dev, "closing on CPU %d\n", 1876874aeea5SJeff Kirsher raw_smp_processor_id()); 1877874aeea5SJeff Kirsher 1878874aeea5SJeff Kirsher /* Stop the device and flush all the channels */ 1879874aeea5SJeff Kirsher efx_stop_all(efx); 1880874aeea5SJeff Kirsher 1881874aeea5SJeff Kirsher return 0; 1882874aeea5SJeff Kirsher } 1883874aeea5SJeff Kirsher 1884874aeea5SJeff Kirsher /* Context: process, dev_base_lock or RTNL held, non-blocking. */ 18852aa9ef11SBen Hutchings static struct rtnl_link_stats64 *efx_net_stats(struct net_device *net_dev, 18862aa9ef11SBen Hutchings struct rtnl_link_stats64 *stats) 1887874aeea5SJeff Kirsher { 1888874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 1889874aeea5SJeff Kirsher struct efx_mac_stats *mac_stats = &efx->mac_stats; 1890874aeea5SJeff Kirsher 1891874aeea5SJeff Kirsher spin_lock_bh(&efx->stats_lock); 18921cb34522SBen Hutchings 1893874aeea5SJeff Kirsher efx->type->update_stats(efx); 1894874aeea5SJeff Kirsher 1895874aeea5SJeff Kirsher stats->rx_packets = mac_stats->rx_packets; 1896874aeea5SJeff Kirsher stats->tx_packets = mac_stats->tx_packets; 1897874aeea5SJeff Kirsher stats->rx_bytes = mac_stats->rx_bytes; 1898874aeea5SJeff Kirsher stats->tx_bytes = mac_stats->tx_bytes; 1899874aeea5SJeff Kirsher stats->rx_dropped = efx->n_rx_nodesc_drop_cnt; 1900874aeea5SJeff Kirsher stats->multicast = mac_stats->rx_multicast; 1901874aeea5SJeff Kirsher stats->collisions = mac_stats->tx_collision; 1902874aeea5SJeff Kirsher stats->rx_length_errors = (mac_stats->rx_gtjumbo + 1903874aeea5SJeff Kirsher mac_stats->rx_length_error); 1904874aeea5SJeff Kirsher stats->rx_crc_errors = mac_stats->rx_bad; 1905874aeea5SJeff Kirsher stats->rx_frame_errors = mac_stats->rx_align_error; 1906874aeea5SJeff Kirsher stats->rx_fifo_errors = mac_stats->rx_overflow; 1907874aeea5SJeff Kirsher stats->rx_missed_errors = mac_stats->rx_missed; 1908874aeea5SJeff Kirsher stats->tx_window_errors = mac_stats->tx_late_collision; 1909874aeea5SJeff Kirsher 1910874aeea5SJeff Kirsher stats->rx_errors = (stats->rx_length_errors + 1911874aeea5SJeff Kirsher stats->rx_crc_errors + 1912874aeea5SJeff Kirsher stats->rx_frame_errors + 1913874aeea5SJeff Kirsher mac_stats->rx_symbol_error); 1914874aeea5SJeff Kirsher stats->tx_errors = (stats->tx_window_errors + 1915874aeea5SJeff Kirsher mac_stats->tx_bad); 1916874aeea5SJeff Kirsher 19171cb34522SBen Hutchings spin_unlock_bh(&efx->stats_lock); 19181cb34522SBen Hutchings 1919874aeea5SJeff Kirsher return stats; 1920874aeea5SJeff Kirsher } 1921874aeea5SJeff Kirsher 1922874aeea5SJeff Kirsher /* Context: netif_tx_lock held, BHs disabled. */ 1923874aeea5SJeff Kirsher static void efx_watchdog(struct net_device *net_dev) 1924874aeea5SJeff Kirsher { 1925874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 1926874aeea5SJeff Kirsher 1927874aeea5SJeff Kirsher netif_err(efx, tx_err, efx->net_dev, 1928874aeea5SJeff Kirsher "TX stuck with port_enabled=%d: resetting channels\n", 1929874aeea5SJeff Kirsher efx->port_enabled); 1930874aeea5SJeff Kirsher 1931874aeea5SJeff Kirsher efx_schedule_reset(efx, RESET_TYPE_TX_WATCHDOG); 1932874aeea5SJeff Kirsher } 1933874aeea5SJeff Kirsher 1934874aeea5SJeff Kirsher 1935874aeea5SJeff Kirsher /* Context: process, rtnl_lock() held. */ 1936874aeea5SJeff Kirsher static int efx_change_mtu(struct net_device *net_dev, int new_mtu) 1937874aeea5SJeff Kirsher { 1938874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 19398b7325b4SBen Hutchings int rc; 1940874aeea5SJeff Kirsher 19418b7325b4SBen Hutchings rc = efx_check_disabled(efx); 19428b7325b4SBen Hutchings if (rc) 19438b7325b4SBen Hutchings return rc; 1944874aeea5SJeff Kirsher if (new_mtu > EFX_MAX_MTU) 1945874aeea5SJeff Kirsher return -EINVAL; 1946874aeea5SJeff Kirsher 1947874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "changing MTU to %d\n", new_mtu); 1948874aeea5SJeff Kirsher 194929c69a48SBen Hutchings efx_device_detach_sync(efx); 195029c69a48SBen Hutchings efx_stop_all(efx); 195129c69a48SBen Hutchings 1952874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1953874aeea5SJeff Kirsher net_dev->mtu = new_mtu; 1954710b208dSBen Hutchings efx->type->reconfigure_mac(efx); 1955874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1956874aeea5SJeff Kirsher 1957874aeea5SJeff Kirsher efx_start_all(efx); 195829c69a48SBen Hutchings netif_device_attach(efx->net_dev); 19596c8eef4aSBen Hutchings return 0; 1960874aeea5SJeff Kirsher } 1961874aeea5SJeff Kirsher 1962874aeea5SJeff Kirsher static int efx_set_mac_address(struct net_device *net_dev, void *data) 1963874aeea5SJeff Kirsher { 1964874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 1965874aeea5SJeff Kirsher struct sockaddr *addr = data; 1966874aeea5SJeff Kirsher char *new_addr = addr->sa_data; 1967874aeea5SJeff Kirsher 1968874aeea5SJeff Kirsher if (!is_valid_ether_addr(new_addr)) { 1969874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 1970874aeea5SJeff Kirsher "invalid ethernet MAC address requested: %pM\n", 1971874aeea5SJeff Kirsher new_addr); 1972504f9b5aSDanny Kukawka return -EADDRNOTAVAIL; 1973874aeea5SJeff Kirsher } 1974874aeea5SJeff Kirsher 1975874aeea5SJeff Kirsher memcpy(net_dev->dev_addr, new_addr, net_dev->addr_len); 1976cd2d5b52SBen Hutchings efx_sriov_mac_address_changed(efx); 1977874aeea5SJeff Kirsher 1978874aeea5SJeff Kirsher /* Reconfigure the MAC */ 1979874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 1980710b208dSBen Hutchings efx->type->reconfigure_mac(efx); 1981874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 1982874aeea5SJeff Kirsher 1983874aeea5SJeff Kirsher return 0; 1984874aeea5SJeff Kirsher } 1985874aeea5SJeff Kirsher 1986874aeea5SJeff Kirsher /* Context: netif_addr_lock held, BHs disabled. */ 19870fca8c97SBen Hutchings static void efx_set_rx_mode(struct net_device *net_dev) 1988874aeea5SJeff Kirsher { 1989874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 1990874aeea5SJeff Kirsher struct netdev_hw_addr *ha; 1991874aeea5SJeff Kirsher union efx_multicast_hash *mc_hash = &efx->multicast_hash; 1992874aeea5SJeff Kirsher u32 crc; 1993874aeea5SJeff Kirsher int bit; 1994874aeea5SJeff Kirsher 1995874aeea5SJeff Kirsher efx->promiscuous = !!(net_dev->flags & IFF_PROMISC); 1996874aeea5SJeff Kirsher 1997874aeea5SJeff Kirsher /* Build multicast hash table */ 1998874aeea5SJeff Kirsher if (efx->promiscuous || (net_dev->flags & IFF_ALLMULTI)) { 1999874aeea5SJeff Kirsher memset(mc_hash, 0xff, sizeof(*mc_hash)); 2000874aeea5SJeff Kirsher } else { 2001874aeea5SJeff Kirsher memset(mc_hash, 0x00, sizeof(*mc_hash)); 2002874aeea5SJeff Kirsher netdev_for_each_mc_addr(ha, net_dev) { 2003874aeea5SJeff Kirsher crc = ether_crc_le(ETH_ALEN, ha->addr); 2004874aeea5SJeff Kirsher bit = crc & (EFX_MCAST_HASH_ENTRIES - 1); 200532766ec8SBen Hutchings __set_bit_le(bit, mc_hash); 2006874aeea5SJeff Kirsher } 2007874aeea5SJeff Kirsher 2008874aeea5SJeff Kirsher /* Broadcast packets go through the multicast hash filter. 2009874aeea5SJeff Kirsher * ether_crc_le() of the broadcast address is 0xbe2612ff 2010874aeea5SJeff Kirsher * so we always add bit 0xff to the mask. 2011874aeea5SJeff Kirsher */ 201232766ec8SBen Hutchings __set_bit_le(0xff, mc_hash); 2013874aeea5SJeff Kirsher } 2014874aeea5SJeff Kirsher 2015874aeea5SJeff Kirsher if (efx->port_enabled) 2016874aeea5SJeff Kirsher queue_work(efx->workqueue, &efx->mac_work); 2017874aeea5SJeff Kirsher /* Otherwise efx_start_port() will do this */ 2018874aeea5SJeff Kirsher } 2019874aeea5SJeff Kirsher 2020c8f44affSMichał Mirosław static int efx_set_features(struct net_device *net_dev, netdev_features_t data) 2021874aeea5SJeff Kirsher { 2022874aeea5SJeff Kirsher struct efx_nic *efx = netdev_priv(net_dev); 2023874aeea5SJeff Kirsher 2024874aeea5SJeff Kirsher /* If disabling RX n-tuple filtering, clear existing filters */ 2025874aeea5SJeff Kirsher if (net_dev->features & ~data & NETIF_F_NTUPLE) 2026874aeea5SJeff Kirsher efx_filter_clear_rx(efx, EFX_FILTER_PRI_MANUAL); 2027874aeea5SJeff Kirsher 2028874aeea5SJeff Kirsher return 0; 2029874aeea5SJeff Kirsher } 2030874aeea5SJeff Kirsher 2031874aeea5SJeff Kirsher static const struct net_device_ops efx_netdev_ops = { 2032874aeea5SJeff Kirsher .ndo_open = efx_net_open, 2033874aeea5SJeff Kirsher .ndo_stop = efx_net_stop, 2034874aeea5SJeff Kirsher .ndo_get_stats64 = efx_net_stats, 2035874aeea5SJeff Kirsher .ndo_tx_timeout = efx_watchdog, 2036874aeea5SJeff Kirsher .ndo_start_xmit = efx_hard_start_xmit, 2037874aeea5SJeff Kirsher .ndo_validate_addr = eth_validate_addr, 2038874aeea5SJeff Kirsher .ndo_do_ioctl = efx_ioctl, 2039874aeea5SJeff Kirsher .ndo_change_mtu = efx_change_mtu, 2040874aeea5SJeff Kirsher .ndo_set_mac_address = efx_set_mac_address, 20410fca8c97SBen Hutchings .ndo_set_rx_mode = efx_set_rx_mode, 2042874aeea5SJeff Kirsher .ndo_set_features = efx_set_features, 2043cd2d5b52SBen Hutchings #ifdef CONFIG_SFC_SRIOV 2044cd2d5b52SBen Hutchings .ndo_set_vf_mac = efx_sriov_set_vf_mac, 2045cd2d5b52SBen Hutchings .ndo_set_vf_vlan = efx_sriov_set_vf_vlan, 2046cd2d5b52SBen Hutchings .ndo_set_vf_spoofchk = efx_sriov_set_vf_spoofchk, 2047cd2d5b52SBen Hutchings .ndo_get_vf_config = efx_sriov_get_vf_config, 2048cd2d5b52SBen Hutchings #endif 2049874aeea5SJeff Kirsher #ifdef CONFIG_NET_POLL_CONTROLLER 2050874aeea5SJeff Kirsher .ndo_poll_controller = efx_netpoll, 2051874aeea5SJeff Kirsher #endif 2052874aeea5SJeff Kirsher .ndo_setup_tc = efx_setup_tc, 2053874aeea5SJeff Kirsher #ifdef CONFIG_RFS_ACCEL 2054874aeea5SJeff Kirsher .ndo_rx_flow_steer = efx_filter_rfs, 2055874aeea5SJeff Kirsher #endif 2056874aeea5SJeff Kirsher }; 2057874aeea5SJeff Kirsher 2058874aeea5SJeff Kirsher static void efx_update_name(struct efx_nic *efx) 2059874aeea5SJeff Kirsher { 2060874aeea5SJeff Kirsher strcpy(efx->name, efx->net_dev->name); 2061874aeea5SJeff Kirsher efx_mtd_rename(efx); 2062874aeea5SJeff Kirsher efx_set_channel_names(efx); 2063874aeea5SJeff Kirsher } 2064874aeea5SJeff Kirsher 2065874aeea5SJeff Kirsher static int efx_netdev_event(struct notifier_block *this, 2066874aeea5SJeff Kirsher unsigned long event, void *ptr) 2067874aeea5SJeff Kirsher { 2068351638e7SJiri Pirko struct net_device *net_dev = netdev_notifier_info_to_dev(ptr); 2069874aeea5SJeff Kirsher 2070874aeea5SJeff Kirsher if (net_dev->netdev_ops == &efx_netdev_ops && 2071874aeea5SJeff Kirsher event == NETDEV_CHANGENAME) 2072874aeea5SJeff Kirsher efx_update_name(netdev_priv(net_dev)); 2073874aeea5SJeff Kirsher 2074874aeea5SJeff Kirsher return NOTIFY_DONE; 2075874aeea5SJeff Kirsher } 2076874aeea5SJeff Kirsher 2077874aeea5SJeff Kirsher static struct notifier_block efx_netdev_notifier = { 2078874aeea5SJeff Kirsher .notifier_call = efx_netdev_event, 2079874aeea5SJeff Kirsher }; 2080874aeea5SJeff Kirsher 2081874aeea5SJeff Kirsher static ssize_t 2082874aeea5SJeff Kirsher show_phy_type(struct device *dev, struct device_attribute *attr, char *buf) 2083874aeea5SJeff Kirsher { 2084874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); 2085874aeea5SJeff Kirsher return sprintf(buf, "%d\n", efx->phy_type); 2086874aeea5SJeff Kirsher } 2087776fbcc9SBen Hutchings static DEVICE_ATTR(phy_type, 0444, show_phy_type, NULL); 2088874aeea5SJeff Kirsher 2089874aeea5SJeff Kirsher static int efx_register_netdev(struct efx_nic *efx) 2090874aeea5SJeff Kirsher { 2091874aeea5SJeff Kirsher struct net_device *net_dev = efx->net_dev; 2092874aeea5SJeff Kirsher struct efx_channel *channel; 2093874aeea5SJeff Kirsher int rc; 2094874aeea5SJeff Kirsher 2095874aeea5SJeff Kirsher net_dev->watchdog_timeo = 5 * HZ; 2096874aeea5SJeff Kirsher net_dev->irq = efx->pci_dev->irq; 2097874aeea5SJeff Kirsher net_dev->netdev_ops = &efx_netdev_ops; 2098874aeea5SJeff Kirsher SET_ETHTOOL_OPS(net_dev, &efx_ethtool_ops); 20997e6d06f0SBen Hutchings net_dev->gso_max_segs = EFX_TSO_MAX_SEGS; 2100874aeea5SJeff Kirsher 2101874aeea5SJeff Kirsher rtnl_lock(); 2102874aeea5SJeff Kirsher 21037153f623SBen Hutchings /* Enable resets to be scheduled and check whether any were 21047153f623SBen Hutchings * already requested. If so, the NIC is probably hosed so we 21057153f623SBen Hutchings * abort. 21067153f623SBen Hutchings */ 21077153f623SBen Hutchings efx->state = STATE_READY; 21087153f623SBen Hutchings smp_mb(); /* ensure we change state before checking reset_pending */ 21097153f623SBen Hutchings if (efx->reset_pending) { 21107153f623SBen Hutchings netif_err(efx, probe, efx->net_dev, 21117153f623SBen Hutchings "aborting probe due to scheduled reset\n"); 21127153f623SBen Hutchings rc = -EIO; 21137153f623SBen Hutchings goto fail_locked; 21147153f623SBen Hutchings } 21157153f623SBen Hutchings 2116874aeea5SJeff Kirsher rc = dev_alloc_name(net_dev, net_dev->name); 2117874aeea5SJeff Kirsher if (rc < 0) 2118874aeea5SJeff Kirsher goto fail_locked; 2119874aeea5SJeff Kirsher efx_update_name(efx); 2120874aeea5SJeff Kirsher 21218f8b3d51SBen Hutchings /* Always start with carrier off; PHY events will detect the link */ 21228f8b3d51SBen Hutchings netif_carrier_off(net_dev); 21238f8b3d51SBen Hutchings 2124874aeea5SJeff Kirsher rc = register_netdevice(net_dev); 2125874aeea5SJeff Kirsher if (rc) 2126874aeea5SJeff Kirsher goto fail_locked; 2127874aeea5SJeff Kirsher 2128874aeea5SJeff Kirsher efx_for_each_channel(channel, efx) { 2129874aeea5SJeff Kirsher struct efx_tx_queue *tx_queue; 2130874aeea5SJeff Kirsher efx_for_each_channel_tx_queue(tx_queue, channel) 2131874aeea5SJeff Kirsher efx_init_tx_queue_core_txq(tx_queue); 2132874aeea5SJeff Kirsher } 2133874aeea5SJeff Kirsher 2134874aeea5SJeff Kirsher rtnl_unlock(); 2135874aeea5SJeff Kirsher 2136874aeea5SJeff Kirsher rc = device_create_file(&efx->pci_dev->dev, &dev_attr_phy_type); 2137874aeea5SJeff Kirsher if (rc) { 2138874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 2139874aeea5SJeff Kirsher "failed to init net dev attributes\n"); 2140874aeea5SJeff Kirsher goto fail_registered; 2141874aeea5SJeff Kirsher } 2142874aeea5SJeff Kirsher 2143874aeea5SJeff Kirsher return 0; 2144874aeea5SJeff Kirsher 21457153f623SBen Hutchings fail_registered: 21467153f623SBen Hutchings rtnl_lock(); 21477153f623SBen Hutchings unregister_netdevice(net_dev); 2148874aeea5SJeff Kirsher fail_locked: 21497153f623SBen Hutchings efx->state = STATE_UNINIT; 2150874aeea5SJeff Kirsher rtnl_unlock(); 2151874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "could not register net dev\n"); 2152874aeea5SJeff Kirsher return rc; 2153874aeea5SJeff Kirsher } 2154874aeea5SJeff Kirsher 2155874aeea5SJeff Kirsher static void efx_unregister_netdev(struct efx_nic *efx) 2156874aeea5SJeff Kirsher { 2157874aeea5SJeff Kirsher if (!efx->net_dev) 2158874aeea5SJeff Kirsher return; 2159874aeea5SJeff Kirsher 2160874aeea5SJeff Kirsher BUG_ON(netdev_priv(efx->net_dev) != efx); 2161874aeea5SJeff Kirsher 2162874aeea5SJeff Kirsher strlcpy(efx->name, pci_name(efx->pci_dev), sizeof(efx->name)); 2163874aeea5SJeff Kirsher device_remove_file(&efx->pci_dev->dev, &dev_attr_phy_type); 21647153f623SBen Hutchings 21657153f623SBen Hutchings rtnl_lock(); 21667153f623SBen Hutchings unregister_netdevice(efx->net_dev); 21677153f623SBen Hutchings efx->state = STATE_UNINIT; 21687153f623SBen Hutchings rtnl_unlock(); 2169874aeea5SJeff Kirsher } 2170874aeea5SJeff Kirsher 2171874aeea5SJeff Kirsher /************************************************************************** 2172874aeea5SJeff Kirsher * 2173874aeea5SJeff Kirsher * Device reset and suspend 2174874aeea5SJeff Kirsher * 2175874aeea5SJeff Kirsher **************************************************************************/ 2176874aeea5SJeff Kirsher 2177874aeea5SJeff Kirsher /* Tears down the entire software state and most of the hardware state 2178874aeea5SJeff Kirsher * before reset. */ 2179874aeea5SJeff Kirsher void efx_reset_down(struct efx_nic *efx, enum reset_type method) 2180874aeea5SJeff Kirsher { 2181874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 2182874aeea5SJeff Kirsher 2183874aeea5SJeff Kirsher efx_stop_all(efx); 2184d8291187SBen Hutchings efx_disable_interrupts(efx); 21855642ceefSBen Hutchings 21865642ceefSBen Hutchings mutex_lock(&efx->mac_lock); 2187874aeea5SJeff Kirsher if (efx->port_initialized && method != RESET_TYPE_INVISIBLE) 2188874aeea5SJeff Kirsher efx->phy_op->fini(efx); 2189874aeea5SJeff Kirsher efx->type->fini(efx); 2190874aeea5SJeff Kirsher } 2191874aeea5SJeff Kirsher 2192874aeea5SJeff Kirsher /* This function will always ensure that the locks acquired in 2193874aeea5SJeff Kirsher * efx_reset_down() are released. A failure return code indicates 2194874aeea5SJeff Kirsher * that we were unable to reinitialise the hardware, and the 2195874aeea5SJeff Kirsher * driver should be disabled. If ok is false, then the rx and tx 2196874aeea5SJeff Kirsher * engines are not restarted, pending a RESET_DISABLE. */ 2197874aeea5SJeff Kirsher int efx_reset_up(struct efx_nic *efx, enum reset_type method, bool ok) 2198874aeea5SJeff Kirsher { 2199874aeea5SJeff Kirsher int rc; 2200874aeea5SJeff Kirsher 2201874aeea5SJeff Kirsher EFX_ASSERT_RESET_SERIALISED(efx); 2202874aeea5SJeff Kirsher 2203874aeea5SJeff Kirsher rc = efx->type->init(efx); 2204874aeea5SJeff Kirsher if (rc) { 2205874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "failed to initialise NIC\n"); 2206874aeea5SJeff Kirsher goto fail; 2207874aeea5SJeff Kirsher } 2208874aeea5SJeff Kirsher 2209874aeea5SJeff Kirsher if (!ok) 2210874aeea5SJeff Kirsher goto fail; 2211874aeea5SJeff Kirsher 2212874aeea5SJeff Kirsher if (efx->port_initialized && method != RESET_TYPE_INVISIBLE) { 2213874aeea5SJeff Kirsher rc = efx->phy_op->init(efx); 2214874aeea5SJeff Kirsher if (rc) 2215874aeea5SJeff Kirsher goto fail; 2216874aeea5SJeff Kirsher if (efx->phy_op->reconfigure(efx)) 2217874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, 2218874aeea5SJeff Kirsher "could not restore PHY settings\n"); 2219874aeea5SJeff Kirsher } 2220874aeea5SJeff Kirsher 2221710b208dSBen Hutchings efx->type->reconfigure_mac(efx); 2222874aeea5SJeff Kirsher 2223d8291187SBen Hutchings efx_enable_interrupts(efx); 2224874aeea5SJeff Kirsher efx_restore_filters(efx); 2225cd2d5b52SBen Hutchings efx_sriov_reset(efx); 2226874aeea5SJeff Kirsher 2227874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2228874aeea5SJeff Kirsher 2229874aeea5SJeff Kirsher efx_start_all(efx); 2230874aeea5SJeff Kirsher 2231874aeea5SJeff Kirsher return 0; 2232874aeea5SJeff Kirsher 2233874aeea5SJeff Kirsher fail: 2234874aeea5SJeff Kirsher efx->port_initialized = false; 2235874aeea5SJeff Kirsher 2236874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2237874aeea5SJeff Kirsher 2238874aeea5SJeff Kirsher return rc; 2239874aeea5SJeff Kirsher } 2240874aeea5SJeff Kirsher 2241874aeea5SJeff Kirsher /* Reset the NIC using the specified method. Note that the reset may 2242874aeea5SJeff Kirsher * fail, in which case the card will be left in an unusable state. 2243874aeea5SJeff Kirsher * 2244874aeea5SJeff Kirsher * Caller must hold the rtnl_lock. 2245874aeea5SJeff Kirsher */ 2246874aeea5SJeff Kirsher int efx_reset(struct efx_nic *efx, enum reset_type method) 2247874aeea5SJeff Kirsher { 2248874aeea5SJeff Kirsher int rc, rc2; 2249874aeea5SJeff Kirsher bool disabled; 2250874aeea5SJeff Kirsher 2251874aeea5SJeff Kirsher netif_info(efx, drv, efx->net_dev, "resetting (%s)\n", 2252874aeea5SJeff Kirsher RESET_TYPE(method)); 2253874aeea5SJeff Kirsher 2254c2f3b8e3SDaniel Pieczko efx_device_detach_sync(efx); 2255874aeea5SJeff Kirsher efx_reset_down(efx, method); 2256874aeea5SJeff Kirsher 2257874aeea5SJeff Kirsher rc = efx->type->reset(efx, method); 2258874aeea5SJeff Kirsher if (rc) { 2259874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "failed to reset hardware\n"); 2260874aeea5SJeff Kirsher goto out; 2261874aeea5SJeff Kirsher } 2262874aeea5SJeff Kirsher 2263874aeea5SJeff Kirsher /* Clear flags for the scopes we covered. We assume the NIC and 2264874aeea5SJeff Kirsher * driver are now quiescent so that there is no race here. 2265874aeea5SJeff Kirsher */ 2266874aeea5SJeff Kirsher efx->reset_pending &= -(1 << (method + 1)); 2267874aeea5SJeff Kirsher 2268874aeea5SJeff Kirsher /* Reinitialise bus-mastering, which may have been turned off before 2269874aeea5SJeff Kirsher * the reset was scheduled. This is still appropriate, even in the 2270874aeea5SJeff Kirsher * RESET_TYPE_DISABLE since this driver generally assumes the hardware 2271874aeea5SJeff Kirsher * can respond to requests. */ 2272874aeea5SJeff Kirsher pci_set_master(efx->pci_dev); 2273874aeea5SJeff Kirsher 2274874aeea5SJeff Kirsher out: 2275874aeea5SJeff Kirsher /* Leave device stopped if necessary */ 2276626950dbSAlexandre Rames disabled = rc || 2277626950dbSAlexandre Rames method == RESET_TYPE_DISABLE || 2278626950dbSAlexandre Rames method == RESET_TYPE_RECOVER_OR_DISABLE; 2279874aeea5SJeff Kirsher rc2 = efx_reset_up(efx, method, !disabled); 2280874aeea5SJeff Kirsher if (rc2) { 2281874aeea5SJeff Kirsher disabled = true; 2282874aeea5SJeff Kirsher if (!rc) 2283874aeea5SJeff Kirsher rc = rc2; 2284874aeea5SJeff Kirsher } 2285874aeea5SJeff Kirsher 2286874aeea5SJeff Kirsher if (disabled) { 2287874aeea5SJeff Kirsher dev_close(efx->net_dev); 2288874aeea5SJeff Kirsher netif_err(efx, drv, efx->net_dev, "has been disabled\n"); 2289874aeea5SJeff Kirsher efx->state = STATE_DISABLED; 2290874aeea5SJeff Kirsher } else { 2291874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "reset complete\n"); 2292874aeea5SJeff Kirsher netif_device_attach(efx->net_dev); 2293874aeea5SJeff Kirsher } 2294874aeea5SJeff Kirsher return rc; 2295874aeea5SJeff Kirsher } 2296874aeea5SJeff Kirsher 2297626950dbSAlexandre Rames /* Try recovery mechanisms. 2298626950dbSAlexandre Rames * For now only EEH is supported. 2299626950dbSAlexandre Rames * Returns 0 if the recovery mechanisms are unsuccessful. 2300626950dbSAlexandre Rames * Returns a non-zero value otherwise. 2301626950dbSAlexandre Rames */ 2302b28405b0SAlexandre Rames int efx_try_recovery(struct efx_nic *efx) 2303626950dbSAlexandre Rames { 2304626950dbSAlexandre Rames #ifdef CONFIG_EEH 2305626950dbSAlexandre Rames /* A PCI error can occur and not be seen by EEH because nothing 2306626950dbSAlexandre Rames * happens on the PCI bus. In this case the driver may fail and 2307626950dbSAlexandre Rames * schedule a 'recover or reset', leading to this recovery handler. 2308626950dbSAlexandre Rames * Manually call the eeh failure check function. 2309626950dbSAlexandre Rames */ 2310626950dbSAlexandre Rames struct eeh_dev *eehdev = 2311626950dbSAlexandre Rames of_node_to_eeh_dev(pci_device_to_OF_node(efx->pci_dev)); 2312626950dbSAlexandre Rames 2313626950dbSAlexandre Rames if (eeh_dev_check_failure(eehdev)) { 2314626950dbSAlexandre Rames /* The EEH mechanisms will handle the error and reset the 2315626950dbSAlexandre Rames * device if necessary. 2316626950dbSAlexandre Rames */ 2317626950dbSAlexandre Rames return 1; 2318626950dbSAlexandre Rames } 2319626950dbSAlexandre Rames #endif 2320626950dbSAlexandre Rames return 0; 2321626950dbSAlexandre Rames } 2322626950dbSAlexandre Rames 2323874aeea5SJeff Kirsher /* The worker thread exists so that code that cannot sleep can 2324874aeea5SJeff Kirsher * schedule a reset for later. 2325874aeea5SJeff Kirsher */ 2326874aeea5SJeff Kirsher static void efx_reset_work(struct work_struct *data) 2327874aeea5SJeff Kirsher { 2328874aeea5SJeff Kirsher struct efx_nic *efx = container_of(data, struct efx_nic, reset_work); 2329626950dbSAlexandre Rames unsigned long pending; 2330626950dbSAlexandre Rames enum reset_type method; 2331626950dbSAlexandre Rames 2332626950dbSAlexandre Rames pending = ACCESS_ONCE(efx->reset_pending); 2333626950dbSAlexandre Rames method = fls(pending) - 1; 2334626950dbSAlexandre Rames 2335626950dbSAlexandre Rames if ((method == RESET_TYPE_RECOVER_OR_DISABLE || 2336626950dbSAlexandre Rames method == RESET_TYPE_RECOVER_OR_ALL) && 2337626950dbSAlexandre Rames efx_try_recovery(efx)) 2338626950dbSAlexandre Rames return; 2339874aeea5SJeff Kirsher 2340874aeea5SJeff Kirsher if (!pending) 2341874aeea5SJeff Kirsher return; 2342874aeea5SJeff Kirsher 2343874aeea5SJeff Kirsher rtnl_lock(); 23447153f623SBen Hutchings 23457153f623SBen Hutchings /* We checked the state in efx_schedule_reset() but it may 23467153f623SBen Hutchings * have changed by now. Now that we have the RTNL lock, 23477153f623SBen Hutchings * it cannot change again. 23487153f623SBen Hutchings */ 23497153f623SBen Hutchings if (efx->state == STATE_READY) 2350626950dbSAlexandre Rames (void)efx_reset(efx, method); 23517153f623SBen Hutchings 2352874aeea5SJeff Kirsher rtnl_unlock(); 2353874aeea5SJeff Kirsher } 2354874aeea5SJeff Kirsher 2355874aeea5SJeff Kirsher void efx_schedule_reset(struct efx_nic *efx, enum reset_type type) 2356874aeea5SJeff Kirsher { 2357874aeea5SJeff Kirsher enum reset_type method; 2358874aeea5SJeff Kirsher 2359626950dbSAlexandre Rames if (efx->state == STATE_RECOVERY) { 2360626950dbSAlexandre Rames netif_dbg(efx, drv, efx->net_dev, 2361626950dbSAlexandre Rames "recovering: skip scheduling %s reset\n", 2362626950dbSAlexandre Rames RESET_TYPE(type)); 2363626950dbSAlexandre Rames return; 2364626950dbSAlexandre Rames } 2365626950dbSAlexandre Rames 2366874aeea5SJeff Kirsher switch (type) { 2367874aeea5SJeff Kirsher case RESET_TYPE_INVISIBLE: 2368874aeea5SJeff Kirsher case RESET_TYPE_ALL: 2369626950dbSAlexandre Rames case RESET_TYPE_RECOVER_OR_ALL: 2370874aeea5SJeff Kirsher case RESET_TYPE_WORLD: 2371874aeea5SJeff Kirsher case RESET_TYPE_DISABLE: 2372626950dbSAlexandre Rames case RESET_TYPE_RECOVER_OR_DISABLE: 2373874aeea5SJeff Kirsher method = type; 2374874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "scheduling %s reset\n", 2375874aeea5SJeff Kirsher RESET_TYPE(method)); 2376874aeea5SJeff Kirsher break; 2377874aeea5SJeff Kirsher default: 2378874aeea5SJeff Kirsher method = efx->type->map_reset_reason(type); 2379874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, 2380874aeea5SJeff Kirsher "scheduling %s reset for %s\n", 2381874aeea5SJeff Kirsher RESET_TYPE(method), RESET_TYPE(type)); 2382874aeea5SJeff Kirsher break; 2383874aeea5SJeff Kirsher } 2384874aeea5SJeff Kirsher 2385874aeea5SJeff Kirsher set_bit(method, &efx->reset_pending); 23867153f623SBen Hutchings smp_mb(); /* ensure we change reset_pending before checking state */ 23877153f623SBen Hutchings 23887153f623SBen Hutchings /* If we're not READY then just leave the flags set as the cue 23897153f623SBen Hutchings * to abort probing or reschedule the reset later. 23907153f623SBen Hutchings */ 23917153f623SBen Hutchings if (ACCESS_ONCE(efx->state) != STATE_READY) 23927153f623SBen Hutchings return; 2393874aeea5SJeff Kirsher 2394874aeea5SJeff Kirsher /* efx_process_channel() will no longer read events once a 2395874aeea5SJeff Kirsher * reset is scheduled. So switch back to poll'd MCDI completions. */ 2396874aeea5SJeff Kirsher efx_mcdi_mode_poll(efx); 2397874aeea5SJeff Kirsher 2398874aeea5SJeff Kirsher queue_work(reset_workqueue, &efx->reset_work); 2399874aeea5SJeff Kirsher } 2400874aeea5SJeff Kirsher 2401874aeea5SJeff Kirsher /************************************************************************** 2402874aeea5SJeff Kirsher * 2403874aeea5SJeff Kirsher * List of NICs we support 2404874aeea5SJeff Kirsher * 2405874aeea5SJeff Kirsher **************************************************************************/ 2406874aeea5SJeff Kirsher 2407874aeea5SJeff Kirsher /* PCI device ID table */ 2408874aeea5SJeff Kirsher static DEFINE_PCI_DEVICE_TABLE(efx_pci_table) = { 24090e59e7e7SLinus Torvalds {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 24100e59e7e7SLinus Torvalds PCI_DEVICE_ID_SOLARFLARE_SFC4000A_0), 2411874aeea5SJeff Kirsher .driver_data = (unsigned long) &falcon_a1_nic_type}, 24120e59e7e7SLinus Torvalds {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 24130e59e7e7SLinus Torvalds PCI_DEVICE_ID_SOLARFLARE_SFC4000B), 2414874aeea5SJeff Kirsher .driver_data = (unsigned long) &falcon_b0_nic_type}, 2415547c474fSBen Hutchings {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x0803), /* SFC9020 */ 2416874aeea5SJeff Kirsher .driver_data = (unsigned long) &siena_a0_nic_type}, 2417547c474fSBen Hutchings {PCI_DEVICE(PCI_VENDOR_ID_SOLARFLARE, 0x0813), /* SFL9021 */ 2418874aeea5SJeff Kirsher .driver_data = (unsigned long) &siena_a0_nic_type}, 2419874aeea5SJeff Kirsher {0} /* end of list */ 2420874aeea5SJeff Kirsher }; 2421874aeea5SJeff Kirsher 2422874aeea5SJeff Kirsher /************************************************************************** 2423874aeea5SJeff Kirsher * 2424874aeea5SJeff Kirsher * Dummy PHY/MAC operations 2425874aeea5SJeff Kirsher * 2426874aeea5SJeff Kirsher * Can be used for some unimplemented operations 2427874aeea5SJeff Kirsher * Needed so all function pointers are valid and do not have to be tested 2428874aeea5SJeff Kirsher * before use 2429874aeea5SJeff Kirsher * 2430874aeea5SJeff Kirsher **************************************************************************/ 2431874aeea5SJeff Kirsher int efx_port_dummy_op_int(struct efx_nic *efx) 2432874aeea5SJeff Kirsher { 2433874aeea5SJeff Kirsher return 0; 2434874aeea5SJeff Kirsher } 2435874aeea5SJeff Kirsher void efx_port_dummy_op_void(struct efx_nic *efx) {} 2436874aeea5SJeff Kirsher 2437874aeea5SJeff Kirsher static bool efx_port_dummy_op_poll(struct efx_nic *efx) 2438874aeea5SJeff Kirsher { 2439874aeea5SJeff Kirsher return false; 2440874aeea5SJeff Kirsher } 2441874aeea5SJeff Kirsher 2442874aeea5SJeff Kirsher static const struct efx_phy_operations efx_dummy_phy_operations = { 2443874aeea5SJeff Kirsher .init = efx_port_dummy_op_int, 2444874aeea5SJeff Kirsher .reconfigure = efx_port_dummy_op_int, 2445874aeea5SJeff Kirsher .poll = efx_port_dummy_op_poll, 2446874aeea5SJeff Kirsher .fini = efx_port_dummy_op_void, 2447874aeea5SJeff Kirsher }; 2448874aeea5SJeff Kirsher 2449874aeea5SJeff Kirsher /************************************************************************** 2450874aeea5SJeff Kirsher * 2451874aeea5SJeff Kirsher * Data housekeeping 2452874aeea5SJeff Kirsher * 2453874aeea5SJeff Kirsher **************************************************************************/ 2454874aeea5SJeff Kirsher 2455874aeea5SJeff Kirsher /* This zeroes out and then fills in the invariants in a struct 2456874aeea5SJeff Kirsher * efx_nic (including all sub-structures). 2457874aeea5SJeff Kirsher */ 2458adeb15aaSBen Hutchings static int efx_init_struct(struct efx_nic *efx, 2459874aeea5SJeff Kirsher struct pci_dev *pci_dev, struct net_device *net_dev) 2460874aeea5SJeff Kirsher { 2461874aeea5SJeff Kirsher int i; 2462874aeea5SJeff Kirsher 2463874aeea5SJeff Kirsher /* Initialise common structures */ 2464874aeea5SJeff Kirsher spin_lock_init(&efx->biu_lock); 2465874aeea5SJeff Kirsher #ifdef CONFIG_SFC_MTD 2466874aeea5SJeff Kirsher INIT_LIST_HEAD(&efx->mtd_list); 2467874aeea5SJeff Kirsher #endif 2468874aeea5SJeff Kirsher INIT_WORK(&efx->reset_work, efx_reset_work); 2469874aeea5SJeff Kirsher INIT_DELAYED_WORK(&efx->monitor_work, efx_monitor); 2470dd40781eSBen Hutchings INIT_DELAYED_WORK(&efx->selftest_work, efx_selftest_async_work); 2471874aeea5SJeff Kirsher efx->pci_dev = pci_dev; 2472874aeea5SJeff Kirsher efx->msg_enable = debug; 2473f16aeea0SBen Hutchings efx->state = STATE_UNINIT; 2474874aeea5SJeff Kirsher strlcpy(efx->name, pci_name(pci_dev), sizeof(efx->name)); 2475874aeea5SJeff Kirsher 2476874aeea5SJeff Kirsher efx->net_dev = net_dev; 2477874aeea5SJeff Kirsher spin_lock_init(&efx->stats_lock); 2478874aeea5SJeff Kirsher mutex_init(&efx->mac_lock); 2479874aeea5SJeff Kirsher efx->phy_op = &efx_dummy_phy_operations; 2480874aeea5SJeff Kirsher efx->mdio.dev = net_dev; 2481874aeea5SJeff Kirsher INIT_WORK(&efx->mac_work, efx_mac_work); 24829f2cb71cSBen Hutchings init_waitqueue_head(&efx->flush_wq); 2483874aeea5SJeff Kirsher 2484874aeea5SJeff Kirsher for (i = 0; i < EFX_MAX_CHANNELS; i++) { 2485874aeea5SJeff Kirsher efx->channel[i] = efx_alloc_channel(efx, i, NULL); 2486874aeea5SJeff Kirsher if (!efx->channel[i]) 2487874aeea5SJeff Kirsher goto fail; 2488d8291187SBen Hutchings efx->msi_context[i].efx = efx; 2489d8291187SBen Hutchings efx->msi_context[i].index = i; 2490874aeea5SJeff Kirsher } 2491874aeea5SJeff Kirsher 2492874aeea5SJeff Kirsher EFX_BUG_ON_PARANOID(efx->type->phys_addr_channels > EFX_MAX_CHANNELS); 2493874aeea5SJeff Kirsher 2494874aeea5SJeff Kirsher /* Higher numbered interrupt modes are less capable! */ 2495874aeea5SJeff Kirsher efx->interrupt_mode = max(efx->type->max_interrupt_mode, 2496874aeea5SJeff Kirsher interrupt_mode); 2497874aeea5SJeff Kirsher 2498874aeea5SJeff Kirsher /* Would be good to use the net_dev name, but we're too early */ 2499874aeea5SJeff Kirsher snprintf(efx->workqueue_name, sizeof(efx->workqueue_name), "sfc%s", 2500874aeea5SJeff Kirsher pci_name(pci_dev)); 2501874aeea5SJeff Kirsher efx->workqueue = create_singlethread_workqueue(efx->workqueue_name); 2502874aeea5SJeff Kirsher if (!efx->workqueue) 2503874aeea5SJeff Kirsher goto fail; 2504874aeea5SJeff Kirsher 2505874aeea5SJeff Kirsher return 0; 2506874aeea5SJeff Kirsher 2507874aeea5SJeff Kirsher fail: 2508874aeea5SJeff Kirsher efx_fini_struct(efx); 2509874aeea5SJeff Kirsher return -ENOMEM; 2510874aeea5SJeff Kirsher } 2511874aeea5SJeff Kirsher 2512874aeea5SJeff Kirsher static void efx_fini_struct(struct efx_nic *efx) 2513874aeea5SJeff Kirsher { 2514874aeea5SJeff Kirsher int i; 2515874aeea5SJeff Kirsher 2516874aeea5SJeff Kirsher for (i = 0; i < EFX_MAX_CHANNELS; i++) 2517874aeea5SJeff Kirsher kfree(efx->channel[i]); 2518874aeea5SJeff Kirsher 2519874aeea5SJeff Kirsher if (efx->workqueue) { 2520874aeea5SJeff Kirsher destroy_workqueue(efx->workqueue); 2521874aeea5SJeff Kirsher efx->workqueue = NULL; 2522874aeea5SJeff Kirsher } 2523874aeea5SJeff Kirsher } 2524874aeea5SJeff Kirsher 2525874aeea5SJeff Kirsher /************************************************************************** 2526874aeea5SJeff Kirsher * 2527874aeea5SJeff Kirsher * PCI interface 2528874aeea5SJeff Kirsher * 2529874aeea5SJeff Kirsher **************************************************************************/ 2530874aeea5SJeff Kirsher 2531874aeea5SJeff Kirsher /* Main body of final NIC shutdown code 2532874aeea5SJeff Kirsher * This is called only at module unload (or hotplug removal). 2533874aeea5SJeff Kirsher */ 2534874aeea5SJeff Kirsher static void efx_pci_remove_main(struct efx_nic *efx) 2535874aeea5SJeff Kirsher { 25367153f623SBen Hutchings /* Flush reset_work. It can no longer be scheduled since we 25377153f623SBen Hutchings * are not READY. 25387153f623SBen Hutchings */ 25397153f623SBen Hutchings BUG_ON(efx->state == STATE_READY); 25407153f623SBen Hutchings cancel_work_sync(&efx->reset_work); 25417153f623SBen Hutchings 2542d8291187SBen Hutchings efx_disable_interrupts(efx); 2543874aeea5SJeff Kirsher efx_nic_fini_interrupt(efx); 2544874aeea5SJeff Kirsher efx_fini_port(efx); 2545874aeea5SJeff Kirsher efx->type->fini(efx); 2546874aeea5SJeff Kirsher efx_fini_napi(efx); 2547874aeea5SJeff Kirsher efx_remove_all(efx); 2548874aeea5SJeff Kirsher } 2549874aeea5SJeff Kirsher 2550874aeea5SJeff Kirsher /* Final NIC shutdown 2551874aeea5SJeff Kirsher * This is called only at module unload (or hotplug removal). 2552874aeea5SJeff Kirsher */ 2553874aeea5SJeff Kirsher static void efx_pci_remove(struct pci_dev *pci_dev) 2554874aeea5SJeff Kirsher { 2555874aeea5SJeff Kirsher struct efx_nic *efx; 2556874aeea5SJeff Kirsher 2557874aeea5SJeff Kirsher efx = pci_get_drvdata(pci_dev); 2558874aeea5SJeff Kirsher if (!efx) 2559874aeea5SJeff Kirsher return; 2560874aeea5SJeff Kirsher 2561874aeea5SJeff Kirsher /* Mark the NIC as fini, then stop the interface */ 2562874aeea5SJeff Kirsher rtnl_lock(); 2563874aeea5SJeff Kirsher dev_close(efx->net_dev); 2564d8291187SBen Hutchings efx_disable_interrupts(efx); 2565874aeea5SJeff Kirsher rtnl_unlock(); 2566874aeea5SJeff Kirsher 2567cd2d5b52SBen Hutchings efx_sriov_fini(efx); 2568874aeea5SJeff Kirsher efx_unregister_netdev(efx); 2569874aeea5SJeff Kirsher 2570874aeea5SJeff Kirsher efx_mtd_remove(efx); 2571874aeea5SJeff Kirsher 2572874aeea5SJeff Kirsher efx_pci_remove_main(efx); 2573874aeea5SJeff Kirsher 2574874aeea5SJeff Kirsher efx_fini_io(efx); 2575874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "shutdown successful\n"); 2576874aeea5SJeff Kirsher 2577874aeea5SJeff Kirsher efx_fini_struct(efx); 25783de4e301SBen Hutchings pci_set_drvdata(pci_dev, NULL); 2579874aeea5SJeff Kirsher free_netdev(efx->net_dev); 2580626950dbSAlexandre Rames 2581626950dbSAlexandre Rames pci_disable_pcie_error_reporting(pci_dev); 2582874aeea5SJeff Kirsher }; 2583874aeea5SJeff Kirsher 2584460eeaa0SBen Hutchings /* NIC VPD information 2585460eeaa0SBen Hutchings * Called during probe to display the part number of the 2586460eeaa0SBen Hutchings * installed NIC. VPD is potentially very large but this should 2587460eeaa0SBen Hutchings * always appear within the first 512 bytes. 2588460eeaa0SBen Hutchings */ 2589460eeaa0SBen Hutchings #define SFC_VPD_LEN 512 2590460eeaa0SBen Hutchings static void efx_print_product_vpd(struct efx_nic *efx) 2591460eeaa0SBen Hutchings { 2592460eeaa0SBen Hutchings struct pci_dev *dev = efx->pci_dev; 2593460eeaa0SBen Hutchings char vpd_data[SFC_VPD_LEN]; 2594460eeaa0SBen Hutchings ssize_t vpd_size; 2595460eeaa0SBen Hutchings int i, j; 2596460eeaa0SBen Hutchings 2597460eeaa0SBen Hutchings /* Get the vpd data from the device */ 2598460eeaa0SBen Hutchings vpd_size = pci_read_vpd(dev, 0, sizeof(vpd_data), vpd_data); 2599460eeaa0SBen Hutchings if (vpd_size <= 0) { 2600460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "Unable to read VPD\n"); 2601460eeaa0SBen Hutchings return; 2602460eeaa0SBen Hutchings } 2603460eeaa0SBen Hutchings 2604460eeaa0SBen Hutchings /* Get the Read only section */ 2605460eeaa0SBen Hutchings i = pci_vpd_find_tag(vpd_data, 0, vpd_size, PCI_VPD_LRDT_RO_DATA); 2606460eeaa0SBen Hutchings if (i < 0) { 2607460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "VPD Read-only not found\n"); 2608460eeaa0SBen Hutchings return; 2609460eeaa0SBen Hutchings } 2610460eeaa0SBen Hutchings 2611460eeaa0SBen Hutchings j = pci_vpd_lrdt_size(&vpd_data[i]); 2612460eeaa0SBen Hutchings i += PCI_VPD_LRDT_TAG_SIZE; 2613460eeaa0SBen Hutchings if (i + j > vpd_size) 2614460eeaa0SBen Hutchings j = vpd_size - i; 2615460eeaa0SBen Hutchings 2616460eeaa0SBen Hutchings /* Get the Part number */ 2617460eeaa0SBen Hutchings i = pci_vpd_find_info_keyword(vpd_data, i, j, "PN"); 2618460eeaa0SBen Hutchings if (i < 0) { 2619460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "Part number not found\n"); 2620460eeaa0SBen Hutchings return; 2621460eeaa0SBen Hutchings } 2622460eeaa0SBen Hutchings 2623460eeaa0SBen Hutchings j = pci_vpd_info_field_size(&vpd_data[i]); 2624460eeaa0SBen Hutchings i += PCI_VPD_INFO_FLD_HDR_SIZE; 2625460eeaa0SBen Hutchings if (i + j > vpd_size) { 2626460eeaa0SBen Hutchings netif_err(efx, drv, efx->net_dev, "Incomplete part number\n"); 2627460eeaa0SBen Hutchings return; 2628460eeaa0SBen Hutchings } 2629460eeaa0SBen Hutchings 2630460eeaa0SBen Hutchings netif_info(efx, drv, efx->net_dev, 2631460eeaa0SBen Hutchings "Part Number : %.*s\n", j, &vpd_data[i]); 2632460eeaa0SBen Hutchings } 2633460eeaa0SBen Hutchings 2634460eeaa0SBen Hutchings 2635874aeea5SJeff Kirsher /* Main body of NIC initialisation 2636874aeea5SJeff Kirsher * This is called at module load (or hotplug insertion, theoretically). 2637874aeea5SJeff Kirsher */ 2638874aeea5SJeff Kirsher static int efx_pci_probe_main(struct efx_nic *efx) 2639874aeea5SJeff Kirsher { 2640874aeea5SJeff Kirsher int rc; 2641874aeea5SJeff Kirsher 2642874aeea5SJeff Kirsher /* Do start-of-day initialisation */ 2643874aeea5SJeff Kirsher rc = efx_probe_all(efx); 2644874aeea5SJeff Kirsher if (rc) 2645874aeea5SJeff Kirsher goto fail1; 2646874aeea5SJeff Kirsher 2647874aeea5SJeff Kirsher efx_init_napi(efx); 2648874aeea5SJeff Kirsher 2649874aeea5SJeff Kirsher rc = efx->type->init(efx); 2650874aeea5SJeff Kirsher if (rc) { 2651874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 2652874aeea5SJeff Kirsher "failed to initialise NIC\n"); 2653874aeea5SJeff Kirsher goto fail3; 2654874aeea5SJeff Kirsher } 2655874aeea5SJeff Kirsher 2656874aeea5SJeff Kirsher rc = efx_init_port(efx); 2657874aeea5SJeff Kirsher if (rc) { 2658874aeea5SJeff Kirsher netif_err(efx, probe, efx->net_dev, 2659874aeea5SJeff Kirsher "failed to initialise port\n"); 2660874aeea5SJeff Kirsher goto fail4; 2661874aeea5SJeff Kirsher } 2662874aeea5SJeff Kirsher 2663874aeea5SJeff Kirsher rc = efx_nic_init_interrupt(efx); 2664874aeea5SJeff Kirsher if (rc) 2665874aeea5SJeff Kirsher goto fail5; 2666d8291187SBen Hutchings efx_enable_interrupts(efx); 2667874aeea5SJeff Kirsher 2668874aeea5SJeff Kirsher return 0; 2669874aeea5SJeff Kirsher 2670874aeea5SJeff Kirsher fail5: 2671874aeea5SJeff Kirsher efx_fini_port(efx); 2672874aeea5SJeff Kirsher fail4: 2673874aeea5SJeff Kirsher efx->type->fini(efx); 2674874aeea5SJeff Kirsher fail3: 2675874aeea5SJeff Kirsher efx_fini_napi(efx); 2676874aeea5SJeff Kirsher efx_remove_all(efx); 2677874aeea5SJeff Kirsher fail1: 2678874aeea5SJeff Kirsher return rc; 2679874aeea5SJeff Kirsher } 2680874aeea5SJeff Kirsher 2681874aeea5SJeff Kirsher /* NIC initialisation 2682874aeea5SJeff Kirsher * 2683874aeea5SJeff Kirsher * This is called at module load (or hotplug insertion, 268473ba7b68SBen Hutchings * theoretically). It sets up PCI mappings, resets the NIC, 2685874aeea5SJeff Kirsher * sets up and registers the network devices with the kernel and hooks 2686874aeea5SJeff Kirsher * the interrupt service routine. It does not prepare the device for 2687874aeea5SJeff Kirsher * transmission; this is left to the first time one of the network 2688874aeea5SJeff Kirsher * interfaces is brought up (i.e. efx_net_open). 2689874aeea5SJeff Kirsher */ 269087d1fc11SBill Pemberton static int efx_pci_probe(struct pci_dev *pci_dev, 2691874aeea5SJeff Kirsher const struct pci_device_id *entry) 2692874aeea5SJeff Kirsher { 2693874aeea5SJeff Kirsher struct net_device *net_dev; 2694874aeea5SJeff Kirsher struct efx_nic *efx; 2695fadac6aaSBen Hutchings int rc; 2696874aeea5SJeff Kirsher 2697874aeea5SJeff Kirsher /* Allocate and initialise a struct net_device and struct efx_nic */ 2698874aeea5SJeff Kirsher net_dev = alloc_etherdev_mqs(sizeof(*efx), EFX_MAX_CORE_TX_QUEUES, 2699874aeea5SJeff Kirsher EFX_MAX_RX_QUEUES); 2700874aeea5SJeff Kirsher if (!net_dev) 2701874aeea5SJeff Kirsher return -ENOMEM; 2702adeb15aaSBen Hutchings efx = netdev_priv(net_dev); 2703adeb15aaSBen Hutchings efx->type = (const struct efx_nic_type *) entry->driver_data; 2704adeb15aaSBen Hutchings net_dev->features |= (efx->type->offload_features | NETIF_F_SG | 2705874aeea5SJeff Kirsher NETIF_F_HIGHDMA | NETIF_F_TSO | 2706874aeea5SJeff Kirsher NETIF_F_RXCSUM); 2707adeb15aaSBen Hutchings if (efx->type->offload_features & NETIF_F_V6_CSUM) 2708874aeea5SJeff Kirsher net_dev->features |= NETIF_F_TSO6; 2709874aeea5SJeff Kirsher /* Mask for features that also apply to VLAN devices */ 2710874aeea5SJeff Kirsher net_dev->vlan_features |= (NETIF_F_ALL_CSUM | NETIF_F_SG | 2711874aeea5SJeff Kirsher NETIF_F_HIGHDMA | NETIF_F_ALL_TSO | 2712874aeea5SJeff Kirsher NETIF_F_RXCSUM); 2713874aeea5SJeff Kirsher /* All offloads can be toggled */ 2714874aeea5SJeff Kirsher net_dev->hw_features = net_dev->features & ~NETIF_F_HIGHDMA; 2715874aeea5SJeff Kirsher pci_set_drvdata(pci_dev, efx); 2716874aeea5SJeff Kirsher SET_NETDEV_DEV(net_dev, &pci_dev->dev); 2717adeb15aaSBen Hutchings rc = efx_init_struct(efx, pci_dev, net_dev); 2718874aeea5SJeff Kirsher if (rc) 2719874aeea5SJeff Kirsher goto fail1; 2720874aeea5SJeff Kirsher 2721874aeea5SJeff Kirsher netif_info(efx, probe, efx->net_dev, 2722874aeea5SJeff Kirsher "Solarflare NIC detected\n"); 2723874aeea5SJeff Kirsher 2724460eeaa0SBen Hutchings efx_print_product_vpd(efx); 2725460eeaa0SBen Hutchings 2726874aeea5SJeff Kirsher /* Set up basic I/O (BAR mappings etc) */ 2727874aeea5SJeff Kirsher rc = efx_init_io(efx); 2728874aeea5SJeff Kirsher if (rc) 2729874aeea5SJeff Kirsher goto fail2; 2730874aeea5SJeff Kirsher 2731874aeea5SJeff Kirsher rc = efx_pci_probe_main(efx); 2732fadac6aaSBen Hutchings if (rc) 2733874aeea5SJeff Kirsher goto fail3; 2734874aeea5SJeff Kirsher 2735874aeea5SJeff Kirsher rc = efx_register_netdev(efx); 2736874aeea5SJeff Kirsher if (rc) 2737fadac6aaSBen Hutchings goto fail4; 2738874aeea5SJeff Kirsher 2739cd2d5b52SBen Hutchings rc = efx_sriov_init(efx); 2740cd2d5b52SBen Hutchings if (rc) 2741cd2d5b52SBen Hutchings netif_err(efx, probe, efx->net_dev, 2742cd2d5b52SBen Hutchings "SR-IOV can't be enabled rc %d\n", rc); 2743cd2d5b52SBen Hutchings 2744874aeea5SJeff Kirsher netif_dbg(efx, probe, efx->net_dev, "initialisation successful\n"); 2745874aeea5SJeff Kirsher 27467c43161cSBen Hutchings /* Try to create MTDs, but allow this to fail */ 2747874aeea5SJeff Kirsher rtnl_lock(); 27487c43161cSBen Hutchings rc = efx_mtd_probe(efx); 2749874aeea5SJeff Kirsher rtnl_unlock(); 27507c43161cSBen Hutchings if (rc) 27517c43161cSBen Hutchings netif_warn(efx, probe, efx->net_dev, 27527c43161cSBen Hutchings "failed to create MTDs (%d)\n", rc); 27537c43161cSBen Hutchings 2754626950dbSAlexandre Rames rc = pci_enable_pcie_error_reporting(pci_dev); 2755626950dbSAlexandre Rames if (rc && rc != -EINVAL) 2756626950dbSAlexandre Rames netif_warn(efx, probe, efx->net_dev, 2757626950dbSAlexandre Rames "pci_enable_pcie_error_reporting failed (%d)\n", rc); 2758626950dbSAlexandre Rames 2759874aeea5SJeff Kirsher return 0; 2760874aeea5SJeff Kirsher 2761874aeea5SJeff Kirsher fail4: 2762fadac6aaSBen Hutchings efx_pci_remove_main(efx); 2763874aeea5SJeff Kirsher fail3: 2764874aeea5SJeff Kirsher efx_fini_io(efx); 2765874aeea5SJeff Kirsher fail2: 2766874aeea5SJeff Kirsher efx_fini_struct(efx); 2767874aeea5SJeff Kirsher fail1: 27683de4e301SBen Hutchings pci_set_drvdata(pci_dev, NULL); 2769874aeea5SJeff Kirsher WARN_ON(rc > 0); 2770874aeea5SJeff Kirsher netif_dbg(efx, drv, efx->net_dev, "initialisation failed. rc=%d\n", rc); 2771874aeea5SJeff Kirsher free_netdev(net_dev); 2772874aeea5SJeff Kirsher return rc; 2773874aeea5SJeff Kirsher } 2774874aeea5SJeff Kirsher 2775874aeea5SJeff Kirsher static int efx_pm_freeze(struct device *dev) 2776874aeea5SJeff Kirsher { 2777874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); 2778874aeea5SJeff Kirsher 277961da026dSBen Hutchings rtnl_lock(); 278061da026dSBen Hutchings 27816032fb56SBen Hutchings if (efx->state != STATE_DISABLED) { 2782f16aeea0SBen Hutchings efx->state = STATE_UNINIT; 2783874aeea5SJeff Kirsher 2784c2f3b8e3SDaniel Pieczko efx_device_detach_sync(efx); 2785874aeea5SJeff Kirsher 2786874aeea5SJeff Kirsher efx_stop_all(efx); 2787d8291187SBen Hutchings efx_disable_interrupts(efx); 27886032fb56SBen Hutchings } 2789874aeea5SJeff Kirsher 279061da026dSBen Hutchings rtnl_unlock(); 279161da026dSBen Hutchings 2792874aeea5SJeff Kirsher return 0; 2793874aeea5SJeff Kirsher } 2794874aeea5SJeff Kirsher 2795874aeea5SJeff Kirsher static int efx_pm_thaw(struct device *dev) 2796874aeea5SJeff Kirsher { 2797874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(to_pci_dev(dev)); 2798874aeea5SJeff Kirsher 279961da026dSBen Hutchings rtnl_lock(); 280061da026dSBen Hutchings 28016032fb56SBen Hutchings if (efx->state != STATE_DISABLED) { 2802d8291187SBen Hutchings efx_enable_interrupts(efx); 2803874aeea5SJeff Kirsher 2804874aeea5SJeff Kirsher mutex_lock(&efx->mac_lock); 2805874aeea5SJeff Kirsher efx->phy_op->reconfigure(efx); 2806874aeea5SJeff Kirsher mutex_unlock(&efx->mac_lock); 2807874aeea5SJeff Kirsher 2808874aeea5SJeff Kirsher efx_start_all(efx); 2809874aeea5SJeff Kirsher 2810874aeea5SJeff Kirsher netif_device_attach(efx->net_dev); 2811874aeea5SJeff Kirsher 2812f16aeea0SBen Hutchings efx->state = STATE_READY; 2813874aeea5SJeff Kirsher 2814874aeea5SJeff Kirsher efx->type->resume_wol(efx); 28156032fb56SBen Hutchings } 2816874aeea5SJeff Kirsher 281761da026dSBen Hutchings rtnl_unlock(); 281861da026dSBen Hutchings 2819874aeea5SJeff Kirsher /* Reschedule any quenched resets scheduled during efx_pm_freeze() */ 2820874aeea5SJeff Kirsher queue_work(reset_workqueue, &efx->reset_work); 2821874aeea5SJeff Kirsher 2822874aeea5SJeff Kirsher return 0; 2823874aeea5SJeff Kirsher } 2824874aeea5SJeff Kirsher 2825874aeea5SJeff Kirsher static int efx_pm_poweroff(struct device *dev) 2826874aeea5SJeff Kirsher { 2827874aeea5SJeff Kirsher struct pci_dev *pci_dev = to_pci_dev(dev); 2828874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(pci_dev); 2829874aeea5SJeff Kirsher 2830874aeea5SJeff Kirsher efx->type->fini(efx); 2831874aeea5SJeff Kirsher 2832874aeea5SJeff Kirsher efx->reset_pending = 0; 2833874aeea5SJeff Kirsher 2834874aeea5SJeff Kirsher pci_save_state(pci_dev); 2835874aeea5SJeff Kirsher return pci_set_power_state(pci_dev, PCI_D3hot); 2836874aeea5SJeff Kirsher } 2837874aeea5SJeff Kirsher 2838874aeea5SJeff Kirsher /* Used for both resume and restore */ 2839874aeea5SJeff Kirsher static int efx_pm_resume(struct device *dev) 2840874aeea5SJeff Kirsher { 2841874aeea5SJeff Kirsher struct pci_dev *pci_dev = to_pci_dev(dev); 2842874aeea5SJeff Kirsher struct efx_nic *efx = pci_get_drvdata(pci_dev); 2843874aeea5SJeff Kirsher int rc; 2844874aeea5SJeff Kirsher 2845874aeea5SJeff Kirsher rc = pci_set_power_state(pci_dev, PCI_D0); 2846874aeea5SJeff Kirsher if (rc) 2847874aeea5SJeff Kirsher return rc; 2848874aeea5SJeff Kirsher pci_restore_state(pci_dev); 2849874aeea5SJeff Kirsher rc = pci_enable_device(pci_dev); 2850874aeea5SJeff Kirsher if (rc) 2851874aeea5SJeff Kirsher return rc; 2852874aeea5SJeff Kirsher pci_set_master(efx->pci_dev); 2853874aeea5SJeff Kirsher rc = efx->type->reset(efx, RESET_TYPE_ALL); 2854874aeea5SJeff Kirsher if (rc) 2855874aeea5SJeff Kirsher return rc; 2856874aeea5SJeff Kirsher rc = efx->type->init(efx); 2857874aeea5SJeff Kirsher if (rc) 2858874aeea5SJeff Kirsher return rc; 2859874aeea5SJeff Kirsher efx_pm_thaw(dev); 2860874aeea5SJeff Kirsher return 0; 2861874aeea5SJeff Kirsher } 2862874aeea5SJeff Kirsher 2863874aeea5SJeff Kirsher static int efx_pm_suspend(struct device *dev) 2864874aeea5SJeff Kirsher { 2865874aeea5SJeff Kirsher int rc; 2866874aeea5SJeff Kirsher 2867874aeea5SJeff Kirsher efx_pm_freeze(dev); 2868874aeea5SJeff Kirsher rc = efx_pm_poweroff(dev); 2869874aeea5SJeff Kirsher if (rc) 2870874aeea5SJeff Kirsher efx_pm_resume(dev); 2871874aeea5SJeff Kirsher return rc; 2872874aeea5SJeff Kirsher } 2873874aeea5SJeff Kirsher 287418e83e4cSBen Hutchings static const struct dev_pm_ops efx_pm_ops = { 2875874aeea5SJeff Kirsher .suspend = efx_pm_suspend, 2876874aeea5SJeff Kirsher .resume = efx_pm_resume, 2877874aeea5SJeff Kirsher .freeze = efx_pm_freeze, 2878874aeea5SJeff Kirsher .thaw = efx_pm_thaw, 2879874aeea5SJeff Kirsher .poweroff = efx_pm_poweroff, 2880874aeea5SJeff Kirsher .restore = efx_pm_resume, 2881874aeea5SJeff Kirsher }; 2882874aeea5SJeff Kirsher 2883626950dbSAlexandre Rames /* A PCI error affecting this device was detected. 2884626950dbSAlexandre Rames * At this point MMIO and DMA may be disabled. 2885626950dbSAlexandre Rames * Stop the software path and request a slot reset. 2886626950dbSAlexandre Rames */ 2887debd0034Sstephen hemminger static pci_ers_result_t efx_io_error_detected(struct pci_dev *pdev, 2888626950dbSAlexandre Rames enum pci_channel_state state) 2889626950dbSAlexandre Rames { 2890626950dbSAlexandre Rames pci_ers_result_t status = PCI_ERS_RESULT_RECOVERED; 2891626950dbSAlexandre Rames struct efx_nic *efx = pci_get_drvdata(pdev); 2892626950dbSAlexandre Rames 2893626950dbSAlexandre Rames if (state == pci_channel_io_perm_failure) 2894626950dbSAlexandre Rames return PCI_ERS_RESULT_DISCONNECT; 2895626950dbSAlexandre Rames 2896626950dbSAlexandre Rames rtnl_lock(); 2897626950dbSAlexandre Rames 2898626950dbSAlexandre Rames if (efx->state != STATE_DISABLED) { 2899626950dbSAlexandre Rames efx->state = STATE_RECOVERY; 2900626950dbSAlexandre Rames efx->reset_pending = 0; 2901626950dbSAlexandre Rames 2902626950dbSAlexandre Rames efx_device_detach_sync(efx); 2903626950dbSAlexandre Rames 2904626950dbSAlexandre Rames efx_stop_all(efx); 2905d8291187SBen Hutchings efx_disable_interrupts(efx); 2906626950dbSAlexandre Rames 2907626950dbSAlexandre Rames status = PCI_ERS_RESULT_NEED_RESET; 2908626950dbSAlexandre Rames } else { 2909626950dbSAlexandre Rames /* If the interface is disabled we don't want to do anything 2910626950dbSAlexandre Rames * with it. 2911626950dbSAlexandre Rames */ 2912626950dbSAlexandre Rames status = PCI_ERS_RESULT_RECOVERED; 2913626950dbSAlexandre Rames } 2914626950dbSAlexandre Rames 2915626950dbSAlexandre Rames rtnl_unlock(); 2916626950dbSAlexandre Rames 2917626950dbSAlexandre Rames pci_disable_device(pdev); 2918626950dbSAlexandre Rames 2919626950dbSAlexandre Rames return status; 2920626950dbSAlexandre Rames } 2921626950dbSAlexandre Rames 2922626950dbSAlexandre Rames /* Fake a successfull reset, which will be performed later in efx_io_resume. */ 2923debd0034Sstephen hemminger static pci_ers_result_t efx_io_slot_reset(struct pci_dev *pdev) 2924626950dbSAlexandre Rames { 2925626950dbSAlexandre Rames struct efx_nic *efx = pci_get_drvdata(pdev); 2926626950dbSAlexandre Rames pci_ers_result_t status = PCI_ERS_RESULT_RECOVERED; 2927626950dbSAlexandre Rames int rc; 2928626950dbSAlexandre Rames 2929626950dbSAlexandre Rames if (pci_enable_device(pdev)) { 2930626950dbSAlexandre Rames netif_err(efx, hw, efx->net_dev, 2931626950dbSAlexandre Rames "Cannot re-enable PCI device after reset.\n"); 2932626950dbSAlexandre Rames status = PCI_ERS_RESULT_DISCONNECT; 2933626950dbSAlexandre Rames } 2934626950dbSAlexandre Rames 2935626950dbSAlexandre Rames rc = pci_cleanup_aer_uncorrect_error_status(pdev); 2936626950dbSAlexandre Rames if (rc) { 2937626950dbSAlexandre Rames netif_err(efx, hw, efx->net_dev, 2938626950dbSAlexandre Rames "pci_cleanup_aer_uncorrect_error_status failed (%d)\n", rc); 2939626950dbSAlexandre Rames /* Non-fatal error. Continue. */ 2940626950dbSAlexandre Rames } 2941626950dbSAlexandre Rames 2942626950dbSAlexandre Rames return status; 2943626950dbSAlexandre Rames } 2944626950dbSAlexandre Rames 2945626950dbSAlexandre Rames /* Perform the actual reset and resume I/O operations. */ 2946626950dbSAlexandre Rames static void efx_io_resume(struct pci_dev *pdev) 2947626950dbSAlexandre Rames { 2948626950dbSAlexandre Rames struct efx_nic *efx = pci_get_drvdata(pdev); 2949626950dbSAlexandre Rames int rc; 2950626950dbSAlexandre Rames 2951626950dbSAlexandre Rames rtnl_lock(); 2952626950dbSAlexandre Rames 2953626950dbSAlexandre Rames if (efx->state == STATE_DISABLED) 2954626950dbSAlexandre Rames goto out; 2955626950dbSAlexandre Rames 2956626950dbSAlexandre Rames rc = efx_reset(efx, RESET_TYPE_ALL); 2957626950dbSAlexandre Rames if (rc) { 2958626950dbSAlexandre Rames netif_err(efx, hw, efx->net_dev, 2959626950dbSAlexandre Rames "efx_reset failed after PCI error (%d)\n", rc); 2960626950dbSAlexandre Rames } else { 2961626950dbSAlexandre Rames efx->state = STATE_READY; 2962626950dbSAlexandre Rames netif_dbg(efx, hw, efx->net_dev, 2963626950dbSAlexandre Rames "Done resetting and resuming IO after PCI error.\n"); 2964626950dbSAlexandre Rames } 2965626950dbSAlexandre Rames 2966626950dbSAlexandre Rames out: 2967626950dbSAlexandre Rames rtnl_unlock(); 2968626950dbSAlexandre Rames } 2969626950dbSAlexandre Rames 2970626950dbSAlexandre Rames /* For simplicity and reliability, we always require a slot reset and try to 2971626950dbSAlexandre Rames * reset the hardware when a pci error affecting the device is detected. 2972626950dbSAlexandre Rames * We leave both the link_reset and mmio_enabled callback unimplemented: 2973626950dbSAlexandre Rames * with our request for slot reset the mmio_enabled callback will never be 2974626950dbSAlexandre Rames * called, and the link_reset callback is not used by AER or EEH mechanisms. 2975626950dbSAlexandre Rames */ 2976626950dbSAlexandre Rames static struct pci_error_handlers efx_err_handlers = { 2977626950dbSAlexandre Rames .error_detected = efx_io_error_detected, 2978626950dbSAlexandre Rames .slot_reset = efx_io_slot_reset, 2979626950dbSAlexandre Rames .resume = efx_io_resume, 2980626950dbSAlexandre Rames }; 2981626950dbSAlexandre Rames 2982874aeea5SJeff Kirsher static struct pci_driver efx_pci_driver = { 2983874aeea5SJeff Kirsher .name = KBUILD_MODNAME, 2984874aeea5SJeff Kirsher .id_table = efx_pci_table, 2985874aeea5SJeff Kirsher .probe = efx_pci_probe, 2986874aeea5SJeff Kirsher .remove = efx_pci_remove, 2987874aeea5SJeff Kirsher .driver.pm = &efx_pm_ops, 2988626950dbSAlexandre Rames .err_handler = &efx_err_handlers, 2989874aeea5SJeff Kirsher }; 2990874aeea5SJeff Kirsher 2991874aeea5SJeff Kirsher /************************************************************************** 2992874aeea5SJeff Kirsher * 2993874aeea5SJeff Kirsher * Kernel module interface 2994874aeea5SJeff Kirsher * 2995874aeea5SJeff Kirsher *************************************************************************/ 2996874aeea5SJeff Kirsher 2997874aeea5SJeff Kirsher module_param(interrupt_mode, uint, 0444); 2998874aeea5SJeff Kirsher MODULE_PARM_DESC(interrupt_mode, 2999874aeea5SJeff Kirsher "Interrupt mode (0=>MSIX 1=>MSI 2=>legacy)"); 3000874aeea5SJeff Kirsher 3001874aeea5SJeff Kirsher static int __init efx_init_module(void) 3002874aeea5SJeff Kirsher { 3003874aeea5SJeff Kirsher int rc; 3004874aeea5SJeff Kirsher 3005874aeea5SJeff Kirsher printk(KERN_INFO "Solarflare NET driver v" EFX_DRIVER_VERSION "\n"); 3006874aeea5SJeff Kirsher 3007874aeea5SJeff Kirsher rc = register_netdevice_notifier(&efx_netdev_notifier); 3008874aeea5SJeff Kirsher if (rc) 3009874aeea5SJeff Kirsher goto err_notifier; 3010874aeea5SJeff Kirsher 3011cd2d5b52SBen Hutchings rc = efx_init_sriov(); 3012cd2d5b52SBen Hutchings if (rc) 3013cd2d5b52SBen Hutchings goto err_sriov; 3014cd2d5b52SBen Hutchings 3015874aeea5SJeff Kirsher reset_workqueue = create_singlethread_workqueue("sfc_reset"); 3016874aeea5SJeff Kirsher if (!reset_workqueue) { 3017874aeea5SJeff Kirsher rc = -ENOMEM; 3018874aeea5SJeff Kirsher goto err_reset; 3019874aeea5SJeff Kirsher } 3020874aeea5SJeff Kirsher 3021874aeea5SJeff Kirsher rc = pci_register_driver(&efx_pci_driver); 3022874aeea5SJeff Kirsher if (rc < 0) 3023874aeea5SJeff Kirsher goto err_pci; 3024874aeea5SJeff Kirsher 3025874aeea5SJeff Kirsher return 0; 3026874aeea5SJeff Kirsher 3027874aeea5SJeff Kirsher err_pci: 3028874aeea5SJeff Kirsher destroy_workqueue(reset_workqueue); 3029874aeea5SJeff Kirsher err_reset: 3030cd2d5b52SBen Hutchings efx_fini_sriov(); 3031cd2d5b52SBen Hutchings err_sriov: 3032874aeea5SJeff Kirsher unregister_netdevice_notifier(&efx_netdev_notifier); 3033874aeea5SJeff Kirsher err_notifier: 3034874aeea5SJeff Kirsher return rc; 3035874aeea5SJeff Kirsher } 3036874aeea5SJeff Kirsher 3037874aeea5SJeff Kirsher static void __exit efx_exit_module(void) 3038874aeea5SJeff Kirsher { 3039874aeea5SJeff Kirsher printk(KERN_INFO "Solarflare NET driver unloading\n"); 3040874aeea5SJeff Kirsher 3041874aeea5SJeff Kirsher pci_unregister_driver(&efx_pci_driver); 3042874aeea5SJeff Kirsher destroy_workqueue(reset_workqueue); 3043cd2d5b52SBen Hutchings efx_fini_sriov(); 3044874aeea5SJeff Kirsher unregister_netdevice_notifier(&efx_netdev_notifier); 3045874aeea5SJeff Kirsher 3046874aeea5SJeff Kirsher } 3047874aeea5SJeff Kirsher 3048874aeea5SJeff Kirsher module_init(efx_init_module); 3049874aeea5SJeff Kirsher module_exit(efx_exit_module); 3050874aeea5SJeff Kirsher 3051874aeea5SJeff Kirsher MODULE_AUTHOR("Solarflare Communications and " 3052874aeea5SJeff Kirsher "Michael Brown <mbrown@fensystems.co.uk>"); 3053874aeea5SJeff Kirsher MODULE_DESCRIPTION("Solarflare Communications network driver"); 3054874aeea5SJeff Kirsher MODULE_LICENSE("GPL"); 3055874aeea5SJeff Kirsher MODULE_DEVICE_TABLE(pci, efx_pci_table); 3056