File Index
Files and directories
Sign in
FILE

ixgbe_main.c

File preview with syntax highlighting.

linux-6.19.14/drivers/net/ethernet/intel/ixgbe/ixgbe_main.c C
    1// SPDX-License-Identifier: GPL-2.0
    2/* Copyright(c) 1999 - 2024 Intel Corporation. */
    3
    4#include <linux/types.h>
    5#include <linux/module.h>
    6#include <linux/pci.h>
    7#include <linux/netdevice.h>
    8#include <linux/vmalloc.h>
    9#include <linux/string.h>
   10#include <linux/in.h>
   11#include <linux/interrupt.h>
   12#include <linux/iopoll.h>
   13#include <linux/ip.h>
   14#include <linux/tcp.h>
   15#include <linux/sctp.h>
   16#include <linux/pkt_sched.h>
   17#include <linux/ipv6.h>
   18#include <linux/slab.h>
   19#include <net/checksum.h>
   20#include <net/ip6_checksum.h>
   21#include <linux/etherdevice.h>
   22#include <linux/ethtool.h>
   23#include <linux/if.h>
   24#include <linux/if_vlan.h>
   25#include <linux/if_macvlan.h>
   26#include <linux/if_bridge.h>
   27#include <linux/prefetch.h>
   28#include <linux/bpf.h>
   29#include <linux/bpf_trace.h>
   30#include <linux/atomic.h>
   31#include <linux/numa.h>
   32#include <generated/utsrelease.h>
   33#include <scsi/fc/fc_fcoe.h>
   34#include <net/udp_tunnel.h>
   35#include <net/pkt_cls.h>
   36#include <net/tc_act/tc_gact.h>
   37#include <net/tc_act/tc_mirred.h>
   38#include <net/vxlan.h>
   39#include <net/mpls.h>
   40#include <net/netdev_queues.h>
   41#include <net/xdp_sock_drv.h>
   42#include <net/xfrm.h>
   43
   44#include "ixgbe.h"
   45#include "ixgbe_common.h"
   46#include "ixgbe_e610.h"
   47#include "ixgbe_dcb_82599.h"
   48#include "ixgbe_mbx.h"
   49#include "ixgbe_phy.h"
   50#include "ixgbe_sriov.h"
   51#include "ixgbe_model.h"
   52#include "ixgbe_txrx_common.h"
   53#include "devlink/devlink.h"
   54
   55char ixgbe_driver_name[] = "ixgbe";
   56static const char ixgbe_driver_string[] =
   57			      "Intel(R) 10 Gigabit PCI Express Network Driver";
   58#ifdef IXGBE_FCOE
   59char ixgbe_default_device_descr[] =
   60			      "Intel(R) 10 Gigabit Network Connection";
   61#else
   62static char ixgbe_default_device_descr[] =
   63			      "Intel(R) 10 Gigabit Network Connection";
   64#endif
   65static const char ixgbe_copyright[] =
   66				"Copyright (c) 1999-2016 Intel Corporation.";
   67
   68static const char ixgbe_overheat_msg[] = "Network adapter has been stopped because it has over heated. Restart the computer. If the problem persists, power off the system and replace the adapter";
   69
   70static const struct ixgbe_info *ixgbe_info_tbl[] = {
   71	[board_82598]		= &ixgbe_82598_info,
   72	[board_82599]		= &ixgbe_82599_info,
   73	[board_X540]		= &ixgbe_X540_info,
   74	[board_X550]		= &ixgbe_X550_info,
   75	[board_X550EM_x]	= &ixgbe_X550EM_x_info,
   76	[board_x550em_x_fw]	= &ixgbe_x550em_x_fw_info,
   77	[board_x550em_a]	= &ixgbe_x550em_a_info,
   78	[board_x550em_a_fw]	= &ixgbe_x550em_a_fw_info,
   79	[board_e610]		= &ixgbe_e610_info,
   80};
   81
   82/* ixgbe_pci_tbl - PCI Device ID Table
   83 *
   84 * Wildcard entries (PCI_ANY_ID) should come last
   85 * Last entry must be all 0s
   86 *
   87 * { Vendor ID, Device ID, SubVendor ID, SubDevice ID,
   88 *   Class, Class Mask, private data (not used) }
   89 */
   90static const struct pci_device_id ixgbe_pci_tbl[] = {
   91	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598), board_82598 },
   92	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598AF_DUAL_PORT), board_82598 },
   93	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598AF_SINGLE_PORT), board_82598 },
   94	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598AT), board_82598 },
   95	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598AT2), board_82598 },
   96	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598EB_CX4), board_82598 },
   97	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598_CX4_DUAL_PORT), board_82598 },
   98	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598_DA_DUAL_PORT), board_82598 },
   99	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598_SR_DUAL_PORT_EM), board_82598 },
  100	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598EB_XF_LR), board_82598 },
  101	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598EB_SFP_LOM), board_82598 },
  102	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598_BX), board_82598 },
  103	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_KX4), board_82599 },
  104	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_XAUI_LOM), board_82599 },
  105	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_KR), board_82599 },
  106	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP), board_82599 },
  107	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP_EM), board_82599 },
  108	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_KX4_MEZZ), board_82599 },
  109	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_CX4), board_82599 },
  110	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_BACKPLANE_FCOE), board_82599 },
  111	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP_FCOE), board_82599 },
  112	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_T3_LOM), board_82599 },
  113	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_COMBO_BACKPLANE), board_82599 },
  114	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X540T), board_X540 },
  115	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP_SF2), board_82599 },
  116	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_LS), board_82599 },
  117	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_QSFP_SF_QP), board_82599 },
  118	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599EN_SFP), board_82599 },
  119	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP_SF_QP), board_82599 },
  120	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X540T1), board_X540 },
  121	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550T), board_X550},
  122	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550T1), board_X550},
  123	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_KX4), board_X550EM_x},
  124	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_XFI), board_X550EM_x},
  125	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_KR), board_X550EM_x},
  126	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_10G_T), board_X550EM_x},
  127	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_SFP), board_X550EM_x},
  128	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_1G_T), board_x550em_x_fw},
  129	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_KR), board_x550em_a },
  130	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_KR_L), board_x550em_a },
  131	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SFP_N), board_x550em_a },
  132	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SGMII), board_x550em_a },
  133	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SGMII_L), board_x550em_a },
  134	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_10G_T), board_x550em_a},
  135	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SFP), board_x550em_a },
  136	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_1G_T), board_x550em_a_fw },
  137	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_1G_T_L), board_x550em_a_fw },
  138	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_E610_BACKPLANE), board_e610},
  139	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_E610_SFP), board_e610},
  140	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_E610_10G_T), board_e610},
  141	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_E610_2_5G_T), board_e610},
  142	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_E610_SGMII), board_e610},
  143	/* required last entry */
  144	{0, }
  145};
  146MODULE_DEVICE_TABLE(pci, ixgbe_pci_tbl);
  147
  148#ifdef CONFIG_IXGBE_DCA
  149static int ixgbe_notify_dca(struct notifier_block *, unsigned long event,
  150			    void *p);
  151static struct notifier_block dca_notifier = {
  152	.notifier_call = ixgbe_notify_dca,
  153	.next          = NULL,
  154	.priority      = 0
  155};
  156#endif
  157
  158#ifdef CONFIG_PCI_IOV
  159static unsigned int max_vfs;
  160module_param(max_vfs, uint, 0);
  161MODULE_PARM_DESC(max_vfs,
  162		 "Maximum number of virtual functions to allocate per physical function - default is zero and maximum value is 63. (Deprecated)");
  163#endif /* CONFIG_PCI_IOV */
  164
  165static bool allow_unsupported_sfp;
  166module_param(allow_unsupported_sfp, bool, 0444);
  167MODULE_PARM_DESC(allow_unsupported_sfp,
  168		 "Allow unsupported and untested SFP+ modules on 82599-based adapters");
  169
  170#define DEFAULT_MSG_ENABLE (NETIF_MSG_DRV|NETIF_MSG_PROBE|NETIF_MSG_LINK)
  171static int debug = -1;
  172module_param(debug, int, 0);
  173MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)");
  174
  175MODULE_IMPORT_NS("LIBIE_FWLOG");
  176MODULE_DESCRIPTION("Intel(R) 10 Gigabit PCI Express Network Driver");
  177MODULE_LICENSE("GPL v2");
  178
  179DEFINE_STATIC_KEY_FALSE(ixgbe_xdp_locking_key);
  180EXPORT_SYMBOL(ixgbe_xdp_locking_key);
  181
  182static struct workqueue_struct *ixgbe_wq;
  183
  184static bool ixgbe_check_cfg_remove(struct ixgbe_hw *hw, struct pci_dev *pdev);
  185static void ixgbe_watchdog_link_is_down(struct ixgbe_adapter *);
  186static void ixgbe_watchdog_link_is_up(struct ixgbe_adapter *);
  187static void ixgbe_watchdog_update_link(struct ixgbe_adapter *);
  188
  189static const struct net_device_ops ixgbe_netdev_ops;
  190
  191static bool netif_is_ixgbe(struct net_device *dev)
  192{
  193	return dev && (dev->netdev_ops == &ixgbe_netdev_ops);
  194}
  195
  196static int ixgbe_read_pci_cfg_word_parent(struct ixgbe_adapter *adapter,
  197					  u32 reg, u16 *value)
  198{
  199	struct pci_dev *parent_dev;
  200	struct pci_bus *parent_bus;
  201
  202	parent_bus = adapter->pdev->bus->parent;
  203	if (!parent_bus)
  204		return -1;
  205
  206	parent_dev = parent_bus->self;
  207	if (!parent_dev)
  208		return -1;
  209
  210	if (!pci_is_pcie(parent_dev))
  211		return -1;
  212
  213	pcie_capability_read_word(parent_dev, reg, value);
  214	if (*value == IXGBE_FAILED_READ_CFG_WORD &&
  215	    ixgbe_check_cfg_remove(&adapter->hw, parent_dev))
  216		return -1;
  217	return 0;
  218}
  219
  220static int ixgbe_get_parent_bus_info(struct ixgbe_adapter *adapter)
  221{
  222	struct ixgbe_hw *hw = &adapter->hw;
  223	u16 link_status = 0;
  224	int err;
  225
  226	hw->bus.type = ixgbe_bus_type_pci_express;
  227
  228	/* Get the negotiated link width and speed from PCI config space of the
  229	 * parent, as this device is behind a switch
  230	 */
  231	err = ixgbe_read_pci_cfg_word_parent(adapter, 18, &link_status);
  232
  233	/* assume caller will handle error case */
  234	if (err)
  235		return err;
  236
  237	hw->bus.width = ixgbe_convert_bus_width(link_status);
  238	hw->bus.speed = ixgbe_convert_bus_speed(link_status);
  239
  240	return 0;
  241}
  242
  243/**
  244 * ixgbe_pcie_from_parent - Determine whether PCIe info should come from parent
  245 * @hw: hw specific details
  246 *
  247 * This function is used by probe to determine whether a device's PCI-Express
  248 * bandwidth details should be gathered from the parent bus instead of from the
  249 * device. Used to ensure that various locations all have the correct device ID
  250 * checks.
  251 *
  252 * Return: true if information should be collected from the parent bus, false
  253 *         otherwise
  254 */
  255static bool ixgbe_pcie_from_parent(struct ixgbe_hw *hw)
  256{
  257	switch (hw->device_id) {
  258	case IXGBE_DEV_ID_82599_SFP_SF_QP:
  259	case IXGBE_DEV_ID_82599_QSFP_SF_QP:
  260		return true;
  261	default:
  262		return false;
  263	}
  264}
  265
  266static void ixgbe_check_minimum_link(struct ixgbe_adapter *adapter,
  267				     int expected_gts)
  268{
  269	struct ixgbe_hw *hw = &adapter->hw;
  270	struct pci_dev *pdev;
  271
  272	/* Some devices are not connected over PCIe and thus do not negotiate
  273	 * speed. These devices do not have valid bus info, and thus any report
  274	 * we generate may not be correct.
  275	 */
  276	if (hw->bus.type == ixgbe_bus_type_internal)
  277		return;
  278
  279	/* determine whether to use the parent device */
  280	if (ixgbe_pcie_from_parent(&adapter->hw))
  281		pdev = adapter->pdev->bus->parent->self;
  282	else
  283		pdev = adapter->pdev;
  284
  285	pcie_print_link_status(pdev);
  286}
  287
  288static void ixgbe_service_event_schedule(struct ixgbe_adapter *adapter)
  289{
  290	if (!test_bit(__IXGBE_DOWN, &adapter->state) &&
  291	    !test_bit(__IXGBE_REMOVING, &adapter->state) &&
  292	    !test_and_set_bit(__IXGBE_SERVICE_SCHED, &adapter->state))
  293		queue_work(ixgbe_wq, &adapter->service_task);
  294}
  295
  296static void ixgbe_remove_adapter(struct ixgbe_hw *hw)
  297{
  298	struct ixgbe_adapter *adapter = hw->back;
  299
  300	if (!hw->hw_addr)
  301		return;
  302	hw->hw_addr = NULL;
  303	e_dev_err("Adapter removed\n");
  304	if (test_bit(__IXGBE_SERVICE_INITED, &adapter->state))
  305		ixgbe_service_event_schedule(adapter);
  306}
  307
  308static u32 ixgbe_check_remove(struct ixgbe_hw *hw, u32 reg)
  309{
  310	u8 __iomem *reg_addr;
  311	u32 value;
  312	int i;
  313
  314	reg_addr = READ_ONCE(hw->hw_addr);
  315	if (ixgbe_removed(reg_addr))
  316		return IXGBE_FAILED_READ_REG;
  317
  318	/* Register read of 0xFFFFFFF can indicate the adapter has been removed,
  319	 * so perform several status register reads to determine if the adapter
  320	 * has been removed.
  321	 */
  322	for (i = 0; i < IXGBE_FAILED_READ_RETRIES; i++) {
  323		value = readl(reg_addr + IXGBE_STATUS);
  324		if (value != IXGBE_FAILED_READ_REG)
  325			break;
  326		mdelay(3);
  327	}
  328
  329	if (value == IXGBE_FAILED_READ_REG)
  330		ixgbe_remove_adapter(hw);
  331	else
  332		value = readl(reg_addr + reg);
  333	return value;
  334}
  335
  336/**
  337 * ixgbe_read_reg - Read from device register
  338 * @hw: hw specific details
  339 * @reg: offset of register to read
  340 *
  341 * Returns : value read or IXGBE_FAILED_READ_REG if removed
  342 *
  343 * This function is used to read device registers. It checks for device
  344 * removal by confirming any read that returns all ones by checking the
  345 * status register value for all ones. This function avoids reading from
  346 * the hardware if a removal was previously detected in which case it
  347 * returns IXGBE_FAILED_READ_REG (all ones).
  348 */
  349u32 ixgbe_read_reg(struct ixgbe_hw *hw, u32 reg)
  350{
  351	u8 __iomem *reg_addr = READ_ONCE(hw->hw_addr);
  352	u32 value;
  353
  354	if (ixgbe_removed(reg_addr))
  355		return IXGBE_FAILED_READ_REG;
  356	if (unlikely(hw->phy.nw_mng_if_sel &
  357		     IXGBE_NW_MNG_IF_SEL_SGMII_ENABLE)) {
  358		struct ixgbe_adapter *adapter;
  359		int i;
  360
  361		for (i = 0; i < 200; ++i) {
  362			value = readl(reg_addr + IXGBE_MAC_SGMII_BUSY);
  363			if (likely(!value))
  364				goto writes_completed;
  365			if (value == IXGBE_FAILED_READ_REG) {
  366				ixgbe_remove_adapter(hw);
  367				return IXGBE_FAILED_READ_REG;
  368			}
  369			udelay(5);
  370		}
  371
  372		adapter = hw->back;
  373		e_warn(hw, "register writes incomplete %08x\n", value);
  374	}
  375
  376writes_completed:
  377	value = readl(reg_addr + reg);
  378	if (unlikely(value == IXGBE_FAILED_READ_REG))
  379		value = ixgbe_check_remove(hw, reg);
  380	return value;
  381}
  382
  383static bool ixgbe_check_cfg_remove(struct ixgbe_hw *hw, struct pci_dev *pdev)
  384{
  385	u16 value;
  386
  387	pci_read_config_word(pdev, PCI_VENDOR_ID, &value);
  388	if (value == IXGBE_FAILED_READ_CFG_WORD) {
  389		ixgbe_remove_adapter(hw);
  390		return true;
  391	}
  392	return false;
  393}
  394
  395u16 ixgbe_read_pci_cfg_word(struct ixgbe_hw *hw, u32 reg)
  396{
  397	struct ixgbe_adapter *adapter = hw->back;
  398	u16 value;
  399
  400	if (ixgbe_removed(hw->hw_addr))
  401		return IXGBE_FAILED_READ_CFG_WORD;
  402	pci_read_config_word(adapter->pdev, reg, &value);
  403	if (value == IXGBE_FAILED_READ_CFG_WORD &&
  404	    ixgbe_check_cfg_remove(hw, adapter->pdev))
  405		return IXGBE_FAILED_READ_CFG_WORD;
  406	return value;
  407}
  408
  409#ifdef CONFIG_PCI_IOV
  410static u32 ixgbe_read_pci_cfg_dword(struct ixgbe_hw *hw, u32 reg)
  411{
  412	struct ixgbe_adapter *adapter = hw->back;
  413	u32 value;
  414
  415	if (ixgbe_removed(hw->hw_addr))
  416		return IXGBE_FAILED_READ_CFG_DWORD;
  417	pci_read_config_dword(adapter->pdev, reg, &value);
  418	if (value == IXGBE_FAILED_READ_CFG_DWORD &&
  419	    ixgbe_check_cfg_remove(hw, adapter->pdev))
  420		return IXGBE_FAILED_READ_CFG_DWORD;
  421	return value;
  422}
  423#endif /* CONFIG_PCI_IOV */
  424
  425void ixgbe_write_pci_cfg_word(struct ixgbe_hw *hw, u32 reg, u16 value)
  426{
  427	struct ixgbe_adapter *adapter = hw->back;
  428
  429	if (ixgbe_removed(hw->hw_addr))
  430		return;
  431	pci_write_config_word(adapter->pdev, reg, value);
  432}
  433
  434static void ixgbe_service_event_complete(struct ixgbe_adapter *adapter)
  435{
  436	BUG_ON(!test_bit(__IXGBE_SERVICE_SCHED, &adapter->state));
  437
  438	/* flush memory to make sure state is correct before next watchdog */
  439	smp_mb__before_atomic();
  440	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
  441}
  442
  443struct ixgbe_reg_info {
  444	u32 ofs;
  445	char *name;
  446};
  447
  448static const struct ixgbe_reg_info ixgbe_reg_info_tbl[] = {
  449
  450	/* General Registers */
  451	{IXGBE_CTRL, "CTRL"},
  452	{IXGBE_STATUS, "STATUS"},
  453	{IXGBE_CTRL_EXT, "CTRL_EXT"},
  454
  455	/* Interrupt Registers */
  456	{IXGBE_EICR, "EICR"},
  457
  458	/* RX Registers */
  459	{IXGBE_SRRCTL(0), "SRRCTL"},
  460	{IXGBE_DCA_RXCTRL(0), "DRXCTL"},
  461	{IXGBE_RDLEN(0), "RDLEN"},
  462	{IXGBE_RDH(0), "RDH"},
  463	{IXGBE_RDT(0), "RDT"},
  464	{IXGBE_RXDCTL(0), "RXDCTL"},
  465	{IXGBE_RDBAL(0), "RDBAL"},
  466	{IXGBE_RDBAH(0), "RDBAH"},
  467
  468	/* TX Registers */
  469	{IXGBE_TDBAL(0), "TDBAL"},
  470	{IXGBE_TDBAH(0), "TDBAH"},
  471	{IXGBE_TDLEN(0), "TDLEN"},
  472	{IXGBE_TDH(0), "TDH"},
  473	{IXGBE_TDT(0), "TDT"},
  474	{IXGBE_TXDCTL(0), "TXDCTL"},
  475
  476	/* List Terminator */
  477	{ .name = NULL }
  478};
  479
  480
  481/*
  482 * ixgbe_regdump - register printout routine
  483 */
  484static void ixgbe_regdump(struct ixgbe_hw *hw, struct ixgbe_reg_info *reginfo)
  485{
  486	int i;
  487	char rname[16];
  488	u32 regs[64];
  489
  490	switch (reginfo->ofs) {
  491	case IXGBE_SRRCTL(0):
  492		for (i = 0; i < 64; i++)
  493			regs[i] = IXGBE_READ_REG(hw, IXGBE_SRRCTL(i));
  494		break;
  495	case IXGBE_DCA_RXCTRL(0):
  496		for (i = 0; i < 64; i++)
  497			regs[i] = IXGBE_READ_REG(hw, IXGBE_DCA_RXCTRL(i));
  498		break;
  499	case IXGBE_RDLEN(0):
  500		for (i = 0; i < 64; i++)
  501			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDLEN(i));
  502		break;
  503	case IXGBE_RDH(0):
  504		for (i = 0; i < 64; i++)
  505			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDH(i));
  506		break;
  507	case IXGBE_RDT(0):
  508		for (i = 0; i < 64; i++)
  509			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDT(i));
  510		break;
  511	case IXGBE_RXDCTL(0):
  512		for (i = 0; i < 64; i++)
  513			regs[i] = IXGBE_READ_REG(hw, IXGBE_RXDCTL(i));
  514		break;
  515	case IXGBE_RDBAL(0):
  516		for (i = 0; i < 64; i++)
  517			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDBAL(i));
  518		break;
  519	case IXGBE_RDBAH(0):
  520		for (i = 0; i < 64; i++)
  521			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDBAH(i));
  522		break;
  523	case IXGBE_TDBAL(0):
  524		for (i = 0; i < 64; i++)
  525			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDBAL(i));
  526		break;
  527	case IXGBE_TDBAH(0):
  528		for (i = 0; i < 64; i++)
  529			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDBAH(i));
  530		break;
  531	case IXGBE_TDLEN(0):
  532		for (i = 0; i < 64; i++)
  533			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDLEN(i));
  534		break;
  535	case IXGBE_TDH(0):
  536		for (i = 0; i < 64; i++)
  537			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDH(i));
  538		break;
  539	case IXGBE_TDT(0):
  540		for (i = 0; i < 64; i++)
  541			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDT(i));
  542		break;
  543	case IXGBE_TXDCTL(0):
  544		for (i = 0; i < 64; i++)
  545			regs[i] = IXGBE_READ_REG(hw, IXGBE_TXDCTL(i));
  546		break;
  547	default:
  548		pr_info("%-15s %08x\n",
  549			reginfo->name, IXGBE_READ_REG(hw, reginfo->ofs));
  550		return;
  551	}
  552
  553	i = 0;
  554	while (i < 64) {
  555		int j;
  556		char buf[9 * 8 + 1];
  557		char *p = buf;
  558
  559		snprintf(rname, 16, "%s[%d-%d]", reginfo->name, i, i + 7);
  560		for (j = 0; j < 8; j++)
  561			p += sprintf(p, " %08x", regs[i++]);
  562		pr_err("%-15s%s\n", rname, buf);
  563	}
  564
  565}
  566
  567static void ixgbe_print_buffer(struct ixgbe_ring *ring, int n)
  568{
  569	struct ixgbe_tx_buffer *tx_buffer;
  570
  571	tx_buffer = &ring->tx_buffer_info[ring->next_to_clean];
  572	pr_info(" %5d %5X %5X %016llX %08X %p %016llX\n",
  573		n, ring->next_to_use, ring->next_to_clean,
  574		(u64)dma_unmap_addr(tx_buffer, dma),
  575		dma_unmap_len(tx_buffer, len),
  576		tx_buffer->next_to_watch,
  577		(u64)tx_buffer->time_stamp);
  578}
  579
  580/*
  581 * ixgbe_dump - Print registers, tx-rings and rx-rings
  582 */
  583static void ixgbe_dump(struct ixgbe_adapter *adapter)
  584{
  585	struct net_device *netdev = adapter->netdev;
  586	struct ixgbe_hw *hw = &adapter->hw;
  587	struct ixgbe_reg_info *reginfo;
  588	int n = 0;
  589	struct ixgbe_ring *ring;
  590	struct ixgbe_tx_buffer *tx_buffer;
  591	union ixgbe_adv_tx_desc *tx_desc;
  592	struct my_u0 { u64 a; u64 b; } *u0;
  593	struct ixgbe_ring *rx_ring;
  594	union ixgbe_adv_rx_desc *rx_desc;
  595	struct ixgbe_rx_buffer *rx_buffer_info;
  596	int i = 0;
  597
  598	if (!netif_msg_hw(adapter))
  599		return;
  600
  601	/* Print netdevice Info */
  602	if (netdev) {
  603		dev_info(&adapter->pdev->dev, "Net device Info\n");
  604		pr_info("Device Name     state            "
  605			"trans_start\n");
  606		pr_info("%-15s %016lX %016lX\n",
  607			netdev->name,
  608			netdev->state,
  609			dev_trans_start(netdev));
  610	}
  611
  612	/* Print Registers */
  613	dev_info(&adapter->pdev->dev, "Register Dump\n");
  614	pr_info(" Register Name   Value\n");
  615	for (reginfo = (struct ixgbe_reg_info *)ixgbe_reg_info_tbl;
  616	     reginfo->name; reginfo++) {
  617		ixgbe_regdump(hw, reginfo);
  618	}
  619
  620	/* Print TX Ring Summary */
  621	if (!netdev || !netif_running(netdev))
  622		return;
  623
  624	dev_info(&adapter->pdev->dev, "TX Rings Summary\n");
  625	pr_info(" %s     %s              %s        %s\n",
  626		"Queue [NTU] [NTC] [bi(ntc)->dma  ]",
  627		"leng", "ntw", "timestamp");
  628	for (n = 0; n < adapter->num_tx_queues; n++) {
  629		ring = adapter->tx_ring[n];
  630		ixgbe_print_buffer(ring, n);
  631	}
  632
  633	for (n = 0; n < adapter->num_xdp_queues; n++) {
  634		ring = adapter->xdp_ring[n];
  635		ixgbe_print_buffer(ring, n);
  636	}
  637
  638	/* Print TX Rings */
  639	if (!netif_msg_tx_done(adapter))
  640		goto rx_ring_summary;
  641
  642	dev_info(&adapter->pdev->dev, "TX Rings Dump\n");
  643
  644	/* Transmit Descriptor Formats
  645	 *
  646	 * 82598 Advanced Transmit Descriptor
  647	 *   +--------------------------------------------------------------+
  648	 * 0 |         Buffer Address [63:0]                                |
  649	 *   +--------------------------------------------------------------+
  650	 * 8 |  PAYLEN  | POPTS  | IDX | STA | DCMD  |DTYP |  RSV |  DTALEN |
  651	 *   +--------------------------------------------------------------+
  652	 *   63       46 45    40 39 36 35 32 31   24 23 20 19              0
  653	 *
  654	 * 82598 Advanced Transmit Descriptor (Write-Back Format)
  655	 *   +--------------------------------------------------------------+
  656	 * 0 |                          RSV [63:0]                          |
  657	 *   +--------------------------------------------------------------+
  658	 * 8 |            RSV           |  STA  |          NXTSEQ           |
  659	 *   +--------------------------------------------------------------+
  660	 *   63                       36 35   32 31                         0
  661	 *
  662	 * 82599+ Advanced Transmit Descriptor
  663	 *   +--------------------------------------------------------------+
  664	 * 0 |         Buffer Address [63:0]                                |
  665	 *   +--------------------------------------------------------------+
  666	 * 8 |PAYLEN  |POPTS|CC|IDX  |STA  |DCMD  |DTYP |MAC  |RSV  |DTALEN |
  667	 *   +--------------------------------------------------------------+
  668	 *   63     46 45 40 39 38 36 35 32 31  24 23 20 19 18 17 16 15     0
  669	 *
  670	 * 82599+ Advanced Transmit Descriptor (Write-Back Format)
  671	 *   +--------------------------------------------------------------+
  672	 * 0 |                          RSV [63:0]                          |
  673	 *   +--------------------------------------------------------------+
  674	 * 8 |            RSV           |  STA  |           RSV             |
  675	 *   +--------------------------------------------------------------+
  676	 *   63                       36 35   32 31                         0
  677	 */
  678
  679	for (n = 0; n < adapter->num_tx_queues; n++) {
  680		ring = adapter->tx_ring[n];
  681		pr_info("------------------------------------\n");
  682		pr_info("TX QUEUE INDEX = %d\n", ring->queue_index);
  683		pr_info("------------------------------------\n");
  684		pr_info("%s%s    %s              %s        %s          %s\n",
  685			"T [desc]     [address 63:0  ] ",
  686			"[PlPOIdStDDt Ln] [bi->dma       ] ",
  687			"leng", "ntw", "timestamp", "bi->skb");
  688
  689		for (i = 0; ring->desc && (i < ring->count); i++) {
  690			tx_desc = IXGBE_TX_DESC(ring, i);
  691			tx_buffer = &ring->tx_buffer_info[i];
  692			u0 = (struct my_u0 *)tx_desc;
  693			if (dma_unmap_len(tx_buffer, len) > 0) {
  694				const char *ring_desc;
  695
  696				if (i == ring->next_to_use &&
  697				    i == ring->next_to_clean)
  698					ring_desc = " NTC/U";
  699				else if (i == ring->next_to_use)
  700					ring_desc = " NTU";
  701				else if (i == ring->next_to_clean)
  702					ring_desc = " NTC";
  703				else
  704					ring_desc = "";
  705				pr_info("T [0x%03X]    %016llX %016llX %016llX %08X %p %016llX %p%s",
  706					i,
  707					le64_to_cpu((__force __le64)u0->a),
  708					le64_to_cpu((__force __le64)u0->b),
  709					(u64)dma_unmap_addr(tx_buffer, dma),
  710					dma_unmap_len(tx_buffer, len),
  711					tx_buffer->next_to_watch,
  712					(u64)tx_buffer->time_stamp,
  713					tx_buffer->skb,
  714					ring_desc);
  715
  716				if (netif_msg_pktdata(adapter) &&
  717				    tx_buffer->skb)
  718					print_hex_dump(KERN_INFO, "",
  719						DUMP_PREFIX_ADDRESS, 16, 1,
  720						tx_buffer->skb->data,
  721						dma_unmap_len(tx_buffer, len),
  722						true);
  723			}
  724		}
  725	}
  726
  727	/* Print RX Rings Summary */
  728rx_ring_summary:
  729	dev_info(&adapter->pdev->dev, "RX Rings Summary\n");
  730	pr_info("Queue [NTU] [NTC]\n");
  731	for (n = 0; n < adapter->num_rx_queues; n++) {
  732		rx_ring = adapter->rx_ring[n];
  733		pr_info("%5d %5X %5X\n",
  734			n, rx_ring->next_to_use, rx_ring->next_to_clean);
  735	}
  736
  737	/* Print RX Rings */
  738	if (!netif_msg_rx_status(adapter))
  739		return;
  740
  741	dev_info(&adapter->pdev->dev, "RX Rings Dump\n");
  742
  743	/* Receive Descriptor Formats
  744	 *
  745	 * 82598 Advanced Receive Descriptor (Read) Format
  746	 *    63                                           1        0
  747	 *    +-----------------------------------------------------+
  748	 *  0 |       Packet Buffer Address [63:1]           |A0/NSE|
  749	 *    +----------------------------------------------+------+
  750	 *  8 |       Header Buffer Address [63:1]           |  DD  |
  751	 *    +-----------------------------------------------------+
  752	 *
  753	 *
  754	 * 82598 Advanced Receive Descriptor (Write-Back) Format
  755	 *
  756	 *   63       48 47    32 31  30      21 20 16 15   4 3     0
  757	 *   +------------------------------------------------------+
  758	 * 0 |       RSS Hash /  |SPH| HDR_LEN  | RSV |Packet|  RSS |
  759	 *   | Packet   | IP     |   |          |     | Type | Type |
  760	 *   | Checksum | Ident  |   |          |     |      |      |
  761	 *   +------------------------------------------------------+
  762	 * 8 | VLAN Tag | Length | Extended Error | Extended Status |
  763	 *   +------------------------------------------------------+
  764	 *   63       48 47    32 31            20 19               0
  765	 *
  766	 * 82599+ Advanced Receive Descriptor (Read) Format
  767	 *    63                                           1        0
  768	 *    +-----------------------------------------------------+
  769	 *  0 |       Packet Buffer Address [63:1]           |A0/NSE|
  770	 *    +----------------------------------------------+------+
  771	 *  8 |       Header Buffer Address [63:1]           |  DD  |
  772	 *    +-----------------------------------------------------+
  773	 *
  774	 *
  775	 * 82599+ Advanced Receive Descriptor (Write-Back) Format
  776	 *
  777	 *   63       48 47    32 31  30      21 20 17 16   4 3     0
  778	 *   +------------------------------------------------------+
  779	 * 0 |RSS / Frag Checksum|SPH| HDR_LEN  |RSC- |Packet|  RSS |
  780	 *   |/ RTT / PCoE_PARAM |   |          | CNT | Type | Type |
  781	 *   |/ Flow Dir Flt ID  |   |          |     |      |      |
  782	 *   +------------------------------------------------------+
  783	 * 8 | VLAN Tag | Length |Extended Error| Xtnd Status/NEXTP |
  784	 *   +------------------------------------------------------+
  785	 *   63       48 47    32 31          20 19                 0
  786	 */
  787
  788	for (n = 0; n < adapter->num_rx_queues; n++) {
  789		rx_ring = adapter->rx_ring[n];
  790		pr_info("------------------------------------\n");
  791		pr_info("RX QUEUE INDEX = %d\n", rx_ring->queue_index);
  792		pr_info("------------------------------------\n");
  793		pr_info("%s%s%s\n",
  794			"R  [desc]      [ PktBuf     A0] ",
  795			"[  HeadBuf   DD] [bi->dma       ] [bi->skb       ] ",
  796			"<-- Adv Rx Read format");
  797		pr_info("%s%s%s\n",
  798			"RWB[desc]      [PcsmIpSHl PtRs] ",
  799			"[vl er S cks ln] ---------------- [bi->skb       ] ",
  800			"<-- Adv Rx Write-Back format");
  801
  802		for (i = 0; i < rx_ring->count; i++) {
  803			const char *ring_desc;
  804
  805			if (i == rx_ring->next_to_use)
  806				ring_desc = " NTU";
  807			else if (i == rx_ring->next_to_clean)
  808				ring_desc = " NTC";
  809			else
  810				ring_desc = "";
  811
  812			rx_buffer_info = &rx_ring->rx_buffer_info[i];
  813			rx_desc = IXGBE_RX_DESC(rx_ring, i);
  814			u0 = (struct my_u0 *)rx_desc;
  815			if (rx_desc->wb.upper.length) {
  816				/* Descriptor Done */
  817				pr_info("RWB[0x%03X]     %016llX %016llX ---------------- %p%s\n",
  818					i,
  819					le64_to_cpu((__force __le64)u0->a),
  820					le64_to_cpu((__force __le64)u0->b),
  821					rx_buffer_info->skb,
  822					ring_desc);
  823			} else {
  824				pr_info("R  [0x%03X]     %016llX %016llX %016llX %p%s\n",
  825					i,
  826					le64_to_cpu((__force __le64)u0->a),
  827					le64_to_cpu((__force __le64)u0->b),
  828					(u64)rx_buffer_info->dma,
  829					rx_buffer_info->skb,
  830					ring_desc);
  831
  832				if (netif_msg_pktdata(adapter) &&
  833				    rx_buffer_info->dma) {
  834					print_hex_dump(KERN_INFO, "",
  835					   DUMP_PREFIX_ADDRESS, 16, 1,
  836					   page_address(rx_buffer_info->page) +
  837						    rx_buffer_info->page_offset,
  838					   ixgbe_rx_bufsz(rx_ring), true);
  839				}
  840			}
  841		}
  842	}
  843}
  844
  845static void ixgbe_release_hw_control(struct ixgbe_adapter *adapter)
  846{
  847	u32 ctrl_ext;
  848
  849	/* Let firmware take over control of h/w */
  850	ctrl_ext = IXGBE_READ_REG(&adapter->hw, IXGBE_CTRL_EXT);
  851	IXGBE_WRITE_REG(&adapter->hw, IXGBE_CTRL_EXT,
  852			ctrl_ext & ~IXGBE_CTRL_EXT_DRV_LOAD);
  853}
  854
  855static void ixgbe_get_hw_control(struct ixgbe_adapter *adapter)
  856{
  857	u32 ctrl_ext;
  858
  859	/* Let firmware know the driver has taken over */
  860	ctrl_ext = IXGBE_READ_REG(&adapter->hw, IXGBE_CTRL_EXT);
  861	IXGBE_WRITE_REG(&adapter->hw, IXGBE_CTRL_EXT,
  862			ctrl_ext | IXGBE_CTRL_EXT_DRV_LOAD);
  863}
  864
  865/**
  866 * ixgbe_set_ivar - set the IVAR registers, mapping interrupt causes to vectors
  867 * @adapter: pointer to adapter struct
  868 * @direction: 0 for Rx, 1 for Tx, -1 for other causes
  869 * @queue: queue to map the corresponding interrupt to
  870 * @msix_vector: the vector to map to the corresponding queue
  871 *
  872 */
  873static void ixgbe_set_ivar(struct ixgbe_adapter *adapter, s8 direction,
  874			   u8 queue, u8 msix_vector)
  875{
  876	u32 ivar, index;
  877	struct ixgbe_hw *hw = &adapter->hw;
  878	switch (hw->mac.type) {
  879	case ixgbe_mac_82598EB:
  880		msix_vector |= IXGBE_IVAR_ALLOC_VAL;
  881		if (direction == -1)
  882			direction = 0;
  883		index = (((direction * 64) + queue) >> 2) & 0x1F;
  884		ivar = IXGBE_READ_REG(hw, IXGBE_IVAR(index));
  885		ivar &= ~(0xFF << (8 * (queue & 0x3)));
  886		ivar |= (msix_vector << (8 * (queue & 0x3)));
  887		IXGBE_WRITE_REG(hw, IXGBE_IVAR(index), ivar);
  888		break;
  889	case ixgbe_mac_82599EB:
  890	case ixgbe_mac_X540:
  891	case ixgbe_mac_X550:
  892	case ixgbe_mac_X550EM_x:
  893	case ixgbe_mac_x550em_a:
  894	case ixgbe_mac_e610:
  895		if (direction == -1) {
  896			/* other causes */
  897			msix_vector |= IXGBE_IVAR_ALLOC_VAL;
  898			index = ((queue & 1) * 8);
  899			ivar = IXGBE_READ_REG(&adapter->hw, IXGBE_IVAR_MISC);
  900			ivar &= ~(0xFF << index);
  901			ivar |= (msix_vector << index);
  902			IXGBE_WRITE_REG(&adapter->hw, IXGBE_IVAR_MISC, ivar);
  903			break;
  904		} else {
  905			/* tx or rx causes */
  906			msix_vector |= IXGBE_IVAR_ALLOC_VAL;
  907			index = ((16 * (queue & 1)) + (8 * direction));
  908			ivar = IXGBE_READ_REG(hw, IXGBE_IVAR(queue >> 1));
  909			ivar &= ~(0xFF << index);
  910			ivar |= (msix_vector << index);
  911			IXGBE_WRITE_REG(hw, IXGBE_IVAR(queue >> 1), ivar);
  912			break;
  913		}
  914	default:
  915		break;
  916	}
  917}
  918
  919void ixgbe_irq_rearm_queues(struct ixgbe_adapter *adapter,
  920			    u64 qmask)
  921{
  922	u32 mask;
  923
  924	switch (adapter->hw.mac.type) {
  925	case ixgbe_mac_82598EB:
  926		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
  927		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS, mask);
  928		break;
  929	case ixgbe_mac_82599EB:
  930	case ixgbe_mac_X540:
  931	case ixgbe_mac_X550:
  932	case ixgbe_mac_X550EM_x:
  933	case ixgbe_mac_x550em_a:
  934	case ixgbe_mac_e610:
  935		mask = (qmask & 0xFFFFFFFF);
  936		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS_EX(0), mask);
  937		mask = (qmask >> 32);
  938		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS_EX(1), mask);
  939		break;
  940	default:
  941		break;
  942	}
  943}
  944
  945static void ixgbe_update_xoff_rx_lfc(struct ixgbe_adapter *adapter)
  946{
  947	struct ixgbe_hw *hw = &adapter->hw;
  948	struct ixgbe_hw_stats *hwstats = &adapter->stats;
  949	int i;
  950	u32 data;
  951
  952	if ((hw->fc.current_mode != ixgbe_fc_full) &&
  953	    (hw->fc.current_mode != ixgbe_fc_rx_pause))
  954		return;
  955
  956	switch (hw->mac.type) {
  957	case ixgbe_mac_82598EB:
  958		data = IXGBE_READ_REG(hw, IXGBE_LXOFFRXC);
  959		break;
  960	default:
  961		data = IXGBE_READ_REG(hw, IXGBE_LXOFFRXCNT);
  962	}
  963	hwstats->lxoffrxc += data;
  964
  965	/* refill credits (no tx hang) if we received xoff */
  966	if (!data)
  967		return;
  968
  969	for (i = 0; i < adapter->num_tx_queues; i++)
  970		clear_bit(__IXGBE_HANG_CHECK_ARMED,
  971			  &adapter->tx_ring[i]->state);
  972}
  973
  974static void ixgbe_update_xoff_received(struct ixgbe_adapter *adapter)
  975{
  976	struct ixgbe_hw *hw = &adapter->hw;
  977	struct ixgbe_hw_stats *hwstats = &adapter->stats;
  978	u32 xoff[8] = {0};
  979	u8 tc;
  980	int i;
  981	bool pfc_en = adapter->dcb_cfg.pfc_mode_enable;
  982
  983	if (adapter->ixgbe_ieee_pfc)
  984		pfc_en |= !!(adapter->ixgbe_ieee_pfc->pfc_en);
  985
  986	if (!(adapter->flags & IXGBE_FLAG_DCB_ENABLED) || !pfc_en) {
  987		ixgbe_update_xoff_rx_lfc(adapter);
  988		return;
  989	}
  990
  991	/* update stats for each tc, only valid with PFC enabled */
  992	for (i = 0; i < MAX_TX_PACKET_BUFFERS; i++) {
  993		u32 pxoffrxc;
  994
  995		switch (hw->mac.type) {
  996		case ixgbe_mac_82598EB:
  997			pxoffrxc = IXGBE_READ_REG(hw, IXGBE_PXOFFRXC(i));
  998			break;
  999		default:
 1000			pxoffrxc = IXGBE_READ_REG(hw, IXGBE_PXOFFRXCNT(i));
 1001		}
 1002		hwstats->pxoffrxc[i] += pxoffrxc;
 1003		/* Get the TC for given UP */
 1004		tc = netdev_get_prio_tc_map(adapter->netdev, i);
 1005		xoff[tc] += pxoffrxc;
 1006	}
 1007
 1008	/* disarm tx queues that have received xoff frames */
 1009	for (i = 0; i < adapter->num_tx_queues; i++) {
 1010		struct ixgbe_ring *tx_ring = adapter->tx_ring[i];
 1011
 1012		tc = tx_ring->dcb_tc;
 1013		if (xoff[tc])
 1014			clear_bit(__IXGBE_HANG_CHECK_ARMED, &tx_ring->state);
 1015	}
 1016
 1017	for (i = 0; i < adapter->num_xdp_queues; i++) {
 1018		struct ixgbe_ring *xdp_ring = adapter->xdp_ring[i];
 1019
 1020		tc = xdp_ring->dcb_tc;
 1021		if (xoff[tc])
 1022			clear_bit(__IXGBE_HANG_CHECK_ARMED, &xdp_ring->state);
 1023	}
 1024}
 1025
 1026static u64 ixgbe_get_tx_completed(struct ixgbe_ring *ring)
 1027{
 1028	return ring->stats.packets;
 1029}
 1030
 1031static u64 ixgbe_get_tx_pending(struct ixgbe_ring *ring)
 1032{
 1033	unsigned int head, tail;
 1034
 1035	head = ring->next_to_clean;
 1036	tail = ring->next_to_use;
 1037
 1038	return ((head <= tail) ? tail : tail + ring->count) - head;
 1039}
 1040
 1041/**
 1042 * ixgbe_get_vf_idx - provide VF index number based on queue index
 1043 * @adapter: pointer to the adapter struct
 1044 * @queue: Tx queue identifier
 1045 * @vf: output VF index
 1046 *
 1047 * Provide VF index number associated to the input queue.
 1048 *
 1049 * Returns: 0 if VF provided or error number.
 1050 */
 1051static int ixgbe_get_vf_idx(struct ixgbe_adapter *adapter, u16 queue, u16 *vf)
 1052{
 1053	struct ixgbe_hw *hw = &adapter->hw;
 1054	u8 queue_count;
 1055	u32 reg;
 1056
 1057	if (queue >= adapter->num_tx_queues)
 1058		return -EINVAL;
 1059
 1060	/* Determine number of queues by checking
 1061	 * number of virtual functions
 1062	 */
 1063	reg = IXGBE_READ_REG(hw, IXGBE_GCR_EXT);
 1064	switch (reg & IXGBE_GCR_EXT_VT_MODE_MASK) {
 1065	case IXGBE_GCR_EXT_VT_MODE_64:
 1066		queue_count = IXGBE_64VFS_QUEUES;
 1067		break;
 1068	case IXGBE_GCR_EXT_VT_MODE_32:
 1069		queue_count = IXGBE_32VFS_QUEUES;
 1070		break;
 1071	case IXGBE_GCR_EXT_VT_MODE_16:
 1072		queue_count = IXGBE_16VFS_QUEUES;
 1073		break;
 1074	default:
 1075		return -EINVAL;
 1076	}
 1077
 1078	*vf = queue / queue_count;
 1079
 1080	return 0;
 1081}
 1082
 1083static bool ixgbe_check_tx_hang(struct ixgbe_ring *tx_ring)
 1084{
 1085	u32 tx_done = ixgbe_get_tx_completed(tx_ring);
 1086	u32 tx_done_old = tx_ring->tx_stats.tx_done_old;
 1087	u32 tx_pending = ixgbe_get_tx_pending(tx_ring);
 1088
 1089	clear_check_for_tx_hang(tx_ring);
 1090
 1091	/*
 1092	 * Check for a hung queue, but be thorough. This verifies
 1093	 * that a transmit has been completed since the previous
 1094	 * check AND there is at least one packet pending. The
 1095	 * ARMED bit is set to indicate a potential hang. The
 1096	 * bit is cleared if a pause frame is received to remove
 1097	 * false hang detection due to PFC or 802.3x frames. By
 1098	 * requiring this to fail twice we avoid races with
 1099	 * pfc clearing the ARMED bit and conditions where we
 1100	 * run the check_tx_hang logic with a transmit completion
 1101	 * pending but without time to complete it yet.
 1102	 */
 1103	if (tx_done_old == tx_done && tx_pending)
 1104		/* make sure it is true for two checks in a row */
 1105		return test_and_set_bit(__IXGBE_HANG_CHECK_ARMED,
 1106					&tx_ring->state);
 1107	/* update completed stats and continue */
 1108	tx_ring->tx_stats.tx_done_old = tx_done;
 1109	/* reset the countdown */
 1110	clear_bit(__IXGBE_HANG_CHECK_ARMED, &tx_ring->state);
 1111
 1112	return false;
 1113}
 1114
 1115/**
 1116 * ixgbe_tx_timeout_reset - initiate reset due to Tx timeout
 1117 * @adapter: driver private struct
 1118 **/
 1119static void ixgbe_tx_timeout_reset(struct ixgbe_adapter *adapter)
 1120{
 1121
 1122	/* Do the reset outside of interrupt context */
 1123	if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
 1124		set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
 1125		e_warn(drv, "initiating reset due to tx timeout\n");
 1126		ixgbe_service_event_schedule(adapter);
 1127	}
 1128}
 1129
 1130/**
 1131 * ixgbe_tx_maxrate - callback to set the maximum per-queue bitrate
 1132 * @netdev: network interface device structure
 1133 * @queue_index: Tx queue to set
 1134 * @maxrate: desired maximum transmit bitrate
 1135 **/
 1136static int ixgbe_tx_maxrate(struct net_device *netdev,
 1137			    int queue_index, u32 maxrate)
 1138{
 1139	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 1140	struct ixgbe_hw *hw = &adapter->hw;
 1141	u32 bcnrc_val = ixgbe_link_mbps(adapter);
 1142
 1143	if (!maxrate)
 1144		return 0;
 1145
 1146	/* Calculate the rate factor values to set */
 1147	bcnrc_val <<= IXGBE_RTTBCNRC_RF_INT_SHIFT;
 1148	bcnrc_val /= maxrate;
 1149
 1150	/* clear everything but the rate factor */
 1151	bcnrc_val &= IXGBE_RTTBCNRC_RF_INT_MASK |
 1152	IXGBE_RTTBCNRC_RF_DEC_MASK;
 1153
 1154	/* enable the rate scheduler */
 1155	bcnrc_val |= IXGBE_RTTBCNRC_RS_ENA;
 1156
 1157	IXGBE_WRITE_REG(hw, IXGBE_RTTDQSEL, queue_index);
 1158	IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRC, bcnrc_val);
 1159
 1160	return 0;
 1161}
 1162
 1163/**
 1164 * ixgbe_update_tx_ring_stats - Update Tx ring specific counters
 1165 * @tx_ring: ring to update
 1166 * @q_vector: queue vector ring belongs to
 1167 * @pkts: number of processed packets
 1168 * @bytes: number of processed bytes
 1169 */
 1170void ixgbe_update_tx_ring_stats(struct ixgbe_ring *tx_ring,
 1171				struct ixgbe_q_vector *q_vector, u64 pkts,
 1172				u64 bytes)
 1173{
 1174	u64_stats_update_begin(&tx_ring->syncp);
 1175	tx_ring->stats.bytes += bytes;
 1176	tx_ring->stats.packets += pkts;
 1177	u64_stats_update_end(&tx_ring->syncp);
 1178	q_vector->tx.total_bytes += bytes;
 1179	q_vector->tx.total_packets += pkts;
 1180}
 1181
 1182/**
 1183 * ixgbe_update_rx_ring_stats - Update Rx ring specific counters
 1184 * @rx_ring: ring to update
 1185 * @q_vector: queue vector ring belongs to
 1186 * @pkts: number of processed packets
 1187 * @bytes: number of processed bytes
 1188 */
 1189void ixgbe_update_rx_ring_stats(struct ixgbe_ring *rx_ring,
 1190				struct ixgbe_q_vector *q_vector, u64 pkts,
 1191				u64 bytes)
 1192{
 1193	u64_stats_update_begin(&rx_ring->syncp);
 1194	rx_ring->stats.bytes += bytes;
 1195	rx_ring->stats.packets += pkts;
 1196	u64_stats_update_end(&rx_ring->syncp);
 1197	q_vector->rx.total_bytes += bytes;
 1198	q_vector->rx.total_packets += pkts;
 1199}
 1200
 1201/**
 1202 * ixgbe_pf_handle_tx_hang - handle Tx hang on PF
 1203 * @tx_ring: tx ring number
 1204 * @next: next ring
 1205 *
 1206 * Prints a message containing details about the tx hang.
 1207 */
 1208static void ixgbe_pf_handle_tx_hang(struct ixgbe_ring *tx_ring,
 1209				    unsigned int next)
 1210{
 1211	struct ixgbe_adapter *adapter = netdev_priv(tx_ring->netdev);
 1212	struct ixgbe_hw *hw = &adapter->hw;
 1213
 1214	e_err(drv, "Detected Tx Unit Hang\n"
 1215		   "  Tx Queue             <%d>\n"
 1216		   "  TDH, TDT             <%x>, <%x>\n"
 1217		   "  next_to_use          <%x>\n"
 1218		   "  next_to_clean        <%x>\n"
 1219		   "tx_buffer_info[next_to_clean]\n"
 1220		   "  time_stamp           <%lx>\n"
 1221		   "  jiffies              <%lx>\n",
 1222	      tx_ring->queue_index,
 1223	      IXGBE_READ_REG(hw, IXGBE_TDH(tx_ring->reg_idx)),
 1224	      IXGBE_READ_REG(hw, IXGBE_TDT(tx_ring->reg_idx)),
 1225	      tx_ring->next_to_use, next,
 1226	      tx_ring->tx_buffer_info[next].time_stamp, jiffies);
 1227
 1228	netif_stop_subqueue(tx_ring->netdev,
 1229			    tx_ring->queue_index);
 1230}
 1231
 1232/**
 1233 * ixgbe_vf_handle_tx_hang - handle Tx hang on VF
 1234 * @adapter: structure containing ring specific data
 1235 * @vf: VF index
 1236 *
 1237 * Print a message containing details about malicious driver detection.
 1238 * Set malicious VF link down if the detection happened several times.
 1239 */
 1240static void ixgbe_vf_handle_tx_hang(struct ixgbe_adapter *adapter, u16 vf)
 1241{
 1242	struct ixgbe_hw *hw = &adapter->hw;
 1243
 1244	if (adapter->hw.mac.type != ixgbe_mac_e610)
 1245		return;
 1246
 1247	e_warn(drv,
 1248	       "Malicious Driver Detection tx hang detected on PF %d VF %d MAC: %pM",
 1249	       hw->bus.func, vf, adapter->vfinfo[vf].vf_mac_addresses);
 1250
 1251	adapter->tx_hang_count[vf]++;
 1252	if (adapter->tx_hang_count[vf] == IXGBE_MAX_TX_VF_HANGS) {
 1253		ixgbe_set_vf_link_state(adapter, vf,
 1254					IFLA_VF_LINK_STATE_DISABLE);
 1255		adapter->tx_hang_count[vf] = 0;
 1256	}
 1257}
 1258
 1259static u32 ixgbe_poll_tx_icache(struct ixgbe_hw *hw, u16 queue, u16 idx)
 1260{
 1261	IXGBE_WRITE_REG(hw, IXGBE_TXDESCIC, queue * idx);
 1262	return IXGBE_READ_REG(hw, IXGBE_TXDESCIC);
 1263}
 1264
 1265/**
 1266 * ixgbe_check_illegal_queue - search for queue with illegal packet
 1267 * @adapter: structure containing ring specific data
 1268 * @queue: queue index
 1269 *
 1270 * Check if tx descriptor connected with input queue
 1271 * contains illegal packet.
 1272 *
 1273 * Returns: true if queue contain illegal packet.
 1274 */
 1275static bool ixgbe_check_illegal_queue(struct ixgbe_adapter *adapter,
 1276				      u16 queue)
 1277{
 1278	u32 hdr_len_reg, mss_len_reg, type_reg;
 1279	struct ixgbe_hw *hw = &adapter->hw;
 1280	u32 mss_len, header_len, reg;
 1281
 1282	for (u16 i = 0; i < IXGBE_MAX_TX_DESCRIPTORS; i++) {
 1283		/* HW will clear bit IXGBE_TXDESCIC_READY when address
 1284		 * is written to address field. HW will set this bit
 1285		 * when iCache read is done, and data is ready at TIC_DWx.
 1286		 * Set descriptor address.
 1287		 */
 1288		read_poll_timeout(ixgbe_poll_tx_icache, reg,
 1289				  !(reg & IXGBE_TXDESCIC_READY), 0, 0, false,
 1290				  hw, queue, i);
 1291
 1292		/* read tx descriptor access registers */
 1293		hdr_len_reg = IXGBE_READ_REG(hw, IXGBE_TIC_DW2(IXGBE_VLAN_MACIP_LENS_REG));
 1294		type_reg = IXGBE_READ_REG(hw, IXGBE_TIC_DW2(IXGBE_TYPE_TUCMD_MLHL));
 1295		mss_len_reg = IXGBE_READ_REG(hw, IXGBE_TIC_DW2(IXGBE_MSS_L4LEN_IDX));
 1296
 1297		/* check if Advanced Context Descriptor */
 1298		if (FIELD_GET(IXGBE_ADVTXD_DTYP_MASK, type_reg) !=
 1299		    IXGBE_ADVTXD_DTYP_CTXT)
 1300			continue;
 1301
 1302		/* check for illegal MSS and Header length */
 1303		mss_len = FIELD_GET(IXGBE_ADVTXD_MSS_MASK, mss_len_reg);
 1304		header_len = FIELD_GET(IXGBE_ADVTXD_HEADER_LEN_MASK,
 1305				       hdr_len_reg);
 1306		if ((mss_len + header_len) > SZ_16K) {
 1307			e_warn(probe, "mss len + header len too long\n");
 1308			return true;
 1309		}
 1310	}
 1311
 1312	return false;
 1313}
 1314
 1315/**
 1316 * ixgbe_handle_mdd_event - handle mdd event
 1317 * @adapter: structure containing ring specific data
 1318 * @tx_ring: tx descriptor ring to handle
 1319 *
 1320 * Reset VF driver if malicious vf detected or
 1321 * illegal packet in an any queue detected.
 1322 */
 1323static void ixgbe_handle_mdd_event(struct ixgbe_adapter *adapter,
 1324				   struct ixgbe_ring *tx_ring)
 1325{
 1326	u16 vf, q;
 1327
 1328	if (adapter->vfinfo && ixgbe_check_mdd_event(adapter)) {
 1329		/* vf mdd info and malicious vf detected */
 1330		if (!ixgbe_get_vf_idx(adapter, tx_ring->queue_index, &vf))
 1331			ixgbe_vf_handle_tx_hang(adapter, vf);
 1332	} else {
 1333		/* malicious vf not detected */
 1334		for (q = 0; q < IXGBE_MAX_TX_QUEUES; q++) {
 1335			if (ixgbe_check_illegal_queue(adapter, q) &&
 1336			    !ixgbe_get_vf_idx(adapter, q, &vf))
 1337				/* illegal queue detected */
 1338				ixgbe_vf_handle_tx_hang(adapter, vf);
 1339		}
 1340	}
 1341}
 1342
 1343/**
 1344 * ixgbe_clean_tx_irq - Reclaim resources after transmit completes
 1345 * @q_vector: structure containing interrupt and ring information
 1346 * @tx_ring: tx ring to clean
 1347 * @napi_budget: Used to determine if we are in netpoll
 1348 **/
 1349static bool ixgbe_clean_tx_irq(struct ixgbe_q_vector *q_vector,
 1350			       struct ixgbe_ring *tx_ring, int napi_budget)
 1351{
 1352	struct ixgbe_adapter *adapter = q_vector->adapter;
 1353	struct ixgbe_tx_buffer *tx_buffer;
 1354	union ixgbe_adv_tx_desc *tx_desc;
 1355	unsigned int total_bytes = 0, total_packets = 0, total_ipsec = 0;
 1356	unsigned int budget = q_vector->tx.work_limit;
 1357	unsigned int i = tx_ring->next_to_clean;
 1358	struct netdev_queue *txq;
 1359
 1360	if (test_bit(__IXGBE_DOWN, &adapter->state))
 1361		return true;
 1362
 1363	tx_buffer = &tx_ring->tx_buffer_info[i];
 1364	tx_desc = IXGBE_TX_DESC(tx_ring, i);
 1365	i -= tx_ring->count;
 1366
 1367	do {
 1368		union ixgbe_adv_tx_desc *eop_desc = tx_buffer->next_to_watch;
 1369
 1370		/* if next_to_watch is not set then there is no work pending */
 1371		if (!eop_desc)
 1372			break;
 1373
 1374		/* prevent any other reads prior to eop_desc */
 1375		smp_rmb();
 1376
 1377		/* if DD is not set pending work has not been completed */
 1378		if (!(eop_desc->wb.status & cpu_to_le32(IXGBE_TXD_STAT_DD)))
 1379			break;
 1380
 1381		/* clear next_to_watch to prevent false hangs */
 1382		tx_buffer->next_to_watch = NULL;
 1383
 1384		/* update the statistics for this packet */
 1385		total_bytes += tx_buffer->bytecount;
 1386		total_packets += tx_buffer->gso_segs;
 1387		if (tx_buffer->tx_flags & IXGBE_TX_FLAGS_IPSEC)
 1388			total_ipsec++;
 1389
 1390		/* free the skb */
 1391		if (ring_is_xdp(tx_ring))
 1392			xdp_return_frame(tx_buffer->xdpf);
 1393		else
 1394			napi_consume_skb(tx_buffer->skb, napi_budget);
 1395
 1396		/* unmap skb header data */
 1397		dma_unmap_single(tx_ring->dev,
 1398				 dma_unmap_addr(tx_buffer, dma),
 1399				 dma_unmap_len(tx_buffer, len),
 1400				 DMA_TO_DEVICE);
 1401
 1402		/* clear tx_buffer data */
 1403		dma_unmap_len_set(tx_buffer, len, 0);
 1404
 1405		/* unmap remaining buffers */
 1406		while (tx_desc != eop_desc) {
 1407			tx_buffer++;
 1408			tx_desc++;
 1409			i++;
 1410			if (unlikely(!i)) {
 1411				i -= tx_ring->count;
 1412				tx_buffer = tx_ring->tx_buffer_info;
 1413				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
 1414			}
 1415
 1416			/* unmap any remaining paged data */
 1417			if (dma_unmap_len(tx_buffer, len)) {
 1418				dma_unmap_page(tx_ring->dev,
 1419					       dma_unmap_addr(tx_buffer, dma),
 1420					       dma_unmap_len(tx_buffer, len),
 1421					       DMA_TO_DEVICE);
 1422				dma_unmap_len_set(tx_buffer, len, 0);
 1423			}
 1424		}
 1425
 1426		/* move us one more past the eop_desc for start of next pkt */
 1427		tx_buffer++;
 1428		tx_desc++;
 1429		i++;
 1430		if (unlikely(!i)) {
 1431			i -= tx_ring->count;
 1432			tx_buffer = tx_ring->tx_buffer_info;
 1433			tx_desc = IXGBE_TX_DESC(tx_ring, 0);
 1434		}
 1435
 1436		/* issue prefetch for next Tx descriptor */
 1437		prefetch(tx_desc);
 1438
 1439		/* update budget accounting */
 1440		budget--;
 1441	} while (likely(budget));
 1442
 1443	i += tx_ring->count;
 1444	tx_ring->next_to_clean = i;
 1445	ixgbe_update_tx_ring_stats(tx_ring, q_vector, total_packets,
 1446				   total_bytes);
 1447	adapter->tx_ipsec += total_ipsec;
 1448
 1449	if (ring_is_xdp(tx_ring))
 1450		return !!budget;
 1451
 1452	if (check_for_tx_hang(tx_ring) && ixgbe_check_tx_hang(tx_ring)) {
 1453		if (adapter->hw.mac.type == ixgbe_mac_e610)
 1454			ixgbe_handle_mdd_event(adapter, tx_ring);
 1455
 1456		ixgbe_pf_handle_tx_hang(tx_ring, i);
 1457
 1458		e_info(probe,
 1459		       "tx hang %d detected on queue %d, resetting adapter\n",
 1460			adapter->tx_timeout_count + 1, tx_ring->queue_index);
 1461
 1462		/* schedule immediate reset if we believe we hung */
 1463		ixgbe_tx_timeout_reset(adapter);
 1464
 1465		/* the adapter is about to reset, no point in enabling stuff */
 1466		return true;
 1467	}
 1468
 1469#define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
 1470	txq = netdev_get_tx_queue(tx_ring->netdev, tx_ring->queue_index);
 1471	if (!__netif_txq_completed_wake(txq, total_packets, total_bytes,
 1472					ixgbe_desc_unused(tx_ring),
 1473					TX_WAKE_THRESHOLD,
 1474					!netif_carrier_ok(tx_ring->netdev) ||
 1475					test_bit(__IXGBE_DOWN, &adapter->state)))
 1476		++tx_ring->tx_stats.restart_queue;
 1477
 1478	return !!budget;
 1479}
 1480
 1481#ifdef CONFIG_IXGBE_DCA
 1482static void ixgbe_update_tx_dca(struct ixgbe_adapter *adapter,
 1483				struct ixgbe_ring *tx_ring,
 1484				int cpu)
 1485{
 1486	struct ixgbe_hw *hw = &adapter->hw;
 1487	u32 txctrl = 0;
 1488	u16 reg_offset;
 1489
 1490	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
 1491		txctrl = dca3_get_tag(tx_ring->dev, cpu);
 1492
 1493	switch (hw->mac.type) {
 1494	case ixgbe_mac_82598EB:
 1495		reg_offset = IXGBE_DCA_TXCTRL(tx_ring->reg_idx);
 1496		break;
 1497	case ixgbe_mac_82599EB:
 1498	case ixgbe_mac_X540:
 1499		reg_offset = IXGBE_DCA_TXCTRL_82599(tx_ring->reg_idx);
 1500		txctrl <<= IXGBE_DCA_TXCTRL_CPUID_SHIFT_82599;
 1501		break;
 1502	default:
 1503		/* for unknown hardware do not write register */
 1504		return;
 1505	}
 1506
 1507	/*
 1508	 * We can enable relaxed ordering for reads, but not writes when
 1509	 * DCA is enabled.  This is due to a known issue in some chipsets
 1510	 * which will cause the DCA tag to be cleared.
 1511	 */
 1512	txctrl |= IXGBE_DCA_TXCTRL_DESC_RRO_EN |
 1513		  IXGBE_DCA_TXCTRL_DATA_RRO_EN |
 1514		  IXGBE_DCA_TXCTRL_DESC_DCA_EN;
 1515
 1516	IXGBE_WRITE_REG(hw, reg_offset, txctrl);
 1517}
 1518
 1519static void ixgbe_update_rx_dca(struct ixgbe_adapter *adapter,
 1520				struct ixgbe_ring *rx_ring,
 1521				int cpu)
 1522{
 1523	struct ixgbe_hw *hw = &adapter->hw;
 1524	u32 rxctrl = 0;
 1525	u8 reg_idx = rx_ring->reg_idx;
 1526
 1527	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
 1528		rxctrl = dca3_get_tag(rx_ring->dev, cpu);
 1529
 1530	switch (hw->mac.type) {
 1531	case ixgbe_mac_82599EB:
 1532	case ixgbe_mac_X540:
 1533		rxctrl <<= IXGBE_DCA_RXCTRL_CPUID_SHIFT_82599;
 1534		break;
 1535	default:
 1536		break;
 1537	}
 1538
 1539	/*
 1540	 * We can enable relaxed ordering for reads, but not writes when
 1541	 * DCA is enabled.  This is due to a known issue in some chipsets
 1542	 * which will cause the DCA tag to be cleared.
 1543	 */
 1544	rxctrl |= IXGBE_DCA_RXCTRL_DESC_RRO_EN |
 1545		  IXGBE_DCA_RXCTRL_DATA_DCA_EN |
 1546		  IXGBE_DCA_RXCTRL_DESC_DCA_EN;
 1547
 1548	IXGBE_WRITE_REG(hw, IXGBE_DCA_RXCTRL(reg_idx), rxctrl);
 1549}
 1550
 1551static void ixgbe_update_dca(struct ixgbe_q_vector *q_vector)
 1552{
 1553	struct ixgbe_adapter *adapter = q_vector->adapter;
 1554	struct ixgbe_ring *ring;
 1555	int cpu = get_cpu();
 1556
 1557	if (q_vector->cpu == cpu)
 1558		goto out_no_update;
 1559
 1560	ixgbe_for_each_ring(ring, q_vector->tx)
 1561		ixgbe_update_tx_dca(adapter, ring, cpu);
 1562
 1563	ixgbe_for_each_ring(ring, q_vector->rx)
 1564		ixgbe_update_rx_dca(adapter, ring, cpu);
 1565
 1566	q_vector->cpu = cpu;
 1567out_no_update:
 1568	put_cpu();
 1569}
 1570
 1571static void ixgbe_setup_dca(struct ixgbe_adapter *adapter)
 1572{
 1573	int i;
 1574
 1575	/* always use CB2 mode, difference is masked in the CB driver */
 1576	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
 1577		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
 1578				IXGBE_DCA_CTRL_DCA_MODE_CB2);
 1579	else
 1580		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
 1581				IXGBE_DCA_CTRL_DCA_DISABLE);
 1582
 1583	for (i = 0; i < adapter->num_q_vectors; i++) {
 1584		adapter->q_vector[i]->cpu = -1;
 1585		ixgbe_update_dca(adapter->q_vector[i]);
 1586	}
 1587}
 1588
 1589static int __ixgbe_notify_dca(struct device *dev, void *data)
 1590{
 1591	struct ixgbe_adapter *adapter = dev_get_drvdata(dev);
 1592	unsigned long event = *(unsigned long *)data;
 1593
 1594	if (!(adapter->flags & IXGBE_FLAG_DCA_CAPABLE))
 1595		return 0;
 1596
 1597	switch (event) {
 1598	case DCA_PROVIDER_ADD:
 1599		/* if we're already enabled, don't do it again */
 1600		if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
 1601			break;
 1602		if (dca_add_requester(dev) == 0) {
 1603			adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
 1604			IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
 1605					IXGBE_DCA_CTRL_DCA_MODE_CB2);
 1606			break;
 1607		}
 1608		fallthrough; /* DCA is disabled. */
 1609	case DCA_PROVIDER_REMOVE:
 1610		if (adapter->flags & IXGBE_FLAG_DCA_ENABLED) {
 1611			dca_remove_requester(dev);
 1612			adapter->flags &= ~IXGBE_FLAG_DCA_ENABLED;
 1613			IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
 1614					IXGBE_DCA_CTRL_DCA_DISABLE);
 1615		}
 1616		break;
 1617	}
 1618
 1619	return 0;
 1620}
 1621
 1622#endif /* CONFIG_IXGBE_DCA */
 1623
 1624#define IXGBE_RSS_L4_TYPES_MASK \
 1625	((1ul << IXGBE_RXDADV_RSSTYPE_IPV4_TCP) | \
 1626	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV4_UDP) | \
 1627	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV6_TCP) | \
 1628	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV6_UDP))
 1629
 1630static inline void ixgbe_rx_hash(struct ixgbe_ring *ring,
 1631				 union ixgbe_adv_rx_desc *rx_desc,
 1632				 struct sk_buff *skb)
 1633{
 1634	u16 rss_type;
 1635
 1636	if (!(ring->netdev->features & NETIF_F_RXHASH))
 1637		return;
 1638
 1639	rss_type = le16_to_cpu(rx_desc->wb.lower.lo_dword.hs_rss.pkt_info) &
 1640		   IXGBE_RXDADV_RSSTYPE_MASK;
 1641
 1642	if (!rss_type)
 1643		return;
 1644
 1645	skb_set_hash(skb, le32_to_cpu(rx_desc->wb.lower.hi_dword.rss),
 1646		     (IXGBE_RSS_L4_TYPES_MASK & (1ul << rss_type)) ?
 1647		     PKT_HASH_TYPE_L4 : PKT_HASH_TYPE_L3);
 1648}
 1649
 1650#ifdef IXGBE_FCOE
 1651/**
 1652 * ixgbe_rx_is_fcoe - check the rx desc for incoming pkt type
 1653 * @ring: structure containing ring specific data
 1654 * @rx_desc: advanced rx descriptor
 1655 *
 1656 * Returns : true if it is FCoE pkt
 1657 */
 1658static inline bool ixgbe_rx_is_fcoe(struct ixgbe_ring *ring,
 1659				    union ixgbe_adv_rx_desc *rx_desc)
 1660{
 1661	__le16 pkt_info = rx_desc->wb.lower.lo_dword.hs_rss.pkt_info;
 1662
 1663	return test_bit(__IXGBE_RX_FCOE, &ring->state) &&
 1664	       ((pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_ETQF_MASK)) ==
 1665		(cpu_to_le16(IXGBE_ETQF_FILTER_FCOE <<
 1666			     IXGBE_RXDADV_PKTTYPE_ETQF_SHIFT)));
 1667}
 1668
 1669#endif /* IXGBE_FCOE */
 1670/**
 1671 * ixgbe_rx_checksum - indicate in skb if hw indicated a good cksum
 1672 * @ring: structure containing ring specific data
 1673 * @rx_desc: current Rx descriptor being processed
 1674 * @skb: skb currently being received and modified
 1675 **/
 1676static inline void ixgbe_rx_checksum(struct ixgbe_ring *ring,
 1677				     union ixgbe_adv_rx_desc *rx_desc,
 1678				     struct sk_buff *skb)
 1679{
 1680	__le16 pkt_info = rx_desc->wb.lower.lo_dword.hs_rss.pkt_info;
 1681	bool encap_pkt = false;
 1682
 1683	skb_checksum_none_assert(skb);
 1684
 1685	/* Rx csum disabled */
 1686	if (!(ring->netdev->features & NETIF_F_RXCSUM))
 1687		return;
 1688
 1689	/* check for VXLAN and Geneve packets */
 1690	if (pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_VXLAN)) {
 1691		encap_pkt = true;
 1692		skb->encapsulation = 1;
 1693	}
 1694
 1695	/* if IP and error */
 1696	if (ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_IPCS) &&
 1697	    ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_IPE)) {
 1698		ring->rx_stats.csum_err++;
 1699		return;
 1700	}
 1701
 1702	if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_L4CS))
 1703		return;
 1704
 1705	if (ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_TCPE)) {
 1706		/*
 1707		 * 82599 errata, UDP frames with a 0 checksum can be marked as
 1708		 * checksum errors.
 1709		 */
 1710		if ((pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_UDP)) &&
 1711		    test_bit(__IXGBE_RX_CSUM_UDP_ZERO_ERR, &ring->state))
 1712			return;
 1713
 1714		ring->rx_stats.csum_err++;
 1715		return;
 1716	}
 1717
 1718	/* It must be a TCP or UDP packet with a valid checksum */
 1719	skb->ip_summed = CHECKSUM_UNNECESSARY;
 1720	if (encap_pkt) {
 1721		if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_OUTERIPCS))
 1722			return;
 1723
 1724		if (ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_OUTERIPER)) {
 1725			skb->ip_summed = CHECKSUM_NONE;
 1726			return;
 1727		}
 1728		/* If we checked the outer header let the stack know */
 1729		skb->csum_level = 1;
 1730	}
 1731}
 1732
 1733static unsigned int ixgbe_rx_offset(struct ixgbe_ring *rx_ring)
 1734{
 1735	return ring_uses_build_skb(rx_ring) ? IXGBE_SKB_PAD : 0;
 1736}
 1737
 1738static bool ixgbe_alloc_mapped_page(struct ixgbe_ring *rx_ring,
 1739				    struct ixgbe_rx_buffer *bi)
 1740{
 1741	struct page *page = bi->page;
 1742	dma_addr_t dma;
 1743
 1744	/* since we are recycling buffers we should seldom need to alloc */
 1745	if (likely(page))
 1746		return true;
 1747
 1748	/* alloc new page for storage */
 1749	page = dev_alloc_pages(ixgbe_rx_pg_order(rx_ring));
 1750	if (unlikely(!page)) {
 1751		rx_ring->rx_stats.alloc_rx_page_failed++;
 1752		return false;
 1753	}
 1754
 1755	/* map page for use */
 1756	dma = dma_map_page_attrs(rx_ring->dev, page, 0,
 1757				 ixgbe_rx_pg_size(rx_ring),
 1758				 DMA_FROM_DEVICE,
 1759				 IXGBE_RX_DMA_ATTR);
 1760
 1761	/*
 1762	 * if mapping failed free memory back to system since
 1763	 * there isn't much point in holding memory we can't use
 1764	 */
 1765	if (dma_mapping_error(rx_ring->dev, dma)) {
 1766		__free_pages(page, ixgbe_rx_pg_order(rx_ring));
 1767
 1768		rx_ring->rx_stats.alloc_rx_page_failed++;
 1769		return false;
 1770	}
 1771
 1772	bi->dma = dma;
 1773	bi->page = page;
 1774	bi->page_offset = rx_ring->rx_offset;
 1775	page_ref_add(page, USHRT_MAX - 1);
 1776	bi->pagecnt_bias = USHRT_MAX;
 1777	rx_ring->rx_stats.alloc_rx_page++;
 1778
 1779	return true;
 1780}
 1781
 1782/**
 1783 * ixgbe_alloc_rx_buffers - Replace used receive buffers
 1784 * @rx_ring: ring to place buffers on
 1785 * @cleaned_count: number of buffers to replace
 1786 **/
 1787void ixgbe_alloc_rx_buffers(struct ixgbe_ring *rx_ring, u16 cleaned_count)
 1788{
 1789	union ixgbe_adv_rx_desc *rx_desc;
 1790	struct ixgbe_rx_buffer *bi;
 1791	u16 i = rx_ring->next_to_use;
 1792	u16 bufsz;
 1793
 1794	/* nothing to do */
 1795	if (!cleaned_count)
 1796		return;
 1797
 1798	rx_desc = IXGBE_RX_DESC(rx_ring, i);
 1799	bi = &rx_ring->rx_buffer_info[i];
 1800	i -= rx_ring->count;
 1801
 1802	bufsz = ixgbe_rx_bufsz(rx_ring);
 1803
 1804	do {
 1805		if (!ixgbe_alloc_mapped_page(rx_ring, bi))
 1806			break;
 1807
 1808		/* sync the buffer for use by the device */
 1809		dma_sync_single_range_for_device(rx_ring->dev, bi->dma,
 1810						 bi->page_offset, bufsz,
 1811						 DMA_FROM_DEVICE);
 1812
 1813		/*
 1814		 * Refresh the desc even if buffer_addrs didn't change
 1815		 * because each write-back erases this info.
 1816		 */
 1817		rx_desc->read.pkt_addr = cpu_to_le64(bi->dma + bi->page_offset);
 1818
 1819		rx_desc++;
 1820		bi++;
 1821		i++;
 1822		if (unlikely(!i)) {
 1823			rx_desc = IXGBE_RX_DESC(rx_ring, 0);
 1824			bi = rx_ring->rx_buffer_info;
 1825			i -= rx_ring->count;
 1826		}
 1827
 1828		/* clear the length for the next_to_use descriptor */
 1829		rx_desc->wb.upper.length = 0;
 1830
 1831		cleaned_count--;
 1832	} while (cleaned_count);
 1833
 1834	i += rx_ring->count;
 1835
 1836	if (rx_ring->next_to_use != i) {
 1837		rx_ring->next_to_use = i;
 1838
 1839		/* update next to alloc since we have filled the ring */
 1840		rx_ring->next_to_alloc = i;
 1841
 1842		/* Force memory writes to complete before letting h/w
 1843		 * know there are new descriptors to fetch.  (Only
 1844		 * applicable for weak-ordered memory model archs,
 1845		 * such as IA-64).
 1846		 */
 1847		wmb();
 1848		writel(i, rx_ring->tail);
 1849	}
 1850}
 1851
 1852static void ixgbe_set_rsc_gso_size(struct ixgbe_ring *ring,
 1853				   struct sk_buff *skb)
 1854{
 1855	u16 hdr_len = skb_headlen(skb);
 1856
 1857	/* set gso_size to avoid messing up TCP MSS */
 1858	skb_shinfo(skb)->gso_size = DIV_ROUND_UP((skb->len - hdr_len),
 1859						 IXGBE_CB(skb)->append_cnt);
 1860	skb_shinfo(skb)->gso_type = SKB_GSO_TCPV4;
 1861}
 1862
 1863static void ixgbe_update_rsc_stats(struct ixgbe_ring *rx_ring,
 1864				   struct sk_buff *skb)
 1865{
 1866	/* if append_cnt is 0 then frame is not RSC */
 1867	if (!IXGBE_CB(skb)->append_cnt)
 1868		return;
 1869
 1870	rx_ring->rx_stats.rsc_count += IXGBE_CB(skb)->append_cnt;
 1871	rx_ring->rx_stats.rsc_flush++;
 1872
 1873	ixgbe_set_rsc_gso_size(rx_ring, skb);
 1874
 1875	/* gso_size is computed using append_cnt so always clear it last */
 1876	IXGBE_CB(skb)->append_cnt = 0;
 1877}
 1878
 1879/**
 1880 * ixgbe_process_skb_fields - Populate skb header fields from Rx descriptor
 1881 * @rx_ring: rx descriptor ring packet is being transacted on
 1882 * @rx_desc: pointer to the EOP Rx descriptor
 1883 * @skb: pointer to current skb being populated
 1884 *
 1885 * This function checks the ring, descriptor, and packet information in
 1886 * order to populate the hash, checksum, VLAN, timestamp, protocol, and
 1887 * other fields within the skb.
 1888 **/
 1889void ixgbe_process_skb_fields(struct ixgbe_ring *rx_ring,
 1890			      union ixgbe_adv_rx_desc *rx_desc,
 1891			      struct sk_buff *skb)
 1892{
 1893	struct net_device *dev = rx_ring->netdev;
 1894	u32 flags = rx_ring->q_vector->adapter->flags;
 1895
 1896	ixgbe_update_rsc_stats(rx_ring, skb);
 1897
 1898	ixgbe_rx_hash(rx_ring, rx_desc, skb);
 1899
 1900	ixgbe_rx_checksum(rx_ring, rx_desc, skb);
 1901
 1902	if (unlikely(flags & IXGBE_FLAG_RX_HWTSTAMP_ENABLED))
 1903		ixgbe_ptp_rx_hwtstamp(rx_ring, rx_desc, skb);
 1904
 1905	if ((dev->features & NETIF_F_HW_VLAN_CTAG_RX) &&
 1906	    ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_VP)) {
 1907		u16 vid = le16_to_cpu(rx_desc->wb.upper.vlan);
 1908		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vid);
 1909	}
 1910
 1911	if (ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_STAT_SECP))
 1912		ixgbe_ipsec_rx(rx_ring, rx_desc, skb);
 1913
 1914	/* record Rx queue, or update MACVLAN statistics */
 1915	if (netif_is_ixgbe(dev))
 1916		skb_record_rx_queue(skb, rx_ring->queue_index);
 1917	else
 1918		macvlan_count_rx(netdev_priv(dev), skb->len + ETH_HLEN, true,
 1919				 false);
 1920
 1921	skb->protocol = eth_type_trans(skb, dev);
 1922}
 1923
 1924void ixgbe_rx_skb(struct ixgbe_q_vector *q_vector,
 1925		  struct sk_buff *skb)
 1926{
 1927	napi_gro_receive(&q_vector->napi, skb);
 1928}
 1929
 1930/**
 1931 * ixgbe_is_non_eop - process handling of non-EOP buffers
 1932 * @rx_ring: Rx ring being processed
 1933 * @rx_desc: Rx descriptor for current buffer
 1934 * @skb: Current socket buffer containing buffer in progress
 1935 *
 1936 * This function updates next to clean.  If the buffer is an EOP buffer
 1937 * this function exits returning false, otherwise it will place the
 1938 * sk_buff in the next buffer to be chained and return true indicating
 1939 * that this is in fact a non-EOP buffer.
 1940 **/
 1941static bool ixgbe_is_non_eop(struct ixgbe_ring *rx_ring,
 1942			     union ixgbe_adv_rx_desc *rx_desc,
 1943			     struct sk_buff *skb)
 1944{
 1945	u32 ntc = rx_ring->next_to_clean + 1;
 1946
 1947	/* fetch, update, and store next to clean */
 1948	ntc = (ntc < rx_ring->count) ? ntc : 0;
 1949	rx_ring->next_to_clean = ntc;
 1950
 1951	prefetch(IXGBE_RX_DESC(rx_ring, ntc));
 1952
 1953	/* update RSC append count if present */
 1954	if (ring_is_rsc_enabled(rx_ring)) {
 1955		__le32 rsc_enabled = rx_desc->wb.lower.lo_dword.data &
 1956				     cpu_to_le32(IXGBE_RXDADV_RSCCNT_MASK);
 1957
 1958		if (unlikely(rsc_enabled)) {
 1959			u32 rsc_cnt = le32_to_cpu(rsc_enabled);
 1960
 1961			rsc_cnt >>= IXGBE_RXDADV_RSCCNT_SHIFT;
 1962			IXGBE_CB(skb)->append_cnt += rsc_cnt - 1;
 1963
 1964			/* update ntc based on RSC value */
 1965			ntc = le32_to_cpu(rx_desc->wb.upper.status_error);
 1966			ntc &= IXGBE_RXDADV_NEXTP_MASK;
 1967			ntc >>= IXGBE_RXDADV_NEXTP_SHIFT;
 1968		}
 1969	}
 1970
 1971	/* if we are the last buffer then there is nothing else to do */
 1972	if (likely(ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP)))
 1973		return false;
 1974
 1975	/* place skb in next buffer to be received */
 1976	rx_ring->rx_buffer_info[ntc].skb = skb;
 1977	rx_ring->rx_stats.non_eop_descs++;
 1978
 1979	return true;
 1980}
 1981
 1982/**
 1983 * ixgbe_pull_tail - ixgbe specific version of skb_pull_tail
 1984 * @rx_ring: rx descriptor ring packet is being transacted on
 1985 * @skb: pointer to current skb being adjusted
 1986 *
 1987 * This function is an ixgbe specific version of __pskb_pull_tail.  The
 1988 * main difference between this version and the original function is that
 1989 * this function can make several assumptions about the state of things
 1990 * that allow for significant optimizations versus the standard function.
 1991 * As a result we can do things like drop a frag and maintain an accurate
 1992 * truesize for the skb.
 1993 */
 1994static void ixgbe_pull_tail(struct ixgbe_ring *rx_ring,
 1995			    struct sk_buff *skb)
 1996{
 1997	skb_frag_t *frag = &skb_shinfo(skb)->frags[0];
 1998	unsigned char *va;
 1999	unsigned int pull_len;
 2000
 2001	/*
 2002	 * it is valid to use page_address instead of kmap since we are
 2003	 * working with pages allocated out of the lomem pool per
 2004	 * alloc_page(GFP_ATOMIC)
 2005	 */
 2006	va = skb_frag_address(frag);
 2007
 2008	/*
 2009	 * we need the header to contain the greater of either ETH_HLEN or
 2010	 * 60 bytes if the skb->len is less than 60 for skb_pad.
 2011	 */
 2012	pull_len = eth_get_headlen(skb->dev, va, IXGBE_RX_HDR_SIZE);
 2013
 2014	/* align pull length to size of long to optimize memcpy performance */
 2015	skb_copy_to_linear_data(skb, va, ALIGN(pull_len, sizeof(long)));
 2016
 2017	/* update all of the pointers */
 2018	skb_frag_size_sub(frag, pull_len);
 2019	skb_frag_off_add(frag, pull_len);
 2020	skb->data_len -= pull_len;
 2021	skb->tail += pull_len;
 2022}
 2023
 2024/**
 2025 * ixgbe_dma_sync_frag - perform DMA sync for first frag of SKB
 2026 * @rx_ring: rx descriptor ring packet is being transacted on
 2027 * @skb: pointer to current skb being updated
 2028 *
 2029 * This function provides a basic DMA sync up for the first fragment of an
 2030 * skb.  The reason for doing this is that the first fragment cannot be
 2031 * unmapped until we have reached the end of packet descriptor for a buffer
 2032 * chain.
 2033 */
 2034static void ixgbe_dma_sync_frag(struct ixgbe_ring *rx_ring,
 2035				struct sk_buff *skb)
 2036{
 2037	if (ring_uses_build_skb(rx_ring)) {
 2038		unsigned long mask = (unsigned long)ixgbe_rx_pg_size(rx_ring) - 1;
 2039		unsigned long offset = (unsigned long)(skb->data) & mask;
 2040
 2041		dma_sync_single_range_for_cpu(rx_ring->dev,
 2042					      IXGBE_CB(skb)->dma,
 2043					      offset,
 2044					      skb_headlen(skb),
 2045					      DMA_FROM_DEVICE);
 2046	} else {
 2047		skb_frag_t *frag = &skb_shinfo(skb)->frags[0];
 2048
 2049		dma_sync_single_range_for_cpu(rx_ring->dev,
 2050					      IXGBE_CB(skb)->dma,
 2051					      skb_frag_off(frag),
 2052					      skb_frag_size(frag),
 2053					      DMA_FROM_DEVICE);
 2054	}
 2055
 2056	/* If the page was released, just unmap it. */
 2057	if (unlikely(IXGBE_CB(skb)->page_released)) {
 2058		dma_unmap_page_attrs(rx_ring->dev, IXGBE_CB(skb)->dma,
 2059				     ixgbe_rx_pg_size(rx_ring),
 2060				     DMA_FROM_DEVICE,
 2061				     IXGBE_RX_DMA_ATTR);
 2062	}
 2063}
 2064
 2065/**
 2066 * ixgbe_cleanup_headers - Correct corrupted or empty headers
 2067 * @rx_ring: rx descriptor ring packet is being transacted on
 2068 * @rx_desc: pointer to the EOP Rx descriptor
 2069 * @skb: pointer to current skb being fixed
 2070 *
 2071 * Check if the skb is valid in the XDP case it will be an error pointer.
 2072 * Return true in this case to abort processing and advance to next
 2073 * descriptor.
 2074 *
 2075 * Check for corrupted packet headers caused by senders on the local L2
 2076 * embedded NIC switch not setting up their Tx Descriptors right.  These
 2077 * should be very rare.
 2078 *
 2079 * Also address the case where we are pulling data in on pages only
 2080 * and as such no data is present in the skb header.
 2081 *
 2082 * In addition if skb is not at least 60 bytes we need to pad it so that
 2083 * it is large enough to qualify as a valid Ethernet frame.
 2084 *
 2085 * Returns true if an error was encountered and skb was freed.
 2086 **/
 2087bool ixgbe_cleanup_headers(struct ixgbe_ring *rx_ring,
 2088			   union ixgbe_adv_rx_desc *rx_desc,
 2089			   struct sk_buff *skb)
 2090{
 2091	struct net_device *netdev = rx_ring->netdev;
 2092
 2093	/* Verify netdev is present, and that packet does not have any
 2094	 * errors that would be unacceptable to the netdev.
 2095	 */
 2096	if (!netdev ||
 2097	    (unlikely(ixgbe_test_staterr(rx_desc,
 2098					 IXGBE_RXDADV_ERR_FRAME_ERR_MASK) &&
 2099	     !(netdev->features & NETIF_F_RXALL)))) {
 2100		dev_kfree_skb_any(skb);
 2101		return true;
 2102	}
 2103
 2104	/* place header in linear portion of buffer */
 2105	if (!skb_headlen(skb))
 2106		ixgbe_pull_tail(rx_ring, skb);
 2107
 2108#ifdef IXGBE_FCOE
 2109	/* do not attempt to pad FCoE Frames as this will disrupt DDP */
 2110	if (ixgbe_rx_is_fcoe(rx_ring, rx_desc))
 2111		return false;
 2112
 2113#endif
 2114	/* if eth_skb_pad returns an error the skb was freed */
 2115	if (eth_skb_pad(skb))
 2116		return true;
 2117
 2118	return false;
 2119}
 2120
 2121/**
 2122 * ixgbe_reuse_rx_page - page flip buffer and store it back on the ring
 2123 * @rx_ring: rx descriptor ring to store buffers on
 2124 * @old_buff: donor buffer to have page reused
 2125 *
 2126 * Synchronizes page for reuse by the adapter
 2127 **/
 2128static void ixgbe_reuse_rx_page(struct ixgbe_ring *rx_ring,
 2129				struct ixgbe_rx_buffer *old_buff)
 2130{
 2131	struct ixgbe_rx_buffer *new_buff;
 2132	u16 nta = rx_ring->next_to_alloc;
 2133
 2134	new_buff = &rx_ring->rx_buffer_info[nta];
 2135
 2136	/* update, and store next to alloc */
 2137	nta++;
 2138	rx_ring->next_to_alloc = (nta < rx_ring->count) ? nta : 0;
 2139
 2140	/* Transfer page from old buffer to new buffer.
 2141	 * Move each member individually to avoid possible store
 2142	 * forwarding stalls and unnecessary copy of skb.
 2143	 */
 2144	new_buff->dma		= old_buff->dma;
 2145	new_buff->page		= old_buff->page;
 2146	new_buff->page_offset	= old_buff->page_offset;
 2147	new_buff->pagecnt_bias	= old_buff->pagecnt_bias;
 2148}
 2149
 2150static bool ixgbe_can_reuse_rx_page(struct ixgbe_rx_buffer *rx_buffer,
 2151				    int rx_buffer_pgcnt)
 2152{
 2153	unsigned int pagecnt_bias = rx_buffer->pagecnt_bias;
 2154	struct page *page = rx_buffer->page;
 2155
 2156	/* avoid re-using remote and pfmemalloc pages */
 2157	if (!dev_page_is_reusable(page))
 2158		return false;
 2159
 2160#if (PAGE_SIZE < 8192)
 2161	/* if we are only owner of page we can reuse it */
 2162	if (unlikely((rx_buffer_pgcnt - pagecnt_bias) > 1))
 2163		return false;
 2164#else
 2165	/* The last offset is a bit aggressive in that we assume the
 2166	 * worst case of FCoE being enabled and using a 3K buffer.
 2167	 * However this should have minimal impact as the 1K extra is
 2168	 * still less than one buffer in size.
 2169	 */
 2170#define IXGBE_LAST_OFFSET \
 2171	(SKB_WITH_OVERHEAD(PAGE_SIZE) - IXGBE_RXBUFFER_3K)
 2172	if (rx_buffer->page_offset > IXGBE_LAST_OFFSET)
 2173		return false;
 2174#endif
 2175
 2176	/* If we have drained the page fragment pool we need to update
 2177	 * the pagecnt_bias and page count so that we fully restock the
 2178	 * number of references the driver holds.
 2179	 */
 2180	if (unlikely(pagecnt_bias == 1)) {
 2181		page_ref_add(page, USHRT_MAX - 1);
 2182		rx_buffer->pagecnt_bias = USHRT_MAX;
 2183	}
 2184
 2185	return true;
 2186}
 2187
 2188/**
 2189 * ixgbe_add_rx_frag - Add contents of Rx buffer to sk_buff
 2190 * @rx_ring: rx descriptor ring to transact packets on
 2191 * @rx_buffer: buffer containing page to add
 2192 * @skb: sk_buff to place the data into
 2193 * @size: size of data in rx_buffer
 2194 *
 2195 * This function will add the data contained in rx_buffer->page to the skb.
 2196 * This is done either through a direct copy if the data in the buffer is
 2197 * less than the skb header size, otherwise it will just attach the page as
 2198 * a frag to the skb.
 2199 *
 2200 * The function will then update the page offset if necessary and return
 2201 * true if the buffer can be reused by the adapter.
 2202 **/
 2203static void ixgbe_add_rx_frag(struct ixgbe_ring *rx_ring,
 2204			      struct ixgbe_rx_buffer *rx_buffer,
 2205			      struct sk_buff *skb,
 2206			      unsigned int size)
 2207{
 2208#if (PAGE_SIZE < 8192)
 2209	unsigned int truesize = ixgbe_rx_pg_size(rx_ring) / 2;
 2210#else
 2211	unsigned int truesize = rx_ring->rx_offset ?
 2212				SKB_DATA_ALIGN(rx_ring->rx_offset + size) :
 2213				SKB_DATA_ALIGN(size);
 2214#endif
 2215	skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, rx_buffer->page,
 2216			rx_buffer->page_offset, size, truesize);
 2217#if (PAGE_SIZE < 8192)
 2218	rx_buffer->page_offset ^= truesize;
 2219#else
 2220	rx_buffer->page_offset += truesize;
 2221#endif
 2222}
 2223
 2224static struct ixgbe_rx_buffer *ixgbe_get_rx_buffer(struct ixgbe_ring *rx_ring,
 2225						   union ixgbe_adv_rx_desc *rx_desc,
 2226						   struct sk_buff **skb,
 2227						   const unsigned int size,
 2228						   int *rx_buffer_pgcnt)
 2229{
 2230	struct ixgbe_rx_buffer *rx_buffer;
 2231
 2232	rx_buffer = &rx_ring->rx_buffer_info[rx_ring->next_to_clean];
 2233	*rx_buffer_pgcnt =
 2234#if (PAGE_SIZE < 8192)
 2235		page_count(rx_buffer->page);
 2236#else
 2237		0;
 2238#endif
 2239	prefetchw(rx_buffer->page);
 2240	*skb = rx_buffer->skb;
 2241
 2242	/* Delay unmapping of the first packet. It carries the header
 2243	 * information, HW may still access the header after the writeback.
 2244	 * Only unmap it when EOP is reached
 2245	 */
 2246	if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP)) {
 2247		if (!*skb)
 2248			goto skip_sync;
 2249	} else {
 2250		if (*skb)
 2251			ixgbe_dma_sync_frag(rx_ring, *skb);
 2252	}
 2253
 2254	/* we are reusing so sync this buffer for CPU use */
 2255	dma_sync_single_range_for_cpu(rx_ring->dev,
 2256				      rx_buffer->dma,
 2257				      rx_buffer->page_offset,
 2258				      size,
 2259				      DMA_FROM_DEVICE);
 2260skip_sync:
 2261	rx_buffer->pagecnt_bias--;
 2262
 2263	return rx_buffer;
 2264}
 2265
 2266static void ixgbe_put_rx_buffer(struct ixgbe_ring *rx_ring,
 2267				struct ixgbe_rx_buffer *rx_buffer,
 2268				struct sk_buff *skb,
 2269				int rx_buffer_pgcnt)
 2270{
 2271	if (ixgbe_can_reuse_rx_page(rx_buffer, rx_buffer_pgcnt)) {
 2272		/* hand second half of page back to the ring */
 2273		ixgbe_reuse_rx_page(rx_ring, rx_buffer);
 2274	} else {
 2275		if (skb && IXGBE_CB(skb)->dma == rx_buffer->dma) {
 2276			/* the page has been released from the ring */
 2277			IXGBE_CB(skb)->page_released = true;
 2278		} else {
 2279			/* we are not reusing the buffer so unmap it */
 2280			dma_unmap_page_attrs(rx_ring->dev, rx_buffer->dma,
 2281					     ixgbe_rx_pg_size(rx_ring),
 2282					     DMA_FROM_DEVICE,
 2283					     IXGBE_RX_DMA_ATTR);
 2284		}
 2285		__page_frag_cache_drain(rx_buffer->page,
 2286					rx_buffer->pagecnt_bias);
 2287	}
 2288
 2289	/* clear contents of rx_buffer */
 2290	rx_buffer->page = NULL;
 2291	rx_buffer->skb = NULL;
 2292}
 2293
 2294static struct sk_buff *ixgbe_construct_skb(struct ixgbe_ring *rx_ring,
 2295					   struct ixgbe_rx_buffer *rx_buffer,
 2296					   struct xdp_buff *xdp,
 2297					   union ixgbe_adv_rx_desc *rx_desc)
 2298{
 2299	unsigned int size = xdp->data_end - xdp->data;
 2300#if (PAGE_SIZE < 8192)
 2301	unsigned int truesize = ixgbe_rx_pg_size(rx_ring) / 2;
 2302#else
 2303	unsigned int truesize = SKB_DATA_ALIGN(xdp->data_end -
 2304					       xdp->data_hard_start);
 2305#endif
 2306	struct sk_buff *skb;
 2307
 2308	/* prefetch first cache line of first page */
 2309	net_prefetch(xdp->data);
 2310
 2311	/* Note, we get here by enabling legacy-rx via:
 2312	 *
 2313	 *    ethtool --set-priv-flags <dev> legacy-rx on
 2314	 *
 2315	 * In this mode, we currently get 0 extra XDP headroom as
 2316	 * opposed to having legacy-rx off, where we process XDP
 2317	 * packets going to stack via ixgbe_build_skb(). The latter
 2318	 * provides us currently with 192 bytes of headroom.
 2319	 *
 2320	 * For ixgbe_construct_skb() mode it means that the
 2321	 * xdp->data_meta will always point to xdp->data, since
 2322	 * the helper cannot expand the head. Should this ever
 2323	 * change in future for legacy-rx mode on, then lets also
 2324	 * add xdp->data_meta handling here.
 2325	 */
 2326
 2327	/* allocate a skb to store the frags */
 2328	skb = napi_alloc_skb(&rx_ring->q_vector->napi, IXGBE_RX_HDR_SIZE);
 2329	if (unlikely(!skb))
 2330		return NULL;
 2331
 2332	if (size > IXGBE_RX_HDR_SIZE) {
 2333		if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP))
 2334			IXGBE_CB(skb)->dma = rx_buffer->dma;
 2335
 2336		skb_add_rx_frag(skb, 0, rx_buffer->page,
 2337				xdp->data - page_address(rx_buffer->page),
 2338				size, truesize);
 2339#if (PAGE_SIZE < 8192)
 2340		rx_buffer->page_offset ^= truesize;
 2341#else
 2342		rx_buffer->page_offset += truesize;
 2343#endif
 2344	} else {
 2345		memcpy(__skb_put(skb, size),
 2346		       xdp->data, ALIGN(size, sizeof(long)));
 2347		rx_buffer->pagecnt_bias++;
 2348	}
 2349
 2350	return skb;
 2351}
 2352
 2353static struct sk_buff *ixgbe_build_skb(struct ixgbe_ring *rx_ring,
 2354				       struct ixgbe_rx_buffer *rx_buffer,
 2355				       struct xdp_buff *xdp,
 2356				       union ixgbe_adv_rx_desc *rx_desc)
 2357{
 2358	unsigned int metasize = xdp->data - xdp->data_meta;
 2359#if (PAGE_SIZE < 8192)
 2360	unsigned int truesize = ixgbe_rx_pg_size(rx_ring) / 2;
 2361#else
 2362	unsigned int truesize = SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) +
 2363				SKB_DATA_ALIGN(xdp->data_end -
 2364					       xdp->data_hard_start);
 2365#endif
 2366	struct sk_buff *skb;
 2367
 2368	/* Prefetch first cache line of first page. If xdp->data_meta
 2369	 * is unused, this points exactly as xdp->data, otherwise we
 2370	 * likely have a consumer accessing first few bytes of meta
 2371	 * data, and then actual data.
 2372	 */
 2373	net_prefetch(xdp->data_meta);
 2374
 2375	/* build an skb to around the page buffer */
 2376	skb = napi_build_skb(xdp->data_hard_start, truesize);
 2377	if (unlikely(!skb))
 2378		return NULL;
 2379
 2380	/* update pointers within the skb to store the data */
 2381	skb_reserve(skb, xdp->data - xdp->data_hard_start);
 2382	__skb_put(skb, xdp->data_end - xdp->data);
 2383	if (metasize)
 2384		skb_metadata_set(skb, metasize);
 2385
 2386	/* record DMA address if this is the start of a chain of buffers */
 2387	if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP))
 2388		IXGBE_CB(skb)->dma = rx_buffer->dma;
 2389
 2390	/* update buffer offset */
 2391#if (PAGE_SIZE < 8192)
 2392	rx_buffer->page_offset ^= truesize;
 2393#else
 2394	rx_buffer->page_offset += truesize;
 2395#endif
 2396
 2397	return skb;
 2398}
 2399
 2400static int ixgbe_run_xdp(struct ixgbe_adapter *adapter,
 2401			 struct ixgbe_ring *rx_ring,
 2402			 struct xdp_buff *xdp)
 2403{
 2404	int err, result = IXGBE_XDP_PASS;
 2405	struct bpf_prog *xdp_prog;
 2406	struct ixgbe_ring *ring;
 2407	struct xdp_frame *xdpf;
 2408	u32 act;
 2409
 2410	xdp_prog = READ_ONCE(rx_ring->xdp_prog);
 2411
 2412	if (!xdp_prog)
 2413		goto xdp_out;
 2414
 2415	prefetchw(xdp->data_hard_start); /* xdp_frame write */
 2416
 2417	act = bpf_prog_run_xdp(xdp_prog, xdp);
 2418	switch (act) {
 2419	case XDP_PASS:
 2420		break;
 2421	case XDP_TX:
 2422		xdpf = xdp_convert_buff_to_frame(xdp);
 2423		if (unlikely(!xdpf))
 2424			goto out_failure;
 2425		ring = ixgbe_determine_xdp_ring(adapter);
 2426		if (static_branch_unlikely(&ixgbe_xdp_locking_key))
 2427			spin_lock(&ring->tx_lock);
 2428		result = ixgbe_xmit_xdp_ring(ring, xdpf);
 2429		if (static_branch_unlikely(&ixgbe_xdp_locking_key))
 2430			spin_unlock(&ring->tx_lock);
 2431		if (result == IXGBE_XDP_CONSUMED)
 2432			goto out_failure;
 2433		break;
 2434	case XDP_REDIRECT:
 2435		err = xdp_do_redirect(adapter->netdev, xdp, xdp_prog);
 2436		if (err)
 2437			goto out_failure;
 2438		result = IXGBE_XDP_REDIR;
 2439		break;
 2440	default:
 2441		bpf_warn_invalid_xdp_action(rx_ring->netdev, xdp_prog, act);
 2442		fallthrough;
 2443	case XDP_ABORTED:
 2444out_failure:
 2445		trace_xdp_exception(rx_ring->netdev, xdp_prog, act);
 2446		fallthrough; /* handle aborts by dropping packet */
 2447	case XDP_DROP:
 2448		result = IXGBE_XDP_CONSUMED;
 2449		break;
 2450	}
 2451xdp_out:
 2452	return result;
 2453}
 2454
 2455static unsigned int ixgbe_rx_frame_truesize(struct ixgbe_ring *rx_ring,
 2456					    unsigned int size)
 2457{
 2458	unsigned int truesize;
 2459
 2460#if (PAGE_SIZE < 8192)
 2461	truesize = ixgbe_rx_pg_size(rx_ring) / 2; /* Must be power-of-2 */
 2462#else
 2463	truesize = rx_ring->rx_offset ?
 2464		SKB_DATA_ALIGN(rx_ring->rx_offset + size) +
 2465		SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) :
 2466		SKB_DATA_ALIGN(size);
 2467#endif
 2468	return truesize;
 2469}
 2470
 2471static void ixgbe_rx_buffer_flip(struct ixgbe_ring *rx_ring,
 2472				 struct ixgbe_rx_buffer *rx_buffer,
 2473				 unsigned int size)
 2474{
 2475	unsigned int truesize = ixgbe_rx_frame_truesize(rx_ring, size);
 2476#if (PAGE_SIZE < 8192)
 2477	rx_buffer->page_offset ^= truesize;
 2478#else
 2479	rx_buffer->page_offset += truesize;
 2480#endif
 2481}
 2482
 2483/**
 2484 * ixgbe_clean_rx_irq - Clean completed descriptors from Rx ring - bounce buf
 2485 * @q_vector: structure containing interrupt and ring information
 2486 * @rx_ring: rx descriptor ring to transact packets on
 2487 * @budget: Total limit on number of packets to process
 2488 *
 2489 * This function provides a "bounce buffer" approach to Rx interrupt
 2490 * processing.  The advantage to this is that on systems that have
 2491 * expensive overhead for IOMMU access this provides a means of avoiding
 2492 * it by maintaining the mapping of the page to the system.
 2493 *
 2494 * Returns amount of work completed
 2495 **/
 2496static int ixgbe_clean_rx_irq(struct ixgbe_q_vector *q_vector,
 2497			       struct ixgbe_ring *rx_ring,
 2498			       const int budget)
 2499{
 2500	unsigned int total_rx_bytes = 0, total_rx_packets = 0, frame_sz = 0;
 2501	struct ixgbe_adapter *adapter = q_vector->adapter;
 2502#ifdef IXGBE_FCOE
 2503	int ddp_bytes;
 2504	unsigned int mss = 0;
 2505#endif /* IXGBE_FCOE */
 2506	u16 cleaned_count = ixgbe_desc_unused(rx_ring);
 2507	unsigned int offset = rx_ring->rx_offset;
 2508	unsigned int xdp_xmit = 0;
 2509	struct xdp_buff xdp;
 2510	int xdp_res = 0;
 2511
 2512	/* Frame size depend on rx_ring setup when PAGE_SIZE=4K */
 2513#if (PAGE_SIZE < 8192)
 2514	frame_sz = ixgbe_rx_frame_truesize(rx_ring, 0);
 2515#endif
 2516	xdp_init_buff(&xdp, frame_sz, &rx_ring->xdp_rxq);
 2517
 2518	while (likely(total_rx_packets < budget)) {
 2519		union ixgbe_adv_rx_desc *rx_desc;
 2520		struct ixgbe_rx_buffer *rx_buffer;
 2521		struct sk_buff *skb;
 2522		int rx_buffer_pgcnt;
 2523		unsigned int size;
 2524
 2525		/* return some buffers to hardware, one at a time is too slow */
 2526		if (cleaned_count >= IXGBE_RX_BUFFER_WRITE) {
 2527			ixgbe_alloc_rx_buffers(rx_ring, cleaned_count);
 2528			cleaned_count = 0;
 2529		}
 2530
 2531		rx_desc = IXGBE_RX_DESC(rx_ring, rx_ring->next_to_clean);
 2532		size = le16_to_cpu(rx_desc->wb.upper.length);
 2533		if (!size)
 2534			break;
 2535
 2536		/* This memory barrier is needed to keep us from reading
 2537		 * any other fields out of the rx_desc until we know the
 2538		 * descriptor has been written back
 2539		 */
 2540		dma_rmb();
 2541
 2542		rx_buffer = ixgbe_get_rx_buffer(rx_ring, rx_desc, &skb, size, &rx_buffer_pgcnt);
 2543
 2544		/* retrieve a buffer from the ring */
 2545		if (!skb) {
 2546			unsigned char *hard_start;
 2547
 2548			hard_start = page_address(rx_buffer->page) +
 2549				     rx_buffer->page_offset - offset;
 2550			xdp_prepare_buff(&xdp, hard_start, offset, size, true);
 2551			xdp_buff_clear_frags_flag(&xdp);
 2552#if (PAGE_SIZE > 4096)
 2553			/* At larger PAGE_SIZE, frame_sz depend on len size */
 2554			xdp.frame_sz = ixgbe_rx_frame_truesize(rx_ring, size);
 2555#endif
 2556			xdp_res = ixgbe_run_xdp(adapter, rx_ring, &xdp);
 2557		}
 2558
 2559		if (xdp_res) {
 2560			if (xdp_res & (IXGBE_XDP_TX | IXGBE_XDP_REDIR)) {
 2561				xdp_xmit |= xdp_res;
 2562				ixgbe_rx_buffer_flip(rx_ring, rx_buffer, size);
 2563			} else {
 2564				rx_buffer->pagecnt_bias++;
 2565			}
 2566			total_rx_packets++;
 2567			total_rx_bytes += size;
 2568		} else if (skb) {
 2569			ixgbe_add_rx_frag(rx_ring, rx_buffer, skb, size);
 2570		} else if (ring_uses_build_skb(rx_ring)) {
 2571			skb = ixgbe_build_skb(rx_ring, rx_buffer,
 2572					      &xdp, rx_desc);
 2573		} else {
 2574			skb = ixgbe_construct_skb(rx_ring, rx_buffer,
 2575						  &xdp, rx_desc);
 2576		}
 2577
 2578		/* exit if we failed to retrieve a buffer */
 2579		if (!xdp_res && !skb) {
 2580			rx_ring->rx_stats.alloc_rx_buff_failed++;
 2581			rx_buffer->pagecnt_bias++;
 2582			break;
 2583		}
 2584
 2585		ixgbe_put_rx_buffer(rx_ring, rx_buffer, skb, rx_buffer_pgcnt);
 2586		cleaned_count++;
 2587
 2588		/* place incomplete frames back on ring for completion */
 2589		if (ixgbe_is_non_eop(rx_ring, rx_desc, skb))
 2590			continue;
 2591
 2592		/* verify the packet layout is correct */
 2593		if (xdp_res || ixgbe_cleanup_headers(rx_ring, rx_desc, skb))
 2594			continue;
 2595
 2596		/* probably a little skewed due to removing CRC */
 2597		total_rx_bytes += skb->len;
 2598
 2599		/* populate checksum, timestamp, VLAN, and protocol */
 2600		ixgbe_process_skb_fields(rx_ring, rx_desc, skb);
 2601
 2602#ifdef IXGBE_FCOE
 2603		/* if ddp, not passing to ULD unless for FCP_RSP or error */
 2604		if (ixgbe_rx_is_fcoe(rx_ring, rx_desc)) {
 2605			ddp_bytes = ixgbe_fcoe_ddp(adapter, rx_desc, skb);
 2606			/* include DDPed FCoE data */
 2607			if (ddp_bytes > 0) {
 2608				if (!mss) {
 2609					mss = rx_ring->netdev->mtu -
 2610						sizeof(struct fcoe_hdr) -
 2611						sizeof(struct fc_frame_header) -
 2612						sizeof(struct fcoe_crc_eof);
 2613					if (mss > 512)
 2614						mss &= ~511;
 2615				}
 2616				total_rx_bytes += ddp_bytes;
 2617				total_rx_packets += DIV_ROUND_UP(ddp_bytes,
 2618								 mss);
 2619			}
 2620			if (!ddp_bytes) {
 2621				dev_kfree_skb_any(skb);
 2622				continue;
 2623			}
 2624		}
 2625
 2626#endif /* IXGBE_FCOE */
 2627		ixgbe_rx_skb(q_vector, skb);
 2628
 2629		/* update budget accounting */
 2630		total_rx_packets++;
 2631	}
 2632
 2633	if (xdp_xmit & IXGBE_XDP_REDIR)
 2634		xdp_do_flush();
 2635
 2636	if (xdp_xmit & IXGBE_XDP_TX) {
 2637		struct ixgbe_ring *ring = ixgbe_determine_xdp_ring(adapter);
 2638
 2639		ixgbe_xdp_ring_update_tail_locked(ring);
 2640	}
 2641
 2642	ixgbe_update_rx_ring_stats(rx_ring, q_vector, total_rx_packets,
 2643				   total_rx_bytes);
 2644
 2645	return total_rx_packets;
 2646}
 2647
 2648/**
 2649 * ixgbe_configure_msix - Configure MSI-X hardware
 2650 * @adapter: board private structure
 2651 *
 2652 * ixgbe_configure_msix sets up the hardware to properly generate MSI-X
 2653 * interrupts.
 2654 **/
 2655static void ixgbe_configure_msix(struct ixgbe_adapter *adapter)
 2656{
 2657	struct ixgbe_q_vector *q_vector;
 2658	int v_idx;
 2659	u32 mask;
 2660
 2661	/* Populate MSIX to EITR Select */
 2662	if (adapter->num_vfs > 32) {
 2663		u32 eitrsel = BIT(adapter->num_vfs - 32) - 1;
 2664		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITRSEL, eitrsel);
 2665	}
 2666
 2667	/*
 2668	 * Populate the IVAR table and set the ITR values to the
 2669	 * corresponding register.
 2670	 */
 2671	for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
 2672		struct ixgbe_ring *ring;
 2673		q_vector = adapter->q_vector[v_idx];
 2674
 2675		ixgbe_for_each_ring(ring, q_vector->rx)
 2676			ixgbe_set_ivar(adapter, 0, ring->reg_idx, v_idx);
 2677
 2678		ixgbe_for_each_ring(ring, q_vector->tx)
 2679			ixgbe_set_ivar(adapter, 1, ring->reg_idx, v_idx);
 2680
 2681		ixgbe_write_eitr(q_vector);
 2682	}
 2683
 2684	switch (adapter->hw.mac.type) {
 2685	case ixgbe_mac_82598EB:
 2686		ixgbe_set_ivar(adapter, -1, IXGBE_IVAR_OTHER_CAUSES_INDEX,
 2687			       v_idx);
 2688		break;
 2689	case ixgbe_mac_82599EB:
 2690	case ixgbe_mac_X540:
 2691	case ixgbe_mac_X550:
 2692	case ixgbe_mac_X550EM_x:
 2693	case ixgbe_mac_x550em_a:
 2694	case ixgbe_mac_e610:
 2695		ixgbe_set_ivar(adapter, -1, 1, v_idx);
 2696		break;
 2697	default:
 2698		break;
 2699	}
 2700	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITR(v_idx), 1950);
 2701
 2702	/* set up to autoclear timer, and the vectors */
 2703	mask = IXGBE_EIMS_ENABLE_MASK;
 2704	mask &= ~(IXGBE_EIMS_OTHER |
 2705		  IXGBE_EIMS_MAILBOX |
 2706		  IXGBE_EIMS_LSC);
 2707
 2708	if (adapter->hw.mac.type == ixgbe_mac_e610)
 2709		mask &= ~IXGBE_EIMS_FW_EVENT;
 2710
 2711	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIAC, mask);
 2712}
 2713
 2714/**
 2715 * ixgbe_update_itr - update the dynamic ITR value based on statistics
 2716 * @q_vector: structure containing interrupt and ring information
 2717 * @ring_container: structure containing ring performance data
 2718 *
 2719 *      Stores a new ITR value based on packets and byte
 2720 *      counts during the last interrupt.  The advantage of per interrupt
 2721 *      computation is faster updates and more accurate ITR for the current
 2722 *      traffic pattern.  Constants in this function were computed
 2723 *      based on theoretical maximum wire speed and thresholds were set based
 2724 *      on testing data as well as attempting to minimize response time
 2725 *      while increasing bulk throughput.
 2726 **/
 2727static void ixgbe_update_itr(struct ixgbe_q_vector *q_vector,
 2728			     struct ixgbe_ring_container *ring_container)
 2729{
 2730	unsigned int itr = IXGBE_ITR_ADAPTIVE_MIN_USECS |
 2731			   IXGBE_ITR_ADAPTIVE_LATENCY;
 2732	unsigned int avg_wire_size, packets, bytes;
 2733	unsigned long next_update = jiffies;
 2734
 2735	/* If we don't have any rings just leave ourselves set for maximum
 2736	 * possible latency so we take ourselves out of the equation.
 2737	 */
 2738	if (!ring_container->ring)
 2739		return;
 2740
 2741	/* If we didn't update within up to 1 - 2 jiffies we can assume
 2742	 * that either packets are coming in so slow there hasn't been
 2743	 * any work, or that there is so much work that NAPI is dealing
 2744	 * with interrupt moderation and we don't need to do anything.
 2745	 */
 2746	if (time_after(next_update, ring_container->next_update))
 2747		goto clear_counts;
 2748
 2749	packets = ring_container->total_packets;
 2750
 2751	/* We have no packets to actually measure against. This means
 2752	 * either one of the other queues on this vector is active or
 2753	 * we are a Tx queue doing TSO with too high of an interrupt rate.
 2754	 *
 2755	 * When this occurs just tick up our delay by the minimum value
 2756	 * and hope that this extra delay will prevent us from being called
 2757	 * without any work on our queue.
 2758	 */
 2759	if (!packets) {
 2760		itr = (q_vector->itr >> 2) + IXGBE_ITR_ADAPTIVE_MIN_INC;
 2761		if (itr > IXGBE_ITR_ADAPTIVE_MAX_USECS)
 2762			itr = IXGBE_ITR_ADAPTIVE_MAX_USECS;
 2763		itr += ring_container->itr & IXGBE_ITR_ADAPTIVE_LATENCY;
 2764		goto clear_counts;
 2765	}
 2766
 2767	bytes = ring_container->total_bytes;
 2768
 2769	/* If packets are less than 4 or bytes are less than 9000 assume
 2770	 * insufficient data to use bulk rate limiting approach. We are
 2771	 * likely latency driven.
 2772	 */
 2773	if (packets < 4 && bytes < 9000) {
 2774		itr = IXGBE_ITR_ADAPTIVE_LATENCY;
 2775		goto adjust_by_size;
 2776	}
 2777
 2778	/* Between 4 and 48 we can assume that our current interrupt delay
 2779	 * is only slightly too low. As such we should increase it by a small
 2780	 * fixed amount.
 2781	 */
 2782	if (packets < 48) {
 2783		itr = (q_vector->itr >> 2) + IXGBE_ITR_ADAPTIVE_MIN_INC;
 2784		if (itr > IXGBE_ITR_ADAPTIVE_MAX_USECS)
 2785			itr = IXGBE_ITR_ADAPTIVE_MAX_USECS;
 2786		goto clear_counts;
 2787	}
 2788
 2789	/* Between 48 and 96 is our "goldilocks" zone where we are working
 2790	 * out "just right". Just report that our current ITR is good for us.
 2791	 */
 2792	if (packets < 96) {
 2793		itr = q_vector->itr >> 2;
 2794		goto clear_counts;
 2795	}
 2796
 2797	/* If packet count is 96 or greater we are likely looking at a slight
 2798	 * overrun of the delay we want. Try halving our delay to see if that
 2799	 * will cut the number of packets in half per interrupt.
 2800	 */
 2801	if (packets < 256) {
 2802		itr = q_vector->itr >> 3;
 2803		if (itr < IXGBE_ITR_ADAPTIVE_MIN_USECS)
 2804			itr = IXGBE_ITR_ADAPTIVE_MIN_USECS;
 2805		goto clear_counts;
 2806	}
 2807
 2808	/* The paths below assume we are dealing with a bulk ITR since number
 2809	 * of packets is 256 or greater. We are just going to have to compute
 2810	 * a value and try to bring the count under control, though for smaller
 2811	 * packet sizes there isn't much we can do as NAPI polling will likely
 2812	 * be kicking in sooner rather than later.
 2813	 */
 2814	itr = IXGBE_ITR_ADAPTIVE_BULK;
 2815
 2816adjust_by_size:
 2817	/* If packet counts are 256 or greater we can assume we have a gross
 2818	 * overestimation of what the rate should be. Instead of trying to fine
 2819	 * tune it just use the formula below to try and dial in an exact value
 2820	 * give the current packet size of the frame.
 2821	 */
 2822	avg_wire_size = bytes / packets;
 2823
 2824	/* The following is a crude approximation of:
 2825	 *  wmem_default / (size + overhead) = desired_pkts_per_int
 2826	 *  rate / bits_per_byte / (size + ethernet overhead) = pkt_rate
 2827	 *  (desired_pkt_rate / pkt_rate) * usecs_per_sec = ITR value
 2828	 *
 2829	 * Assuming wmem_default is 212992 and overhead is 640 bytes per
 2830	 * packet, (256 skb, 64 headroom, 320 shared info), we can reduce the
 2831	 * formula down to
 2832	 *
 2833	 *  (170 * (size + 24)) / (size + 640) = ITR
 2834	 *
 2835	 * We first do some math on the packet size and then finally bitshift
 2836	 * by 8 after rounding up. We also have to account for PCIe link speed
 2837	 * difference as ITR scales based on this.
 2838	 */
 2839	if (avg_wire_size <= 60) {
 2840		/* Start at 50k ints/sec */
 2841		avg_wire_size = 5120;
 2842	} else if (avg_wire_size <= 316) {
 2843		/* 50K ints/sec to 16K ints/sec */
 2844		avg_wire_size *= 40;
 2845		avg_wire_size += 2720;
 2846	} else if (avg_wire_size <= 1084) {
 2847		/* 16K ints/sec to 9.2K ints/sec */
 2848		avg_wire_size *= 15;
 2849		avg_wire_size += 11452;
 2850	} else if (avg_wire_size < 1968) {
 2851		/* 9.2K ints/sec to 8K ints/sec */
 2852		avg_wire_size *= 5;
 2853		avg_wire_size += 22420;
 2854	} else {
 2855		/* plateau at a limit of 8K ints/sec */
 2856		avg_wire_size = 32256;
 2857	}
 2858
 2859	/* If we are in low latency mode half our delay which doubles the rate
 2860	 * to somewhere between 100K to 16K ints/sec
 2861	 */
 2862	if (itr & IXGBE_ITR_ADAPTIVE_LATENCY)
 2863		avg_wire_size >>= 1;
 2864
 2865	/* Resultant value is 256 times larger than it needs to be. This
 2866	 * gives us room to adjust the value as needed to either increase
 2867	 * or decrease the value based on link speeds of 10G, 2.5G, 1G, etc.
 2868	 *
 2869	 * Use addition as we have already recorded the new latency flag
 2870	 * for the ITR value.
 2871	 */
 2872	switch (q_vector->adapter->link_speed) {
 2873	case IXGBE_LINK_SPEED_10GB_FULL:
 2874	case IXGBE_LINK_SPEED_100_FULL:
 2875	default:
 2876		itr += DIV_ROUND_UP(avg_wire_size,
 2877				    IXGBE_ITR_ADAPTIVE_MIN_INC * 256) *
 2878		       IXGBE_ITR_ADAPTIVE_MIN_INC;
 2879		break;
 2880	case IXGBE_LINK_SPEED_2_5GB_FULL:
 2881	case IXGBE_LINK_SPEED_1GB_FULL:
 2882	case IXGBE_LINK_SPEED_10_FULL:
 2883		if (avg_wire_size > 8064)
 2884			avg_wire_size = 8064;
 2885		itr += DIV_ROUND_UP(avg_wire_size,
 2886				    IXGBE_ITR_ADAPTIVE_MIN_INC * 64) *
 2887		       IXGBE_ITR_ADAPTIVE_MIN_INC;
 2888		break;
 2889	}
 2890
 2891clear_counts:
 2892	/* write back value */
 2893	ring_container->itr = itr;
 2894
 2895	/* next update should occur within next jiffy */
 2896	ring_container->next_update = next_update + 1;
 2897
 2898	ring_container->total_bytes = 0;
 2899	ring_container->total_packets = 0;
 2900}
 2901
 2902/**
 2903 * ixgbe_write_eitr - write EITR register in hardware specific way
 2904 * @q_vector: structure containing interrupt and ring information
 2905 *
 2906 * This function is made to be called by ethtool and by the driver
 2907 * when it needs to update EITR registers at runtime.  Hardware
 2908 * specific quirks/differences are taken care of here.
 2909 */
 2910void ixgbe_write_eitr(struct ixgbe_q_vector *q_vector)
 2911{
 2912	struct ixgbe_adapter *adapter = q_vector->adapter;
 2913	struct ixgbe_hw *hw = &adapter->hw;
 2914	int v_idx = q_vector->v_idx;
 2915	u32 itr_reg = q_vector->itr & IXGBE_MAX_EITR;
 2916
 2917	switch (adapter->hw.mac.type) {
 2918	case ixgbe_mac_82598EB:
 2919		/* must write high and low 16 bits to reset counter */
 2920		itr_reg |= (itr_reg << 16);
 2921		break;
 2922	case ixgbe_mac_82599EB:
 2923	case ixgbe_mac_X540:
 2924	case ixgbe_mac_X550:
 2925	case ixgbe_mac_X550EM_x:
 2926	case ixgbe_mac_x550em_a:
 2927	case ixgbe_mac_e610:
 2928		/*
 2929		 * set the WDIS bit to not clear the timer bits and cause an
 2930		 * immediate assertion of the interrupt
 2931		 */
 2932		itr_reg |= IXGBE_EITR_CNT_WDIS;
 2933		break;
 2934	default:
 2935		break;
 2936	}
 2937	IXGBE_WRITE_REG(hw, IXGBE_EITR(v_idx), itr_reg);
 2938}
 2939
 2940static void ixgbe_set_itr(struct ixgbe_q_vector *q_vector)
 2941{
 2942	u32 new_itr;
 2943
 2944	ixgbe_update_itr(q_vector, &q_vector->tx);
 2945	ixgbe_update_itr(q_vector, &q_vector->rx);
 2946
 2947	/* use the smallest value of new ITR delay calculations */
 2948	new_itr = min(q_vector->rx.itr, q_vector->tx.itr);
 2949
 2950	/* Clear latency flag if set, shift into correct position */
 2951	new_itr &= ~IXGBE_ITR_ADAPTIVE_LATENCY;
 2952	new_itr <<= 2;
 2953
 2954	if (new_itr != q_vector->itr) {
 2955		/* save the algorithm value here */
 2956		q_vector->itr = new_itr;
 2957
 2958		ixgbe_write_eitr(q_vector);
 2959	}
 2960}
 2961
 2962/**
 2963 * ixgbe_check_overtemp_subtask - check for over temperature
 2964 * @adapter: pointer to adapter
 2965 **/
 2966static void ixgbe_check_overtemp_subtask(struct ixgbe_adapter *adapter)
 2967{
 2968	struct ixgbe_hw *hw = &adapter->hw;
 2969	u32 eicr = adapter->interrupt_event;
 2970
 2971	if (test_bit(__IXGBE_DOWN, &adapter->state))
 2972		return;
 2973
 2974	if (!(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_EVENT))
 2975		return;
 2976
 2977	adapter->flags2 &= ~IXGBE_FLAG2_TEMP_SENSOR_EVENT;
 2978
 2979	switch (hw->device_id) {
 2980	case IXGBE_DEV_ID_82599_T3_LOM:
 2981		/*
 2982		 * Since the warning interrupt is for both ports
 2983		 * we don't have to check if:
 2984		 *  - This interrupt wasn't for our port.
 2985		 *  - We may have missed the interrupt so always have to
 2986		 *    check if we  got a LSC
 2987		 */
 2988		if (!(eicr & IXGBE_EICR_GPI_SDP0_8259X) &&
 2989		    !(eicr & IXGBE_EICR_LSC))
 2990			return;
 2991
 2992		if (!(eicr & IXGBE_EICR_LSC) && hw->mac.ops.check_link) {
 2993			u32 speed;
 2994			bool link_up = false;
 2995
 2996			hw->mac.ops.check_link(hw, &speed, &link_up, false);
 2997
 2998			if (link_up)
 2999				return;
 3000		}
 3001
 3002		/* Check if this is not due to overtemp */
 3003		if (!hw->phy.ops.check_overtemp(hw))
 3004			return;
 3005
 3006		break;
 3007	case IXGBE_DEV_ID_X550EM_A_1G_T:
 3008	case IXGBE_DEV_ID_X550EM_A_1G_T_L:
 3009		if (!hw->phy.ops.check_overtemp(hw))
 3010			return;
 3011		break;
 3012	default:
 3013		if (adapter->hw.mac.type >= ixgbe_mac_X540)
 3014			return;
 3015		if (!(eicr & IXGBE_EICR_GPI_SDP0(hw)))
 3016			return;
 3017		break;
 3018	}
 3019	e_crit(drv, "%s\n", ixgbe_overheat_msg);
 3020
 3021	adapter->interrupt_event = 0;
 3022}
 3023
 3024static void ixgbe_check_fan_failure(struct ixgbe_adapter *adapter, u32 eicr)
 3025{
 3026	struct ixgbe_hw *hw = &adapter->hw;
 3027
 3028	if ((adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE) &&
 3029	    (eicr & IXGBE_EICR_GPI_SDP1(hw))) {
 3030		e_crit(probe, "Fan has stopped, replace the adapter\n");
 3031		/* write to clear the interrupt */
 3032		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1(hw));
 3033	}
 3034}
 3035
 3036static void ixgbe_check_overtemp_event(struct ixgbe_adapter *adapter, u32 eicr)
 3037{
 3038	struct ixgbe_hw *hw = &adapter->hw;
 3039
 3040	if (!(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE))
 3041		return;
 3042
 3043	switch (adapter->hw.mac.type) {
 3044	case ixgbe_mac_82599EB:
 3045		/*
 3046		 * Need to check link state so complete overtemp check
 3047		 * on service task
 3048		 */
 3049		if (((eicr & IXGBE_EICR_GPI_SDP0(hw)) ||
 3050		     (eicr & IXGBE_EICR_LSC)) &&
 3051		    (!test_bit(__IXGBE_DOWN, &adapter->state))) {
 3052			adapter->interrupt_event = eicr;
 3053			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_EVENT;
 3054			ixgbe_service_event_schedule(adapter);
 3055			return;
 3056		}
 3057		return;
 3058	case ixgbe_mac_x550em_a:
 3059		if (eicr & IXGBE_EICR_GPI_SDP0_X550EM_a) {
 3060			adapter->interrupt_event = eicr;
 3061			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_EVENT;
 3062			ixgbe_service_event_schedule(adapter);
 3063			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC,
 3064					IXGBE_EICR_GPI_SDP0_X550EM_a);
 3065			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICR,
 3066					IXGBE_EICR_GPI_SDP0_X550EM_a);
 3067		}
 3068		return;
 3069	case ixgbe_mac_X550:
 3070	case ixgbe_mac_X540:
 3071		if (!(eicr & IXGBE_EICR_TS))
 3072			return;
 3073		break;
 3074	default:
 3075		return;
 3076	}
 3077
 3078	e_crit(drv, "%s\n", ixgbe_overheat_msg);
 3079}
 3080
 3081static inline bool ixgbe_is_sfp(struct ixgbe_hw *hw)
 3082{
 3083	switch (hw->mac.type) {
 3084	case ixgbe_mac_82598EB:
 3085		if (hw->phy.type == ixgbe_phy_nl)
 3086			return true;
 3087		return false;
 3088	case ixgbe_mac_82599EB:
 3089	case ixgbe_mac_X550EM_x:
 3090	case ixgbe_mac_x550em_a:
 3091		switch (hw->mac.ops.get_media_type(hw)) {
 3092		case ixgbe_media_type_fiber:
 3093		case ixgbe_media_type_fiber_qsfp:
 3094			return true;
 3095		default:
 3096			return false;
 3097		}
 3098	default:
 3099		return false;
 3100	}
 3101}
 3102
 3103static void ixgbe_check_sfp_event(struct ixgbe_adapter *adapter, u32 eicr)
 3104{
 3105	struct ixgbe_hw *hw = &adapter->hw;
 3106	u32 eicr_mask = IXGBE_EICR_GPI_SDP2(hw);
 3107
 3108	if (!ixgbe_is_sfp(hw))
 3109		return;
 3110
 3111	/* Later MAC's use different SDP */
 3112	if (hw->mac.type >= ixgbe_mac_X540)
 3113		eicr_mask = IXGBE_EICR_GPI_SDP0_X540;
 3114
 3115	if (eicr & eicr_mask) {
 3116		/* Clear the interrupt */
 3117		IXGBE_WRITE_REG(hw, IXGBE_EICR, eicr_mask);
 3118		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
 3119			adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
 3120			adapter->sfp_poll_time = 0;
 3121			ixgbe_service_event_schedule(adapter);
 3122		}
 3123	}
 3124
 3125	if (adapter->hw.mac.type == ixgbe_mac_82599EB &&
 3126	    (eicr & IXGBE_EICR_GPI_SDP1(hw))) {
 3127		/* Clear the interrupt */
 3128		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1(hw));
 3129		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
 3130			adapter->flags |= IXGBE_FLAG_NEED_LINK_CONFIG;
 3131			ixgbe_service_event_schedule(adapter);
 3132		}
 3133	}
 3134}
 3135
 3136static void ixgbe_check_lsc(struct ixgbe_adapter *adapter)
 3137{
 3138	struct ixgbe_hw *hw = &adapter->hw;
 3139
 3140	adapter->lsc_int++;
 3141	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
 3142	adapter->link_check_timeout = jiffies;
 3143	if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
 3144		IXGBE_WRITE_REG(hw, IXGBE_EIMC, IXGBE_EIMC_LSC);
 3145		IXGBE_WRITE_FLUSH(hw);
 3146		ixgbe_service_event_schedule(adapter);
 3147	}
 3148}
 3149
 3150/**
 3151 * ixgbe_check_phy_fw_load - check if PHY FW load failed
 3152 * @adapter: pointer to adapter structure
 3153 * @link_cfg_err: bitmap from the link info structure
 3154 *
 3155 * Check if external PHY FW load failed and print an error message if it did.
 3156 */
 3157static void ixgbe_check_phy_fw_load(struct ixgbe_adapter *adapter,
 3158				    u8 link_cfg_err)
 3159{
 3160	if (!(link_cfg_err & IXGBE_ACI_LINK_EXTERNAL_PHY_LOAD_FAILURE)) {
 3161		adapter->flags2 &= ~IXGBE_FLAG2_PHY_FW_LOAD_FAILED;
 3162		return;
 3163	}
 3164
 3165	if (adapter->flags2 & IXGBE_FLAG2_PHY_FW_LOAD_FAILED)
 3166		return;
 3167
 3168	if (link_cfg_err & IXGBE_ACI_LINK_EXTERNAL_PHY_LOAD_FAILURE) {
 3169		netdev_err(adapter->netdev, "Device failed to load the FW for the external PHY. Please download and install the latest NVM for your device and try again\n");
 3170		adapter->flags2 |= IXGBE_FLAG2_PHY_FW_LOAD_FAILED;
 3171	}
 3172}
 3173
 3174/**
 3175 * ixgbe_check_module_power - check module power level
 3176 * @adapter: pointer to adapter structure
 3177 * @link_cfg_err: bitmap from the link info structure
 3178 *
 3179 * Check module power level returned by a previous call to aci_get_link_info
 3180 * and print error messages if module power level is not supported.
 3181 */
 3182static void ixgbe_check_module_power(struct ixgbe_adapter *adapter,
 3183				     u8 link_cfg_err)
 3184{
 3185	/* If module power level is supported, clear the flag. */
 3186	if (!(link_cfg_err & (IXGBE_ACI_LINK_INVAL_MAX_POWER_LIMIT |
 3187			      IXGBE_ACI_LINK_MODULE_POWER_UNSUPPORTED))) {
 3188		adapter->flags2 &= ~IXGBE_FLAG2_MOD_POWER_UNSUPPORTED;
 3189		return;
 3190	}
 3191
 3192	/* If IXGBE_FLAG2_MOD_POWER_UNSUPPORTED was previously set and the
 3193	 * above block didn't clear this bit, there's nothing to do.
 3194	 */
 3195	if (adapter->flags2 & IXGBE_FLAG2_MOD_POWER_UNSUPPORTED)
 3196		return;
 3197
 3198	if (link_cfg_err & IXGBE_ACI_LINK_INVAL_MAX_POWER_LIMIT) {
 3199		netdev_err(adapter->netdev, "The installed module is incompatible with the device's NVM image. Cannot start link.\n");
 3200		adapter->flags2 |= IXGBE_FLAG2_MOD_POWER_UNSUPPORTED;
 3201	} else if (link_cfg_err & IXGBE_ACI_LINK_MODULE_POWER_UNSUPPORTED) {
 3202		netdev_err(adapter->netdev, "The module's power requirements exceed the device's power supply. Cannot start link.\n");
 3203		adapter->flags2 |= IXGBE_FLAG2_MOD_POWER_UNSUPPORTED;
 3204	}
 3205}
 3206
 3207/**
 3208 * ixgbe_check_link_cfg_err - check if link configuration failed
 3209 * @adapter: pointer to adapter structure
 3210 * @link_cfg_err: bitmap from the link info structure
 3211 *
 3212 * Print if any link configuration failure happens due to the value in the
 3213 * link_cfg_err parameter in the link info structure.
 3214 */
 3215static void ixgbe_check_link_cfg_err(struct ixgbe_adapter *adapter,
 3216				     u8 link_cfg_err)
 3217{
 3218	ixgbe_check_module_power(adapter, link_cfg_err);
 3219	ixgbe_check_phy_fw_load(adapter, link_cfg_err);
 3220}
 3221
 3222/**
 3223 * ixgbe_process_link_status_event - process the link event
 3224 * @adapter: pointer to adapter structure
 3225 * @link_up: true if the physical link is up and false if it is down
 3226 * @link_speed: current link speed received from the link event
 3227 *
 3228 * Return: 0 on success or negative value on failure.
 3229 */
 3230static int
 3231ixgbe_process_link_status_event(struct ixgbe_adapter *adapter, bool link_up,
 3232				u16 link_speed)
 3233{
 3234	struct ixgbe_hw *hw = &adapter->hw;
 3235	int status;
 3236
 3237	/* Update the link info structures and re-enable link events,
 3238	 * don't bail on failure due to other book keeping needed.
 3239	 */
 3240	status = ixgbe_update_link_info(hw);
 3241	if (status)
 3242		e_dev_err("Failed to update link status, err %d aq_err %d\n",
 3243			  status, hw->aci.last_status);
 3244
 3245	ixgbe_check_link_cfg_err(adapter, hw->link.link_info.link_cfg_err);
 3246
 3247	/* Check if the link state is up after updating link info, and treat
 3248	 * this event as an UP event since the link is actually UP now.
 3249	 */
 3250	if (hw->link.link_info.link_info & IXGBE_ACI_LINK_UP)
 3251		link_up = true;
 3252
 3253	/* Turn off PHY if media was removed. */
 3254	if (!(adapter->flags2 & IXGBE_FLAG2_NO_MEDIA) &&
 3255	    !(hw->link.link_info.link_info & IXGBE_ACI_MEDIA_AVAILABLE))
 3256		adapter->flags2 |= IXGBE_FLAG2_NO_MEDIA;
 3257
 3258	if (link_up == adapter->link_up &&
 3259	    link_up == netif_carrier_ok(adapter->netdev) &&
 3260	    link_speed == adapter->link_speed)
 3261		return 0;
 3262
 3263	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
 3264	adapter->link_check_timeout = jiffies;
 3265	ixgbe_watchdog_update_link(adapter);
 3266
 3267	if (link_up)
 3268		ixgbe_watchdog_link_is_up(adapter);
 3269	else
 3270		ixgbe_watchdog_link_is_down(adapter);
 3271
 3272	return 0;
 3273}
 3274
 3275/**
 3276 * ixgbe_handle_link_status_event - handle link status event via ACI
 3277 * @adapter: pointer to adapter structure
 3278 * @e: event structure containing link status info
 3279 */
 3280static void
 3281ixgbe_handle_link_status_event(struct ixgbe_adapter *adapter,
 3282			       struct ixgbe_aci_event *e)
 3283{
 3284	struct ixgbe_aci_cmd_get_link_status_data *link_data;
 3285	u16 link_speed;
 3286	bool link_up;
 3287
 3288	link_data = (struct ixgbe_aci_cmd_get_link_status_data *)e->msg_buf;
 3289
 3290	link_up = !!(link_data->link_info & IXGBE_ACI_LINK_UP);
 3291	link_speed = le16_to_cpu(link_data->link_speed);
 3292
 3293	if (ixgbe_process_link_status_event(adapter, link_up, link_speed))
 3294		e_dev_warn("Could not process link status event");
 3295}
 3296
 3297/**
 3298 * ixgbe_schedule_fw_event - schedule Firmware event
 3299 * @adapter: pointer to the adapter structure
 3300 *
 3301 * If the adapter is not in down, removing or resetting state,
 3302 * an event is scheduled.
 3303 */
 3304static void ixgbe_schedule_fw_event(struct ixgbe_adapter *adapter)
 3305{
 3306	if (!test_bit(__IXGBE_DOWN, &adapter->state) &&
 3307	    !test_bit(__IXGBE_REMOVING, &adapter->state) &&
 3308	    !test_bit(__IXGBE_RESETTING, &adapter->state)) {
 3309		adapter->flags2 |= IXGBE_FLAG2_FW_ASYNC_EVENT;
 3310		ixgbe_service_event_schedule(adapter);
 3311	}
 3312}
 3313
 3314/**
 3315 * ixgbe_aci_event_cleanup - release msg_buf memory
 3316 * @event: pointer to the event holding msg_buf to be released
 3317 *
 3318 * Clean memory allocated for event's msg_buf. Implements auto memory cleanup.
 3319 */
 3320static void ixgbe_aci_event_cleanup(struct ixgbe_aci_event *event)
 3321{
 3322	kfree(event->msg_buf);
 3323}
 3324
 3325/**
 3326 * ixgbe_handle_fw_event - handle Firmware event
 3327 * @adapter: pointer to the adapter structure
 3328 *
 3329 * Obtain an event from the ACI and then and then process it according to the
 3330 * type of the event and the opcode.
 3331 */
 3332static void ixgbe_handle_fw_event(struct ixgbe_adapter *adapter)
 3333{
 3334	struct ixgbe_aci_event event __cleanup(ixgbe_aci_event_cleanup);
 3335	struct ixgbe_hw *hw = &adapter->hw;
 3336	bool pending = false;
 3337	int err;
 3338
 3339	if (adapter->flags2 & IXGBE_FLAG2_FW_ASYNC_EVENT)
 3340		adapter->flags2 &= ~IXGBE_FLAG2_FW_ASYNC_EVENT;
 3341	event.buf_len = IXGBE_ACI_MAX_BUFFER_SIZE;
 3342	event.msg_buf = kzalloc(event.buf_len, GFP_KERNEL);
 3343	if (!event.msg_buf)
 3344		return;
 3345
 3346	do {
 3347		err = ixgbe_aci_get_event(hw, &event, &pending);
 3348		if (err)
 3349			break;
 3350
 3351		switch (le16_to_cpu(event.desc.opcode)) {
 3352		case ixgbe_aci_opc_get_link_status:
 3353			ixgbe_handle_link_status_event(adapter, &event);
 3354			break;
 3355		case ixgbe_aci_opc_temp_tca_event:
 3356			e_crit(drv, "%s\n", ixgbe_overheat_msg);
 3357			ixgbe_down(adapter);
 3358			break;
 3359		case libie_aqc_opc_fw_logs_event:
 3360			libie_get_fwlog_data(&hw->fwlog, event.msg_buf,
 3361					     le16_to_cpu(event.desc.datalen));
 3362			break;
 3363		default:
 3364			e_warn(hw, "unknown FW async event captured\n");
 3365			break;
 3366		}
 3367	} while (pending);
 3368}
 3369
 3370static inline void ixgbe_irq_enable_queues(struct ixgbe_adapter *adapter,
 3371					   u64 qmask)
 3372{
 3373	struct ixgbe_hw *hw = &adapter->hw;
 3374	u32 mask;
 3375
 3376	switch (hw->mac.type) {
 3377	case ixgbe_mac_82598EB:
 3378		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
 3379		IXGBE_WRITE_REG(hw, IXGBE_EIMS, mask);
 3380		break;
 3381	case ixgbe_mac_82599EB:
 3382	case ixgbe_mac_X540:
 3383	case ixgbe_mac_X550:
 3384	case ixgbe_mac_X550EM_x:
 3385	case ixgbe_mac_x550em_a:
 3386	case ixgbe_mac_e610:
 3387		mask = (qmask & 0xFFFFFFFF);
 3388		if (mask)
 3389			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(0), mask);
 3390		mask = (qmask >> 32);
 3391		if (mask)
 3392			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(1), mask);
 3393		break;
 3394	default:
 3395		break;
 3396	}
 3397	/* skip the flush */
 3398}
 3399
 3400/**
 3401 * ixgbe_irq_enable - Enable default interrupt generation settings
 3402 * @adapter: board private structure
 3403 * @queues: enable irqs for queues
 3404 * @flush: flush register write
 3405 **/
 3406static inline void ixgbe_irq_enable(struct ixgbe_adapter *adapter, bool queues,
 3407				    bool flush)
 3408{
 3409	struct ixgbe_hw *hw = &adapter->hw;
 3410	u32 mask = (IXGBE_EIMS_ENABLE_MASK & ~IXGBE_EIMS_RTX_QUEUE);
 3411
 3412	/* don't reenable LSC while waiting for link */
 3413	if (adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE)
 3414		mask &= ~IXGBE_EIMS_LSC;
 3415
 3416	if (adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE)
 3417		switch (adapter->hw.mac.type) {
 3418		case ixgbe_mac_82599EB:
 3419			mask |= IXGBE_EIMS_GPI_SDP0(hw);
 3420			break;
 3421		case ixgbe_mac_X540:
 3422		case ixgbe_mac_X550:
 3423		case ixgbe_mac_X550EM_x:
 3424		case ixgbe_mac_x550em_a:
 3425			mask |= IXGBE_EIMS_TS;
 3426			break;
 3427		default:
 3428			break;
 3429		}
 3430	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE)
 3431		mask |= IXGBE_EIMS_GPI_SDP1(hw);
 3432	switch (adapter->hw.mac.type) {
 3433	case ixgbe_mac_82599EB:
 3434		mask |= IXGBE_EIMS_GPI_SDP1(hw);
 3435		mask |= IXGBE_EIMS_GPI_SDP2(hw);
 3436		fallthrough;
 3437	case ixgbe_mac_X540:
 3438	case ixgbe_mac_X550:
 3439	case ixgbe_mac_X550EM_x:
 3440	case ixgbe_mac_e610:
 3441		mask |= IXGBE_EIMS_FW_EVENT;
 3442		fallthrough;
 3443	case ixgbe_mac_x550em_a:
 3444		if (adapter->hw.device_id == IXGBE_DEV_ID_X550EM_X_SFP ||
 3445		    adapter->hw.device_id == IXGBE_DEV_ID_X550EM_A_SFP ||
 3446		    adapter->hw.device_id == IXGBE_DEV_ID_X550EM_A_SFP_N)
 3447			mask |= IXGBE_EIMS_GPI_SDP0(&adapter->hw);
 3448		if (adapter->hw.phy.type == ixgbe_phy_x550em_ext_t)
 3449			mask |= IXGBE_EICR_GPI_SDP0_X540;
 3450		mask |= IXGBE_EIMS_ECC;
 3451		mask |= IXGBE_EIMS_MAILBOX;
 3452		break;
 3453	default:
 3454		break;
 3455	}
 3456
 3457	if ((adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) &&
 3458	    !(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
 3459		mask |= IXGBE_EIMS_FLOW_DIR;
 3460
 3461	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMS, mask);
 3462	if (queues)
 3463		ixgbe_irq_enable_queues(adapter, ~0);
 3464	if (flush)
 3465		IXGBE_WRITE_FLUSH(&adapter->hw);
 3466}
 3467
 3468static irqreturn_t ixgbe_msix_other(int irq, void *data)
 3469{
 3470	struct ixgbe_adapter *adapter = data;
 3471	struct ixgbe_hw *hw = &adapter->hw;
 3472	u32 eicr;
 3473
 3474	/*
 3475	 * Workaround for Silicon errata.  Use clear-by-write instead
 3476	 * of clear-by-read.  Reading with EICS will return the
 3477	 * interrupt causes without clearing, which later be done
 3478	 * with the write to EICR.
 3479	 */
 3480	eicr = IXGBE_READ_REG(hw, IXGBE_EICS);
 3481
 3482	/* The lower 16bits of the EICR register are for the queue interrupts
 3483	 * which should be masked here in order to not accidentally clear them if
 3484	 * the bits are high when ixgbe_msix_other is called. There is a race
 3485	 * condition otherwise which results in possible performance loss
 3486	 * especially if the ixgbe_msix_other interrupt is triggering
 3487	 * consistently (as it would when PPS is turned on for the X540 device)
 3488	 */
 3489	eicr &= 0xFFFF0000;
 3490
 3491	IXGBE_WRITE_REG(hw, IXGBE_EICR, eicr);
 3492
 3493	if (eicr & IXGBE_EICR_LSC)
 3494		ixgbe_check_lsc(adapter);
 3495
 3496	if (eicr & IXGBE_EICR_MAILBOX)
 3497		ixgbe_msg_task(adapter);
 3498
 3499	if (eicr & IXGBE_EICR_FW_EVENT)
 3500		ixgbe_schedule_fw_event(adapter);
 3501
 3502	switch (hw->mac.type) {
 3503	case ixgbe_mac_82599EB:
 3504	case ixgbe_mac_X540:
 3505	case ixgbe_mac_X550:
 3506	case ixgbe_mac_X550EM_x:
 3507	case ixgbe_mac_x550em_a:
 3508	case ixgbe_mac_e610:
 3509		if (hw->phy.type == ixgbe_phy_x550em_ext_t &&
 3510		    (eicr & IXGBE_EICR_GPI_SDP0_X540)) {
 3511			adapter->flags2 |= IXGBE_FLAG2_PHY_INTERRUPT;
 3512			ixgbe_service_event_schedule(adapter);
 3513			IXGBE_WRITE_REG(hw, IXGBE_EICR,
 3514					IXGBE_EICR_GPI_SDP0_X540);
 3515		}
 3516		if (eicr & IXGBE_EICR_ECC) {
 3517			e_info(link, "Received ECC Err, initiating reset\n");
 3518			set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
 3519			ixgbe_service_event_schedule(adapter);
 3520			IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_ECC);
 3521		}
 3522		/* Handle Flow Director Full threshold interrupt */
 3523		if (eicr & IXGBE_EICR_FLOW_DIR) {
 3524			int reinit_count = 0;
 3525			int i;
 3526			for (i = 0; i < adapter->num_tx_queues; i++) {
 3527				struct ixgbe_ring *ring = adapter->tx_ring[i];
 3528				if (test_and_clear_bit(__IXGBE_TX_FDIR_INIT_DONE,
 3529						       &ring->state))
 3530					reinit_count++;
 3531			}
 3532			if (reinit_count) {
 3533				/* no more flow director interrupts until after init */
 3534				IXGBE_WRITE_REG(hw, IXGBE_EIMC, IXGBE_EIMC_FLOW_DIR);
 3535				adapter->flags2 |= IXGBE_FLAG2_FDIR_REQUIRES_REINIT;
 3536				ixgbe_service_event_schedule(adapter);
 3537			}
 3538		}
 3539		ixgbe_check_sfp_event(adapter, eicr);
 3540		ixgbe_check_overtemp_event(adapter, eicr);
 3541		break;
 3542	default:
 3543		break;
 3544	}
 3545
 3546	ixgbe_check_fan_failure(adapter, eicr);
 3547
 3548	if (unlikely(eicr & IXGBE_EICR_TIMESYNC))
 3549		ixgbe_ptp_check_pps_event(adapter);
 3550
 3551	/* re-enable the original interrupt state, no lsc, no queues */
 3552	if (!test_bit(__IXGBE_DOWN, &adapter->state))
 3553		ixgbe_irq_enable(adapter, false, false);
 3554
 3555	return IRQ_HANDLED;
 3556}
 3557
 3558static irqreturn_t ixgbe_msix_clean_rings(int irq, void *data)
 3559{
 3560	struct ixgbe_q_vector *q_vector = data;
 3561
 3562	/* EIAM disabled interrupts (on this vector) for us */
 3563
 3564	if (q_vector->rx.ring || q_vector->tx.ring)
 3565		napi_schedule_irqoff(&q_vector->napi);
 3566
 3567	return IRQ_HANDLED;
 3568}
 3569
 3570/**
 3571 * ixgbe_poll - NAPI Rx polling callback
 3572 * @napi: structure for representing this polling device
 3573 * @budget: how many packets driver is allowed to clean
 3574 *
 3575 * This function is used for legacy and MSI, NAPI mode
 3576 **/
 3577int ixgbe_poll(struct napi_struct *napi, int budget)
 3578{
 3579	struct ixgbe_q_vector *q_vector =
 3580				container_of(napi, struct ixgbe_q_vector, napi);
 3581	struct ixgbe_adapter *adapter = q_vector->adapter;
 3582	struct ixgbe_ring *ring;
 3583	int per_ring_budget, work_done = 0;
 3584	bool clean_complete = true;
 3585
 3586#ifdef CONFIG_IXGBE_DCA
 3587	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
 3588		ixgbe_update_dca(q_vector);
 3589#endif
 3590
 3591	ixgbe_for_each_ring(ring, q_vector->tx) {
 3592		bool wd = ring->xsk_pool ?
 3593			  ixgbe_clean_xdp_tx_irq(q_vector, ring, budget) :
 3594			  ixgbe_clean_tx_irq(q_vector, ring, budget);
 3595
 3596		if (!wd)
 3597			clean_complete = false;
 3598	}
 3599
 3600	/* Exit if we are called by netpoll */
 3601	if (budget <= 0)
 3602		return budget;
 3603
 3604	/* attempt to distribute budget to each queue fairly, but don't allow
 3605	 * the budget to go below 1 because we'll exit polling */
 3606	if (q_vector->rx.count > 1)
 3607		per_ring_budget = max(budget/q_vector->rx.count, 1);
 3608	else
 3609		per_ring_budget = budget;
 3610
 3611	ixgbe_for_each_ring(ring, q_vector->rx) {
 3612		int cleaned = ring->xsk_pool ?
 3613			      ixgbe_clean_rx_irq_zc(q_vector, ring,
 3614						    per_ring_budget) :
 3615			      ixgbe_clean_rx_irq(q_vector, ring,
 3616						 per_ring_budget);
 3617
 3618		work_done += cleaned;
 3619		if (cleaned >= per_ring_budget)
 3620			clean_complete = false;
 3621	}
 3622
 3623	/* If all work not completed, return budget and keep polling */
 3624	if (!clean_complete)
 3625		return budget;
 3626
 3627	/* all work done, exit the polling mode */
 3628	if (likely(napi_complete_done(napi, work_done))) {
 3629		if (adapter->rx_itr_setting & 1)
 3630			ixgbe_set_itr(q_vector);
 3631		if (!test_bit(__IXGBE_DOWN, &adapter->state))
 3632			ixgbe_irq_enable_queues(adapter,
 3633						BIT_ULL(q_vector->v_idx));
 3634	}
 3635
 3636	return min(work_done, budget - 1);
 3637}
 3638
 3639/**
 3640 * ixgbe_request_msix_irqs - Initialize MSI-X interrupts
 3641 * @adapter: board private structure
 3642 *
 3643 * ixgbe_request_msix_irqs allocates MSI-X vectors and requests
 3644 * interrupts from the kernel.
 3645 **/
 3646static int ixgbe_request_msix_irqs(struct ixgbe_adapter *adapter)
 3647{
 3648	struct net_device *netdev = adapter->netdev;
 3649	unsigned int ri = 0, ti = 0;
 3650	int vector, err;
 3651
 3652	for (vector = 0; vector < adapter->num_q_vectors; vector++) {
 3653		struct ixgbe_q_vector *q_vector = adapter->q_vector[vector];
 3654		struct msix_entry *entry = &adapter->msix_entries[vector];
 3655
 3656		if (q_vector->tx.ring && q_vector->rx.ring) {
 3657			snprintf(q_vector->name, sizeof(q_vector->name),
 3658				 "%s-TxRx-%u", netdev->name, ri++);
 3659			ti++;
 3660		} else if (q_vector->rx.ring) {
 3661			snprintf(q_vector->name, sizeof(q_vector->name),
 3662				 "%s-rx-%u", netdev->name, ri++);
 3663		} else if (q_vector->tx.ring) {
 3664			snprintf(q_vector->name, sizeof(q_vector->name),
 3665				 "%s-tx-%u", netdev->name, ti++);
 3666		} else {
 3667			/* skip this unused q_vector */
 3668			continue;
 3669		}
 3670		err = request_irq(entry->vector, &ixgbe_msix_clean_rings, 0,
 3671				  q_vector->name, q_vector);
 3672		if (err) {
 3673			e_err(probe, "request_irq failed for MSIX interrupt "
 3674			      "Error: %d\n", err);
 3675			goto free_queue_irqs;
 3676		}
 3677		/* If Flow Director is enabled, set interrupt affinity */
 3678		if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
 3679			/* assign the mask for this irq */
 3680			irq_update_affinity_hint(entry->vector,
 3681						 &q_vector->affinity_mask);
 3682		}
 3683	}
 3684
 3685	err = request_irq(adapter->msix_entries[vector].vector,
 3686			  ixgbe_msix_other, 0, netdev->name, adapter);
 3687	if (err) {
 3688		e_err(probe, "request_irq for msix_other failed: %d\n", err);
 3689		goto free_queue_irqs;
 3690	}
 3691
 3692	return 0;
 3693
 3694free_queue_irqs:
 3695	while (vector) {
 3696		vector--;
 3697		irq_update_affinity_hint(adapter->msix_entries[vector].vector,
 3698					 NULL);
 3699		free_irq(adapter->msix_entries[vector].vector,
 3700			 adapter->q_vector[vector]);
 3701	}
 3702	adapter->flags &= ~IXGBE_FLAG_MSIX_ENABLED;
 3703	pci_disable_msix(adapter->pdev);
 3704	kfree(adapter->msix_entries);
 3705	adapter->msix_entries = NULL;
 3706	return err;
 3707}
 3708
 3709/**
 3710 * ixgbe_intr - legacy mode Interrupt Handler
 3711 * @irq: interrupt number
 3712 * @data: pointer to a network interface device structure
 3713 **/
 3714static irqreturn_t ixgbe_intr(int irq, void *data)
 3715{
 3716	struct ixgbe_adapter *adapter = data;
 3717	struct ixgbe_hw *hw = &adapter->hw;
 3718	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
 3719	u32 eicr;
 3720
 3721	/*
 3722	 * Workaround for silicon errata #26 on 82598.  Mask the interrupt
 3723	 * before the read of EICR.
 3724	 */
 3725	IXGBE_WRITE_REG(hw, IXGBE_EIMC, IXGBE_IRQ_CLEAR_MASK);
 3726
 3727	/* for NAPI, using EIAM to auto-mask tx/rx interrupt bits on read
 3728	 * therefore no explicit interrupt disable is necessary */
 3729	eicr = IXGBE_READ_REG(hw, IXGBE_EICR);
 3730	if (!eicr) {
 3731		/*
 3732		 * shared interrupt alert!
 3733		 * make sure interrupts are enabled because the read will
 3734		 * have disabled interrupts due to EIAM
 3735		 * finish the workaround of silicon errata on 82598.  Unmask
 3736		 * the interrupt that we masked before the EICR read.
 3737		 */
 3738		if (!test_bit(__IXGBE_DOWN, &adapter->state))
 3739			ixgbe_irq_enable(adapter, true, true);
 3740		return IRQ_NONE;	/* Not our interrupt */
 3741	}
 3742
 3743	if (eicr & IXGBE_EICR_LSC)
 3744		ixgbe_check_lsc(adapter);
 3745
 3746	if (eicr & IXGBE_EICR_FW_EVENT)
 3747		ixgbe_schedule_fw_event(adapter);
 3748
 3749	switch (hw->mac.type) {
 3750	case ixgbe_mac_82599EB:
 3751		ixgbe_check_sfp_event(adapter, eicr);
 3752		fallthrough;
 3753	case ixgbe_mac_X540:
 3754	case ixgbe_mac_X550:
 3755	case ixgbe_mac_X550EM_x:
 3756	case ixgbe_mac_x550em_a:
 3757	case ixgbe_mac_e610:
 3758		if (eicr & IXGBE_EICR_ECC) {
 3759			e_info(link, "Received ECC Err, initiating reset\n");
 3760			set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
 3761			ixgbe_service_event_schedule(adapter);
 3762			IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_ECC);
 3763		}
 3764		ixgbe_check_overtemp_event(adapter, eicr);
 3765		break;
 3766	default:
 3767		break;
 3768	}
 3769
 3770	ixgbe_check_fan_failure(adapter, eicr);
 3771	if (unlikely(eicr & IXGBE_EICR_TIMESYNC))
 3772		ixgbe_ptp_check_pps_event(adapter);
 3773
 3774	/* would disable interrupts here but EIAM disabled it */
 3775	napi_schedule_irqoff(&q_vector->napi);
 3776
 3777	/*
 3778	 * re-enable link(maybe) and non-queue interrupts, no flush.
 3779	 * ixgbe_poll will re-enable the queue interrupts
 3780	 */
 3781	if (!test_bit(__IXGBE_DOWN, &adapter->state))
 3782		ixgbe_irq_enable(adapter, false, false);
 3783
 3784	return IRQ_HANDLED;
 3785}
 3786
 3787/**
 3788 * ixgbe_request_irq - initialize interrupts
 3789 * @adapter: board private structure
 3790 *
 3791 * Attempts to configure interrupts using the best available
 3792 * capabilities of the hardware and kernel.
 3793 **/
 3794static int ixgbe_request_irq(struct ixgbe_adapter *adapter)
 3795{
 3796	struct net_device *netdev = adapter->netdev;
 3797	int err;
 3798
 3799	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
 3800		err = ixgbe_request_msix_irqs(adapter);
 3801	else if (adapter->flags & IXGBE_FLAG_MSI_ENABLED)
 3802		err = request_irq(adapter->pdev->irq, ixgbe_intr, 0,
 3803				  netdev->name, adapter);
 3804	else
 3805		err = request_irq(adapter->pdev->irq, ixgbe_intr, IRQF_SHARED,
 3806				  netdev->name, adapter);
 3807
 3808	if (err)
 3809		e_err(probe, "request_irq failed, Error %d\n", err);
 3810
 3811	return err;
 3812}
 3813
 3814static void ixgbe_free_irq(struct ixgbe_adapter *adapter)
 3815{
 3816	int vector;
 3817
 3818	if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED)) {
 3819		free_irq(adapter->pdev->irq, adapter);
 3820		return;
 3821	}
 3822
 3823	if (!adapter->msix_entries)
 3824		return;
 3825
 3826	for (vector = 0; vector < adapter->num_q_vectors; vector++) {
 3827		struct ixgbe_q_vector *q_vector = adapter->q_vector[vector];
 3828		struct msix_entry *entry = &adapter->msix_entries[vector];
 3829
 3830		/* free only the irqs that were actually requested */
 3831		if (!q_vector->rx.ring && !q_vector->tx.ring)
 3832			continue;
 3833
 3834		/* clear the affinity_mask in the IRQ descriptor */
 3835		irq_update_affinity_hint(entry->vector, NULL);
 3836
 3837		free_irq(entry->vector, q_vector);
 3838	}
 3839
 3840	free_irq(adapter->msix_entries[vector].vector, adapter);
 3841}
 3842
 3843/**
 3844 * ixgbe_irq_disable - Mask off interrupt generation on the NIC
 3845 * @adapter: board private structure
 3846 **/
 3847static inline void ixgbe_irq_disable(struct ixgbe_adapter *adapter)
 3848{
 3849	switch (adapter->hw.mac.type) {
 3850	case ixgbe_mac_82598EB:
 3851		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, ~0);
 3852		break;
 3853	case ixgbe_mac_82599EB:
 3854	case ixgbe_mac_X540:
 3855	case ixgbe_mac_X550:
 3856	case ixgbe_mac_X550EM_x:
 3857	case ixgbe_mac_x550em_a:
 3858	case ixgbe_mac_e610:
 3859		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFF0000);
 3860		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(0), ~0);
 3861		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(1), ~0);
 3862		break;
 3863	default:
 3864		break;
 3865	}
 3866	IXGBE_WRITE_FLUSH(&adapter->hw);
 3867	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
 3868		int vector;
 3869
 3870		for (vector = 0; vector < adapter->num_q_vectors; vector++)
 3871			synchronize_irq(adapter->msix_entries[vector].vector);
 3872
 3873		synchronize_irq(adapter->msix_entries[vector++].vector);
 3874	} else {
 3875		synchronize_irq(adapter->pdev->irq);
 3876	}
 3877}
 3878
 3879/**
 3880 * ixgbe_configure_msi_and_legacy - Initialize PIN (INTA...) and MSI interrupts
 3881 * @adapter: board private structure
 3882 *
 3883 **/
 3884static void ixgbe_configure_msi_and_legacy(struct ixgbe_adapter *adapter)
 3885{
 3886	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
 3887
 3888	ixgbe_write_eitr(q_vector);
 3889
 3890	ixgbe_set_ivar(adapter, 0, 0, 0);
 3891	ixgbe_set_ivar(adapter, 1, 0, 0);
 3892
 3893	e_info(hw, "Legacy interrupt IVAR setup done\n");
 3894}
 3895
 3896/**
 3897 * ixgbe_configure_tx_ring - Configure 8259x Tx ring after Reset
 3898 * @adapter: board private structure
 3899 * @ring: structure containing ring specific data
 3900 *
 3901 * Configure the Tx descriptor ring after a reset.
 3902 **/
 3903void ixgbe_configure_tx_ring(struct ixgbe_adapter *adapter,
 3904			     struct ixgbe_ring *ring)
 3905{
 3906	struct ixgbe_hw *hw = &adapter->hw;
 3907	u64 tdba = ring->dma;
 3908	int wait_loop = 10;
 3909	u32 txdctl = IXGBE_TXDCTL_ENABLE;
 3910	u8 reg_idx = ring->reg_idx;
 3911
 3912	ring->xsk_pool = NULL;
 3913	if (ring_is_xdp(ring))
 3914		ring->xsk_pool = ixgbe_xsk_pool(adapter, ring);
 3915
 3916	/* disable queue to avoid issues while updating state */
 3917	IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), 0);
 3918	IXGBE_WRITE_FLUSH(hw);
 3919
 3920	IXGBE_WRITE_REG(hw, IXGBE_TDBAL(reg_idx),
 3921			(tdba & DMA_BIT_MASK(32)));
 3922	IXGBE_WRITE_REG(hw, IXGBE_TDBAH(reg_idx), (tdba >> 32));
 3923	IXGBE_WRITE_REG(hw, IXGBE_TDLEN(reg_idx),
 3924			ring->count * sizeof(union ixgbe_adv_tx_desc));
 3925	IXGBE_WRITE_REG(hw, IXGBE_TDH(reg_idx), 0);
 3926	IXGBE_WRITE_REG(hw, IXGBE_TDT(reg_idx), 0);
 3927	ring->tail = adapter->io_addr + IXGBE_TDT(reg_idx);
 3928
 3929	/*
 3930	 * set WTHRESH to encourage burst writeback, it should not be set
 3931	 * higher than 1 when:
 3932	 * - ITR is 0 as it could cause false TX hangs
 3933	 * - ITR is set to > 100k int/sec and BQL is enabled
 3934	 *
 3935	 * In order to avoid issues WTHRESH + PTHRESH should always be equal
 3936	 * to or less than the number of on chip descriptors, which is
 3937	 * currently 40.
 3938	 */
 3939	if (!ring->q_vector || (ring->q_vector->itr < IXGBE_100K_ITR))
 3940		txdctl |= 1u << 16;	/* WTHRESH = 1 */
 3941	else
 3942		txdctl |= 8u << 16;	/* WTHRESH = 8 */
 3943
 3944	/*
 3945	 * Setting PTHRESH to 32 both improves performance
 3946	 * and avoids a TX hang with DFP enabled
 3947	 */
 3948	txdctl |= (1u << 8) |	/* HTHRESH = 1 */
 3949		   32;		/* PTHRESH = 32 */
 3950
 3951	/* reinitialize flowdirector state */
 3952	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
 3953		ring->atr_sample_rate = adapter->atr_sample_rate;
 3954		ring->atr_count = 0;
 3955		set_bit(__IXGBE_TX_FDIR_INIT_DONE, &ring->state);
 3956	} else {
 3957		ring->atr_sample_rate = 0;
 3958	}
 3959
 3960	/* initialize XPS */
 3961	if (!test_and_set_bit(__IXGBE_TX_XPS_INIT_DONE, &ring->state)) {
 3962		struct ixgbe_q_vector *q_vector = ring->q_vector;
 3963
 3964		if (q_vector)
 3965			netif_set_xps_queue(ring->netdev,
 3966					    &q_vector->affinity_mask,
 3967					    ring->queue_index);
 3968	}
 3969
 3970	clear_bit(__IXGBE_HANG_CHECK_ARMED, &ring->state);
 3971
 3972	/* reinitialize tx_buffer_info */
 3973	memset(ring->tx_buffer_info, 0,
 3974	       sizeof(struct ixgbe_tx_buffer) * ring->count);
 3975
 3976	/* enable queue */
 3977	IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), txdctl);
 3978
 3979	/* TXDCTL.EN will return 0 on 82598 if link is down, so skip it */
 3980	if (hw->mac.type == ixgbe_mac_82598EB &&
 3981	    !(IXGBE_READ_REG(hw, IXGBE_LINKS) & IXGBE_LINKS_UP))
 3982		return;
 3983
 3984	/* poll to verify queue is enabled */
 3985	do {
 3986		usleep_range(1000, 2000);
 3987		txdctl = IXGBE_READ_REG(hw, IXGBE_TXDCTL(reg_idx));
 3988	} while (--wait_loop && !(txdctl & IXGBE_TXDCTL_ENABLE));
 3989	if (!wait_loop)
 3990		hw_dbg(hw, "Could not enable Tx Queue %d\n", reg_idx);
 3991}
 3992
 3993static void ixgbe_setup_mtqc(struct ixgbe_adapter *adapter)
 3994{
 3995	struct ixgbe_hw *hw = &adapter->hw;
 3996	u32 rttdcs, mtqc;
 3997	u8 tcs = adapter->hw_tcs;
 3998
 3999	if (hw->mac.type == ixgbe_mac_82598EB)
 4000		return;
 4001
 4002	/* disable the arbiter while setting MTQC */
 4003	rttdcs = IXGBE_READ_REG(hw, IXGBE_RTTDCS);
 4004	rttdcs |= IXGBE_RTTDCS_ARBDIS;
 4005	IXGBE_WRITE_REG(hw, IXGBE_RTTDCS, rttdcs);
 4006
 4007	/* set transmit pool layout */
 4008	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
 4009		mtqc = IXGBE_MTQC_VT_ENA;
 4010		if (tcs > 4)
 4011			mtqc |= IXGBE_MTQC_RT_ENA | IXGBE_MTQC_8TC_8TQ;
 4012		else if (tcs > 1)
 4013			mtqc |= IXGBE_MTQC_RT_ENA | IXGBE_MTQC_4TC_4TQ;
 4014		else if (adapter->ring_feature[RING_F_VMDQ].mask ==
 4015			 IXGBE_82599_VMDQ_4Q_MASK)
 4016			mtqc |= IXGBE_MTQC_32VF;
 4017		else
 4018			mtqc |= IXGBE_MTQC_64VF;
 4019	} else {
 4020		if (tcs > 4) {
 4021			mtqc = IXGBE_MTQC_RT_ENA | IXGBE_MTQC_8TC_8TQ;
 4022		} else if (tcs > 1) {
 4023			mtqc = IXGBE_MTQC_RT_ENA | IXGBE_MTQC_4TC_4TQ;
 4024		} else {
 4025			u8 max_txq = adapter->num_tx_queues +
 4026				adapter->num_xdp_queues;
 4027			if (max_txq > 63)
 4028				mtqc = IXGBE_MTQC_RT_ENA | IXGBE_MTQC_4TC_4TQ;
 4029			else
 4030				mtqc = IXGBE_MTQC_64Q_1PB;
 4031		}
 4032	}
 4033
 4034	IXGBE_WRITE_REG(hw, IXGBE_MTQC, mtqc);
 4035
 4036	/* Enable Security TX Buffer IFG for multiple pb */
 4037	if (tcs) {
 4038		u32 sectx = IXGBE_READ_REG(hw, IXGBE_SECTXMINIFG);
 4039		sectx |= IXGBE_SECTX_DCB;
 4040		IXGBE_WRITE_REG(hw, IXGBE_SECTXMINIFG, sectx);
 4041	}
 4042
 4043	/* re-enable the arbiter */
 4044	rttdcs &= ~IXGBE_RTTDCS_ARBDIS;
 4045	IXGBE_WRITE_REG(hw, IXGBE_RTTDCS, rttdcs);
 4046}
 4047
 4048/**
 4049 * ixgbe_configure_tx - Configure 8259x Transmit Unit after Reset
 4050 * @adapter: board private structure
 4051 *
 4052 * Configure the Tx unit of the MAC after a reset.
 4053 **/
 4054static void ixgbe_configure_tx(struct ixgbe_adapter *adapter)
 4055{
 4056	struct ixgbe_hw *hw = &adapter->hw;
 4057	u32 dmatxctl;
 4058	u32 i;
 4059
 4060	ixgbe_setup_mtqc(adapter);
 4061
 4062	if (hw->mac.type != ixgbe_mac_82598EB) {
 4063		/* DMATXCTL.EN must be before Tx queues are enabled */
 4064		dmatxctl = IXGBE_READ_REG(hw, IXGBE_DMATXCTL);
 4065		dmatxctl |= IXGBE_DMATXCTL_TE;
 4066		IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL, dmatxctl);
 4067	}
 4068
 4069	/* Setup the HW Tx Head and Tail descriptor pointers */
 4070	for (i = 0; i < adapter->num_tx_queues; i++)
 4071		ixgbe_configure_tx_ring(adapter, adapter->tx_ring[i]);
 4072	for (i = 0; i < adapter->num_xdp_queues; i++)
 4073		ixgbe_configure_tx_ring(adapter, adapter->xdp_ring[i]);
 4074}
 4075
 4076static void ixgbe_enable_rx_drop(struct ixgbe_adapter *adapter,
 4077				 struct ixgbe_ring *ring)
 4078{
 4079	struct ixgbe_hw *hw = &adapter->hw;
 4080	u8 reg_idx = ring->reg_idx;
 4081	u32 srrctl = IXGBE_READ_REG(hw, IXGBE_SRRCTL(reg_idx));
 4082
 4083	srrctl |= IXGBE_SRRCTL_DROP_EN;
 4084
 4085	IXGBE_WRITE_REG(hw, IXGBE_SRRCTL(reg_idx), srrctl);
 4086}
 4087
 4088static void ixgbe_disable_rx_drop(struct ixgbe_adapter *adapter,
 4089				  struct ixgbe_ring *ring)
 4090{
 4091	struct ixgbe_hw *hw = &adapter->hw;
 4092	u8 reg_idx = ring->reg_idx;
 4093	u32 srrctl = IXGBE_READ_REG(hw, IXGBE_SRRCTL(reg_idx));
 4094
 4095	srrctl &= ~IXGBE_SRRCTL_DROP_EN;
 4096
 4097	IXGBE_WRITE_REG(hw, IXGBE_SRRCTL(reg_idx), srrctl);
 4098}
 4099
 4100#ifdef CONFIG_IXGBE_DCB
 4101void ixgbe_set_rx_drop_en(struct ixgbe_adapter *adapter)
 4102#else
 4103static void ixgbe_set_rx_drop_en(struct ixgbe_adapter *adapter)
 4104#endif
 4105{
 4106	bool pfc_en = adapter->dcb_cfg.pfc_mode_enable;
 4107	struct ixgbe_hw *hw = &adapter->hw;
 4108	int i;
 4109
 4110	if (hw->mac.ops.disable_mdd)
 4111		hw->mac.ops.disable_mdd(hw);
 4112
 4113	if (adapter->ixgbe_ieee_pfc)
 4114		pfc_en |= !!(adapter->ixgbe_ieee_pfc->pfc_en);
 4115
 4116	/*
 4117	 * We should set the drop enable bit if:
 4118	 *  SR-IOV is enabled
 4119	 *   or
 4120	 *  Number of Rx queues > 1 and flow control is disabled
 4121	 *
 4122	 *  This allows us to avoid head of line blocking for security
 4123	 *  and performance reasons.
 4124	 */
 4125	if (adapter->num_vfs || (adapter->num_rx_queues > 1 &&
 4126	    !(adapter->hw.fc.current_mode & ixgbe_fc_tx_pause) && !pfc_en)) {
 4127		for (i = 0; i < adapter->num_rx_queues; i++)
 4128			ixgbe_enable_rx_drop(adapter, adapter->rx_ring[i]);
 4129	} else {
 4130		for (i = 0; i < adapter->num_rx_queues; i++)
 4131			ixgbe_disable_rx_drop(adapter, adapter->rx_ring[i]);
 4132	}
 4133
 4134	if (hw->mac.ops.enable_mdd)
 4135		hw->mac.ops.enable_mdd(hw);
 4136}
 4137
 4138#define IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT 2
 4139
 4140static void ixgbe_configure_srrctl(struct ixgbe_adapter *adapter,
 4141				   struct ixgbe_ring *rx_ring)
 4142{
 4143	struct ixgbe_hw *hw = &adapter->hw;
 4144	u32 srrctl;
 4145	u8 reg_idx = rx_ring->reg_idx;
 4146
 4147	if (hw->mac.type == ixgbe_mac_82598EB) {
 4148		u16 mask = adapter->ring_feature[RING_F_RSS].mask;
 4149
 4150		/*
 4151		 * if VMDq is not active we must program one srrctl register
 4152		 * per RSS queue since we have enabled RDRXCTL.MVMEN
 4153		 */
 4154		reg_idx &= mask;
 4155	}
 4156
 4157	/* configure header buffer length, needed for RSC */
 4158	srrctl = IXGBE_RX_HDR_SIZE << IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT;
 4159
 4160	/* configure the packet buffer length */
 4161	if (rx_ring->xsk_pool) {
 4162		u32 xsk_buf_len = xsk_pool_get_rx_frame_size(rx_ring->xsk_pool);
 4163
 4164		/* If the MAC support setting RXDCTL.RLPML, the
 4165		 * SRRCTL[n].BSIZEPKT is set to PAGE_SIZE and
 4166		 * RXDCTL.RLPML is set to the actual UMEM buffer
 4167		 * size. If not, then we are stuck with a 1k buffer
 4168		 * size resolution. In this case frames larger than
 4169		 * the UMEM buffer size viewed in a 1k resolution will
 4170		 * be dropped.
 4171		 */
 4172		if (hw->mac.type != ixgbe_mac_82599EB)
 4173			srrctl |= PAGE_SIZE >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
 4174		else
 4175			srrctl |= xsk_buf_len >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
 4176	} else if (test_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state)) {
 4177		srrctl |= IXGBE_RXBUFFER_3K >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
 4178	} else {
 4179		srrctl |= IXGBE_RXBUFFER_2K >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
 4180	}
 4181
 4182	/* configure descriptor type */
 4183	srrctl |= IXGBE_SRRCTL_DESCTYPE_ADV_ONEBUF;
 4184
 4185	IXGBE_WRITE_REG(hw, IXGBE_SRRCTL(reg_idx), srrctl);
 4186}
 4187
 4188/**
 4189 * ixgbe_rss_indir_tbl_entries - Return RSS indirection table entries
 4190 * @adapter: device handle
 4191 *
 4192 *  - 82598/82599/X540:     128
 4193 *  - X550(non-SRIOV mode): 512
 4194 *  - X550(SRIOV mode):     64
 4195 */
 4196u32 ixgbe_rss_indir_tbl_entries(struct ixgbe_adapter *adapter)
 4197{
 4198	if (adapter->hw.mac.type < ixgbe_mac_X550)
 4199		return 128;
 4200	else if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
 4201		return 64;
 4202	else
 4203		return 512;
 4204}
 4205
 4206/**
 4207 * ixgbe_store_key - Write the RSS key to HW
 4208 * @adapter: device handle
 4209 *
 4210 * Write the RSS key stored in adapter.rss_key to HW.
 4211 */
 4212void ixgbe_store_key(struct ixgbe_adapter *adapter)
 4213{
 4214	struct ixgbe_hw *hw = &adapter->hw;
 4215	int i;
 4216
 4217	for (i = 0; i < 10; i++)
 4218		IXGBE_WRITE_REG(hw, IXGBE_RSSRK(i), adapter->rss_key[i]);
 4219}
 4220
 4221/**
 4222 * ixgbe_init_rss_key - Initialize adapter RSS key
 4223 * @adapter: device handle
 4224 *
 4225 * Allocates and initializes the RSS key if it is not allocated.
 4226 **/
 4227static inline int ixgbe_init_rss_key(struct ixgbe_adapter *adapter)
 4228{
 4229	u32 *rss_key;
 4230
 4231	if (!adapter->rss_key) {
 4232		rss_key = kzalloc(IXGBE_RSS_KEY_SIZE, GFP_KERNEL);
 4233		if (unlikely(!rss_key))
 4234			return -ENOMEM;
 4235
 4236		netdev_rss_key_fill(rss_key, IXGBE_RSS_KEY_SIZE);
 4237		adapter->rss_key = rss_key;
 4238	}
 4239
 4240	return 0;
 4241}
 4242
 4243/**
 4244 * ixgbe_store_reta - Write the RETA table to HW
 4245 * @adapter: device handle
 4246 *
 4247 * Write the RSS redirection table stored in adapter.rss_indir_tbl[] to HW.
 4248 */
 4249void ixgbe_store_reta(struct ixgbe_adapter *adapter)
 4250{
 4251	u32 i, reta_entries = ixgbe_rss_indir_tbl_entries(adapter);
 4252	struct ixgbe_hw *hw = &adapter->hw;
 4253	u32 reta = 0;
 4254	u32 indices_multi;
 4255	u8 *indir_tbl = adapter->rss_indir_tbl;
 4256
 4257	/* Fill out the redirection table as follows:
 4258	 *  - 82598:      8 bit wide entries containing pair of 4 bit RSS
 4259	 *    indices.
 4260	 *  - 82599/X540: 8 bit wide entries containing 4 bit RSS index
 4261	 *  - X550:       8 bit wide entries containing 6 bit RSS index
 4262	 */
 4263	if (adapter->hw.mac.type == ixgbe_mac_82598EB)
 4264		indices_multi = 0x11;
 4265	else
 4266		indices_multi = 0x1;
 4267
 4268	/* Write redirection table to HW */
 4269	for (i = 0; i < reta_entries; i++) {
 4270		reta |= indices_multi * indir_tbl[i] << (i & 0x3) * 8;
 4271		if ((i & 3) == 3) {
 4272			if (i < 128)
 4273				IXGBE_WRITE_REG(hw, IXGBE_RETA(i >> 2), reta);
 4274			else
 4275				IXGBE_WRITE_REG(hw, IXGBE_ERETA((i >> 2) - 32),
 4276						reta);
 4277			reta = 0;
 4278		}
 4279	}
 4280}
 4281
 4282/**
 4283 * ixgbe_store_vfreta - Write the RETA table to HW (x550 devices in SRIOV mode)
 4284 * @adapter: device handle
 4285 *
 4286 * Write the RSS redirection table stored in adapter.rss_indir_tbl[] to HW.
 4287 */
 4288static void ixgbe_store_vfreta(struct ixgbe_adapter *adapter)
 4289{
 4290	u32 i, reta_entries = ixgbe_rss_indir_tbl_entries(adapter);
 4291	struct ixgbe_hw *hw = &adapter->hw;
 4292	u32 vfreta = 0;
 4293
 4294	/* Write redirection table to HW */
 4295	for (i = 0; i < reta_entries; i++) {
 4296		u16 pool = adapter->num_rx_pools;
 4297
 4298		vfreta |= (u32)adapter->rss_indir_tbl[i] << (i & 0x3) * 8;
 4299		if ((i & 3) != 3)
 4300			continue;
 4301
 4302		while (pool--)
 4303			IXGBE_WRITE_REG(hw,
 4304					IXGBE_PFVFRETA(i >> 2, VMDQ_P(pool)),
 4305					vfreta);
 4306		vfreta = 0;
 4307	}
 4308}
 4309
 4310static void ixgbe_setup_reta(struct ixgbe_adapter *adapter)
 4311{
 4312	u32 i, j;
 4313	u32 reta_entries = ixgbe_rss_indir_tbl_entries(adapter);
 4314	u16 rss_i = adapter->ring_feature[RING_F_RSS].indices;
 4315
 4316	/* Program table for at least 4 queues w/ SR-IOV so that VFs can
 4317	 * make full use of any rings they may have.  We will use the
 4318	 * PSRTYPE register to control how many rings we use within the PF.
 4319	 */
 4320	if ((adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) && (rss_i < 4))
 4321		rss_i = 4;
 4322
 4323	/* Fill out hash function seeds */
 4324	ixgbe_store_key(adapter);
 4325
 4326	/* Fill out redirection table */
 4327	memset(adapter->rss_indir_tbl, 0, sizeof(adapter->rss_indir_tbl));
 4328
 4329	for (i = 0, j = 0; i < reta_entries; i++, j++) {
 4330		if (j == rss_i)
 4331			j = 0;
 4332
 4333		adapter->rss_indir_tbl[i] = j;
 4334	}
 4335
 4336	ixgbe_store_reta(adapter);
 4337}
 4338
 4339static void ixgbe_setup_vfreta(struct ixgbe_adapter *adapter)
 4340{
 4341	struct ixgbe_hw *hw = &adapter->hw;
 4342	u16 rss_i = adapter->ring_feature[RING_F_RSS].indices;
 4343	int i, j;
 4344
 4345	/* Fill out hash function seeds */
 4346	for (i = 0; i < 10; i++) {
 4347		u16 pool = adapter->num_rx_pools;
 4348
 4349		while (pool--)
 4350			IXGBE_WRITE_REG(hw,
 4351					IXGBE_PFVFRSSRK(i, VMDQ_P(pool)),
 4352					*(adapter->rss_key + i));
 4353	}
 4354
 4355	/* Fill out the redirection table */
 4356	for (i = 0, j = 0; i < 64; i++, j++) {
 4357		if (j == rss_i)
 4358			j = 0;
 4359
 4360		adapter->rss_indir_tbl[i] = j;
 4361	}
 4362
 4363	ixgbe_store_vfreta(adapter);
 4364}
 4365
 4366static void ixgbe_setup_mrqc(struct ixgbe_adapter *adapter)
 4367{
 4368	struct ixgbe_hw *hw = &adapter->hw;
 4369	u32 mrqc = 0, rss_field = 0, vfmrqc = 0;
 4370	u32 rxcsum;
 4371
 4372	/* Disable indicating checksum in descriptor, enables RSS hash */
 4373	rxcsum = IXGBE_READ_REG(hw, IXGBE_RXCSUM);
 4374	rxcsum |= IXGBE_RXCSUM_PCSD;
 4375	IXGBE_WRITE_REG(hw, IXGBE_RXCSUM, rxcsum);
 4376
 4377	if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
 4378		if (adapter->ring_feature[RING_F_RSS].mask)
 4379			mrqc = IXGBE_MRQC_RSSEN;
 4380	} else {
 4381		u8 tcs = adapter->hw_tcs;
 4382
 4383		if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
 4384			if (tcs > 4)
 4385				mrqc = IXGBE_MRQC_VMDQRT8TCEN;	/* 8 TCs */
 4386			else if (tcs > 1)
 4387				mrqc = IXGBE_MRQC_VMDQRT4TCEN;	/* 4 TCs */
 4388			else if (adapter->ring_feature[RING_F_VMDQ].mask ==
 4389				 IXGBE_82599_VMDQ_4Q_MASK)
 4390				mrqc = IXGBE_MRQC_VMDQRSS32EN;
 4391			else
 4392				mrqc = IXGBE_MRQC_VMDQRSS64EN;
 4393
 4394			/* Enable L3/L4 for Tx Switched packets only for X550,
 4395			 * older devices do not support this feature
 4396			 */
 4397			if (hw->mac.type >= ixgbe_mac_X550)
 4398				mrqc |= IXGBE_MRQC_L3L4TXSWEN;
 4399		} else {
 4400			if (tcs > 4)
 4401				mrqc = IXGBE_MRQC_RTRSS8TCEN;
 4402			else if (tcs > 1)
 4403				mrqc = IXGBE_MRQC_RTRSS4TCEN;
 4404			else
 4405				mrqc = IXGBE_MRQC_RSSEN;
 4406		}
 4407	}
 4408
 4409	/* Perform hash on these packet types */
 4410	rss_field |= IXGBE_MRQC_RSS_FIELD_IPV4 |
 4411		     IXGBE_MRQC_RSS_FIELD_IPV4_TCP |
 4412		     IXGBE_MRQC_RSS_FIELD_IPV6 |
 4413		     IXGBE_MRQC_RSS_FIELD_IPV6_TCP;
 4414
 4415	if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV4_UDP)
 4416		rss_field |= IXGBE_MRQC_RSS_FIELD_IPV4_UDP;
 4417	if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV6_UDP)
 4418		rss_field |= IXGBE_MRQC_RSS_FIELD_IPV6_UDP;
 4419
 4420	if ((hw->mac.type >= ixgbe_mac_X550) &&
 4421	    (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)) {
 4422		u16 pool = adapter->num_rx_pools;
 4423
 4424		/* Enable VF RSS mode */
 4425		mrqc |= IXGBE_MRQC_MULTIPLE_RSS;
 4426		IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
 4427
 4428		/* Setup RSS through the VF registers */
 4429		ixgbe_setup_vfreta(adapter);
 4430		vfmrqc = IXGBE_MRQC_RSSEN;
 4431		vfmrqc |= rss_field;
 4432
 4433		while (pool--)
 4434			IXGBE_WRITE_REG(hw,
 4435					IXGBE_PFVFMRQC(VMDQ_P(pool)),
 4436					vfmrqc);
 4437	} else {
 4438		ixgbe_setup_reta(adapter);
 4439		mrqc |= rss_field;
 4440		IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
 4441	}
 4442}
 4443
 4444/**
 4445 * ixgbe_configure_rscctl - enable RSC for the indicated ring
 4446 * @adapter: address of board private structure
 4447 * @ring: structure containing ring specific data
 4448 **/
 4449static void ixgbe_configure_rscctl(struct ixgbe_adapter *adapter,
 4450				   struct ixgbe_ring *ring)
 4451{
 4452	struct ixgbe_hw *hw = &adapter->hw;
 4453	u32 rscctrl;
 4454	u8 reg_idx = ring->reg_idx;
 4455
 4456	if (!ring_is_rsc_enabled(ring))
 4457		return;
 4458
 4459	rscctrl = IXGBE_READ_REG(hw, IXGBE_RSCCTL(reg_idx));
 4460	rscctrl |= IXGBE_RSCCTL_RSCEN;
 4461	/*
 4462	 * we must limit the number of descriptors so that the
 4463	 * total size of max desc * buf_len is not greater
 4464	 * than 65536
 4465	 */
 4466	rscctrl |= IXGBE_RSCCTL_MAXDESC_16;
 4467	IXGBE_WRITE_REG(hw, IXGBE_RSCCTL(reg_idx), rscctrl);
 4468}
 4469
 4470#define IXGBE_MAX_RX_DESC_POLL 10
 4471static void ixgbe_rx_desc_queue_enable(struct ixgbe_adapter *adapter,
 4472				       struct ixgbe_ring *ring)
 4473{
 4474	struct ixgbe_hw *hw = &adapter->hw;
 4475	int wait_loop = IXGBE_MAX_RX_DESC_POLL;
 4476	u32 rxdctl;
 4477	u8 reg_idx = ring->reg_idx;
 4478
 4479	if (ixgbe_removed(hw->hw_addr))
 4480		return;
 4481	/* RXDCTL.EN will return 0 on 82598 if link is down, so skip it */
 4482	if (hw->mac.type == ixgbe_mac_82598EB &&
 4483	    !(IXGBE_READ_REG(hw, IXGBE_LINKS) & IXGBE_LINKS_UP))
 4484		return;
 4485
 4486	do {
 4487		usleep_range(1000, 2000);
 4488		rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
 4489	} while (--wait_loop && !(rxdctl & IXGBE_RXDCTL_ENABLE));
 4490
 4491	if (!wait_loop) {
 4492		e_err(drv, "RXDCTL.ENABLE on Rx queue %d not set within "
 4493		      "the polling period\n", reg_idx);
 4494	}
 4495}
 4496
 4497void ixgbe_configure_rx_ring(struct ixgbe_adapter *adapter,
 4498			     struct ixgbe_ring *ring)
 4499{
 4500	struct ixgbe_hw *hw = &adapter->hw;
 4501	union ixgbe_adv_rx_desc *rx_desc;
 4502	u64 rdba = ring->dma;
 4503	u32 rxdctl;
 4504	u8 reg_idx = ring->reg_idx;
 4505
 4506	xdp_rxq_info_unreg_mem_model(&ring->xdp_rxq);
 4507	ring->xsk_pool = ixgbe_xsk_pool(adapter, ring);
 4508	if (ring->xsk_pool) {
 4509		WARN_ON(xdp_rxq_info_reg_mem_model(&ring->xdp_rxq,
 4510						   MEM_TYPE_XSK_BUFF_POOL,
 4511						   NULL));
 4512		xsk_pool_set_rxq_info(ring->xsk_pool, &ring->xdp_rxq);
 4513	} else {
 4514		WARN_ON(xdp_rxq_info_reg_mem_model(&ring->xdp_rxq,
 4515						   MEM_TYPE_PAGE_SHARED, NULL));
 4516	}
 4517
 4518	/* disable queue to avoid use of these values while updating state */
 4519	rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
 4520	rxdctl &= ~IXGBE_RXDCTL_ENABLE;
 4521
 4522	/* write value back with RXDCTL.ENABLE bit cleared */
 4523	IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(reg_idx), rxdctl);
 4524	IXGBE_WRITE_FLUSH(hw);
 4525
 4526	IXGBE_WRITE_REG(hw, IXGBE_RDBAL(reg_idx), (rdba & DMA_BIT_MASK(32)));
 4527	IXGBE_WRITE_REG(hw, IXGBE_RDBAH(reg_idx), (rdba >> 32));
 4528	IXGBE_WRITE_REG(hw, IXGBE_RDLEN(reg_idx),
 4529			ring->count * sizeof(union ixgbe_adv_rx_desc));
 4530	/* Force flushing of IXGBE_RDLEN to prevent MDD */
 4531	IXGBE_WRITE_FLUSH(hw);
 4532
 4533	IXGBE_WRITE_REG(hw, IXGBE_RDH(reg_idx), 0);
 4534	IXGBE_WRITE_REG(hw, IXGBE_RDT(reg_idx), 0);
 4535	ring->tail = adapter->io_addr + IXGBE_RDT(reg_idx);
 4536
 4537	ixgbe_configure_srrctl(adapter, ring);
 4538	ixgbe_configure_rscctl(adapter, ring);
 4539
 4540	if (hw->mac.type == ixgbe_mac_82598EB) {
 4541		/*
 4542		 * enable cache line friendly hardware writes:
 4543		 * PTHRESH=32 descriptors (half the internal cache),
 4544		 * this also removes ugly rx_no_buffer_count increment
 4545		 * HTHRESH=4 descriptors (to minimize latency on fetch)
 4546		 * WTHRESH=8 burst writeback up to two cache lines
 4547		 */
 4548		rxdctl &= ~0x3FFFFF;
 4549		rxdctl |=  0x080420;
 4550#if (PAGE_SIZE < 8192)
 4551	/* RXDCTL.RLPML does not work on 82599 */
 4552	} else if (hw->mac.type != ixgbe_mac_82599EB) {
 4553		rxdctl &= ~(IXGBE_RXDCTL_RLPMLMASK |
 4554			    IXGBE_RXDCTL_RLPML_EN);
 4555
 4556		/* Limit the maximum frame size so we don't overrun the skb.
 4557		 * This can happen in SRIOV mode when the MTU of the VF is
 4558		 * higher than the MTU of the PF.
 4559		 */
 4560		if (ring_uses_build_skb(ring) &&
 4561		    !test_bit(__IXGBE_RX_3K_BUFFER, &ring->state))
 4562			rxdctl |= IXGBE_MAX_2K_FRAME_BUILD_SKB |
 4563				  IXGBE_RXDCTL_RLPML_EN;
 4564#endif
 4565	}
 4566
 4567	ring->rx_offset = ixgbe_rx_offset(ring);
 4568
 4569	if (ring->xsk_pool && hw->mac.type != ixgbe_mac_82599EB) {
 4570		u32 xsk_buf_len = xsk_pool_get_rx_frame_size(ring->xsk_pool);
 4571
 4572		rxdctl &= ~(IXGBE_RXDCTL_RLPMLMASK |
 4573			    IXGBE_RXDCTL_RLPML_EN);
 4574		rxdctl |= xsk_buf_len | IXGBE_RXDCTL_RLPML_EN;
 4575
 4576		ring->rx_buf_len = xsk_buf_len;
 4577	}
 4578
 4579	/* initialize rx_buffer_info */
 4580	memset(ring->rx_buffer_info, 0,
 4581	       sizeof(struct ixgbe_rx_buffer) * ring->count);
 4582
 4583	/* initialize Rx descriptor 0 */
 4584	rx_desc = IXGBE_RX_DESC(ring, 0);
 4585	rx_desc->wb.upper.length = 0;
 4586
 4587	/* enable receive descriptor ring */
 4588	rxdctl |= IXGBE_RXDCTL_ENABLE;
 4589	IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(reg_idx), rxdctl);
 4590
 4591	ixgbe_rx_desc_queue_enable(adapter, ring);
 4592	if (ring->xsk_pool)
 4593		ixgbe_alloc_rx_buffers_zc(ring, ixgbe_desc_unused(ring));
 4594	else
 4595		ixgbe_alloc_rx_buffers(ring, ixgbe_desc_unused(ring));
 4596}
 4597
 4598static void ixgbe_setup_psrtype(struct ixgbe_adapter *adapter)
 4599{
 4600	struct ixgbe_hw *hw = &adapter->hw;
 4601	int rss_i = adapter->ring_feature[RING_F_RSS].indices;
 4602	u16 pool = adapter->num_rx_pools;
 4603
 4604	/* PSRTYPE must be initialized in non 82598 adapters */
 4605	u32 psrtype = IXGBE_PSRTYPE_TCPHDR |
 4606		      IXGBE_PSRTYPE_UDPHDR |
 4607		      IXGBE_PSRTYPE_IPV4HDR |
 4608		      IXGBE_PSRTYPE_L2HDR |
 4609		      IXGBE_PSRTYPE_IPV6HDR;
 4610
 4611	if (hw->mac.type == ixgbe_mac_82598EB)
 4612		return;
 4613
 4614	if (rss_i > 3)
 4615		psrtype |= 2u << 29;
 4616	else if (rss_i > 1)
 4617		psrtype |= 1u << 29;
 4618
 4619	while (pool--)
 4620		IXGBE_WRITE_REG(hw, IXGBE_PSRTYPE(VMDQ_P(pool)), psrtype);
 4621}
 4622
 4623static void ixgbe_configure_virtualization(struct ixgbe_adapter *adapter)
 4624{
 4625	struct ixgbe_hw *hw = &adapter->hw;
 4626	u16 pool = adapter->num_rx_pools;
 4627	u32 reg_offset, vf_shift, vmolr;
 4628	u32 gcr_ext, vmdctl;
 4629	int i;
 4630
 4631	if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
 4632		return;
 4633
 4634	vmdctl = IXGBE_READ_REG(hw, IXGBE_VT_CTL);
 4635	vmdctl |= IXGBE_VMD_CTL_VMDQ_EN;
 4636	vmdctl &= ~IXGBE_VT_CTL_POOL_MASK;
 4637	vmdctl |= VMDQ_P(0) << IXGBE_VT_CTL_POOL_SHIFT;
 4638	vmdctl |= IXGBE_VT_CTL_REPLEN;
 4639	IXGBE_WRITE_REG(hw, IXGBE_VT_CTL, vmdctl);
 4640
 4641	/* accept untagged packets until a vlan tag is
 4642	 * specifically set for the VMDQ queue/pool
 4643	 */
 4644	vmolr = IXGBE_VMOLR_AUPE;
 4645	while (pool--)
 4646		IXGBE_WRITE_REG(hw, IXGBE_VMOLR(VMDQ_P(pool)), vmolr);
 4647
 4648	vf_shift = VMDQ_P(0) % 32;
 4649	reg_offset = (VMDQ_P(0) >= 32) ? 1 : 0;
 4650
 4651	/* Enable only the PF's pool for Tx/Rx */
 4652	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), GENMASK(31, vf_shift));
 4653	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset ^ 1), reg_offset - 1);
 4654	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), GENMASK(31, vf_shift));
 4655	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset ^ 1), reg_offset - 1);
 4656	if (adapter->bridge_mode == BRIDGE_MODE_VEB)
 4657		IXGBE_WRITE_REG(hw, IXGBE_PFDTXGSWC, IXGBE_PFDTXGSWC_VT_LBEN);
 4658
 4659	/* Map PF MAC address in RAR Entry 0 to first pool following VFs */
 4660	hw->mac.ops.set_vmdq(hw, 0, VMDQ_P(0));
 4661
 4662	/* clear VLAN promisc flag so VFTA will be updated if necessary */
 4663	adapter->flags2 &= ~IXGBE_FLAG2_VLAN_PROMISC;
 4664
 4665	/*
 4666	 * Set up VF register offsets for selected VT Mode,
 4667	 * i.e. 32 or 64 VFs for SR-IOV
 4668	 */
 4669	switch (adapter->ring_feature[RING_F_VMDQ].mask) {
 4670	case IXGBE_82599_VMDQ_8Q_MASK:
 4671		gcr_ext = IXGBE_GCR_EXT_VT_MODE_16;
 4672		break;
 4673	case IXGBE_82599_VMDQ_4Q_MASK:
 4674		gcr_ext = IXGBE_GCR_EXT_VT_MODE_32;
 4675		break;
 4676	default:
 4677		gcr_ext = IXGBE_GCR_EXT_VT_MODE_64;
 4678		break;
 4679	}
 4680
 4681	IXGBE_WRITE_REG(hw, IXGBE_GCR_EXT, gcr_ext);
 4682
 4683	for (i = 0; i < adapter->num_vfs; i++) {
 4684		/* configure spoof checking */
 4685		ixgbe_ndo_set_vf_spoofchk(adapter->netdev, i,
 4686					  adapter->vfinfo[i].spoofchk_enabled);
 4687
 4688		/* Enable/Disable RSS query feature  */
 4689		ixgbe_ndo_set_vf_rss_query_en(adapter->netdev, i,
 4690					  adapter->vfinfo[i].rss_query_enabled);
 4691	}
 4692}
 4693
 4694static void ixgbe_set_rx_buffer_len(struct ixgbe_adapter *adapter)
 4695{
 4696	struct ixgbe_hw *hw = &adapter->hw;
 4697	struct net_device *netdev = adapter->netdev;
 4698	int max_frame = netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
 4699	struct ixgbe_ring *rx_ring;
 4700	int i;
 4701	u32 mhadd, hlreg0;
 4702
 4703#ifdef IXGBE_FCOE
 4704	/* adjust max frame to be able to do baby jumbo for FCoE */
 4705	if ((adapter->flags & IXGBE_FLAG_FCOE_ENABLED) &&
 4706	    (max_frame < IXGBE_FCOE_JUMBO_FRAME_SIZE))
 4707		max_frame = IXGBE_FCOE_JUMBO_FRAME_SIZE;
 4708
 4709#endif /* IXGBE_FCOE */
 4710
 4711	/* adjust max frame to be at least the size of a standard frame */
 4712	if (max_frame < (ETH_FRAME_LEN + ETH_FCS_LEN))
 4713		max_frame = (ETH_FRAME_LEN + ETH_FCS_LEN);
 4714
 4715	mhadd = IXGBE_READ_REG(hw, IXGBE_MHADD);
 4716	if (max_frame != (mhadd >> IXGBE_MHADD_MFS_SHIFT)) {
 4717		mhadd &= ~IXGBE_MHADD_MFS_MASK;
 4718		mhadd |= max_frame << IXGBE_MHADD_MFS_SHIFT;
 4719
 4720		IXGBE_WRITE_REG(hw, IXGBE_MHADD, mhadd);
 4721	}
 4722
 4723	hlreg0 = IXGBE_READ_REG(hw, IXGBE_HLREG0);
 4724	/* set jumbo enable since MHADD.MFS is keeping size locked at max_frame */
 4725	hlreg0 |= IXGBE_HLREG0_JUMBOEN;
 4726	IXGBE_WRITE_REG(hw, IXGBE_HLREG0, hlreg0);
 4727
 4728	/*
 4729	 * Setup the HW Rx Head and Tail Descriptor Pointers and
 4730	 * the Base and Length of the Rx Descriptor Ring
 4731	 */
 4732	for (i = 0; i < adapter->num_rx_queues; i++) {
 4733		rx_ring = adapter->rx_ring[i];
 4734
 4735		clear_ring_rsc_enabled(rx_ring);
 4736		clear_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state);
 4737		clear_bit(__IXGBE_RX_BUILD_SKB_ENABLED, &rx_ring->state);
 4738
 4739		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
 4740			set_ring_rsc_enabled(rx_ring);
 4741
 4742		if (test_bit(__IXGBE_RX_FCOE, &rx_ring->state))
 4743			set_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state);
 4744
 4745		if (adapter->flags2 & IXGBE_FLAG2_RX_LEGACY)
 4746			continue;
 4747
 4748		set_bit(__IXGBE_RX_BUILD_SKB_ENABLED, &rx_ring->state);
 4749
 4750#if (PAGE_SIZE < 8192)
 4751		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
 4752			set_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state);
 4753
 4754		if (IXGBE_2K_TOO_SMALL_WITH_PADDING ||
 4755		    (max_frame > (ETH_FRAME_LEN + ETH_FCS_LEN)))
 4756			set_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state);
 4757#endif
 4758	}
 4759}
 4760
 4761static void ixgbe_setup_rdrxctl(struct ixgbe_adapter *adapter)
 4762{
 4763	struct ixgbe_hw *hw = &adapter->hw;
 4764	u32 rdrxctl = IXGBE_READ_REG(hw, IXGBE_RDRXCTL);
 4765
 4766	switch (hw->mac.type) {
 4767	case ixgbe_mac_82598EB:
 4768		/*
 4769		 * For VMDq support of different descriptor types or
 4770		 * buffer sizes through the use of multiple SRRCTL
 4771		 * registers, RDRXCTL.MVMEN must be set to 1
 4772		 *
 4773		 * also, the manual doesn't mention it clearly but DCA hints
 4774		 * will only use queue 0's tags unless this bit is set.  Side
 4775		 * effects of setting this bit are only that SRRCTL must be
 4776		 * fully programmed [0..15]
 4777		 */
 4778		rdrxctl |= IXGBE_RDRXCTL_MVMEN;
 4779		break;
 4780	case ixgbe_mac_X550:
 4781	case ixgbe_mac_X550EM_x:
 4782	case ixgbe_mac_x550em_a:
 4783	case ixgbe_mac_e610:
 4784		if (adapter->num_vfs)
 4785			rdrxctl |= IXGBE_RDRXCTL_PSP;
 4786		fallthrough;
 4787	case ixgbe_mac_82599EB:
 4788	case ixgbe_mac_X540:
 4789		/* Disable RSC for ACK packets */
 4790		IXGBE_WRITE_REG(hw, IXGBE_RSCDBU,
 4791		   (IXGBE_RSCDBU_RSCACKDIS | IXGBE_READ_REG(hw, IXGBE_RSCDBU)));
 4792		rdrxctl &= ~IXGBE_RDRXCTL_RSCFRSTSIZE;
 4793		/* hardware requires some bits to be set by default */
 4794		rdrxctl |= (IXGBE_RDRXCTL_RSCACKC | IXGBE_RDRXCTL_FCOE_WRFIX);
 4795		rdrxctl |= IXGBE_RDRXCTL_CRCSTRIP;
 4796		break;
 4797	default:
 4798		/* We should do nothing since we don't know this hardware */
 4799		return;
 4800	}
 4801
 4802	IXGBE_WRITE_REG(hw, IXGBE_RDRXCTL, rdrxctl);
 4803}
 4804
 4805/**
 4806 * ixgbe_configure_rx - Configure 8259x Receive Unit after Reset
 4807 * @adapter: board private structure
 4808 *
 4809 * Configure the Rx unit of the MAC after a reset.
 4810 **/
 4811static void ixgbe_configure_rx(struct ixgbe_adapter *adapter)
 4812{
 4813	struct ixgbe_hw *hw = &adapter->hw;
 4814	int i;
 4815	u32 rxctrl, rfctl;
 4816
 4817	/* disable receives while setting up the descriptors */
 4818	hw->mac.ops.disable_rx(hw);
 4819
 4820	ixgbe_setup_psrtype(adapter);
 4821	ixgbe_setup_rdrxctl(adapter);
 4822
 4823	/* RSC Setup */
 4824	rfctl = IXGBE_READ_REG(hw, IXGBE_RFCTL);
 4825	rfctl &= ~IXGBE_RFCTL_RSC_DIS;
 4826	if (!(adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED))
 4827		rfctl |= IXGBE_RFCTL_RSC_DIS;
 4828
 4829	/* disable NFS filtering */
 4830	rfctl |= (IXGBE_RFCTL_NFSW_DIS | IXGBE_RFCTL_NFSR_DIS);
 4831	IXGBE_WRITE_REG(hw, IXGBE_RFCTL, rfctl);
 4832
 4833	/* Program registers for the distribution of queues */
 4834	ixgbe_setup_mrqc(adapter);
 4835
 4836	/* set_rx_buffer_len must be called before ring initialization */
 4837	ixgbe_set_rx_buffer_len(adapter);
 4838
 4839	/*
 4840	 * Setup the HW Rx Head and Tail Descriptor Pointers and
 4841	 * the Base and Length of the Rx Descriptor Ring
 4842	 */
 4843	for (i = 0; i < adapter->num_rx_queues; i++)
 4844		ixgbe_configure_rx_ring(adapter, adapter->rx_ring[i]);
 4845
 4846	rxctrl = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
 4847	/* disable drop enable for 82598 parts */
 4848	if (hw->mac.type == ixgbe_mac_82598EB)
 4849		rxctrl |= IXGBE_RXCTRL_DMBYPS;
 4850
 4851	/* enable all receives */
 4852	rxctrl |= IXGBE_RXCTRL_RXEN;
 4853	hw->mac.ops.enable_rx_dma(hw, rxctrl);
 4854}
 4855
 4856static int ixgbe_vlan_rx_add_vid(struct net_device *netdev,
 4857				 __be16 proto, u16 vid)
 4858{
 4859	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 4860	struct ixgbe_hw *hw = &adapter->hw;
 4861
 4862	/* add VID to filter table */
 4863	if (!vid || !(adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
 4864		hw->mac.ops.set_vfta(&adapter->hw, vid, VMDQ_P(0), true, !!vid);
 4865
 4866	set_bit(vid, adapter->active_vlans);
 4867
 4868	return 0;
 4869}
 4870
 4871static int ixgbe_find_vlvf_entry(struct ixgbe_hw *hw, u32 vlan)
 4872{
 4873	u32 vlvf;
 4874	int idx;
 4875
 4876	/* short cut the special case */
 4877	if (vlan == 0)
 4878		return 0;
 4879
 4880	/* Search for the vlan id in the VLVF entries */
 4881	for (idx = IXGBE_VLVF_ENTRIES; --idx;) {
 4882		vlvf = IXGBE_READ_REG(hw, IXGBE_VLVF(idx));
 4883		if ((vlvf & VLAN_VID_MASK) == vlan)
 4884			break;
 4885	}
 4886
 4887	return idx;
 4888}
 4889
 4890void ixgbe_update_pf_promisc_vlvf(struct ixgbe_adapter *adapter, u32 vid)
 4891{
 4892	struct ixgbe_hw *hw = &adapter->hw;
 4893	u32 bits, word;
 4894	int idx;
 4895
 4896	idx = ixgbe_find_vlvf_entry(hw, vid);
 4897	if (!idx)
 4898		return;
 4899
 4900	/* See if any other pools are set for this VLAN filter
 4901	 * entry other than the PF.
 4902	 */
 4903	word = idx * 2 + (VMDQ_P(0) / 32);
 4904	bits = ~BIT(VMDQ_P(0) % 32);
 4905	bits &= IXGBE_READ_REG(hw, IXGBE_VLVFB(word));
 4906
 4907	/* Disable the filter so this falls into the default pool. */
 4908	if (!bits && !IXGBE_READ_REG(hw, IXGBE_VLVFB(word ^ 1))) {
 4909		if (!(adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
 4910			IXGBE_WRITE_REG(hw, IXGBE_VLVFB(word), 0);
 4911		IXGBE_WRITE_REG(hw, IXGBE_VLVF(idx), 0);
 4912	}
 4913}
 4914
 4915static int ixgbe_vlan_rx_kill_vid(struct net_device *netdev,
 4916				  __be16 proto, u16 vid)
 4917{
 4918	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 4919	struct ixgbe_hw *hw = &adapter->hw;
 4920
 4921	/* remove VID from filter table */
 4922	if (vid && !(adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
 4923		hw->mac.ops.set_vfta(hw, vid, VMDQ_P(0), false, true);
 4924
 4925	clear_bit(vid, adapter->active_vlans);
 4926
 4927	return 0;
 4928}
 4929
 4930/**
 4931 * ixgbe_vlan_strip_disable - helper to disable hw vlan stripping
 4932 * @adapter: driver data
 4933 */
 4934static void ixgbe_vlan_strip_disable(struct ixgbe_adapter *adapter)
 4935{
 4936	struct ixgbe_hw *hw = &adapter->hw;
 4937	u32 vlnctrl;
 4938	int i, j;
 4939
 4940	switch (hw->mac.type) {
 4941	case ixgbe_mac_82598EB:
 4942		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
 4943		vlnctrl &= ~IXGBE_VLNCTRL_VME;
 4944		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
 4945		break;
 4946	case ixgbe_mac_82599EB:
 4947	case ixgbe_mac_X540:
 4948	case ixgbe_mac_X550:
 4949	case ixgbe_mac_X550EM_x:
 4950	case ixgbe_mac_x550em_a:
 4951	case ixgbe_mac_e610:
 4952		for (i = 0; i < adapter->num_rx_queues; i++) {
 4953			struct ixgbe_ring *ring = adapter->rx_ring[i];
 4954
 4955			if (!netif_is_ixgbe(ring->netdev))
 4956				continue;
 4957
 4958			j = ring->reg_idx;
 4959			vlnctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(j));
 4960			vlnctrl &= ~IXGBE_RXDCTL_VME;
 4961			IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(j), vlnctrl);
 4962		}
 4963		break;
 4964	default:
 4965		break;
 4966	}
 4967}
 4968
 4969/**
 4970 * ixgbe_vlan_strip_enable - helper to enable hw vlan stripping
 4971 * @adapter: driver data
 4972 */
 4973static void ixgbe_vlan_strip_enable(struct ixgbe_adapter *adapter)
 4974{
 4975	struct ixgbe_hw *hw = &adapter->hw;
 4976	u32 vlnctrl;
 4977	int i, j;
 4978
 4979	switch (hw->mac.type) {
 4980	case ixgbe_mac_82598EB:
 4981		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
 4982		vlnctrl |= IXGBE_VLNCTRL_VME;
 4983		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
 4984		break;
 4985	case ixgbe_mac_82599EB:
 4986	case ixgbe_mac_X540:
 4987	case ixgbe_mac_X550:
 4988	case ixgbe_mac_X550EM_x:
 4989	case ixgbe_mac_x550em_a:
 4990	case ixgbe_mac_e610:
 4991		for (i = 0; i < adapter->num_rx_queues; i++) {
 4992			struct ixgbe_ring *ring = adapter->rx_ring[i];
 4993
 4994			if (!netif_is_ixgbe(ring->netdev))
 4995				continue;
 4996
 4997			j = ring->reg_idx;
 4998			vlnctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(j));
 4999			vlnctrl |= IXGBE_RXDCTL_VME;
 5000			IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(j), vlnctrl);
 5001		}
 5002		break;
 5003	default:
 5004		break;
 5005	}
 5006}
 5007
 5008static void ixgbe_vlan_promisc_enable(struct ixgbe_adapter *adapter)
 5009{
 5010	struct ixgbe_hw *hw = &adapter->hw;
 5011	u32 vlnctrl, i;
 5012
 5013	vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
 5014
 5015	if (adapter->flags & IXGBE_FLAG_VMDQ_ENABLED) {
 5016	/* For VMDq and SR-IOV we must leave VLAN filtering enabled */
 5017		vlnctrl |= IXGBE_VLNCTRL_VFE;
 5018		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
 5019	} else {
 5020		vlnctrl &= ~IXGBE_VLNCTRL_VFE;
 5021		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
 5022		return;
 5023	}
 5024
 5025	/* Nothing to do for 82598 */
 5026	if (hw->mac.type == ixgbe_mac_82598EB)
 5027		return;
 5028
 5029	/* We are already in VLAN promisc, nothing to do */
 5030	if (adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC)
 5031		return;
 5032
 5033	/* Set flag so we don't redo unnecessary work */
 5034	adapter->flags2 |= IXGBE_FLAG2_VLAN_PROMISC;
 5035
 5036	/* Add PF to all active pools */
 5037	for (i = IXGBE_VLVF_ENTRIES; --i;) {
 5038		u32 reg_offset = IXGBE_VLVFB(i * 2 + VMDQ_P(0) / 32);
 5039		u32 vlvfb = IXGBE_READ_REG(hw, reg_offset);
 5040
 5041		vlvfb |= BIT(VMDQ_P(0) % 32);
 5042		IXGBE_WRITE_REG(hw, reg_offset, vlvfb);
 5043	}
 5044
 5045	/* Set all bits in the VLAN filter table array */
 5046	for (i = hw->mac.vft_size; i--;)
 5047		IXGBE_WRITE_REG(hw, IXGBE_VFTA(i), ~0U);
 5048}
 5049
 5050#define VFTA_BLOCK_SIZE 8
 5051static void ixgbe_scrub_vfta(struct ixgbe_adapter *adapter, u32 vfta_offset)
 5052{
 5053	struct ixgbe_hw *hw = &adapter->hw;
 5054	u32 vfta[VFTA_BLOCK_SIZE] = { 0 };
 5055	u32 vid_start = vfta_offset * 32;
 5056	u32 vid_end = vid_start + (VFTA_BLOCK_SIZE * 32);
 5057	u32 i, vid, word, bits;
 5058
 5059	for (i = IXGBE_VLVF_ENTRIES; --i;) {
 5060		u32 vlvf = IXGBE_READ_REG(hw, IXGBE_VLVF(i));
 5061
 5062		/* pull VLAN ID from VLVF */
 5063		vid = vlvf & VLAN_VID_MASK;
 5064
 5065		/* only concern ourselves with a certain range */
 5066		if (vid < vid_start || vid >= vid_end)
 5067			continue;
 5068
 5069		if (vlvf) {
 5070			/* record VLAN ID in VFTA */
 5071			vfta[(vid - vid_start) / 32] |= BIT(vid % 32);
 5072
 5073			/* if PF is part of this then continue */
 5074			if (test_bit(vid, adapter->active_vlans))
 5075				continue;
 5076		}
 5077
 5078		/* remove PF from the pool */
 5079		word = i * 2 + VMDQ_P(0) / 32;
 5080		bits = ~BIT(VMDQ_P(0) % 32);
 5081		bits &= IXGBE_READ_REG(hw, IXGBE_VLVFB(word));
 5082		IXGBE_WRITE_REG(hw, IXGBE_VLVFB(word), bits);
 5083	}
 5084
 5085	/* extract values from active_vlans and write back to VFTA */
 5086	for (i = VFTA_BLOCK_SIZE; i--;) {
 5087		vid = (vfta_offset + i) * 32;
 5088		word = vid / BITS_PER_LONG;
 5089		bits = vid % BITS_PER_LONG;
 5090
 5091		vfta[i] |= adapter->active_vlans[word] >> bits;
 5092
 5093		IXGBE_WRITE_REG(hw, IXGBE_VFTA(vfta_offset + i), vfta[i]);
 5094	}
 5095}
 5096
 5097static void ixgbe_vlan_promisc_disable(struct ixgbe_adapter *adapter)
 5098{
 5099	struct ixgbe_hw *hw = &adapter->hw;
 5100	u32 vlnctrl, i;
 5101
 5102	/* Set VLAN filtering to enabled */
 5103	vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
 5104	vlnctrl |= IXGBE_VLNCTRL_VFE;
 5105	IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
 5106
 5107	if (!(adapter->flags & IXGBE_FLAG_VMDQ_ENABLED) ||
 5108	    hw->mac.type == ixgbe_mac_82598EB)
 5109		return;
 5110
 5111	/* We are not in VLAN promisc, nothing to do */
 5112	if (!(adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
 5113		return;
 5114
 5115	/* Set flag so we don't redo unnecessary work */
 5116	adapter->flags2 &= ~IXGBE_FLAG2_VLAN_PROMISC;
 5117
 5118	for (i = 0; i < hw->mac.vft_size; i += VFTA_BLOCK_SIZE)
 5119		ixgbe_scrub_vfta(adapter, i);
 5120}
 5121
 5122static void ixgbe_restore_vlan(struct ixgbe_adapter *adapter)
 5123{
 5124	u16 vid = 1;
 5125
 5126	ixgbe_vlan_rx_add_vid(adapter->netdev, htons(ETH_P_8021Q), 0);
 5127
 5128	for_each_set_bit_from(vid, adapter->active_vlans, VLAN_N_VID)
 5129		ixgbe_vlan_rx_add_vid(adapter->netdev, htons(ETH_P_8021Q), vid);
 5130}
 5131
 5132/**
 5133 * ixgbe_write_mc_addr_list - write multicast addresses to MTA
 5134 * @netdev: network interface device structure
 5135 *
 5136 * Writes multicast address list to the MTA hash table.
 5137 * Returns: -ENOMEM on failure
 5138 *                0 on no addresses written
 5139 *                X on writing X addresses to MTA
 5140 **/
 5141static int ixgbe_write_mc_addr_list(struct net_device *netdev)
 5142{
 5143	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 5144	struct ixgbe_hw *hw = &adapter->hw;
 5145
 5146	if (!netif_running(netdev))
 5147		return 0;
 5148
 5149	if (hw->mac.ops.update_mc_addr_list)
 5150		hw->mac.ops.update_mc_addr_list(hw, netdev);
 5151	else
 5152		return -ENOMEM;
 5153
 5154#ifdef CONFIG_PCI_IOV
 5155	ixgbe_restore_vf_multicasts(adapter);
 5156#endif
 5157
 5158	return netdev_mc_count(netdev);
 5159}
 5160
 5161#ifdef CONFIG_PCI_IOV
 5162void ixgbe_full_sync_mac_table(struct ixgbe_adapter *adapter)
 5163{
 5164	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
 5165	struct ixgbe_hw *hw = &adapter->hw;
 5166	int i;
 5167
 5168	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
 5169		mac_table->state &= ~IXGBE_MAC_STATE_MODIFIED;
 5170
 5171		if (mac_table->state & IXGBE_MAC_STATE_IN_USE)
 5172			hw->mac.ops.set_rar(hw, i,
 5173					    mac_table->addr,
 5174					    mac_table->pool,
 5175					    IXGBE_RAH_AV);
 5176		else
 5177			hw->mac.ops.clear_rar(hw, i);
 5178	}
 5179}
 5180
 5181#endif
 5182static void ixgbe_sync_mac_table(struct ixgbe_adapter *adapter)
 5183{
 5184	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
 5185	struct ixgbe_hw *hw = &adapter->hw;
 5186	int i;
 5187
 5188	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
 5189		if (!(mac_table->state & IXGBE_MAC_STATE_MODIFIED))
 5190			continue;
 5191
 5192		mac_table->state &= ~IXGBE_MAC_STATE_MODIFIED;
 5193
 5194		if (mac_table->state & IXGBE_MAC_STATE_IN_USE)
 5195			hw->mac.ops.set_rar(hw, i,
 5196					    mac_table->addr,
 5197					    mac_table->pool,
 5198					    IXGBE_RAH_AV);
 5199		else
 5200			hw->mac.ops.clear_rar(hw, i);
 5201	}
 5202}
 5203
 5204static void ixgbe_flush_sw_mac_table(struct ixgbe_adapter *adapter)
 5205{
 5206	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
 5207	struct ixgbe_hw *hw = &adapter->hw;
 5208	int i;
 5209
 5210	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
 5211		mac_table->state |= IXGBE_MAC_STATE_MODIFIED;
 5212		mac_table->state &= ~IXGBE_MAC_STATE_IN_USE;
 5213	}
 5214
 5215	ixgbe_sync_mac_table(adapter);
 5216}
 5217
 5218static int ixgbe_available_rars(struct ixgbe_adapter *adapter, u16 pool)
 5219{
 5220	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
 5221	struct ixgbe_hw *hw = &adapter->hw;
 5222	int i, count = 0;
 5223
 5224	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
 5225		/* do not count default RAR as available */
 5226		if (mac_table->state & IXGBE_MAC_STATE_DEFAULT)
 5227			continue;
 5228
 5229		/* only count unused and addresses that belong to us */
 5230		if (mac_table->state & IXGBE_MAC_STATE_IN_USE) {
 5231			if (mac_table->pool != pool)
 5232				continue;
 5233		}
 5234
 5235		count++;
 5236	}
 5237
 5238	return count;
 5239}
 5240
 5241/* this function destroys the first RAR entry */
 5242static void ixgbe_mac_set_default_filter(struct ixgbe_adapter *adapter)
 5243{
 5244	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
 5245	struct ixgbe_hw *hw = &adapter->hw;
 5246
 5247	memcpy(&mac_table->addr, hw->mac.addr, ETH_ALEN);
 5248	mac_table->pool = VMDQ_P(0);
 5249
 5250	mac_table->state = IXGBE_MAC_STATE_DEFAULT | IXGBE_MAC_STATE_IN_USE;
 5251
 5252	hw->mac.ops.set_rar(hw, 0, mac_table->addr, mac_table->pool,
 5253			    IXGBE_RAH_AV);
 5254}
 5255
 5256int ixgbe_add_mac_filter(struct ixgbe_adapter *adapter,
 5257			 const u8 *addr, u16 pool)
 5258{
 5259	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
 5260	struct ixgbe_hw *hw = &adapter->hw;
 5261	int i;
 5262
 5263	if (is_zero_ether_addr(addr))
 5264		return -EINVAL;
 5265
 5266	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
 5267		if (mac_table->state & IXGBE_MAC_STATE_IN_USE)
 5268			continue;
 5269
 5270		ether_addr_copy(mac_table->addr, addr);
 5271		mac_table->pool = pool;
 5272
 5273		mac_table->state |= IXGBE_MAC_STATE_MODIFIED |
 5274				    IXGBE_MAC_STATE_IN_USE;
 5275
 5276		ixgbe_sync_mac_table(adapter);
 5277
 5278		return i;
 5279	}
 5280
 5281	return -ENOMEM;
 5282}
 5283
 5284int ixgbe_del_mac_filter(struct ixgbe_adapter *adapter,
 5285			 const u8 *addr, u16 pool)
 5286{
 5287	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
 5288	struct ixgbe_hw *hw = &adapter->hw;
 5289	int i;
 5290
 5291	if (is_zero_ether_addr(addr))
 5292		return -EINVAL;
 5293
 5294	/* search table for addr, if found clear IN_USE flag and sync */
 5295	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
 5296		/* we can only delete an entry if it is in use */
 5297		if (!(mac_table->state & IXGBE_MAC_STATE_IN_USE))
 5298			continue;
 5299		/* we only care about entries that belong to the given pool */
 5300		if (mac_table->pool != pool)
 5301			continue;
 5302		/* we only care about a specific MAC address */
 5303		if (!ether_addr_equal(addr, mac_table->addr))
 5304			continue;
 5305
 5306		mac_table->state |= IXGBE_MAC_STATE_MODIFIED;
 5307		mac_table->state &= ~IXGBE_MAC_STATE_IN_USE;
 5308
 5309		ixgbe_sync_mac_table(adapter);
 5310
 5311		return 0;
 5312	}
 5313
 5314	return -ENOMEM;
 5315}
 5316
 5317static int ixgbe_uc_sync(struct net_device *netdev, const unsigned char *addr)
 5318{
 5319	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 5320	int ret;
 5321
 5322	ret = ixgbe_add_mac_filter(adapter, addr, VMDQ_P(0));
 5323
 5324	return min_t(int, ret, 0);
 5325}
 5326
 5327static int ixgbe_uc_unsync(struct net_device *netdev, const unsigned char *addr)
 5328{
 5329	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 5330
 5331	ixgbe_del_mac_filter(adapter, addr, VMDQ_P(0));
 5332
 5333	return 0;
 5334}
 5335
 5336/**
 5337 * ixgbe_set_rx_mode - Unicast, Multicast and Promiscuous mode set
 5338 * @netdev: network interface device structure
 5339 *
 5340 * The set_rx_method entry point is called whenever the unicast/multicast
 5341 * address list or the network interface flags are updated.  This routine is
 5342 * responsible for configuring the hardware for proper unicast, multicast and
 5343 * promiscuous mode.
 5344 **/
 5345void ixgbe_set_rx_mode(struct net_device *netdev)
 5346{
 5347	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 5348	struct ixgbe_hw *hw = &adapter->hw;
 5349	u32 fctrl, vmolr = IXGBE_VMOLR_BAM | IXGBE_VMOLR_AUPE;
 5350	netdev_features_t features = netdev->features;
 5351	int count;
 5352
 5353	/* Check for Promiscuous and All Multicast modes */
 5354	fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
 5355
 5356	/* set all bits that we expect to always be set */
 5357	fctrl &= ~IXGBE_FCTRL_SBP; /* disable store-bad-packets */
 5358	fctrl |= IXGBE_FCTRL_BAM;
 5359	fctrl |= IXGBE_FCTRL_DPF; /* discard pause frames when FC enabled */
 5360	fctrl |= IXGBE_FCTRL_PMCF;
 5361
 5362	/* clear the bits we are changing the status of */
 5363	fctrl &= ~(IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);
 5364	if (netdev->flags & IFF_PROMISC) {
 5365		hw->addr_ctrl.user_set_promisc = true;
 5366		fctrl |= (IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);
 5367		vmolr |= IXGBE_VMOLR_MPE;
 5368		features &= ~NETIF_F_HW_VLAN_CTAG_FILTER;
 5369	} else {
 5370		if (netdev->flags & IFF_ALLMULTI) {
 5371			fctrl |= IXGBE_FCTRL_MPE;
 5372			vmolr |= IXGBE_VMOLR_MPE;
 5373		}
 5374		hw->addr_ctrl.user_set_promisc = false;
 5375	}
 5376
 5377	/*
 5378	 * Write addresses to available RAR registers, if there is not
 5379	 * sufficient space to store all the addresses then enable
 5380	 * unicast promiscuous mode
 5381	 */
 5382	if (__dev_uc_sync(netdev, ixgbe_uc_sync, ixgbe_uc_unsync)) {
 5383		fctrl |= IXGBE_FCTRL_UPE;
 5384		vmolr |= IXGBE_VMOLR_ROPE;
 5385	}
 5386
 5387	/* Write addresses to the MTA, if the attempt fails
 5388	 * then we should just turn on promiscuous mode so
 5389	 * that we can at least receive multicast traffic
 5390	 */
 5391	count = ixgbe_write_mc_addr_list(netdev);
 5392	if (count < 0) {
 5393		fctrl |= IXGBE_FCTRL_MPE;
 5394		vmolr |= IXGBE_VMOLR_MPE;
 5395	} else if (count) {
 5396		vmolr |= IXGBE_VMOLR_ROMPE;
 5397	}
 5398
 5399	if (hw->mac.type != ixgbe_mac_82598EB) {
 5400		vmolr |= IXGBE_READ_REG(hw, IXGBE_VMOLR(VMDQ_P(0))) &
 5401			 ~(IXGBE_VMOLR_MPE | IXGBE_VMOLR_ROMPE |
 5402			   IXGBE_VMOLR_ROPE);
 5403		IXGBE_WRITE_REG(hw, IXGBE_VMOLR(VMDQ_P(0)), vmolr);
 5404	}
 5405
 5406	/* This is useful for sniffing bad packets. */
 5407	if (features & NETIF_F_RXALL) {
 5408		/* UPE and MPE will be handled by normal PROMISC logic
 5409		 * in e1000e_set_rx_mode */
 5410		fctrl |= (IXGBE_FCTRL_SBP | /* Receive bad packets */
 5411			  IXGBE_FCTRL_BAM | /* RX All Bcast Pkts */
 5412			  IXGBE_FCTRL_PMCF); /* RX All MAC Ctrl Pkts */
 5413
 5414		fctrl &= ~(IXGBE_FCTRL_DPF);
 5415		/* NOTE:  VLAN filtering is disabled by setting PROMISC */
 5416	}
 5417
 5418	IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
 5419
 5420	if (features & NETIF_F_HW_VLAN_CTAG_RX)
 5421		ixgbe_vlan_strip_enable(adapter);
 5422	else
 5423		ixgbe_vlan_strip_disable(adapter);
 5424
 5425	if (features & NETIF_F_HW_VLAN_CTAG_FILTER)
 5426		ixgbe_vlan_promisc_disable(adapter);
 5427	else
 5428		ixgbe_vlan_promisc_enable(adapter);
 5429}
 5430
 5431static void ixgbe_napi_enable_all(struct ixgbe_adapter *adapter)
 5432{
 5433	int q_idx;
 5434
 5435	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++)
 5436		napi_enable(&adapter->q_vector[q_idx]->napi);
 5437}
 5438
 5439static void ixgbe_napi_disable_all(struct ixgbe_adapter *adapter)
 5440{
 5441	int q_idx;
 5442
 5443	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++)
 5444		napi_disable(&adapter->q_vector[q_idx]->napi);
 5445}
 5446
 5447static int ixgbe_udp_tunnel_sync(struct net_device *dev, unsigned int table)
 5448{
 5449	struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
 5450	struct ixgbe_hw *hw = &adapter->hw;
 5451	struct udp_tunnel_info ti;
 5452
 5453	udp_tunnel_nic_get_port(dev, table, 0, &ti);
 5454	if (ti.type == UDP_TUNNEL_TYPE_VXLAN)
 5455		adapter->vxlan_port = ti.port;
 5456	else
 5457		adapter->geneve_port = ti.port;
 5458
 5459	IXGBE_WRITE_REG(hw, IXGBE_VXLANCTRL,
 5460			ntohs(adapter->vxlan_port) |
 5461			ntohs(adapter->geneve_port) <<
 5462				IXGBE_VXLANCTRL_GENEVE_UDPPORT_SHIFT);
 5463	return 0;
 5464}
 5465
 5466static const struct udp_tunnel_nic_info ixgbe_udp_tunnels_x550 = {
 5467	.sync_table	= ixgbe_udp_tunnel_sync,
 5468	.flags		= UDP_TUNNEL_NIC_INFO_IPV4_ONLY,
 5469	.tables		= {
 5470		{ .n_entries = 1, .tunnel_types = UDP_TUNNEL_TYPE_VXLAN,  },
 5471	},
 5472};
 5473
 5474static const struct udp_tunnel_nic_info ixgbe_udp_tunnels_x550em_a = {
 5475	.sync_table	= ixgbe_udp_tunnel_sync,
 5476	.flags		= UDP_TUNNEL_NIC_INFO_IPV4_ONLY,
 5477	.tables		= {
 5478		{ .n_entries = 1, .tunnel_types = UDP_TUNNEL_TYPE_VXLAN,  },
 5479		{ .n_entries = 1, .tunnel_types = UDP_TUNNEL_TYPE_GENEVE, },
 5480	},
 5481};
 5482
 5483#ifdef CONFIG_IXGBE_DCB
 5484/**
 5485 * ixgbe_configure_dcb - Configure DCB hardware
 5486 * @adapter: ixgbe adapter struct
 5487 *
 5488 * This is called by the driver on open to configure the DCB hardware.
 5489 * This is also called by the gennetlink interface when reconfiguring
 5490 * the DCB state.
 5491 */
 5492static void ixgbe_configure_dcb(struct ixgbe_adapter *adapter)
 5493{
 5494	struct ixgbe_hw *hw = &adapter->hw;
 5495	int max_frame = adapter->netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
 5496
 5497	if (!(adapter->flags & IXGBE_FLAG_DCB_ENABLED)) {
 5498		if (hw->mac.type == ixgbe_mac_82598EB)
 5499			netif_set_tso_max_size(adapter->netdev, 65536);
 5500		return;
 5501	}
 5502
 5503	if (hw->mac.type == ixgbe_mac_82598EB)
 5504		netif_set_tso_max_size(adapter->netdev, 32768);
 5505
 5506#ifdef IXGBE_FCOE
 5507	if (adapter->netdev->fcoe_mtu)
 5508		max_frame = max(max_frame, IXGBE_FCOE_JUMBO_FRAME_SIZE);
 5509#endif
 5510
 5511	/* reconfigure the hardware */
 5512	if (adapter->dcbx_cap & DCB_CAP_DCBX_VER_CEE) {
 5513		ixgbe_dcb_calculate_tc_credits(hw, &adapter->dcb_cfg, max_frame,
 5514						DCB_TX_CONFIG);
 5515		ixgbe_dcb_calculate_tc_credits(hw, &adapter->dcb_cfg, max_frame,
 5516						DCB_RX_CONFIG);
 5517		ixgbe_dcb_hw_config(hw, &adapter->dcb_cfg);
 5518	} else if (adapter->ixgbe_ieee_ets && adapter->ixgbe_ieee_pfc) {
 5519		ixgbe_dcb_hw_ets(&adapter->hw,
 5520				 adapter->ixgbe_ieee_ets,
 5521				 max_frame);
 5522		ixgbe_dcb_hw_pfc_config(&adapter->hw,
 5523					adapter->ixgbe_ieee_pfc->pfc_en,
 5524					adapter->ixgbe_ieee_ets->prio_tc);
 5525	}
 5526
 5527	/* Enable RSS Hash per TC */
 5528	if (hw->mac.type != ixgbe_mac_82598EB) {
 5529		u32 msb = 0;
 5530		u16 rss_i = adapter->ring_feature[RING_F_RSS].indices - 1;
 5531
 5532		while (rss_i) {
 5533			msb++;
 5534			rss_i >>= 1;
 5535		}
 5536
 5537		/* write msb to all 8 TCs in one write */
 5538		IXGBE_WRITE_REG(hw, IXGBE_RQTC, msb * 0x11111111);
 5539	}
 5540}
 5541#endif
 5542
 5543/* Additional bittime to account for IXGBE framing */
 5544#define IXGBE_ETH_FRAMING 20
 5545
 5546/**
 5547 * ixgbe_hpbthresh - calculate high water mark for flow control
 5548 *
 5549 * @adapter: board private structure to calculate for
 5550 * @pb: packet buffer to calculate
 5551 */
 5552static int ixgbe_hpbthresh(struct ixgbe_adapter *adapter, int pb)
 5553{
 5554	struct ixgbe_hw *hw = &adapter->hw;
 5555	struct net_device *dev = adapter->netdev;
 5556	int link, tc, kb, marker;
 5557	u32 dv_id, rx_pba;
 5558
 5559	/* Calculate max LAN frame size */
 5560	tc = link = dev->mtu + ETH_HLEN + ETH_FCS_LEN + IXGBE_ETH_FRAMING;
 5561
 5562#ifdef IXGBE_FCOE
 5563	/* FCoE traffic class uses FCOE jumbo frames */
 5564	if (dev->fcoe_mtu && tc < IXGBE_FCOE_JUMBO_FRAME_SIZE &&
 5565	    (pb == ixgbe_fcoe_get_tc(adapter)))
 5566		tc = IXGBE_FCOE_JUMBO_FRAME_SIZE;
 5567#endif
 5568
 5569	/* Calculate delay value for device */
 5570	switch (hw->mac.type) {
 5571	case ixgbe_mac_X540:
 5572	case ixgbe_mac_X550:
 5573	case ixgbe_mac_X550EM_x:
 5574	case ixgbe_mac_x550em_a:
 5575	case ixgbe_mac_e610:
 5576		dv_id = IXGBE_DV_X540(link, tc);
 5577		break;
 5578	default:
 5579		dv_id = IXGBE_DV(link, tc);
 5580		break;
 5581	}
 5582
 5583	/* Loopback switch introduces additional latency */
 5584	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
 5585		dv_id += IXGBE_B2BT(tc);
 5586
 5587	/* Delay value is calculated in bit times convert to KB */
 5588	kb = IXGBE_BT2KB(dv_id);
 5589	rx_pba = IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(pb)) >> 10;
 5590
 5591	marker = rx_pba - kb;
 5592
 5593	/* It is possible that the packet buffer is not large enough
 5594	 * to provide required headroom. In this case throw an error
 5595	 * to user and a do the best we can.
 5596	 */
 5597	if (marker < 0) {
 5598		e_warn(drv, "Packet Buffer(%i) can not provide enough"
 5599			    "headroom to support flow control."
 5600			    "Decrease MTU or number of traffic classes\n", pb);
 5601		marker = tc + 1;
 5602	}
 5603
 5604	return marker;
 5605}
 5606
 5607/**
 5608 * ixgbe_lpbthresh - calculate low water mark for flow control
 5609 *
 5610 * @adapter: board private structure to calculate for
 5611 * @pb: packet buffer to calculate
 5612 */
 5613static int ixgbe_lpbthresh(struct ixgbe_adapter *adapter, int pb)
 5614{
 5615	struct ixgbe_hw *hw = &adapter->hw;
 5616	struct net_device *dev = adapter->netdev;
 5617	int tc;
 5618	u32 dv_id;
 5619
 5620	/* Calculate max LAN frame size */
 5621	tc = dev->mtu + ETH_HLEN + ETH_FCS_LEN;
 5622
 5623#ifdef IXGBE_FCOE
 5624	/* FCoE traffic class uses FCOE jumbo frames */
 5625	if (dev->fcoe_mtu && tc < IXGBE_FCOE_JUMBO_FRAME_SIZE &&
 5626	    (pb == netdev_get_prio_tc_map(dev, adapter->fcoe.up)))
 5627		tc = IXGBE_FCOE_JUMBO_FRAME_SIZE;
 5628#endif
 5629
 5630	/* Calculate delay value for device */
 5631	switch (hw->mac.type) {
 5632	case ixgbe_mac_X540:
 5633	case ixgbe_mac_X550:
 5634	case ixgbe_mac_X550EM_x:
 5635	case ixgbe_mac_x550em_a:
 5636	case ixgbe_mac_e610:
 5637		dv_id = IXGBE_LOW_DV_X540(tc);
 5638		break;
 5639	default:
 5640		dv_id = IXGBE_LOW_DV(tc);
 5641		break;
 5642	}
 5643
 5644	/* Delay value is calculated in bit times convert to KB */
 5645	return IXGBE_BT2KB(dv_id);
 5646}
 5647
 5648/*
 5649 * ixgbe_pbthresh_setup - calculate and setup high low water marks
 5650 */
 5651static void ixgbe_pbthresh_setup(struct ixgbe_adapter *adapter)
 5652{
 5653	struct ixgbe_hw *hw = &adapter->hw;
 5654	int num_tc = adapter->hw_tcs;
 5655	int i;
 5656
 5657	if (!num_tc)
 5658		num_tc = 1;
 5659
 5660	for (i = 0; i < num_tc; i++) {
 5661		hw->fc.high_water[i] = ixgbe_hpbthresh(adapter, i);
 5662		hw->fc.low_water[i] = ixgbe_lpbthresh(adapter, i);
 5663
 5664		/* Low water marks must not be larger than high water marks */
 5665		if (hw->fc.low_water[i] > hw->fc.high_water[i])
 5666			hw->fc.low_water[i] = 0;
 5667	}
 5668
 5669	for (; i < MAX_TRAFFIC_CLASS; i++)
 5670		hw->fc.high_water[i] = 0;
 5671}
 5672
 5673static void ixgbe_configure_pb(struct ixgbe_adapter *adapter)
 5674{
 5675	struct ixgbe_hw *hw = &adapter->hw;
 5676	int hdrm;
 5677	u8 tc = adapter->hw_tcs;
 5678
 5679	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE ||
 5680	    adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE)
 5681		hdrm = 32 << adapter->fdir_pballoc;
 5682	else
 5683		hdrm = 0;
 5684
 5685	hw->mac.ops.set_rxpba(hw, tc, hdrm, PBA_STRATEGY_EQUAL);
 5686	ixgbe_pbthresh_setup(adapter);
 5687}
 5688
 5689static void ixgbe_fdir_filter_restore(struct ixgbe_adapter *adapter)
 5690{
 5691	struct ixgbe_hw *hw = &adapter->hw;
 5692	struct hlist_node *node2;
 5693	struct ixgbe_fdir_filter *filter;
 5694	u8 queue;
 5695
 5696	spin_lock(&adapter->fdir_perfect_lock);
 5697
 5698	if (!hlist_empty(&adapter->fdir_filter_list))
 5699		ixgbe_fdir_set_input_mask_82599(hw, &adapter->fdir_mask);
 5700
 5701	hlist_for_each_entry_safe(filter, node2,
 5702				  &adapter->fdir_filter_list, fdir_node) {
 5703		if (filter->action == IXGBE_FDIR_DROP_QUEUE) {
 5704			queue = IXGBE_FDIR_DROP_QUEUE;
 5705		} else {
 5706			u32 ring = ethtool_get_flow_spec_ring(filter->action);
 5707			u8 vf = ethtool_get_flow_spec_ring_vf(filter->action);
 5708
 5709			if (!vf && (ring >= adapter->num_rx_queues)) {
 5710				e_err(drv, "FDIR restore failed without VF, ring: %u\n",
 5711				      ring);
 5712				continue;
 5713			} else if (vf &&
 5714				   ((vf > adapter->num_vfs) ||
 5715				     ring >= adapter->num_rx_queues_per_pool)) {
 5716				e_err(drv, "FDIR restore failed with VF, vf: %hhu, ring: %u\n",
 5717				      vf, ring);
 5718				continue;
 5719			}
 5720
 5721			/* Map the ring onto the absolute queue index */
 5722			if (!vf)
 5723				queue = adapter->rx_ring[ring]->reg_idx;
 5724			else
 5725				queue = ((vf - 1) *
 5726					adapter->num_rx_queues_per_pool) + ring;
 5727		}
 5728
 5729		ixgbe_fdir_write_perfect_filter_82599(hw,
 5730				&filter->filter, filter->sw_idx, queue);
 5731	}
 5732
 5733	spin_unlock(&adapter->fdir_perfect_lock);
 5734}
 5735
 5736/**
 5737 * ixgbe_clean_rx_ring - Free Rx Buffers per Queue
 5738 * @rx_ring: ring to free buffers from
 5739 **/
 5740static void ixgbe_clean_rx_ring(struct ixgbe_ring *rx_ring)
 5741{
 5742	u16 i = rx_ring->next_to_clean;
 5743	struct ixgbe_rx_buffer *rx_buffer = &rx_ring->rx_buffer_info[i];
 5744
 5745	if (rx_ring->xsk_pool) {
 5746		ixgbe_xsk_clean_rx_ring(rx_ring);
 5747		goto skip_free;
 5748	}
 5749
 5750	/* Free all the Rx ring sk_buffs */
 5751	while (i != rx_ring->next_to_alloc) {
 5752		if (rx_buffer->skb) {
 5753			struct sk_buff *skb = rx_buffer->skb;
 5754			if (IXGBE_CB(skb)->page_released)
 5755				dma_unmap_page_attrs(rx_ring->dev,
 5756						     IXGBE_CB(skb)->dma,
 5757						     ixgbe_rx_pg_size(rx_ring),
 5758						     DMA_FROM_DEVICE,
 5759						     IXGBE_RX_DMA_ATTR);
 5760			dev_kfree_skb(skb);
 5761		}
 5762
 5763		/* Invalidate cache lines that may have been written to by
 5764		 * device so that we avoid corrupting memory.
 5765		 */
 5766		dma_sync_single_range_for_cpu(rx_ring->dev,
 5767					      rx_buffer->dma,
 5768					      rx_buffer->page_offset,
 5769					      ixgbe_rx_bufsz(rx_ring),
 5770					      DMA_FROM_DEVICE);
 5771
 5772		/* free resources associated with mapping */
 5773		dma_unmap_page_attrs(rx_ring->dev, rx_buffer->dma,
 5774				     ixgbe_rx_pg_size(rx_ring),
 5775				     DMA_FROM_DEVICE,
 5776				     IXGBE_RX_DMA_ATTR);
 5777		__page_frag_cache_drain(rx_buffer->page,
 5778					rx_buffer->pagecnt_bias);
 5779
 5780		i++;
 5781		rx_buffer++;
 5782		if (i == rx_ring->count) {
 5783			i = 0;
 5784			rx_buffer = rx_ring->rx_buffer_info;
 5785		}
 5786	}
 5787
 5788skip_free:
 5789	rx_ring->next_to_alloc = 0;
 5790	rx_ring->next_to_clean = 0;
 5791	rx_ring->next_to_use = 0;
 5792}
 5793
 5794static int ixgbe_fwd_ring_up(struct ixgbe_adapter *adapter,
 5795			     struct ixgbe_fwd_adapter *accel)
 5796{
 5797	u16 rss_i = adapter->ring_feature[RING_F_RSS].indices;
 5798	int num_tc = netdev_get_num_tc(adapter->netdev);
 5799	struct net_device *vdev = accel->netdev;
 5800	int i, baseq, err;
 5801
 5802	baseq = accel->pool * adapter->num_rx_queues_per_pool;
 5803	netdev_dbg(vdev, "pool %i:%i queues %i:%i\n",
 5804		   accel->pool, adapter->num_rx_pools,
 5805		   baseq, baseq + adapter->num_rx_queues_per_pool);
 5806
 5807	accel->rx_base_queue = baseq;
 5808	accel->tx_base_queue = baseq;
 5809
 5810	/* record configuration for macvlan interface in vdev */
 5811	for (i = 0; i < num_tc; i++)
 5812		netdev_bind_sb_channel_queue(adapter->netdev, vdev,
 5813					     i, rss_i, baseq + (rss_i * i));
 5814
 5815	for (i = 0; i < adapter->num_rx_queues_per_pool; i++)
 5816		adapter->rx_ring[baseq + i]->netdev = vdev;
 5817
 5818	/* Guarantee all rings are updated before we update the
 5819	 * MAC address filter.
 5820	 */
 5821	wmb();
 5822
 5823	/* ixgbe_add_mac_filter will return an index if it succeeds, so we
 5824	 * need to only treat it as an error value if it is negative.
 5825	 */
 5826	err = ixgbe_add_mac_filter(adapter, vdev->dev_addr,
 5827				   VMDQ_P(accel->pool));
 5828	if (err >= 0)
 5829		return 0;
 5830
 5831	/* if we cannot add the MAC rule then disable the offload */
 5832	macvlan_release_l2fw_offload(vdev);
 5833
 5834	for (i = 0; i < adapter->num_rx_queues_per_pool; i++)
 5835		adapter->rx_ring[baseq + i]->netdev = NULL;
 5836
 5837	netdev_err(vdev, "L2FW offload disabled due to L2 filter error\n");
 5838
 5839	/* unbind the queues and drop the subordinate channel config */
 5840	netdev_unbind_sb_channel(adapter->netdev, vdev);
 5841	netdev_set_sb_channel(vdev, 0);
 5842
 5843	clear_bit(accel->pool, adapter->fwd_bitmask);
 5844	kfree(accel);
 5845
 5846	return err;
 5847}
 5848
 5849static int ixgbe_macvlan_up(struct net_device *vdev,
 5850			    struct netdev_nested_priv *priv)
 5851{
 5852	struct ixgbe_adapter *adapter = (struct ixgbe_adapter *)priv->data;
 5853	struct ixgbe_fwd_adapter *accel;
 5854
 5855	if (!netif_is_macvlan(vdev))
 5856		return 0;
 5857
 5858	accel = macvlan_accel_priv(vdev);
 5859	if (!accel)
 5860		return 0;
 5861
 5862	ixgbe_fwd_ring_up(adapter, accel);
 5863
 5864	return 0;
 5865}
 5866
 5867static void ixgbe_configure_dfwd(struct ixgbe_adapter *adapter)
 5868{
 5869	struct netdev_nested_priv priv = {
 5870		.data = (void *)adapter,
 5871	};
 5872
 5873	netdev_walk_all_upper_dev_rcu(adapter->netdev,
 5874				      ixgbe_macvlan_up, &priv);
 5875}
 5876
 5877static void ixgbe_configure(struct ixgbe_adapter *adapter)
 5878{
 5879	struct ixgbe_hw *hw = &adapter->hw;
 5880
 5881	ixgbe_configure_pb(adapter);
 5882#ifdef CONFIG_IXGBE_DCB
 5883	ixgbe_configure_dcb(adapter);
 5884#endif
 5885	/*
 5886	 * We must restore virtualization before VLANs or else
 5887	 * the VLVF registers will not be populated
 5888	 */
 5889	ixgbe_configure_virtualization(adapter);
 5890
 5891	ixgbe_set_rx_mode(adapter->netdev);
 5892	ixgbe_restore_vlan(adapter);
 5893	ixgbe_ipsec_restore(adapter);
 5894
 5895	switch (hw->mac.type) {
 5896	case ixgbe_mac_82599EB:
 5897	case ixgbe_mac_X540:
 5898		hw->mac.ops.disable_rx_buff(hw);
 5899		break;
 5900	default:
 5901		break;
 5902	}
 5903
 5904	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
 5905		ixgbe_init_fdir_signature_82599(&adapter->hw,
 5906						adapter->fdir_pballoc);
 5907	} else if (adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE) {
 5908		ixgbe_init_fdir_perfect_82599(&adapter->hw,
 5909					      adapter->fdir_pballoc);
 5910		ixgbe_fdir_filter_restore(adapter);
 5911	}
 5912
 5913	switch (hw->mac.type) {
 5914	case ixgbe_mac_82599EB:
 5915	case ixgbe_mac_X540:
 5916		hw->mac.ops.enable_rx_buff(hw);
 5917		break;
 5918	default:
 5919		break;
 5920	}
 5921
 5922#ifdef CONFIG_IXGBE_DCA
 5923	/* configure DCA */
 5924	if (adapter->flags & IXGBE_FLAG_DCA_CAPABLE)
 5925		ixgbe_setup_dca(adapter);
 5926#endif /* CONFIG_IXGBE_DCA */
 5927
 5928#ifdef IXGBE_FCOE
 5929	/* configure FCoE L2 filters, redirection table, and Rx control */
 5930	ixgbe_configure_fcoe(adapter);
 5931
 5932#endif /* IXGBE_FCOE */
 5933	ixgbe_configure_tx(adapter);
 5934	ixgbe_configure_rx(adapter);
 5935	ixgbe_configure_dfwd(adapter);
 5936}
 5937
 5938/**
 5939 * ixgbe_enable_link_status_events - enable link status events
 5940 * @adapter: pointer to the adapter structure
 5941 * @mask: event mask to be set
 5942 *
 5943 * Enables link status events by invoking ixgbe_configure_lse()
 5944 *
 5945 * Return: the exit code of the operation.
 5946 */
 5947static int ixgbe_enable_link_status_events(struct ixgbe_adapter *adapter,
 5948					   u16 mask)
 5949{
 5950	int err;
 5951
 5952	err = ixgbe_configure_lse(&adapter->hw, true, mask);
 5953	if (err)
 5954		return err;
 5955
 5956	adapter->lse_mask = mask;
 5957	return 0;
 5958}
 5959
 5960/**
 5961 * ixgbe_disable_link_status_events - disable link status events
 5962 * @adapter: pointer to the adapter structure
 5963 *
 5964 * Disables link status events by invoking ixgbe_configure_lse()
 5965 *
 5966 * Return: the exit code of the operation.
 5967 */
 5968static int ixgbe_disable_link_status_events(struct ixgbe_adapter *adapter)
 5969{
 5970	int err;
 5971
 5972	err = ixgbe_configure_lse(&adapter->hw, false, adapter->lse_mask);
 5973	if (err)
 5974		return err;
 5975
 5976	adapter->lse_mask = 0;
 5977	return 0;
 5978}
 5979
 5980/**
 5981 * ixgbe_sfp_link_config - set up SFP+ link
 5982 * @adapter: pointer to private adapter struct
 5983 **/
 5984static void ixgbe_sfp_link_config(struct ixgbe_adapter *adapter)
 5985{
 5986	/*
 5987	 * We are assuming the worst case scenario here, and that
 5988	 * is that an SFP was inserted/removed after the reset
 5989	 * but before SFP detection was enabled.  As such the best
 5990	 * solution is to just start searching as soon as we start
 5991	 */
 5992	if (adapter->hw.mac.type == ixgbe_mac_82598EB)
 5993		adapter->flags2 |= IXGBE_FLAG2_SEARCH_FOR_SFP;
 5994
 5995	adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
 5996	adapter->sfp_poll_time = 0;
 5997}
 5998
 5999/**
 6000 * ixgbe_non_sfp_link_config - set up non-SFP+ link
 6001 * @hw: pointer to private hardware struct
 6002 *
 6003 * Configure non-SFP link.
 6004 *
 6005 * Return: 0 on success, negative on failure
 6006 **/
 6007static int ixgbe_non_sfp_link_config(struct ixgbe_hw *hw)
 6008{
 6009	struct ixgbe_adapter *adapter = container_of(hw, struct ixgbe_adapter,
 6010						     hw);
 6011	u16 mask = ~((u16)(IXGBE_ACI_LINK_EVENT_UPDOWN |
 6012			   IXGBE_ACI_LINK_EVENT_MEDIA_NA |
 6013			   IXGBE_ACI_LINK_EVENT_MODULE_QUAL_FAIL |
 6014			   IXGBE_ACI_LINK_EVENT_PHY_FW_LOAD_FAIL));
 6015	bool autoneg, link_up = false;
 6016	int ret = -EIO;
 6017	u32 speed;
 6018
 6019	if (hw->mac.ops.check_link)
 6020		ret = hw->mac.ops.check_link(hw, &speed, &link_up, false);
 6021
 6022	if (ret)
 6023		return ret;
 6024
 6025	speed = hw->phy.autoneg_advertised;
 6026	if (!speed && hw->mac.ops.get_link_capabilities) {
 6027		ret = hw->mac.ops.get_link_capabilities(hw, &speed,
 6028							&autoneg);
 6029		/* remove NBASE-T speeds from default autonegotiation
 6030		 * to accommodate broken network switches in the field
 6031		 * which cannot cope with advertised NBASE-T speeds
 6032		 */
 6033		speed &= ~(IXGBE_LINK_SPEED_5GB_FULL |
 6034			   IXGBE_LINK_SPEED_2_5GB_FULL);
 6035	}
 6036
 6037	if (ret)
 6038		return ret;
 6039
 6040	if (hw->mac.ops.setup_link) {
 6041		if (adapter->hw.mac.type == ixgbe_mac_e610) {
 6042			ret = ixgbe_enable_link_status_events(adapter, mask);
 6043			if (ret)
 6044				return ret;
 6045		}
 6046		ret = hw->mac.ops.setup_link(hw, speed, link_up);
 6047	}
 6048
 6049	return ret;
 6050}
 6051
 6052/**
 6053 * ixgbe_check_media_subtask - check for media
 6054 * @adapter: pointer to adapter structure
 6055 *
 6056 * If media is available then initialize PHY user configuration. Configure the
 6057 * PHY if the interface is up.
 6058 */
 6059static void ixgbe_check_media_subtask(struct ixgbe_adapter *adapter)
 6060{
 6061	struct ixgbe_hw *hw = &adapter->hw;
 6062
 6063	/* No need to check for media if it's already present */
 6064	if (!(adapter->flags2 & IXGBE_FLAG2_NO_MEDIA))
 6065		return;
 6066
 6067	/* Refresh link info and check if media is present */
 6068	if (ixgbe_update_link_info(hw))
 6069		return;
 6070
 6071	ixgbe_check_link_cfg_err(adapter, hw->link.link_info.link_cfg_err);
 6072
 6073	if (hw->link.link_info.link_info & IXGBE_ACI_MEDIA_AVAILABLE) {
 6074		/* PHY settings are reset on media insertion, reconfigure
 6075		 * PHY to preserve settings.
 6076		 */
 6077		if (!(ixgbe_non_sfp_link_config(&adapter->hw)))
 6078			adapter->flags2 &= ~IXGBE_FLAG2_NO_MEDIA;
 6079
 6080		/* A Link Status Event will be generated; the event handler
 6081		 * will complete bringing the interface up
 6082		 */
 6083	}
 6084}
 6085
 6086/**
 6087 * ixgbe_clear_vf_stats_counters - Clear out VF stats after reset
 6088 * @adapter: board private structure
 6089 *
 6090 * On a reset we need to clear out the VF stats or accounting gets
 6091 * messed up because they're not clear on read.
 6092 **/
 6093static void ixgbe_clear_vf_stats_counters(struct ixgbe_adapter *adapter)
 6094{
 6095	struct ixgbe_hw *hw = &adapter->hw;
 6096	int i;
 6097
 6098	for (i = 0; i < adapter->num_vfs; i++) {
 6099		adapter->vfinfo[i].last_vfstats.gprc =
 6100			IXGBE_READ_REG(hw, IXGBE_PVFGPRC(i));
 6101		adapter->vfinfo[i].saved_rst_vfstats.gprc +=
 6102			adapter->vfinfo[i].vfstats.gprc;
 6103		adapter->vfinfo[i].vfstats.gprc = 0;
 6104		adapter->vfinfo[i].last_vfstats.gptc =
 6105			IXGBE_READ_REG(hw, IXGBE_PVFGPTC(i));
 6106		adapter->vfinfo[i].saved_rst_vfstats.gptc +=
 6107			adapter->vfinfo[i].vfstats.gptc;
 6108		adapter->vfinfo[i].vfstats.gptc = 0;
 6109		adapter->vfinfo[i].last_vfstats.gorc =
 6110			IXGBE_READ_REG(hw, IXGBE_PVFGORC_LSB(i));
 6111		adapter->vfinfo[i].saved_rst_vfstats.gorc +=
 6112			adapter->vfinfo[i].vfstats.gorc;
 6113		adapter->vfinfo[i].vfstats.gorc = 0;
 6114		adapter->vfinfo[i].last_vfstats.gotc =
 6115			IXGBE_READ_REG(hw, IXGBE_PVFGOTC_LSB(i));
 6116		adapter->vfinfo[i].saved_rst_vfstats.gotc +=
 6117			adapter->vfinfo[i].vfstats.gotc;
 6118		adapter->vfinfo[i].vfstats.gotc = 0;
 6119		adapter->vfinfo[i].last_vfstats.mprc =
 6120			IXGBE_READ_REG(hw, IXGBE_PVFMPRC(i));
 6121		adapter->vfinfo[i].saved_rst_vfstats.mprc +=
 6122			adapter->vfinfo[i].vfstats.mprc;
 6123		adapter->vfinfo[i].vfstats.mprc = 0;
 6124	}
 6125}
 6126
 6127static void ixgbe_setup_gpie(struct ixgbe_adapter *adapter)
 6128{
 6129	struct ixgbe_hw *hw = &adapter->hw;
 6130	u32 gpie = 0;
 6131
 6132	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
 6133		gpie = IXGBE_GPIE_MSIX_MODE | IXGBE_GPIE_PBA_SUPPORT |
 6134		       IXGBE_GPIE_OCD;
 6135		gpie |= IXGBE_GPIE_EIAME;
 6136		/*
 6137		 * use EIAM to auto-mask when MSI-X interrupt is asserted
 6138		 * this saves a register write for every interrupt
 6139		 */
 6140		switch (hw->mac.type) {
 6141		case ixgbe_mac_82598EB:
 6142			IXGBE_WRITE_REG(hw, IXGBE_EIAM, IXGBE_EICS_RTX_QUEUE);
 6143			break;
 6144		case ixgbe_mac_82599EB:
 6145		case ixgbe_mac_X540:
 6146		case ixgbe_mac_X550:
 6147		case ixgbe_mac_X550EM_x:
 6148		case ixgbe_mac_x550em_a:
 6149		case ixgbe_mac_e610:
 6150		default:
 6151			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(0), 0xFFFFFFFF);
 6152			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(1), 0xFFFFFFFF);
 6153			break;
 6154		}
 6155	} else {
 6156		/* legacy interrupts, use EIAM to auto-mask when reading EICR,
 6157		 * specifically only auto mask tx and rx interrupts */
 6158		IXGBE_WRITE_REG(hw, IXGBE_EIAM, IXGBE_EICS_RTX_QUEUE);
 6159	}
 6160
 6161	/* XXX: to interrupt immediately for EICS writes, enable this */
 6162	/* gpie |= IXGBE_GPIE_EIMEN; */
 6163
 6164	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
 6165		gpie &= ~IXGBE_GPIE_VTMODE_MASK;
 6166
 6167		switch (adapter->ring_feature[RING_F_VMDQ].mask) {
 6168		case IXGBE_82599_VMDQ_8Q_MASK:
 6169			gpie |= IXGBE_GPIE_VTMODE_16;
 6170			break;
 6171		case IXGBE_82599_VMDQ_4Q_MASK:
 6172			gpie |= IXGBE_GPIE_VTMODE_32;
 6173			break;
 6174		default:
 6175			gpie |= IXGBE_GPIE_VTMODE_64;
 6176			break;
 6177		}
 6178	}
 6179
 6180	/* Enable Thermal over heat sensor interrupt */
 6181	if (adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE) {
 6182		switch (adapter->hw.mac.type) {
 6183		case ixgbe_mac_82599EB:
 6184			gpie |= IXGBE_SDP0_GPIEN_8259X;
 6185			break;
 6186		default:
 6187			break;
 6188		}
 6189	}
 6190
 6191	/* Enable fan failure interrupt */
 6192	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE)
 6193		gpie |= IXGBE_SDP1_GPIEN(hw);
 6194
 6195	switch (hw->mac.type) {
 6196	case ixgbe_mac_82599EB:
 6197		gpie |= IXGBE_SDP1_GPIEN_8259X | IXGBE_SDP2_GPIEN_8259X;
 6198		break;
 6199	case ixgbe_mac_X550EM_x:
 6200	case ixgbe_mac_x550em_a:
 6201		gpie |= IXGBE_SDP0_GPIEN_X540;
 6202		break;
 6203	default:
 6204		break;
 6205	}
 6206
 6207	IXGBE_WRITE_REG(hw, IXGBE_GPIE, gpie);
 6208}
 6209
 6210static void ixgbe_up_complete(struct ixgbe_adapter *adapter)
 6211{
 6212	struct ixgbe_hw *hw = &adapter->hw;
 6213	int err;
 6214	u32 ctrl_ext;
 6215
 6216	ixgbe_get_hw_control(adapter);
 6217	ixgbe_setup_gpie(adapter);
 6218
 6219	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
 6220		ixgbe_configure_msix(adapter);
 6221	else
 6222		ixgbe_configure_msi_and_legacy(adapter);
 6223
 6224	/* enable the optics for 82599 SFP+ fiber */
 6225	if (hw->mac.ops.enable_tx_laser)
 6226		hw->mac.ops.enable_tx_laser(hw);
 6227
 6228	if (hw->phy.ops.set_phy_power)
 6229		hw->phy.ops.set_phy_power(hw, true);
 6230
 6231	smp_mb__before_atomic();
 6232	clear_bit(__IXGBE_DOWN, &adapter->state);
 6233	ixgbe_napi_enable_all(adapter);
 6234
 6235	if (ixgbe_is_sfp(hw)) {
 6236		ixgbe_sfp_link_config(adapter);
 6237	} else {
 6238		err = ixgbe_non_sfp_link_config(hw);
 6239		if (err)
 6240			e_err(probe, "link_config FAILED %d\n", err);
 6241	}
 6242
 6243	/* clear any pending interrupts, may auto mask */
 6244	IXGBE_READ_REG(hw, IXGBE_EICR);
 6245	ixgbe_irq_enable(adapter, true, true);
 6246
 6247	/*
 6248	 * If this adapter has a fan, check to see if we had a failure
 6249	 * before we enabled the interrupt.
 6250	 */
 6251	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE) {
 6252		u32 esdp = IXGBE_READ_REG(hw, IXGBE_ESDP);
 6253		if (esdp & IXGBE_ESDP_SDP1)
 6254			e_crit(drv, "Fan has stopped, replace the adapter\n");
 6255	}
 6256
 6257	/* bring the link up in the watchdog, this could race with our first
 6258	 * link up interrupt but shouldn't be a problem */
 6259	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
 6260	adapter->link_check_timeout = jiffies;
 6261	mod_timer(&adapter->service_timer, jiffies);
 6262
 6263	ixgbe_clear_vf_stats_counters(adapter);
 6264	/* Set PF Reset Done bit so PF/VF Mail Ops can work */
 6265	ctrl_ext = IXGBE_READ_REG(hw, IXGBE_CTRL_EXT);
 6266	ctrl_ext |= IXGBE_CTRL_EXT_PFRSTD;
 6267	IXGBE_WRITE_REG(hw, IXGBE_CTRL_EXT, ctrl_ext);
 6268
 6269	/* update setting rx tx for all active vfs */
 6270	ixgbe_set_all_vfs(adapter);
 6271}
 6272
 6273void ixgbe_reinit_locked(struct ixgbe_adapter *adapter)
 6274{
 6275	/* put off any impending NetWatchDogTimeout */
 6276	netif_trans_update(adapter->netdev);
 6277
 6278	while (test_and_set_bit(__IXGBE_RESETTING, &adapter->state))
 6279		usleep_range(1000, 2000);
 6280	if (adapter->hw.phy.type == ixgbe_phy_fw)
 6281		ixgbe_watchdog_link_is_down(adapter);
 6282	ixgbe_down(adapter);
 6283	/*
 6284	 * If SR-IOV enabled then wait a bit before bringing the adapter
 6285	 * back up to give the VFs time to respond to the reset.  The
 6286	 * two second wait is based upon the watchdog timer cycle in
 6287	 * the VF driver.
 6288	 */
 6289	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
 6290		msleep(2000);
 6291	ixgbe_up(adapter);
 6292
 6293	/* E610 has no FW event to notify all PFs of an EMPR reset, so
 6294	 * refresh the FW version here to pick up any new FW version after
 6295	 * a hardware reset (e.g. EMPR triggered by another PF's devlink
 6296	 * reload).  ixgbe_refresh_fw_version() updates both hw->flash and
 6297	 * adapter->eeprom_id so ethtool -i reports the correct string.
 6298	 */
 6299	if (adapter->hw.mac.type == ixgbe_mac_e610)
 6300		(void)ixgbe_refresh_fw_version(adapter);
 6301
 6302	clear_bit(__IXGBE_RESETTING, &adapter->state);
 6303}
 6304
 6305void ixgbe_up(struct ixgbe_adapter *adapter)
 6306{
 6307	/* hardware has been reset, we need to reload some things */
 6308	ixgbe_configure(adapter);
 6309
 6310	ixgbe_up_complete(adapter);
 6311}
 6312
 6313static unsigned long ixgbe_get_completion_timeout(struct ixgbe_adapter *adapter)
 6314{
 6315	u16 devctl2;
 6316
 6317	pcie_capability_read_word(adapter->pdev, PCI_EXP_DEVCTL2, &devctl2);
 6318
 6319	switch (devctl2 & IXGBE_PCIDEVCTRL2_TIMEO_MASK) {
 6320	case IXGBE_PCIDEVCTRL2_17_34s:
 6321	case IXGBE_PCIDEVCTRL2_4_8s:
 6322		/* For now we cap the upper limit on delay to 2 seconds
 6323		 * as we end up going up to 34 seconds of delay in worst
 6324		 * case timeout value.
 6325		 */
 6326	case IXGBE_PCIDEVCTRL2_1_2s:
 6327		return 2000000ul;	/* 2.0 s */
 6328	case IXGBE_PCIDEVCTRL2_260_520ms:
 6329		return 520000ul;	/* 520 ms */
 6330	case IXGBE_PCIDEVCTRL2_65_130ms:
 6331		return 130000ul;	/* 130 ms */
 6332	case IXGBE_PCIDEVCTRL2_16_32ms:
 6333		return 32000ul;		/* 32 ms */
 6334	case IXGBE_PCIDEVCTRL2_1_2ms:
 6335		return 2000ul;		/* 2 ms */
 6336	case IXGBE_PCIDEVCTRL2_50_100us:
 6337		return 100ul;		/* 100 us */
 6338	case IXGBE_PCIDEVCTRL2_16_32ms_def:
 6339		return 32000ul;		/* 32 ms */
 6340	default:
 6341		break;
 6342	}
 6343
 6344	/* We shouldn't need to hit this path, but just in case default as
 6345	 * though completion timeout is not supported and support 32ms.
 6346	 */
 6347	return 32000ul;
 6348}
 6349
 6350void ixgbe_disable_rx(struct ixgbe_adapter *adapter)
 6351{
 6352	unsigned long wait_delay, delay_interval;
 6353	struct ixgbe_hw *hw = &adapter->hw;
 6354	int i, wait_loop;
 6355	u32 rxdctl;
 6356
 6357	/* disable receives */
 6358	hw->mac.ops.disable_rx(hw);
 6359
 6360	if (ixgbe_removed(hw->hw_addr))
 6361		return;
 6362
 6363	/* disable all enabled Rx queues */
 6364	for (i = 0; i < adapter->num_rx_queues; i++) {
 6365		struct ixgbe_ring *ring = adapter->rx_ring[i];
 6366		u8 reg_idx = ring->reg_idx;
 6367
 6368		rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
 6369		rxdctl &= ~IXGBE_RXDCTL_ENABLE;
 6370		rxdctl |= IXGBE_RXDCTL_SWFLSH;
 6371
 6372		/* write value back with RXDCTL.ENABLE bit cleared */
 6373		IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(reg_idx), rxdctl);
 6374	}
 6375
 6376	/* RXDCTL.EN may not change on 82598 if link is down, so skip it */
 6377	if (hw->mac.type == ixgbe_mac_82598EB &&
 6378	    !(IXGBE_READ_REG(hw, IXGBE_LINKS) & IXGBE_LINKS_UP))
 6379		return;
 6380
 6381	/* Determine our minimum delay interval. We will increase this value
 6382	 * with each subsequent test. This way if the device returns quickly
 6383	 * we should spend as little time as possible waiting, however as
 6384	 * the time increases we will wait for larger periods of time.
 6385	 *
 6386	 * The trick here is that we increase the interval using the
 6387	 * following pattern: 1x 3x 5x 7x 9x 11x 13x 15x 17x 19x. The result
 6388	 * of that wait is that it totals up to 100x whatever interval we
 6389	 * choose. Since our minimum wait is 100us we can just divide the
 6390	 * total timeout by 100 to get our minimum delay interval.
 6391	 */
 6392	delay_interval = ixgbe_get_completion_timeout(adapter) / 100;
 6393
 6394	wait_loop = IXGBE_MAX_RX_DESC_POLL;
 6395	wait_delay = delay_interval;
 6396
 6397	while (wait_loop--) {
 6398		usleep_range(wait_delay, wait_delay + 10);
 6399		wait_delay += delay_interval * 2;
 6400		rxdctl = 0;
 6401
 6402		/* OR together the reading of all the active RXDCTL registers,
 6403		 * and then test the result. We need the disable to complete
 6404		 * before we start freeing the memory and invalidating the
 6405		 * DMA mappings.
 6406		 */
 6407		for (i = 0; i < adapter->num_rx_queues; i++) {
 6408			struct ixgbe_ring *ring = adapter->rx_ring[i];
 6409			u8 reg_idx = ring->reg_idx;
 6410
 6411			rxdctl |= IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
 6412		}
 6413
 6414		if (!(rxdctl & IXGBE_RXDCTL_ENABLE))
 6415			return;
 6416	}
 6417
 6418	e_err(drv,
 6419	      "RXDCTL.ENABLE for one or more queues not cleared within the polling period\n");
 6420}
 6421
 6422void ixgbe_disable_tx(struct ixgbe_adapter *adapter)
 6423{
 6424	unsigned long wait_delay, delay_interval;
 6425	struct ixgbe_hw *hw = &adapter->hw;
 6426	int i, wait_loop;
 6427	u32 txdctl;
 6428
 6429	if (ixgbe_removed(hw->hw_addr))
 6430		return;
 6431
 6432	/* disable all enabled Tx queues */
 6433	for (i = 0; i < adapter->num_tx_queues; i++) {
 6434		struct ixgbe_ring *ring = adapter->tx_ring[i];
 6435		u8 reg_idx = ring->reg_idx;
 6436
 6437		IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), IXGBE_TXDCTL_SWFLSH);
 6438	}
 6439
 6440	/* disable all enabled XDP Tx queues */
 6441	for (i = 0; i < adapter->num_xdp_queues; i++) {
 6442		struct ixgbe_ring *ring = adapter->xdp_ring[i];
 6443		u8 reg_idx = ring->reg_idx;
 6444
 6445		IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), IXGBE_TXDCTL_SWFLSH);
 6446	}
 6447
 6448	/* If the link is not up there shouldn't be much in the way of
 6449	 * pending transactions. Those that are left will be flushed out
 6450	 * when the reset logic goes through the flush sequence to clean out
 6451	 * the pending Tx transactions.
 6452	 */
 6453	if (!(IXGBE_READ_REG(hw, IXGBE_LINKS) & IXGBE_LINKS_UP))
 6454		goto dma_engine_disable;
 6455
 6456	/* Determine our minimum delay interval. We will increase this value
 6457	 * with each subsequent test. This way if the device returns quickly
 6458	 * we should spend as little time as possible waiting, however as
 6459	 * the time increases we will wait for larger periods of time.
 6460	 *
 6461	 * The trick here is that we increase the interval using the
 6462	 * following pattern: 1x 3x 5x 7x 9x 11x 13x 15x 17x 19x. The result
 6463	 * of that wait is that it totals up to 100x whatever interval we
 6464	 * choose. Since our minimum wait is 100us we can just divide the
 6465	 * total timeout by 100 to get our minimum delay interval.
 6466	 */
 6467	delay_interval = ixgbe_get_completion_timeout(adapter) / 100;
 6468
 6469	wait_loop = IXGBE_MAX_RX_DESC_POLL;
 6470	wait_delay = delay_interval;
 6471
 6472	while (wait_loop--) {
 6473		usleep_range(wait_delay, wait_delay + 10);
 6474		wait_delay += delay_interval * 2;
 6475		txdctl = 0;
 6476
 6477		/* OR together the reading of all the active TXDCTL registers,
 6478		 * and then test the result. We need the disable to complete
 6479		 * before we start freeing the memory and invalidating the
 6480		 * DMA mappings.
 6481		 */
 6482		for (i = 0; i < adapter->num_tx_queues; i++) {
 6483			struct ixgbe_ring *ring = adapter->tx_ring[i];
 6484			u8 reg_idx = ring->reg_idx;
 6485
 6486			txdctl |= IXGBE_READ_REG(hw, IXGBE_TXDCTL(reg_idx));
 6487		}
 6488		for (i = 0; i < adapter->num_xdp_queues; i++) {
 6489			struct ixgbe_ring *ring = adapter->xdp_ring[i];
 6490			u8 reg_idx = ring->reg_idx;
 6491
 6492			txdctl |= IXGBE_READ_REG(hw, IXGBE_TXDCTL(reg_idx));
 6493		}
 6494
 6495		if (!(txdctl & IXGBE_TXDCTL_ENABLE))
 6496			goto dma_engine_disable;
 6497	}
 6498
 6499	e_err(drv,
 6500	      "TXDCTL.ENABLE for one or more queues not cleared within the polling period\n");
 6501
 6502dma_engine_disable:
 6503	/* Disable the Tx DMA engine on 82599 and later MAC */
 6504	switch (hw->mac.type) {
 6505	case ixgbe_mac_82599EB:
 6506	case ixgbe_mac_X540:
 6507	case ixgbe_mac_X550:
 6508	case ixgbe_mac_X550EM_x:
 6509	case ixgbe_mac_x550em_a:
 6510	case ixgbe_mac_e610:
 6511		IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL,
 6512				(IXGBE_READ_REG(hw, IXGBE_DMATXCTL) &
 6513				 ~IXGBE_DMATXCTL_TE));
 6514		fallthrough;
 6515	default:
 6516		break;
 6517	}
 6518}
 6519
 6520void ixgbe_reset(struct ixgbe_adapter *adapter)
 6521{
 6522	struct ixgbe_hw *hw = &adapter->hw;
 6523	struct net_device *netdev = adapter->netdev;
 6524	int err;
 6525
 6526	if (ixgbe_removed(hw->hw_addr))
 6527		return;
 6528	/* lock SFP init bit to prevent race conditions with the watchdog */
 6529	while (test_and_set_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
 6530		usleep_range(1000, 2000);
 6531
 6532	/* clear all SFP and link config related flags while holding SFP_INIT */
 6533	adapter->flags2 &= ~(IXGBE_FLAG2_SEARCH_FOR_SFP |
 6534			     IXGBE_FLAG2_SFP_NEEDS_RESET);
 6535	adapter->flags &= ~IXGBE_FLAG_NEED_LINK_CONFIG;
 6536
 6537	err = hw->mac.ops.init_hw(hw);
 6538	switch (err) {
 6539	case 0:
 6540	case -ENOENT:
 6541	case -EOPNOTSUPP:
 6542		break;
 6543	case -EALREADY:
 6544		e_dev_err("primary disable timed out\n");
 6545		break;
 6546	case -EACCES:
 6547		/* We are running on a pre-production device, log a warning */
 6548		e_dev_warn("This device is a pre-production adapter/LOM. "
 6549			   "Please be aware there may be issues associated with "
 6550			   "your hardware.  If you are experiencing problems "
 6551			   "please contact your Intel or hardware "
 6552			   "representative who provided you with this "
 6553			   "hardware.\n");
 6554		break;
 6555	default:
 6556		e_dev_err("Hardware Error: %d\n", err);
 6557	}
 6558
 6559	clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);
 6560
 6561	/* flush entries out of MAC table */
 6562	ixgbe_flush_sw_mac_table(adapter);
 6563	__dev_uc_unsync(netdev, NULL);
 6564
 6565	/* do not flush user set addresses */
 6566	ixgbe_mac_set_default_filter(adapter);
 6567
 6568	/* update SAN MAC vmdq pool selection */
 6569	if (hw->mac.san_mac_rar_index)
 6570		hw->mac.ops.set_vmdq_san_mac(hw, VMDQ_P(0));
 6571
 6572	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
 6573		ixgbe_ptp_reset(adapter);
 6574
 6575	if (hw->phy.ops.set_phy_power) {
 6576		if (!netif_running(adapter->netdev) && !adapter->wol)
 6577			hw->phy.ops.set_phy_power(hw, false);
 6578		else
 6579			hw->phy.ops.set_phy_power(hw, true);
 6580	}
 6581}
 6582
 6583/**
 6584 * ixgbe_clean_tx_ring - Free Tx Buffers
 6585 * @tx_ring: ring to be cleaned
 6586 **/
 6587static void ixgbe_clean_tx_ring(struct ixgbe_ring *tx_ring)
 6588{
 6589	u16 i = tx_ring->next_to_clean;
 6590	struct ixgbe_tx_buffer *tx_buffer = &tx_ring->tx_buffer_info[i];
 6591
 6592	if (tx_ring->xsk_pool) {
 6593		ixgbe_xsk_clean_tx_ring(tx_ring);
 6594		goto out;
 6595	}
 6596
 6597	while (i != tx_ring->next_to_use) {
 6598		union ixgbe_adv_tx_desc *eop_desc, *tx_desc;
 6599
 6600		/* Free all the Tx ring sk_buffs */
 6601		if (ring_is_xdp(tx_ring))
 6602			xdp_return_frame(tx_buffer->xdpf);
 6603		else
 6604			dev_kfree_skb_any(tx_buffer->skb);
 6605
 6606		/* unmap skb header data */
 6607		dma_unmap_single(tx_ring->dev,
 6608				 dma_unmap_addr(tx_buffer, dma),
 6609				 dma_unmap_len(tx_buffer, len),
 6610				 DMA_TO_DEVICE);
 6611
 6612		/* check for eop_desc to determine the end of the packet */
 6613		eop_desc = tx_buffer->next_to_watch;
 6614		tx_desc = IXGBE_TX_DESC(tx_ring, i);
 6615
 6616		/* unmap remaining buffers */
 6617		while (tx_desc != eop_desc) {
 6618			tx_buffer++;
 6619			tx_desc++;
 6620			i++;
 6621			if (unlikely(i == tx_ring->count)) {
 6622				i = 0;
 6623				tx_buffer = tx_ring->tx_buffer_info;
 6624				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
 6625			}
 6626
 6627			/* unmap any remaining paged data */
 6628			if (dma_unmap_len(tx_buffer, len))
 6629				dma_unmap_page(tx_ring->dev,
 6630					       dma_unmap_addr(tx_buffer, dma),
 6631					       dma_unmap_len(tx_buffer, len),
 6632					       DMA_TO_DEVICE);
 6633		}
 6634
 6635		/* move us one more past the eop_desc for start of next pkt */
 6636		tx_buffer++;
 6637		i++;
 6638		if (unlikely(i == tx_ring->count)) {
 6639			i = 0;
 6640			tx_buffer = tx_ring->tx_buffer_info;
 6641		}
 6642	}
 6643
 6644	/* reset BQL for queue */
 6645	if (!ring_is_xdp(tx_ring))
 6646		netdev_tx_reset_queue(txring_txq(tx_ring));
 6647
 6648out:
 6649	/* reset next_to_use and next_to_clean */
 6650	tx_ring->next_to_use = 0;
 6651	tx_ring->next_to_clean = 0;
 6652}
 6653
 6654/**
 6655 * ixgbe_clean_all_rx_rings - Free Rx Buffers for all queues
 6656 * @adapter: board private structure
 6657 **/
 6658static void ixgbe_clean_all_rx_rings(struct ixgbe_adapter *adapter)
 6659{
 6660	int i;
 6661
 6662	for (i = 0; i < adapter->num_rx_queues; i++)
 6663		ixgbe_clean_rx_ring(adapter->rx_ring[i]);
 6664}
 6665
 6666/**
 6667 * ixgbe_clean_all_tx_rings - Free Tx Buffers for all queues
 6668 * @adapter: board private structure
 6669 **/
 6670static void ixgbe_clean_all_tx_rings(struct ixgbe_adapter *adapter)
 6671{
 6672	int i;
 6673
 6674	for (i = 0; i < adapter->num_tx_queues; i++)
 6675		ixgbe_clean_tx_ring(adapter->tx_ring[i]);
 6676	for (i = 0; i < adapter->num_xdp_queues; i++)
 6677		ixgbe_clean_tx_ring(adapter->xdp_ring[i]);
 6678}
 6679
 6680static void ixgbe_fdir_filter_exit(struct ixgbe_adapter *adapter)
 6681{
 6682	struct hlist_node *node2;
 6683	struct ixgbe_fdir_filter *filter;
 6684
 6685	spin_lock(&adapter->fdir_perfect_lock);
 6686
 6687	hlist_for_each_entry_safe(filter, node2,
 6688				  &adapter->fdir_filter_list, fdir_node) {
 6689		hlist_del(&filter->fdir_node);
 6690		kfree(filter);
 6691	}
 6692	adapter->fdir_filter_count = 0;
 6693
 6694	spin_unlock(&adapter->fdir_perfect_lock);
 6695}
 6696
 6697void ixgbe_down(struct ixgbe_adapter *adapter)
 6698{
 6699	struct net_device *netdev = adapter->netdev;
 6700	struct ixgbe_hw *hw = &adapter->hw;
 6701	int i;
 6702
 6703	/* signal that we are down to the interrupt handler */
 6704	if (test_and_set_bit(__IXGBE_DOWN, &adapter->state))
 6705		return; /* do nothing if already down */
 6706
 6707	/* Shut off incoming Tx traffic */
 6708	netif_tx_stop_all_queues(netdev);
 6709
 6710	/* call carrier off first to avoid false dev_watchdog timeouts */
 6711	netif_carrier_off(netdev);
 6712	netif_tx_disable(netdev);
 6713
 6714	/* Disable Rx */
 6715	ixgbe_disable_rx(adapter);
 6716
 6717	/* synchronize_rcu() needed for pending XDP buffers to drain */
 6718	if (adapter->xdp_ring[0])
 6719		synchronize_rcu();
 6720
 6721	ixgbe_irq_disable(adapter);
 6722
 6723	ixgbe_napi_disable_all(adapter);
 6724
 6725	clear_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
 6726	adapter->flags2 &= ~IXGBE_FLAG2_FDIR_REQUIRES_REINIT;
 6727	adapter->flags &= ~IXGBE_FLAG_NEED_LINK_UPDATE;
 6728
 6729	timer_delete_sync(&adapter->service_timer);
 6730
 6731	if (adapter->num_vfs) {
 6732		/* Clear EITR Select mapping */
 6733		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITRSEL, 0);
 6734
 6735		/* Mark all the VFs as inactive */
 6736		for (i = 0 ; i < adapter->num_vfs; i++)
 6737			adapter->vfinfo[i].clear_to_send = false;
 6738
 6739		/* update setting rx tx for all active vfs */
 6740		ixgbe_set_all_vfs(adapter);
 6741	}
 6742
 6743	/* disable transmits in the hardware now that interrupts are off */
 6744	ixgbe_disable_tx(adapter);
 6745
 6746	if (!pci_channel_offline(adapter->pdev))
 6747		ixgbe_reset(adapter);
 6748
 6749	/* power down the optics for 82599 SFP+ fiber */
 6750	if (hw->mac.ops.disable_tx_laser)
 6751		hw->mac.ops.disable_tx_laser(hw);
 6752
 6753	ixgbe_clean_all_tx_rings(adapter);
 6754	ixgbe_clean_all_rx_rings(adapter);
 6755	if (adapter->hw.mac.type == ixgbe_mac_e610)
 6756		ixgbe_disable_link_status_events(adapter);
 6757}
 6758
 6759/**
 6760 * ixgbe_set_eee_capable - helper function to determine EEE support on X550
 6761 * @adapter: board private structure
 6762 */
 6763static void ixgbe_set_eee_capable(struct ixgbe_adapter *adapter)
 6764{
 6765	struct ixgbe_hw *hw = &adapter->hw;
 6766
 6767	switch (hw->device_id) {
 6768	case IXGBE_DEV_ID_X550EM_A_1G_T:
 6769	case IXGBE_DEV_ID_X550EM_A_1G_T_L:
 6770		if (!hw->phy.eee_speeds_supported)
 6771			break;
 6772		adapter->flags2 |= IXGBE_FLAG2_EEE_CAPABLE;
 6773		if (!hw->phy.eee_speeds_advertised)
 6774			break;
 6775		adapter->flags2 |= IXGBE_FLAG2_EEE_ENABLED;
 6776		break;
 6777	default:
 6778		adapter->flags2 &= ~IXGBE_FLAG2_EEE_CAPABLE;
 6779		adapter->flags2 &= ~IXGBE_FLAG2_EEE_ENABLED;
 6780		break;
 6781	}
 6782}
 6783
 6784/**
 6785 * ixgbe_tx_timeout - Respond to a Tx Hang
 6786 * @netdev: network interface device structure
 6787 * @txqueue: queue number that timed out
 6788 **/
 6789static void ixgbe_tx_timeout(struct net_device *netdev, unsigned int __always_unused txqueue)
 6790{
 6791	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 6792
 6793	/* Do the reset outside of interrupt context */
 6794	ixgbe_tx_timeout_reset(adapter);
 6795}
 6796
 6797#ifdef CONFIG_IXGBE_DCB
 6798static void ixgbe_init_dcb(struct ixgbe_adapter *adapter)
 6799{
 6800	struct ixgbe_hw *hw = &adapter->hw;
 6801	struct tc_configuration *tc;
 6802	int j;
 6803
 6804	switch (hw->mac.type) {
 6805	case ixgbe_mac_82598EB:
 6806	case ixgbe_mac_82599EB:
 6807		adapter->dcb_cfg.num_tcs.pg_tcs = MAX_TRAFFIC_CLASS;
 6808		adapter->dcb_cfg.num_tcs.pfc_tcs = MAX_TRAFFIC_CLASS;
 6809		break;
 6810	case ixgbe_mac_X540:
 6811	case ixgbe_mac_X550:
 6812	case ixgbe_mac_e610:
 6813		adapter->dcb_cfg.num_tcs.pg_tcs = X540_TRAFFIC_CLASS;
 6814		adapter->dcb_cfg.num_tcs.pfc_tcs = X540_TRAFFIC_CLASS;
 6815		break;
 6816	case ixgbe_mac_X550EM_x:
 6817	case ixgbe_mac_x550em_a:
 6818	default:
 6819		adapter->dcb_cfg.num_tcs.pg_tcs = DEF_TRAFFIC_CLASS;
 6820		adapter->dcb_cfg.num_tcs.pfc_tcs = DEF_TRAFFIC_CLASS;
 6821		break;
 6822	}
 6823
 6824	/* Configure DCB traffic classes */
 6825	for (j = 0; j < MAX_TRAFFIC_CLASS; j++) {
 6826		tc = &adapter->dcb_cfg.tc_config[j];
 6827		tc->path[DCB_TX_CONFIG].bwg_id = 0;
 6828		tc->path[DCB_TX_CONFIG].bwg_percent = 12 + (j & 1);
 6829		tc->path[DCB_RX_CONFIG].bwg_id = 0;
 6830		tc->path[DCB_RX_CONFIG].bwg_percent = 12 + (j & 1);
 6831		tc->dcb_pfc = pfc_disabled;
 6832	}
 6833
 6834	/* Initialize default user to priority mapping, UPx->TC0 */
 6835	tc = &adapter->dcb_cfg.tc_config[0];
 6836	tc->path[DCB_TX_CONFIG].up_to_tc_bitmap = 0xFF;
 6837	tc->path[DCB_RX_CONFIG].up_to_tc_bitmap = 0xFF;
 6838
 6839	adapter->dcb_cfg.bw_percentage[DCB_TX_CONFIG][0] = 100;
 6840	adapter->dcb_cfg.bw_percentage[DCB_RX_CONFIG][0] = 100;
 6841	adapter->dcb_cfg.pfc_mode_enable = false;
 6842	adapter->dcb_set_bitmap = 0x00;
 6843	if (adapter->flags & IXGBE_FLAG_DCB_CAPABLE)
 6844		adapter->dcbx_cap = DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_CEE;
 6845	memcpy(&adapter->temp_dcb_cfg, &adapter->dcb_cfg,
 6846	       sizeof(adapter->temp_dcb_cfg));
 6847}
 6848#endif
 6849
 6850/**
 6851 * ixgbe_sw_init - Initialize general software structures (struct ixgbe_adapter)
 6852 * @adapter: board private structure to initialize
 6853 * @ii: pointer to ixgbe_info for device
 6854 *
 6855 * ixgbe_sw_init initializes the Adapter private data structure.
 6856 * Fields are initialized based on PCI device information and
 6857 * OS network device settings (MTU size).
 6858 **/
 6859static int ixgbe_sw_init(struct ixgbe_adapter *adapter,
 6860			 const struct ixgbe_info *ii)
 6861{
 6862	struct ixgbe_hw *hw = &adapter->hw;
 6863	struct pci_dev *pdev = adapter->pdev;
 6864	unsigned int rss, fdir;
 6865	u32 fwsm;
 6866	int i;
 6867
 6868	/* PCI config space info */
 6869
 6870	hw->vendor_id = pdev->vendor;
 6871	hw->device_id = pdev->device;
 6872	hw->revision_id = pdev->revision;
 6873	hw->subsystem_vendor_id = pdev->subsystem_vendor;
 6874	hw->subsystem_device_id = pdev->subsystem_device;
 6875
 6876	hw->mac.max_link_up_time = IXGBE_LINK_UP_TIME;
 6877
 6878	/* get_invariants needs the device IDs */
 6879	ii->get_invariants(hw);
 6880
 6881	/* Set common capability flags and settings */
 6882	rss = min_t(int, ixgbe_max_rss_indices(adapter), num_online_cpus());
 6883	adapter->ring_feature[RING_F_RSS].limit = rss;
 6884	adapter->flags2 |= IXGBE_FLAG2_RSC_CAPABLE;
 6885	adapter->max_q_vectors = MAX_Q_VECTORS_82599;
 6886	adapter->atr_sample_rate = 20;
 6887	fdir = min_t(int, IXGBE_MAX_FDIR_INDICES, num_online_cpus());
 6888	adapter->ring_feature[RING_F_FDIR].limit = fdir;
 6889	adapter->fdir_pballoc = IXGBE_FDIR_PBALLOC_64K;
 6890	adapter->ring_feature[RING_F_VMDQ].limit = 1;
 6891#ifdef CONFIG_IXGBE_DCA
 6892	adapter->flags |= IXGBE_FLAG_DCA_CAPABLE;
 6893#endif
 6894#ifdef CONFIG_IXGBE_DCB
 6895	adapter->flags |= IXGBE_FLAG_DCB_CAPABLE;
 6896	adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;
 6897#endif
 6898#ifdef IXGBE_FCOE
 6899	adapter->flags |= IXGBE_FLAG_FCOE_CAPABLE;
 6900	adapter->flags &= ~IXGBE_FLAG_FCOE_ENABLED;
 6901#ifdef CONFIG_IXGBE_DCB
 6902	/* Default traffic class to use for FCoE */
 6903	adapter->fcoe.up = IXGBE_FCOE_DEFTC;
 6904#endif /* CONFIG_IXGBE_DCB */
 6905#endif /* IXGBE_FCOE */
 6906
 6907	/* initialize static ixgbe jump table entries */
 6908	adapter->jump_tables[0] = kzalloc(sizeof(*adapter->jump_tables[0]),
 6909					  GFP_KERNEL);
 6910	if (!adapter->jump_tables[0])
 6911		return -ENOMEM;
 6912	adapter->jump_tables[0]->mat = ixgbe_ipv4_fields;
 6913
 6914	for (i = 1; i < IXGBE_MAX_LINK_HANDLE; i++)
 6915		adapter->jump_tables[i] = NULL;
 6916
 6917	adapter->mac_table = kcalloc(hw->mac.num_rar_entries,
 6918				     sizeof(struct ixgbe_mac_addr),
 6919				     GFP_KERNEL);
 6920	if (!adapter->mac_table)
 6921		return -ENOMEM;
 6922
 6923	if (ixgbe_init_rss_key(adapter))
 6924		return -ENOMEM;
 6925
 6926	adapter->af_xdp_zc_qps = bitmap_zalloc(IXGBE_MAX_XDP_QS, GFP_KERNEL);
 6927	if (!adapter->af_xdp_zc_qps)
 6928		return -ENOMEM;
 6929
 6930	/* Set MAC specific capability flags and exceptions */
 6931	switch (hw->mac.type) {
 6932	case ixgbe_mac_82598EB:
 6933		adapter->flags2 &= ~IXGBE_FLAG2_RSC_CAPABLE;
 6934
 6935		if (hw->device_id == IXGBE_DEV_ID_82598AT)
 6936			adapter->flags |= IXGBE_FLAG_FAN_FAIL_CAPABLE;
 6937
 6938		adapter->max_q_vectors = MAX_Q_VECTORS_82598;
 6939		adapter->ring_feature[RING_F_FDIR].limit = 0;
 6940		adapter->atr_sample_rate = 0;
 6941		adapter->fdir_pballoc = 0;
 6942#ifdef IXGBE_FCOE
 6943		adapter->flags &= ~IXGBE_FLAG_FCOE_CAPABLE;
 6944		adapter->flags &= ~IXGBE_FLAG_FCOE_ENABLED;
 6945#ifdef CONFIG_IXGBE_DCB
 6946		adapter->fcoe.up = 0;
 6947#endif /* IXGBE_DCB */
 6948#endif /* IXGBE_FCOE */
 6949		break;
 6950	case ixgbe_mac_82599EB:
 6951		if (hw->device_id == IXGBE_DEV_ID_82599_T3_LOM)
 6952			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
 6953		break;
 6954	case ixgbe_mac_X540:
 6955		fwsm = IXGBE_READ_REG(hw, IXGBE_FWSM(hw));
 6956		if (fwsm & IXGBE_FWSM_TS_ENABLED)
 6957			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
 6958		break;
 6959	case ixgbe_mac_x550em_a:
 6960		switch (hw->device_id) {
 6961		case IXGBE_DEV_ID_X550EM_A_1G_T:
 6962		case IXGBE_DEV_ID_X550EM_A_1G_T_L:
 6963			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
 6964			break;
 6965		default:
 6966			break;
 6967		}
 6968		fallthrough;
 6969	case ixgbe_mac_X550EM_x:
 6970#ifdef CONFIG_IXGBE_DCB
 6971		adapter->flags &= ~IXGBE_FLAG_DCB_CAPABLE;
 6972#endif
 6973#ifdef IXGBE_FCOE
 6974		adapter->flags &= ~IXGBE_FLAG_FCOE_CAPABLE;
 6975#ifdef CONFIG_IXGBE_DCB
 6976		adapter->fcoe.up = 0;
 6977#endif /* IXGBE_DCB */
 6978#endif /* IXGBE_FCOE */
 6979		fallthrough;
 6980	case ixgbe_mac_X550:
 6981		if (hw->mac.type == ixgbe_mac_X550)
 6982			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
 6983#ifdef CONFIG_IXGBE_DCA
 6984		adapter->flags &= ~IXGBE_FLAG_DCA_CAPABLE;
 6985#endif
 6986		break;
 6987	default:
 6988		break;
 6989	}
 6990
 6991	/* Make sure the SWFW semaphore is in a valid state */
 6992	if (hw->mac.ops.init_swfw_sync)
 6993		hw->mac.ops.init_swfw_sync(hw);
 6994
 6995	if (hw->mac.type == ixgbe_mac_e610)
 6996		mutex_init(&hw->aci.lock);
 6997
 6998#ifdef IXGBE_FCOE
 6999	/* FCoE support exists, always init the FCoE lock */
 7000	spin_lock_init(&adapter->fcoe.lock);
 7001
 7002#endif
 7003	/* n-tuple support exists, always init our spinlock */
 7004	spin_lock_init(&adapter->fdir_perfect_lock);
 7005
 7006	/* init spinlock to avoid concurrency of VF resources */
 7007	spin_lock_init(&adapter->vfs_lock);
 7008
 7009#ifdef CONFIG_IXGBE_DCB
 7010	ixgbe_init_dcb(adapter);
 7011#endif
 7012	ixgbe_init_ipsec_offload(adapter);
 7013
 7014	/* default flow control settings */
 7015	hw->fc.requested_mode = ixgbe_fc_full;
 7016	hw->fc.current_mode = ixgbe_fc_full;	/* init for ethtool output */
 7017	ixgbe_pbthresh_setup(adapter);
 7018	hw->fc.pause_time = IXGBE_DEFAULT_FCPAUSE;
 7019	hw->fc.send_xon = true;
 7020	hw->fc.disable_fc_autoneg = ixgbe_device_supports_autoneg_fc(hw);
 7021
 7022#ifdef CONFIG_PCI_IOV
 7023	if (max_vfs > 0)
 7024		e_dev_warn("Enabling SR-IOV VFs using the max_vfs module parameter is deprecated - please use the pci sysfs interface instead.\n");
 7025
 7026	/* assign number of SR-IOV VFs */
 7027	if (hw->mac.type != ixgbe_mac_82598EB) {
 7028		if (max_vfs > IXGBE_MAX_VFS_DRV_LIMIT) {
 7029			max_vfs = 0;
 7030			e_dev_warn("max_vfs parameter out of range. Not assigning any SR-IOV VFs\n");
 7031		}
 7032	}
 7033#endif /* CONFIG_PCI_IOV */
 7034
 7035	/* enable itr by default in dynamic mode */
 7036	adapter->rx_itr_setting = 1;
 7037	adapter->tx_itr_setting = 1;
 7038
 7039	/* set default ring sizes */
 7040	adapter->tx_ring_count = IXGBE_DEFAULT_TXD;
 7041	adapter->rx_ring_count = IXGBE_DEFAULT_RXD;
 7042
 7043	/* set default work limits */
 7044	adapter->tx_work_limit = IXGBE_DEFAULT_TX_WORK;
 7045
 7046	/* initialize eeprom parameters */
 7047	if (hw->eeprom.ops.init_params(hw)) {
 7048		e_dev_err("EEPROM initialization failed\n");
 7049		return -EIO;
 7050	}
 7051
 7052	/* PF holds first pool slot */
 7053	set_bit(0, adapter->fwd_bitmask);
 7054	set_bit(__IXGBE_DOWN, &adapter->state);
 7055
 7056	/* enable locking for XDP_TX if we have more CPUs than queues */
 7057	if (nr_cpu_ids > IXGBE_MAX_XDP_QS)
 7058		static_branch_enable(&ixgbe_xdp_locking_key);
 7059
 7060	return 0;
 7061}
 7062
 7063/**
 7064 * ixgbe_setup_tx_resources - allocate Tx resources (Descriptors)
 7065 * @tx_ring:    tx descriptor ring (for a specific queue) to setup
 7066 *
 7067 * Return 0 on success, negative on failure
 7068 **/
 7069int ixgbe_setup_tx_resources(struct ixgbe_ring *tx_ring)
 7070{
 7071	struct device *dev = tx_ring->dev;
 7072	int orig_node = dev_to_node(dev);
 7073	int ring_node = NUMA_NO_NODE;
 7074	int size;
 7075
 7076	size = sizeof(struct ixgbe_tx_buffer) * tx_ring->count;
 7077
 7078	if (tx_ring->q_vector)
 7079		ring_node = tx_ring->q_vector->numa_node;
 7080
 7081	tx_ring->tx_buffer_info = vmalloc_node(size, ring_node);
 7082	if (!tx_ring->tx_buffer_info)
 7083		tx_ring->tx_buffer_info = vmalloc(size);
 7084	if (!tx_ring->tx_buffer_info)
 7085		goto err;
 7086
 7087	/* round up to nearest 4K */
 7088	tx_ring->size = tx_ring->count * sizeof(union ixgbe_adv_tx_desc);
 7089	tx_ring->size = ALIGN(tx_ring->size, 4096);
 7090
 7091	set_dev_node(dev, ring_node);
 7092	tx_ring->desc = dma_alloc_coherent(dev,
 7093					   tx_ring->size,
 7094					   &tx_ring->dma,
 7095					   GFP_KERNEL);
 7096	set_dev_node(dev, orig_node);
 7097	if (!tx_ring->desc)
 7098		tx_ring->desc = dma_alloc_coherent(dev, tx_ring->size,
 7099						   &tx_ring->dma, GFP_KERNEL);
 7100	if (!tx_ring->desc)
 7101		goto err;
 7102
 7103	tx_ring->next_to_use = 0;
 7104	tx_ring->next_to_clean = 0;
 7105	return 0;
 7106
 7107err:
 7108	vfree(tx_ring->tx_buffer_info);
 7109	tx_ring->tx_buffer_info = NULL;
 7110	dev_err(dev, "Unable to allocate memory for the Tx descriptor ring\n");
 7111	return -ENOMEM;
 7112}
 7113
 7114/**
 7115 * ixgbe_setup_all_tx_resources - allocate all queues Tx resources
 7116 * @adapter: board private structure
 7117 *
 7118 * If this function returns with an error, then it's possible one or
 7119 * more of the rings is populated (while the rest are not).  It is the
 7120 * callers duty to clean those orphaned rings.
 7121 *
 7122 * Return 0 on success, negative on failure
 7123 **/
 7124static int ixgbe_setup_all_tx_resources(struct ixgbe_adapter *adapter)
 7125{
 7126	int i, j = 0, err = 0;
 7127
 7128	for (i = 0; i < adapter->num_tx_queues; i++) {
 7129		err = ixgbe_setup_tx_resources(adapter->tx_ring[i]);
 7130		if (!err)
 7131			continue;
 7132
 7133		e_err(probe, "Allocation for Tx Queue %u failed\n", i);
 7134		goto err_setup_tx;
 7135	}
 7136	for (j = 0; j < adapter->num_xdp_queues; j++) {
 7137		err = ixgbe_setup_tx_resources(adapter->xdp_ring[j]);
 7138		if (!err)
 7139			continue;
 7140
 7141		e_err(probe, "Allocation for Tx Queue %u failed\n", j);
 7142		goto err_setup_tx;
 7143	}
 7144
 7145	return 0;
 7146err_setup_tx:
 7147	/* rewind the index freeing the rings as we go */
 7148	while (j--)
 7149		ixgbe_free_tx_resources(adapter->xdp_ring[j]);
 7150	while (i--)
 7151		ixgbe_free_tx_resources(adapter->tx_ring[i]);
 7152	return err;
 7153}
 7154
 7155static int ixgbe_rx_napi_id(struct ixgbe_ring *rx_ring)
 7156{
 7157	struct ixgbe_q_vector *q_vector = rx_ring->q_vector;
 7158
 7159	return q_vector ? q_vector->napi.napi_id : 0;
 7160}
 7161
 7162/**
 7163 * ixgbe_setup_rx_resources - allocate Rx resources (Descriptors)
 7164 * @adapter: pointer to ixgbe_adapter
 7165 * @rx_ring:    rx descriptor ring (for a specific queue) to setup
 7166 *
 7167 * Returns 0 on success, negative on failure
 7168 **/
 7169int ixgbe_setup_rx_resources(struct ixgbe_adapter *adapter,
 7170			     struct ixgbe_ring *rx_ring)
 7171{
 7172	struct device *dev = rx_ring->dev;
 7173	int orig_node = dev_to_node(dev);
 7174	int ring_node = NUMA_NO_NODE;
 7175	int size;
 7176
 7177	size = sizeof(struct ixgbe_rx_buffer) * rx_ring->count;
 7178
 7179	if (rx_ring->q_vector)
 7180		ring_node = rx_ring->q_vector->numa_node;
 7181
 7182	rx_ring->rx_buffer_info = vmalloc_node(size, ring_node);
 7183	if (!rx_ring->rx_buffer_info)
 7184		rx_ring->rx_buffer_info = vmalloc(size);
 7185	if (!rx_ring->rx_buffer_info)
 7186		goto err;
 7187
 7188	/* Round up to nearest 4K */
 7189	rx_ring->size = rx_ring->count * sizeof(union ixgbe_adv_rx_desc);
 7190	rx_ring->size = ALIGN(rx_ring->size, 4096);
 7191
 7192	set_dev_node(dev, ring_node);
 7193	rx_ring->desc = dma_alloc_coherent(dev,
 7194					   rx_ring->size,
 7195					   &rx_ring->dma,
 7196					   GFP_KERNEL);
 7197	set_dev_node(dev, orig_node);
 7198	if (!rx_ring->desc)
 7199		rx_ring->desc = dma_alloc_coherent(dev, rx_ring->size,
 7200						   &rx_ring->dma, GFP_KERNEL);
 7201	if (!rx_ring->desc)
 7202		goto err;
 7203
 7204	rx_ring->next_to_clean = 0;
 7205	rx_ring->next_to_use = 0;
 7206
 7207	/* XDP RX-queue info */
 7208	if (xdp_rxq_info_reg(&rx_ring->xdp_rxq, adapter->netdev,
 7209			     rx_ring->queue_index, ixgbe_rx_napi_id(rx_ring)) < 0)
 7210		goto err;
 7211
 7212	WRITE_ONCE(rx_ring->xdp_prog, adapter->xdp_prog);
 7213
 7214	return 0;
 7215err:
 7216	vfree(rx_ring->rx_buffer_info);
 7217	rx_ring->rx_buffer_info = NULL;
 7218	dev_err(dev, "Unable to allocate memory for the Rx descriptor ring\n");
 7219	return -ENOMEM;
 7220}
 7221
 7222/**
 7223 * ixgbe_setup_all_rx_resources - allocate all queues Rx resources
 7224 * @adapter: board private structure
 7225 *
 7226 * If this function returns with an error, then it's possible one or
 7227 * more of the rings is populated (while the rest are not).  It is the
 7228 * callers duty to clean those orphaned rings.
 7229 *
 7230 * Return 0 on success, negative on failure
 7231 **/
 7232static int ixgbe_setup_all_rx_resources(struct ixgbe_adapter *adapter)
 7233{
 7234	int i, err = 0;
 7235
 7236	for (i = 0; i < adapter->num_rx_queues; i++) {
 7237		err = ixgbe_setup_rx_resources(adapter, adapter->rx_ring[i]);
 7238		if (!err)
 7239			continue;
 7240
 7241		e_err(probe, "Allocation for Rx Queue %u failed\n", i);
 7242		goto err_setup_rx;
 7243	}
 7244
 7245#ifdef IXGBE_FCOE
 7246	err = ixgbe_setup_fcoe_ddp_resources(adapter);
 7247	if (!err)
 7248#endif
 7249		return 0;
 7250err_setup_rx:
 7251	/* rewind the index freeing the rings as we go */
 7252	while (i--)
 7253		ixgbe_free_rx_resources(adapter->rx_ring[i]);
 7254	return err;
 7255}
 7256
 7257/**
 7258 * ixgbe_free_tx_resources - Free Tx Resources per Queue
 7259 * @tx_ring: Tx descriptor ring for a specific queue
 7260 *
 7261 * Free all transmit software resources
 7262 **/
 7263void ixgbe_free_tx_resources(struct ixgbe_ring *tx_ring)
 7264{
 7265	ixgbe_clean_tx_ring(tx_ring);
 7266
 7267	vfree(tx_ring->tx_buffer_info);
 7268	tx_ring->tx_buffer_info = NULL;
 7269
 7270	/* if not set, then don't free */
 7271	if (!tx_ring->desc)
 7272		return;
 7273
 7274	dma_free_coherent(tx_ring->dev, tx_ring->size,
 7275			  tx_ring->desc, tx_ring->dma);
 7276
 7277	tx_ring->desc = NULL;
 7278}
 7279
 7280/**
 7281 * ixgbe_free_all_tx_resources - Free Tx Resources for All Queues
 7282 * @adapter: board private structure
 7283 *
 7284 * Free all transmit software resources
 7285 **/
 7286static void ixgbe_free_all_tx_resources(struct ixgbe_adapter *adapter)
 7287{
 7288	int i;
 7289
 7290	for (i = 0; i < adapter->num_tx_queues; i++)
 7291		if (adapter->tx_ring[i]->desc)
 7292			ixgbe_free_tx_resources(adapter->tx_ring[i]);
 7293	for (i = 0; i < adapter->num_xdp_queues; i++)
 7294		if (adapter->xdp_ring[i]->desc)
 7295			ixgbe_free_tx_resources(adapter->xdp_ring[i]);
 7296}
 7297
 7298/**
 7299 * ixgbe_free_rx_resources - Free Rx Resources
 7300 * @rx_ring: ring to clean the resources from
 7301 *
 7302 * Free all receive software resources
 7303 **/
 7304void ixgbe_free_rx_resources(struct ixgbe_ring *rx_ring)
 7305{
 7306	ixgbe_clean_rx_ring(rx_ring);
 7307
 7308	rx_ring->xdp_prog = NULL;
 7309	xdp_rxq_info_unreg(&rx_ring->xdp_rxq);
 7310	vfree(rx_ring->rx_buffer_info);
 7311	rx_ring->rx_buffer_info = NULL;
 7312
 7313	/* if not set, then don't free */
 7314	if (!rx_ring->desc)
 7315		return;
 7316
 7317	dma_free_coherent(rx_ring->dev, rx_ring->size,
 7318			  rx_ring->desc, rx_ring->dma);
 7319
 7320	rx_ring->desc = NULL;
 7321}
 7322
 7323/**
 7324 * ixgbe_free_all_rx_resources - Free Rx Resources for All Queues
 7325 * @adapter: board private structure
 7326 *
 7327 * Free all receive software resources
 7328 **/
 7329static void ixgbe_free_all_rx_resources(struct ixgbe_adapter *adapter)
 7330{
 7331	int i;
 7332
 7333#ifdef IXGBE_FCOE
 7334	ixgbe_free_fcoe_ddp_resources(adapter);
 7335
 7336#endif
 7337	for (i = 0; i < adapter->num_rx_queues; i++)
 7338		if (adapter->rx_ring[i]->desc)
 7339			ixgbe_free_rx_resources(adapter->rx_ring[i]);
 7340}
 7341
 7342/**
 7343 * ixgbe_max_xdp_frame_size - returns the maximum allowed frame size for XDP
 7344 * @adapter: device handle, pointer to adapter
 7345 */
 7346static int ixgbe_max_xdp_frame_size(struct ixgbe_adapter *adapter)
 7347{
 7348	if (PAGE_SIZE >= 8192 || adapter->flags2 & IXGBE_FLAG2_RX_LEGACY)
 7349		return IXGBE_RXBUFFER_2K;
 7350	else
 7351		return IXGBE_RXBUFFER_3K;
 7352}
 7353
 7354/**
 7355 * ixgbe_change_mtu - Change the Maximum Transfer Unit
 7356 * @netdev: network interface device structure
 7357 * @new_mtu: new value for maximum frame size
 7358 *
 7359 * Returns 0 on success, negative on failure
 7360 **/
 7361static int ixgbe_change_mtu(struct net_device *netdev, int new_mtu)
 7362{
 7363	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 7364
 7365	if (ixgbe_enabled_xdp_adapter(adapter)) {
 7366		int new_frame_size = new_mtu + IXGBE_PKT_HDR_PAD;
 7367
 7368		if (new_frame_size > ixgbe_max_xdp_frame_size(adapter)) {
 7369			e_warn(probe, "Requested MTU size is not supported with XDP\n");
 7370			return -EINVAL;
 7371		}
 7372	}
 7373
 7374	/*
 7375	 * For 82599EB we cannot allow legacy VFs to enable their receive
 7376	 * paths when MTU greater than 1500 is configured.  So display a
 7377	 * warning that legacy VFs will be disabled.
 7378	 */
 7379	if ((adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) &&
 7380	    (adapter->hw.mac.type == ixgbe_mac_82599EB) &&
 7381	    (new_mtu > ETH_DATA_LEN))
 7382		e_warn(probe, "Setting MTU > 1500 will disable legacy VFs\n");
 7383
 7384	netdev_dbg(netdev, "changing MTU from %d to %d\n",
 7385		   netdev->mtu, new_mtu);
 7386
 7387	/* must set new MTU before calling down or up */
 7388	WRITE_ONCE(netdev->mtu, new_mtu);
 7389
 7390	if (netif_running(netdev))
 7391		ixgbe_reinit_locked(adapter);
 7392
 7393	return 0;
 7394}
 7395
 7396/**
 7397 * ixgbe_open - Called when a network interface is made active
 7398 * @netdev: network interface device structure
 7399 *
 7400 * Returns 0 on success, negative value on failure
 7401 *
 7402 * The open entry point is called when a network interface is made
 7403 * active by the system (IFF_UP).  At this point all resources needed
 7404 * for transmit and receive operations are allocated, the interrupt
 7405 * handler is registered with the OS, the watchdog timer is started,
 7406 * and the stack is notified that the interface is ready.
 7407 **/
 7408int ixgbe_open(struct net_device *netdev)
 7409{
 7410	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 7411	struct ixgbe_hw *hw = &adapter->hw;
 7412	int err, queues;
 7413
 7414	/* disallow open during test */
 7415	if (test_bit(__IXGBE_TESTING, &adapter->state))
 7416		return -EBUSY;
 7417
 7418	netif_carrier_off(netdev);
 7419
 7420	/* allocate transmit descriptors */
 7421	err = ixgbe_setup_all_tx_resources(adapter);
 7422	if (err)
 7423		goto err_setup_tx;
 7424
 7425	/* allocate receive descriptors */
 7426	err = ixgbe_setup_all_rx_resources(adapter);
 7427	if (err)
 7428		goto err_setup_rx;
 7429
 7430	ixgbe_configure(adapter);
 7431
 7432	err = ixgbe_request_irq(adapter);
 7433	if (err)
 7434		goto err_req_irq;
 7435
 7436	/* Notify the stack of the actual queue counts. */
 7437	queues = adapter->num_tx_queues;
 7438	err = netif_set_real_num_tx_queues(netdev, queues);
 7439	if (err)
 7440		goto err_set_queues;
 7441
 7442	queues = adapter->num_rx_queues;
 7443	err = netif_set_real_num_rx_queues(netdev, queues);
 7444	if (err)
 7445		goto err_set_queues;
 7446
 7447	ixgbe_ptp_init(adapter);
 7448
 7449	ixgbe_up_complete(adapter);
 7450
 7451	udp_tunnel_nic_reset_ntf(netdev);
 7452	if (adapter->hw.mac.type == ixgbe_mac_e610) {
 7453		int err = ixgbe_update_link_info(&adapter->hw);
 7454
 7455		if (err)
 7456			e_dev_err("Failed to update link info, err %d.\n", err);
 7457
 7458		ixgbe_check_link_cfg_err(adapter,
 7459					 adapter->hw.link.link_info.link_cfg_err);
 7460
 7461		err = ixgbe_non_sfp_link_config(&adapter->hw);
 7462		if (err)
 7463			e_dev_err("Link setup failed, err %d.\n", err);
 7464	}
 7465
 7466	return 0;
 7467
 7468err_set_queues:
 7469	ixgbe_free_irq(adapter);
 7470err_req_irq:
 7471	ixgbe_free_all_rx_resources(adapter);
 7472	if (hw->phy.ops.set_phy_power && !adapter->wol)
 7473		hw->phy.ops.set_phy_power(&adapter->hw, false);
 7474err_setup_rx:
 7475	ixgbe_free_all_tx_resources(adapter);
 7476err_setup_tx:
 7477	ixgbe_reset(adapter);
 7478
 7479	return err;
 7480}
 7481
 7482static void ixgbe_close_suspend(struct ixgbe_adapter *adapter)
 7483{
 7484	ixgbe_ptp_suspend(adapter);
 7485
 7486	if (adapter->hw.phy.ops.enter_lplu) {
 7487		adapter->hw.phy.reset_disable = true;
 7488		ixgbe_down(adapter);
 7489		adapter->hw.phy.ops.enter_lplu(&adapter->hw);
 7490		adapter->hw.phy.reset_disable = false;
 7491	} else {
 7492		ixgbe_down(adapter);
 7493	}
 7494
 7495	ixgbe_free_irq(adapter);
 7496
 7497	ixgbe_free_all_tx_resources(adapter);
 7498	ixgbe_free_all_rx_resources(adapter);
 7499}
 7500
 7501/**
 7502 * ixgbe_close - Disables a network interface
 7503 * @netdev: network interface device structure
 7504 *
 7505 * Returns 0, this is not allowed to fail
 7506 *
 7507 * The close entry point is called when an interface is de-activated
 7508 * by the OS.  The hardware is still under the drivers control, but
 7509 * needs to be disabled.  A global MAC reset is issued to stop the
 7510 * hardware, and all transmit and receive resources are freed.
 7511 **/
 7512int ixgbe_close(struct net_device *netdev)
 7513{
 7514	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 7515
 7516	ixgbe_ptp_stop(adapter);
 7517
 7518	if (netif_device_present(netdev))
 7519		ixgbe_close_suspend(adapter);
 7520
 7521	ixgbe_fdir_filter_exit(adapter);
 7522
 7523	ixgbe_release_hw_control(adapter);
 7524
 7525	return 0;
 7526}
 7527
 7528static int ixgbe_resume(struct device *dev_d)
 7529{
 7530	struct pci_dev *pdev = to_pci_dev(dev_d);
 7531	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
 7532	struct net_device *netdev = adapter->netdev;
 7533	u32 err;
 7534
 7535	adapter->hw.hw_addr = adapter->io_addr;
 7536
 7537	err = pci_enable_device_mem(pdev);
 7538	if (err) {
 7539		e_dev_err("Cannot enable PCI device from suspend\n");
 7540		return err;
 7541	}
 7542	smp_mb__before_atomic();
 7543	clear_bit(__IXGBE_DISABLED, &adapter->state);
 7544	pci_set_master(pdev);
 7545
 7546	device_wakeup_disable(dev_d);
 7547
 7548	ixgbe_reset(adapter);
 7549
 7550	IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
 7551
 7552	rtnl_lock();
 7553	err = ixgbe_init_interrupt_scheme(adapter);
 7554	if (!err && netif_running(netdev))
 7555		err = ixgbe_open(netdev);
 7556
 7557
 7558	if (!err)
 7559		netif_device_attach(netdev);
 7560	rtnl_unlock();
 7561
 7562	return err;
 7563}
 7564
 7565static int __ixgbe_shutdown(struct pci_dev *pdev, bool *enable_wake)
 7566{
 7567	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
 7568	struct net_device *netdev = adapter->netdev;
 7569	struct ixgbe_hw *hw = &adapter->hw;
 7570	u32 ctrl;
 7571	u32 wufc = adapter->wol;
 7572
 7573	rtnl_lock();
 7574	netif_device_detach(netdev);
 7575
 7576	if (netif_running(netdev))
 7577		ixgbe_close_suspend(adapter);
 7578
 7579	ixgbe_clear_interrupt_scheme(adapter);
 7580	rtnl_unlock();
 7581
 7582	if (hw->mac.ops.stop_link_on_d3)
 7583		hw->mac.ops.stop_link_on_d3(hw);
 7584
 7585	if (wufc) {
 7586		u32 fctrl;
 7587
 7588		ixgbe_set_rx_mode(netdev);
 7589
 7590		/* enable the optics for 82599 SFP+ fiber as we can WoL */
 7591		if (hw->mac.ops.enable_tx_laser)
 7592			hw->mac.ops.enable_tx_laser(hw);
 7593
 7594		/* enable the reception of multicast packets */
 7595		fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
 7596		fctrl |= IXGBE_FCTRL_MPE;
 7597		IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
 7598
 7599		ctrl = IXGBE_READ_REG(hw, IXGBE_CTRL);
 7600		ctrl |= IXGBE_CTRL_GIO_DIS;
 7601		IXGBE_WRITE_REG(hw, IXGBE_CTRL, ctrl);
 7602
 7603		IXGBE_WRITE_REG(hw, IXGBE_WUFC, wufc);
 7604	} else {
 7605		IXGBE_WRITE_REG(hw, IXGBE_WUC, 0);
 7606		IXGBE_WRITE_REG(hw, IXGBE_WUFC, 0);
 7607	}
 7608
 7609	switch (hw->mac.type) {
 7610	case ixgbe_mac_82598EB:
 7611		pci_wake_from_d3(pdev, false);
 7612		break;
 7613	case ixgbe_mac_82599EB:
 7614	case ixgbe_mac_X540:
 7615	case ixgbe_mac_X550:
 7616	case ixgbe_mac_X550EM_x:
 7617	case ixgbe_mac_x550em_a:
 7618	case ixgbe_mac_e610:
 7619		pci_wake_from_d3(pdev, !!wufc);
 7620		break;
 7621	default:
 7622		break;
 7623	}
 7624
 7625	*enable_wake = !!wufc;
 7626	if (hw->phy.ops.set_phy_power && !*enable_wake)
 7627		hw->phy.ops.set_phy_power(hw, false);
 7628
 7629	ixgbe_release_hw_control(adapter);
 7630
 7631	if (!test_and_set_bit(__IXGBE_DISABLED, &adapter->state))
 7632		pci_disable_device(pdev);
 7633
 7634	return 0;
 7635}
 7636
 7637static int ixgbe_suspend(struct device *dev_d)
 7638{
 7639	struct pci_dev *pdev = to_pci_dev(dev_d);
 7640	int retval;
 7641	bool wake;
 7642
 7643	retval = __ixgbe_shutdown(pdev, &wake);
 7644
 7645	device_set_wakeup_enable(dev_d, wake);
 7646
 7647	return retval;
 7648}
 7649
 7650static void ixgbe_shutdown(struct pci_dev *pdev)
 7651{
 7652	bool wake;
 7653
 7654	__ixgbe_shutdown(pdev, &wake);
 7655
 7656	if (system_state == SYSTEM_POWER_OFF) {
 7657		pci_wake_from_d3(pdev, wake);
 7658		pci_set_power_state(pdev, PCI_D3hot);
 7659	}
 7660}
 7661
 7662/**
 7663 * ixgbe_update_stats - Update the board statistics counters.
 7664 * @adapter: board private structure
 7665 **/
 7666void ixgbe_update_stats(struct ixgbe_adapter *adapter)
 7667{
 7668	struct net_device *netdev = adapter->netdev;
 7669	struct ixgbe_hw *hw = &adapter->hw;
 7670	struct ixgbe_hw_stats *hwstats = &adapter->stats;
 7671	u64 total_mpc = 0;
 7672	u32 i, missed_rx = 0, mpc, bprc, lxon, lxoff, xon_off_tot;
 7673	u64 non_eop_descs = 0, restart_queue = 0, tx_busy = 0;
 7674	u64 alloc_rx_page_failed = 0, alloc_rx_buff_failed = 0;
 7675	u64 alloc_rx_page = 0;
 7676	u64 bytes = 0, packets = 0, hw_csum_rx_error = 0;
 7677
 7678	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
 7679	    test_bit(__IXGBE_RESETTING, &adapter->state))
 7680		return;
 7681
 7682	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED) {
 7683		u64 rsc_count = 0;
 7684		u64 rsc_flush = 0;
 7685		for (i = 0; i < adapter->num_rx_queues; i++) {
 7686			rsc_count += adapter->rx_ring[i]->rx_stats.rsc_count;
 7687			rsc_flush += adapter->rx_ring[i]->rx_stats.rsc_flush;
 7688		}
 7689		adapter->rsc_total_count = rsc_count;
 7690		adapter->rsc_total_flush = rsc_flush;
 7691	}
 7692
 7693	for (i = 0; i < adapter->num_rx_queues; i++) {
 7694		struct ixgbe_ring *rx_ring = READ_ONCE(adapter->rx_ring[i]);
 7695
 7696		if (!rx_ring)
 7697			continue;
 7698		non_eop_descs += rx_ring->rx_stats.non_eop_descs;
 7699		alloc_rx_page += rx_ring->rx_stats.alloc_rx_page;
 7700		alloc_rx_page_failed += rx_ring->rx_stats.alloc_rx_page_failed;
 7701		alloc_rx_buff_failed += rx_ring->rx_stats.alloc_rx_buff_failed;
 7702		hw_csum_rx_error += rx_ring->rx_stats.csum_err;
 7703		bytes += rx_ring->stats.bytes;
 7704		packets += rx_ring->stats.packets;
 7705	}
 7706	adapter->non_eop_descs = non_eop_descs;
 7707	adapter->alloc_rx_page = alloc_rx_page;
 7708	adapter->alloc_rx_page_failed = alloc_rx_page_failed;
 7709	adapter->alloc_rx_buff_failed = alloc_rx_buff_failed;
 7710	adapter->hw_csum_rx_error = hw_csum_rx_error;
 7711	netdev->stats.rx_bytes = bytes;
 7712	netdev->stats.rx_packets = packets;
 7713
 7714	bytes = 0;
 7715	packets = 0;
 7716	/* gather some stats to the adapter struct that are per queue */
 7717	for (i = 0; i < adapter->num_tx_queues; i++) {
 7718		struct ixgbe_ring *tx_ring = READ_ONCE(adapter->tx_ring[i]);
 7719
 7720		if (!tx_ring)
 7721			continue;
 7722		restart_queue += tx_ring->tx_stats.restart_queue;
 7723		tx_busy += tx_ring->tx_stats.tx_busy;
 7724		bytes += tx_ring->stats.bytes;
 7725		packets += tx_ring->stats.packets;
 7726	}
 7727	for (i = 0; i < adapter->num_xdp_queues; i++) {
 7728		struct ixgbe_ring *xdp_ring = READ_ONCE(adapter->xdp_ring[i]);
 7729
 7730		if (!xdp_ring)
 7731			continue;
 7732		restart_queue += xdp_ring->tx_stats.restart_queue;
 7733		tx_busy += xdp_ring->tx_stats.tx_busy;
 7734		bytes += xdp_ring->stats.bytes;
 7735		packets += xdp_ring->stats.packets;
 7736	}
 7737	adapter->restart_queue = restart_queue;
 7738	adapter->tx_busy = tx_busy;
 7739	netdev->stats.tx_bytes = bytes;
 7740	netdev->stats.tx_packets = packets;
 7741
 7742	hwstats->crcerrs += IXGBE_READ_REG(hw, IXGBE_CRCERRS);
 7743
 7744	/* 8 register reads */
 7745	for (i = 0; i < 8; i++) {
 7746		/* for packet buffers not used, the register should read 0 */
 7747		mpc = IXGBE_READ_REG(hw, IXGBE_MPC(i));
 7748		missed_rx += mpc;
 7749		hwstats->mpc[i] += mpc;
 7750		total_mpc += hwstats->mpc[i];
 7751		hwstats->pxontxc[i] += IXGBE_READ_REG(hw, IXGBE_PXONTXC(i));
 7752		hwstats->pxofftxc[i] += IXGBE_READ_REG(hw, IXGBE_PXOFFTXC(i));
 7753		switch (hw->mac.type) {
 7754		case ixgbe_mac_82598EB:
 7755			hwstats->rnbc[i] += IXGBE_READ_REG(hw, IXGBE_RNBC(i));
 7756			hwstats->qbtc[i] += IXGBE_READ_REG(hw, IXGBE_QBTC(i));
 7757			hwstats->qbrc[i] += IXGBE_READ_REG(hw, IXGBE_QBRC(i));
 7758			hwstats->pxonrxc[i] +=
 7759				IXGBE_READ_REG(hw, IXGBE_PXONRXC(i));
 7760			break;
 7761		case ixgbe_mac_82599EB:
 7762		case ixgbe_mac_X540:
 7763		case ixgbe_mac_X550:
 7764		case ixgbe_mac_X550EM_x:
 7765		case ixgbe_mac_x550em_a:
 7766		case ixgbe_mac_e610:
 7767			hwstats->pxonrxc[i] +=
 7768				IXGBE_READ_REG(hw, IXGBE_PXONRXCNT(i));
 7769			break;
 7770		default:
 7771			break;
 7772		}
 7773	}
 7774
 7775	/*16 register reads */
 7776	for (i = 0; i < 16; i++) {
 7777		hwstats->qptc[i] += IXGBE_READ_REG(hw, IXGBE_QPTC(i));
 7778		hwstats->qprc[i] += IXGBE_READ_REG(hw, IXGBE_QPRC(i));
 7779		if (hw->mac.type == ixgbe_mac_82599EB ||
 7780		    hw->mac.type == ixgbe_mac_X540 ||
 7781		    hw->mac.type == ixgbe_mac_X550 ||
 7782		    hw->mac.type == ixgbe_mac_X550EM_x ||
 7783		    hw->mac.type == ixgbe_mac_x550em_a ||
 7784		    hw->mac.type == ixgbe_mac_e610) {
 7785			hwstats->qbtc[i] += IXGBE_READ_REG(hw, IXGBE_QBTC_L(i));
 7786			IXGBE_READ_REG(hw, IXGBE_QBTC_H(i)); /* to clear */
 7787			hwstats->qbrc[i] += IXGBE_READ_REG(hw, IXGBE_QBRC_L(i));
 7788			IXGBE_READ_REG(hw, IXGBE_QBRC_H(i)); /* to clear */
 7789		}
 7790	}
 7791
 7792	hwstats->gprc += IXGBE_READ_REG(hw, IXGBE_GPRC);
 7793	/* work around hardware counting issue */
 7794	hwstats->gprc -= missed_rx;
 7795
 7796	ixgbe_update_xoff_received(adapter);
 7797
 7798	/* 82598 hardware only has a 32 bit counter in the high register */
 7799	switch (hw->mac.type) {
 7800	case ixgbe_mac_82598EB:
 7801		hwstats->lxonrxc += IXGBE_READ_REG(hw, IXGBE_LXONRXC);
 7802		hwstats->gorc += IXGBE_READ_REG(hw, IXGBE_GORCH);
 7803		hwstats->gotc += IXGBE_READ_REG(hw, IXGBE_GOTCH);
 7804		hwstats->tor += IXGBE_READ_REG(hw, IXGBE_TORH);
 7805		break;
 7806	case ixgbe_mac_X540:
 7807	case ixgbe_mac_X550:
 7808	case ixgbe_mac_X550EM_x:
 7809	case ixgbe_mac_x550em_a:
 7810	case ixgbe_mac_e610:
 7811		/* OS2BMC stats are X540 and later */
 7812		hwstats->o2bgptc += IXGBE_READ_REG(hw, IXGBE_O2BGPTC);
 7813		hwstats->o2bspc += IXGBE_READ_REG(hw, IXGBE_O2BSPC);
 7814		hwstats->b2ospc += IXGBE_READ_REG(hw, IXGBE_B2OSPC);
 7815		hwstats->b2ogprc += IXGBE_READ_REG(hw, IXGBE_B2OGPRC);
 7816		fallthrough;
 7817	case ixgbe_mac_82599EB:
 7818		for (i = 0; i < 16; i++)
 7819			adapter->hw_rx_no_dma_resources +=
 7820					     IXGBE_READ_REG(hw, IXGBE_QPRDC(i));
 7821		hwstats->gorc += IXGBE_READ_REG(hw, IXGBE_GORCL);
 7822		IXGBE_READ_REG(hw, IXGBE_GORCH); /* to clear */
 7823		hwstats->gotc += IXGBE_READ_REG(hw, IXGBE_GOTCL);
 7824		IXGBE_READ_REG(hw, IXGBE_GOTCH); /* to clear */
 7825		hwstats->tor += IXGBE_READ_REG(hw, IXGBE_TORL);
 7826		IXGBE_READ_REG(hw, IXGBE_TORH); /* to clear */
 7827		hwstats->lxonrxc += IXGBE_READ_REG(hw, IXGBE_LXONRXCNT);
 7828		hwstats->fdirmatch += IXGBE_READ_REG(hw, IXGBE_FDIRMATCH);
 7829		hwstats->fdirmiss += IXGBE_READ_REG(hw, IXGBE_FDIRMISS);
 7830#ifdef IXGBE_FCOE
 7831		hwstats->fccrc += IXGBE_READ_REG(hw, IXGBE_FCCRC);
 7832		hwstats->fcoerpdc += IXGBE_READ_REG(hw, IXGBE_FCOERPDC);
 7833		hwstats->fcoeprc += IXGBE_READ_REG(hw, IXGBE_FCOEPRC);
 7834		hwstats->fcoeptc += IXGBE_READ_REG(hw, IXGBE_FCOEPTC);
 7835		hwstats->fcoedwrc += IXGBE_READ_REG(hw, IXGBE_FCOEDWRC);
 7836		hwstats->fcoedwtc += IXGBE_READ_REG(hw, IXGBE_FCOEDWTC);
 7837		/* Add up per cpu counters for total ddp aloc fail */
 7838		if (adapter->fcoe.ddp_pool) {
 7839			struct ixgbe_fcoe *fcoe = &adapter->fcoe;
 7840			struct ixgbe_fcoe_ddp_pool *ddp_pool;
 7841			unsigned int cpu;
 7842			u64 noddp = 0, noddp_ext_buff = 0;
 7843			for_each_possible_cpu(cpu) {
 7844				ddp_pool = per_cpu_ptr(fcoe->ddp_pool, cpu);
 7845				noddp += ddp_pool->noddp;
 7846				noddp_ext_buff += ddp_pool->noddp_ext_buff;
 7847			}
 7848			hwstats->fcoe_noddp = noddp;
 7849			hwstats->fcoe_noddp_ext_buff = noddp_ext_buff;
 7850		}
 7851#endif /* IXGBE_FCOE */
 7852		break;
 7853	default:
 7854		break;
 7855	}
 7856	bprc = IXGBE_READ_REG(hw, IXGBE_BPRC);
 7857	hwstats->bprc += bprc;
 7858	hwstats->mprc += IXGBE_READ_REG(hw, IXGBE_MPRC);
 7859	if (hw->mac.type == ixgbe_mac_82598EB)
 7860		hwstats->mprc -= bprc;
 7861	hwstats->roc += IXGBE_READ_REG(hw, IXGBE_ROC);
 7862	hwstats->prc64 += IXGBE_READ_REG(hw, IXGBE_PRC64);
 7863	hwstats->prc127 += IXGBE_READ_REG(hw, IXGBE_PRC127);
 7864	hwstats->prc255 += IXGBE_READ_REG(hw, IXGBE_PRC255);
 7865	hwstats->prc511 += IXGBE_READ_REG(hw, IXGBE_PRC511);
 7866	hwstats->prc1023 += IXGBE_READ_REG(hw, IXGBE_PRC1023);
 7867	hwstats->prc1522 += IXGBE_READ_REG(hw, IXGBE_PRC1522);
 7868	hwstats->rlec += IXGBE_READ_REG(hw, IXGBE_RLEC);
 7869	lxon = IXGBE_READ_REG(hw, IXGBE_LXONTXC);
 7870	hwstats->lxontxc += lxon;
 7871	lxoff = IXGBE_READ_REG(hw, IXGBE_LXOFFTXC);
 7872	hwstats->lxofftxc += lxoff;
 7873	hwstats->gptc += IXGBE_READ_REG(hw, IXGBE_GPTC);
 7874	hwstats->mptc += IXGBE_READ_REG(hw, IXGBE_MPTC);
 7875	/*
 7876	 * 82598 errata - tx of flow control packets is included in tx counters
 7877	 */
 7878	xon_off_tot = lxon + lxoff;
 7879	hwstats->gptc -= xon_off_tot;
 7880	hwstats->mptc -= xon_off_tot;
 7881	hwstats->gotc -= (xon_off_tot * (ETH_ZLEN + ETH_FCS_LEN));
 7882	hwstats->ruc += IXGBE_READ_REG(hw, IXGBE_RUC);
 7883	hwstats->rfc += IXGBE_READ_REG(hw, IXGBE_RFC);
 7884	hwstats->rjc += IXGBE_READ_REG(hw, IXGBE_RJC);
 7885	hwstats->tpr += IXGBE_READ_REG(hw, IXGBE_TPR);
 7886	hwstats->ptc64 += IXGBE_READ_REG(hw, IXGBE_PTC64);
 7887	hwstats->ptc64 -= xon_off_tot;
 7888	hwstats->ptc127 += IXGBE_READ_REG(hw, IXGBE_PTC127);
 7889	hwstats->ptc255 += IXGBE_READ_REG(hw, IXGBE_PTC255);
 7890	hwstats->ptc511 += IXGBE_READ_REG(hw, IXGBE_PTC511);
 7891	hwstats->ptc1023 += IXGBE_READ_REG(hw, IXGBE_PTC1023);
 7892	hwstats->ptc1522 += IXGBE_READ_REG(hw, IXGBE_PTC1522);
 7893	hwstats->bptc += IXGBE_READ_REG(hw, IXGBE_BPTC);
 7894
 7895	/* Fill out the OS statistics structure */
 7896	netdev->stats.multicast = hwstats->mprc;
 7897
 7898	/* Rx Errors */
 7899	netdev->stats.rx_errors = hwstats->crcerrs + hwstats->rlec;
 7900	netdev->stats.rx_dropped = 0;
 7901	netdev->stats.rx_length_errors = hwstats->rlec;
 7902	netdev->stats.rx_crc_errors = hwstats->crcerrs;
 7903	netdev->stats.rx_missed_errors = total_mpc;
 7904
 7905	/* VF Stats Collection - skip while resetting because these
 7906	 * are not clear on read and otherwise you'll sometimes get
 7907	 * crazy values.
 7908	 */
 7909	if (!test_bit(__IXGBE_RESETTING, &adapter->state)) {
 7910		for (i = 0; i < adapter->num_vfs; i++) {
 7911			UPDATE_VF_COUNTER_32bit(IXGBE_PVFGPRC(i),
 7912						adapter->vfinfo[i].last_vfstats.gprc,
 7913						adapter->vfinfo[i].vfstats.gprc);
 7914			UPDATE_VF_COUNTER_32bit(IXGBE_PVFGPTC(i),
 7915						adapter->vfinfo[i].last_vfstats.gptc,
 7916						adapter->vfinfo[i].vfstats.gptc);
 7917			UPDATE_VF_COUNTER_36bit(IXGBE_PVFGORC_LSB(i),
 7918						IXGBE_PVFGORC_MSB(i),
 7919						adapter->vfinfo[i].last_vfstats.gorc,
 7920						adapter->vfinfo[i].vfstats.gorc);
 7921			UPDATE_VF_COUNTER_36bit(IXGBE_PVFGOTC_LSB(i),
 7922						IXGBE_PVFGOTC_MSB(i),
 7923						adapter->vfinfo[i].last_vfstats.gotc,
 7924						adapter->vfinfo[i].vfstats.gotc);
 7925			UPDATE_VF_COUNTER_32bit(IXGBE_PVFMPRC(i),
 7926						adapter->vfinfo[i].last_vfstats.mprc,
 7927						adapter->vfinfo[i].vfstats.mprc);
 7928		}
 7929	}
 7930}
 7931
 7932/**
 7933 * ixgbe_fdir_reinit_subtask - worker thread to reinit FDIR filter table
 7934 * @adapter: pointer to the device adapter structure
 7935 **/
 7936static void ixgbe_fdir_reinit_subtask(struct ixgbe_adapter *adapter)
 7937{
 7938	struct ixgbe_hw *hw = &adapter->hw;
 7939	int i;
 7940
 7941	if (!(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
 7942		return;
 7943
 7944	adapter->flags2 &= ~IXGBE_FLAG2_FDIR_REQUIRES_REINIT;
 7945
 7946	/* if interface is down do nothing */
 7947	if (test_bit(__IXGBE_DOWN, &adapter->state))
 7948		return;
 7949
 7950	/* do nothing if we are not using signature filters */
 7951	if (!(adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE))
 7952		return;
 7953
 7954	adapter->fdir_overflow++;
 7955
 7956	if (ixgbe_reinit_fdir_tables_82599(hw) == 0) {
 7957		for (i = 0; i < adapter->num_tx_queues; i++)
 7958			set_bit(__IXGBE_TX_FDIR_INIT_DONE,
 7959				&(adapter->tx_ring[i]->state));
 7960		for (i = 0; i < adapter->num_xdp_queues; i++)
 7961			set_bit(__IXGBE_TX_FDIR_INIT_DONE,
 7962				&adapter->xdp_ring[i]->state);
 7963		/* re-enable flow director interrupts */
 7964		IXGBE_WRITE_REG(hw, IXGBE_EIMS, IXGBE_EIMS_FLOW_DIR);
 7965	} else {
 7966		e_err(probe, "failed to finish FDIR re-initialization, "
 7967		      "ignored adding FDIR ATR filters\n");
 7968	}
 7969}
 7970
 7971/**
 7972 * ixgbe_check_hang_subtask - check for hung queues and dropped interrupts
 7973 * @adapter: pointer to the device adapter structure
 7974 *
 7975 * This function serves two purposes.  First it strobes the interrupt lines
 7976 * in order to make certain interrupts are occurring.  Secondly it sets the
 7977 * bits needed to check for TX hangs.  As a result we should immediately
 7978 * determine if a hang has occurred.
 7979 */
 7980static void ixgbe_check_hang_subtask(struct ixgbe_adapter *adapter)
 7981{
 7982	struct ixgbe_hw *hw = &adapter->hw;
 7983	u64 eics = 0;
 7984	int i;
 7985
 7986	/* If we're down, removing or resetting, just bail */
 7987	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
 7988	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
 7989	    test_bit(__IXGBE_RESETTING, &adapter->state))
 7990		return;
 7991
 7992	/* Force detection of hung controller */
 7993	if (netif_carrier_ok(adapter->netdev))
 7994		for (i = 0; i < adapter->num_tx_queues; i++)
 7995			set_check_for_tx_hang(adapter->tx_ring[i]);
 7996
 7997	if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED)) {
 7998		/*
 7999		 * for legacy and MSI interrupts don't set any bits
 8000		 * that are enabled for EIAM, because this operation
 8001		 * would set *both* EIMS and EICS for any bit in EIAM
 8002		 */
 8003		IXGBE_WRITE_REG(hw, IXGBE_EICS,
 8004			(IXGBE_EICS_TCP_TIMER | IXGBE_EICS_OTHER));
 8005	} else {
 8006		/* get one bit for every active tx/rx interrupt vector */
 8007		for (i = 0; i < adapter->num_q_vectors; i++) {
 8008			struct ixgbe_q_vector *qv = adapter->q_vector[i];
 8009			if (qv->rx.ring || qv->tx.ring)
 8010				eics |= BIT_ULL(i);
 8011		}
 8012	}
 8013
 8014	/* Cause software interrupt to ensure rings are cleaned */
 8015	ixgbe_irq_rearm_queues(adapter, eics);
 8016}
 8017
 8018/**
 8019 * ixgbe_watchdog_update_link - update the link status
 8020 * @adapter: pointer to the device adapter structure
 8021 **/
 8022static void ixgbe_watchdog_update_link(struct ixgbe_adapter *adapter)
 8023{
 8024	struct ixgbe_hw *hw = &adapter->hw;
 8025	u32 link_speed = adapter->link_speed;
 8026	bool link_up = adapter->link_up;
 8027	bool pfc_en = adapter->dcb_cfg.pfc_mode_enable;
 8028
 8029	if (!(adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE))
 8030		return;
 8031
 8032	if (hw->mac.ops.check_link) {
 8033		hw->mac.ops.check_link(hw, &link_speed, &link_up, false);
 8034	} else {
 8035		/* always assume link is up, if no check link function */
 8036		link_speed = IXGBE_LINK_SPEED_10GB_FULL;
 8037		link_up = true;
 8038	}
 8039
 8040	if (adapter->ixgbe_ieee_pfc)
 8041		pfc_en |= !!(adapter->ixgbe_ieee_pfc->pfc_en);
 8042
 8043	if (link_up && !((adapter->flags & IXGBE_FLAG_DCB_ENABLED) && pfc_en)) {
 8044		hw->mac.ops.fc_enable(hw);
 8045		ixgbe_set_rx_drop_en(adapter);
 8046	}
 8047
 8048	if (link_up ||
 8049	    time_after(jiffies, (adapter->link_check_timeout +
 8050				 IXGBE_TRY_LINK_TIMEOUT))) {
 8051		adapter->flags &= ~IXGBE_FLAG_NEED_LINK_UPDATE;
 8052		IXGBE_WRITE_REG(hw, IXGBE_EIMS, IXGBE_EIMC_LSC);
 8053		IXGBE_WRITE_FLUSH(hw);
 8054	}
 8055
 8056	adapter->link_up = link_up;
 8057	adapter->link_speed = link_speed;
 8058}
 8059
 8060static void ixgbe_update_default_up(struct ixgbe_adapter *adapter)
 8061{
 8062#ifdef CONFIG_IXGBE_DCB
 8063	struct net_device *netdev = adapter->netdev;
 8064	struct dcb_app app = {
 8065			      .selector = IEEE_8021QAZ_APP_SEL_ETHERTYPE,
 8066			      .protocol = 0,
 8067			     };
 8068	u8 up = 0;
 8069
 8070	if (adapter->dcbx_cap & DCB_CAP_DCBX_VER_IEEE)
 8071		up = dcb_ieee_getapp_mask(netdev, &app);
 8072
 8073	adapter->default_up = (up > 1) ? (ffs(up) - 1) : 0;
 8074#endif
 8075}
 8076
 8077/**
 8078 * ixgbe_watchdog_link_is_up - update netif_carrier status and
 8079 *                             print link up message
 8080 * @adapter: pointer to the device adapter structure
 8081 **/
 8082static void ixgbe_watchdog_link_is_up(struct ixgbe_adapter *adapter)
 8083{
 8084	struct net_device *netdev = adapter->netdev;
 8085	struct ixgbe_hw *hw = &adapter->hw;
 8086	u32 link_speed = adapter->link_speed;
 8087	const char *speed_str;
 8088	bool flow_rx, flow_tx;
 8089
 8090	/* only continue if link was previously down */
 8091	if (netif_carrier_ok(netdev))
 8092		return;
 8093
 8094	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
 8095
 8096	switch (hw->mac.type) {
 8097	case ixgbe_mac_82598EB: {
 8098		u32 frctl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
 8099		u32 rmcs = IXGBE_READ_REG(hw, IXGBE_RMCS);
 8100		flow_rx = !!(frctl & IXGBE_FCTRL_RFCE);
 8101		flow_tx = !!(rmcs & IXGBE_RMCS_TFCE_802_3X);
 8102	}
 8103		break;
 8104	case ixgbe_mac_X540:
 8105	case ixgbe_mac_X550:
 8106	case ixgbe_mac_X550EM_x:
 8107	case ixgbe_mac_x550em_a:
 8108	case ixgbe_mac_e610:
 8109	case ixgbe_mac_82599EB: {
 8110		u32 mflcn = IXGBE_READ_REG(hw, IXGBE_MFLCN);
 8111		u32 fccfg = IXGBE_READ_REG(hw, IXGBE_FCCFG);
 8112		flow_rx = !!(mflcn & IXGBE_MFLCN_RFCE);
 8113		flow_tx = !!(fccfg & IXGBE_FCCFG_TFCE_802_3X);
 8114	}
 8115		break;
 8116	default:
 8117		flow_tx = false;
 8118		flow_rx = false;
 8119		break;
 8120	}
 8121
 8122	adapter->last_rx_ptp_check = jiffies;
 8123
 8124	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
 8125		ixgbe_ptp_start_cyclecounter(adapter);
 8126
 8127	switch (link_speed) {
 8128	case IXGBE_LINK_SPEED_10GB_FULL:
 8129		speed_str = "10 Gbps";
 8130		break;
 8131	case IXGBE_LINK_SPEED_5GB_FULL:
 8132		speed_str = "5 Gbps";
 8133		break;
 8134	case IXGBE_LINK_SPEED_2_5GB_FULL:
 8135		speed_str = "2.5 Gbps";
 8136		break;
 8137	case IXGBE_LINK_SPEED_1GB_FULL:
 8138		speed_str = "1 Gbps";
 8139		break;
 8140	case IXGBE_LINK_SPEED_100_FULL:
 8141		speed_str = "100 Mbps";
 8142		break;
 8143	case IXGBE_LINK_SPEED_10_FULL:
 8144		speed_str = "10 Mbps";
 8145		break;
 8146	default:
 8147		speed_str = "unknown speed";
 8148		break;
 8149	}
 8150	e_info(drv, "NIC Link is Up %s, Flow Control: %s\n", speed_str,
 8151	       ((flow_rx && flow_tx) ? "RX/TX" :
 8152	       (flow_rx ? "RX" :
 8153	       (flow_tx ? "TX" : "None"))));
 8154
 8155	netif_carrier_on(netdev);
 8156	ixgbe_check_vf_rate_limit(adapter);
 8157
 8158	if (adapter->num_vfs && hw->mac.ops.enable_mdd)
 8159		hw->mac.ops.enable_mdd(hw);
 8160
 8161	/* enable transmits */
 8162	netif_tx_wake_all_queues(adapter->netdev);
 8163
 8164	/* update the default user priority for VFs */
 8165	ixgbe_update_default_up(adapter);
 8166
 8167	/* ping all the active vfs to let them know link has changed */
 8168	ixgbe_ping_all_vfs(adapter);
 8169}
 8170
 8171/**
 8172 * ixgbe_watchdog_link_is_down - update netif_carrier status and
 8173 *                               print link down message
 8174 * @adapter: pointer to the adapter structure
 8175 **/
 8176static void ixgbe_watchdog_link_is_down(struct ixgbe_adapter *adapter)
 8177{
 8178	struct net_device *netdev = adapter->netdev;
 8179	struct ixgbe_hw *hw = &adapter->hw;
 8180
 8181	adapter->link_up = false;
 8182	adapter->link_speed = 0;
 8183
 8184	/* only continue if link was up previously */
 8185	if (!netif_carrier_ok(netdev))
 8186		return;
 8187
 8188	adapter->link_down_events++;
 8189
 8190	/* poll for SFP+ cable when link is down */
 8191	if (ixgbe_is_sfp(hw) && hw->mac.type == ixgbe_mac_82598EB)
 8192		adapter->flags2 |= IXGBE_FLAG2_SEARCH_FOR_SFP;
 8193
 8194	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
 8195		ixgbe_ptp_start_cyclecounter(adapter);
 8196
 8197	e_info(drv, "NIC Link is Down\n");
 8198	netif_carrier_off(netdev);
 8199
 8200	/* ping all the active vfs to let them know link has changed */
 8201	ixgbe_ping_all_vfs(adapter);
 8202}
 8203
 8204static bool ixgbe_ring_tx_pending(struct ixgbe_adapter *adapter)
 8205{
 8206	int i;
 8207
 8208	for (i = 0; i < adapter->num_tx_queues; i++) {
 8209		struct ixgbe_ring *tx_ring = adapter->tx_ring[i];
 8210
 8211		if (tx_ring->next_to_use != tx_ring->next_to_clean)
 8212			return true;
 8213	}
 8214
 8215	return false;
 8216}
 8217
 8218static bool ixgbe_vf_tx_pending(struct ixgbe_adapter *adapter)
 8219{
 8220	struct ixgbe_hw *hw = &adapter->hw;
 8221	struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
 8222	u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);
 8223
 8224	int i, j;
 8225
 8226	if (!adapter->num_vfs)
 8227		return false;
 8228
 8229	/* resetting the PF is only needed for MAC before X550 */
 8230	if (hw->mac.type >= ixgbe_mac_X550)
 8231		return false;
 8232
 8233	for (i = 0; i < adapter->num_vfs; i++) {
 8234		for (j = 0; j < q_per_pool; j++) {
 8235			u32 h, t;
 8236
 8237			h = IXGBE_READ_REG(hw, IXGBE_PVFTDHN(q_per_pool, i, j));
 8238			t = IXGBE_READ_REG(hw, IXGBE_PVFTDTN(q_per_pool, i, j));
 8239
 8240			if (h != t)
 8241				return true;
 8242		}
 8243	}
 8244
 8245	return false;
 8246}
 8247
 8248/**
 8249 * ixgbe_watchdog_flush_tx - flush queues on link down
 8250 * @adapter: pointer to the device adapter structure
 8251 **/
 8252static void ixgbe_watchdog_flush_tx(struct ixgbe_adapter *adapter)
 8253{
 8254	if (!netif_carrier_ok(adapter->netdev)) {
 8255		if (ixgbe_ring_tx_pending(adapter) ||
 8256		    ixgbe_vf_tx_pending(adapter)) {
 8257			/* We've lost link, so the controller stops DMA,
 8258			 * but we've got queued Tx work that's never going
 8259			 * to get done, so reset controller to flush Tx.
 8260			 * (Do the reset outside of interrupt context).
 8261			 */
 8262			e_warn(drv, "initiating reset to clear Tx work after link loss\n");
 8263			set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
 8264		}
 8265	}
 8266}
 8267
 8268#ifdef CONFIG_PCI_IOV
 8269static void ixgbe_bad_vf_abort(struct ixgbe_adapter *adapter, u32 vf)
 8270{
 8271	struct ixgbe_hw *hw = &adapter->hw;
 8272
 8273	if (adapter->hw.mac.type == ixgbe_mac_82599EB &&
 8274	    adapter->flags2 & IXGBE_FLAG2_AUTO_DISABLE_VF) {
 8275		adapter->vfinfo[vf].primary_abort_count++;
 8276		if (adapter->vfinfo[vf].primary_abort_count ==
 8277		    IXGBE_PRIMARY_ABORT_LIMIT) {
 8278			ixgbe_set_vf_link_state(adapter, vf,
 8279						IFLA_VF_LINK_STATE_DISABLE);
 8280			adapter->vfinfo[vf].primary_abort_count = 0;
 8281
 8282			e_info(drv,
 8283			       "Malicious Driver Detection event detected on PF %d VF %d MAC: %pM mdd-disable-vf=on",
 8284			       hw->bus.func, vf,
 8285			       adapter->vfinfo[vf].vf_mac_addresses);
 8286		}
 8287	}
 8288}
 8289
 8290static void ixgbe_check_for_bad_vf(struct ixgbe_adapter *adapter)
 8291{
 8292	struct ixgbe_hw *hw = &adapter->hw;
 8293	struct pci_dev *pdev = adapter->pdev;
 8294	unsigned int vf;
 8295	u32 gpc;
 8296
 8297	if (!(netif_carrier_ok(adapter->netdev)))
 8298		return;
 8299
 8300	gpc = IXGBE_READ_REG(hw, IXGBE_TXDGPC);
 8301	if (gpc) /* If incrementing then no need for the check below */
 8302		return;
 8303	/* Check to see if a bad DMA write target from an errant or
 8304	 * malicious VF has caused a PCIe error.  If so then we can
 8305	 * issue a VFLR to the offending VF(s) and then resume without
 8306	 * requesting a full slot reset.
 8307	 */
 8308
 8309	if (!pdev)
 8310		return;
 8311
 8312	/* check status reg for all VFs owned by this PF */
 8313	for (vf = 0; vf < adapter->num_vfs; ++vf) {
 8314		struct pci_dev *vfdev = adapter->vfinfo[vf].vfdev;
 8315		u16 status_reg;
 8316
 8317		if (!vfdev)
 8318			continue;
 8319		pci_read_config_word(vfdev, PCI_STATUS, &status_reg);
 8320		if (status_reg != IXGBE_FAILED_READ_CFG_WORD &&
 8321		    status_reg & PCI_STATUS_REC_MASTER_ABORT) {
 8322			ixgbe_bad_vf_abort(adapter, vf);
 8323			pcie_flr(vfdev);
 8324		}
 8325	}
 8326}
 8327
 8328static void ixgbe_spoof_check(struct ixgbe_adapter *adapter)
 8329{
 8330	u32 ssvpc;
 8331
 8332	/* Do not perform spoof check for 82598 or if not in IOV mode */
 8333	if (adapter->hw.mac.type == ixgbe_mac_82598EB ||
 8334	    adapter->num_vfs == 0)
 8335		return;
 8336
 8337	ssvpc = IXGBE_READ_REG(&adapter->hw, IXGBE_SSVPC);
 8338
 8339	/*
 8340	 * ssvpc register is cleared on read, if zero then no
 8341	 * spoofed packets in the last interval.
 8342	 */
 8343	if (!ssvpc)
 8344		return;
 8345
 8346	e_warn(drv, "%u Spoofed packets detected\n", ssvpc);
 8347}
 8348#else
 8349static void ixgbe_spoof_check(struct ixgbe_adapter __always_unused *adapter)
 8350{
 8351}
 8352
 8353static void
 8354ixgbe_check_for_bad_vf(struct ixgbe_adapter __always_unused *adapter)
 8355{
 8356}
 8357#endif /* CONFIG_PCI_IOV */
 8358
 8359
 8360/**
 8361 * ixgbe_watchdog_subtask - check and bring link up
 8362 * @adapter: pointer to the device adapter structure
 8363 **/
 8364static void ixgbe_watchdog_subtask(struct ixgbe_adapter *adapter)
 8365{
 8366	/* if interface is down, removing or resetting, do nothing */
 8367	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
 8368	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
 8369	    test_bit(__IXGBE_RESETTING, &adapter->state))
 8370		return;
 8371
 8372	ixgbe_watchdog_update_link(adapter);
 8373
 8374	if (adapter->link_up)
 8375		ixgbe_watchdog_link_is_up(adapter);
 8376	else
 8377		ixgbe_watchdog_link_is_down(adapter);
 8378
 8379	ixgbe_check_for_bad_vf(adapter);
 8380	ixgbe_spoof_check(adapter);
 8381	ixgbe_update_stats(adapter);
 8382
 8383	ixgbe_watchdog_flush_tx(adapter);
 8384}
 8385
 8386/**
 8387 * ixgbe_sfp_detection_subtask - poll for SFP+ cable
 8388 * @adapter: the ixgbe adapter structure
 8389 **/
 8390static void ixgbe_sfp_detection_subtask(struct ixgbe_adapter *adapter)
 8391{
 8392	struct ixgbe_hw *hw = &adapter->hw;
 8393	int err;
 8394
 8395	/* not searching for SFP so there is nothing to do here */
 8396	if (!(adapter->flags2 & IXGBE_FLAG2_SEARCH_FOR_SFP) &&
 8397	    !(adapter->flags2 & IXGBE_FLAG2_SFP_NEEDS_RESET))
 8398		return;
 8399
 8400	if (adapter->sfp_poll_time &&
 8401	    time_after(adapter->sfp_poll_time, jiffies))
 8402		return; /* If not yet time to poll for SFP */
 8403
 8404	/* someone else is in init, wait until next service event */
 8405	if (test_and_set_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
 8406		return;
 8407
 8408	adapter->sfp_poll_time = jiffies + IXGBE_SFP_POLL_JIFFIES - 1;
 8409
 8410	err = hw->phy.ops.identify_sfp(hw);
 8411	if (err == -EOPNOTSUPP)
 8412		goto sfp_out;
 8413
 8414	if (err == -ENOENT) {
 8415		/* If no cable is present, then we need to reset
 8416		 * the next time we find a good cable. */
 8417		adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
 8418	}
 8419
 8420	/* exit on error */
 8421	if (err)
 8422		goto sfp_out;
 8423
 8424	/* exit if reset not needed */
 8425	if (!(adapter->flags2 & IXGBE_FLAG2_SFP_NEEDS_RESET))
 8426		goto sfp_out;
 8427
 8428	adapter->flags2 &= ~IXGBE_FLAG2_SFP_NEEDS_RESET;
 8429
 8430	/*
 8431	 * A module may be identified correctly, but the EEPROM may not have
 8432	 * support for that module.  setup_sfp() will fail in that case, so
 8433	 * we should not allow that module to load.
 8434	 */
 8435	if (hw->mac.type == ixgbe_mac_82598EB)
 8436		err = hw->phy.ops.reset(hw);
 8437	else
 8438		err = hw->mac.ops.setup_sfp(hw);
 8439
 8440	if (err == -EOPNOTSUPP)
 8441		goto sfp_out;
 8442
 8443	adapter->flags |= IXGBE_FLAG_NEED_LINK_CONFIG;
 8444	e_info(probe, "detected SFP+: %d\n", hw->phy.sfp_type);
 8445
 8446sfp_out:
 8447	clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);
 8448
 8449	if (err == -EOPNOTSUPP &&
 8450	    adapter->netdev->reg_state == NETREG_REGISTERED) {
 8451		e_dev_err("failed to initialize because an unsupported "
 8452			  "SFP+ module type was detected.\n");
 8453		e_dev_err("Reload the driver after installing a "
 8454			  "supported module.\n");
 8455		unregister_netdev(adapter->netdev);
 8456	}
 8457}
 8458
 8459/**
 8460 * ixgbe_sfp_link_config_subtask - set up link SFP after module install
 8461 * @adapter: the ixgbe adapter structure
 8462 **/
 8463static void ixgbe_sfp_link_config_subtask(struct ixgbe_adapter *adapter)
 8464{
 8465	struct ixgbe_hw *hw = &adapter->hw;
 8466	u32 cap_speed;
 8467	u32 speed;
 8468	bool autoneg = false;
 8469
 8470	if (!(adapter->flags & IXGBE_FLAG_NEED_LINK_CONFIG))
 8471		return;
 8472
 8473	/* someone else is in init, wait until next service event */
 8474	if (test_and_set_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
 8475		return;
 8476
 8477	adapter->flags &= ~IXGBE_FLAG_NEED_LINK_CONFIG;
 8478
 8479	hw->mac.ops.get_link_capabilities(hw, &cap_speed, &autoneg);
 8480
 8481	/* advertise highest capable link speed */
 8482	if (!autoneg && (cap_speed & IXGBE_LINK_SPEED_10GB_FULL))
 8483		speed = IXGBE_LINK_SPEED_10GB_FULL;
 8484	else
 8485		speed = cap_speed & (IXGBE_LINK_SPEED_10GB_FULL |
 8486				     IXGBE_LINK_SPEED_1GB_FULL);
 8487
 8488	if (hw->mac.ops.setup_link)
 8489		hw->mac.ops.setup_link(hw, speed, true);
 8490
 8491	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
 8492	adapter->link_check_timeout = jiffies;
 8493	clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);
 8494}
 8495
 8496/**
 8497 * ixgbe_service_timer - Timer Call-back
 8498 * @t: pointer to timer_list structure
 8499 **/
 8500static void ixgbe_service_timer(struct timer_list *t)
 8501{
 8502	struct ixgbe_adapter *adapter = timer_container_of(adapter, t,
 8503							   service_timer);
 8504	unsigned long next_event_offset;
 8505
 8506	/* poll faster when waiting for link */
 8507	if (adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE)
 8508		next_event_offset = HZ / 10;
 8509	else
 8510		next_event_offset = HZ * 2;
 8511
 8512	/* Reset the timer */
 8513	mod_timer(&adapter->service_timer, next_event_offset + jiffies);
 8514
 8515	ixgbe_service_event_schedule(adapter);
 8516}
 8517
 8518static void ixgbe_phy_interrupt_subtask(struct ixgbe_adapter *adapter)
 8519{
 8520	struct ixgbe_hw *hw = &adapter->hw;
 8521	bool overtemp;
 8522
 8523	if (!(adapter->flags2 & IXGBE_FLAG2_PHY_INTERRUPT))
 8524		return;
 8525
 8526	adapter->flags2 &= ~IXGBE_FLAG2_PHY_INTERRUPT;
 8527
 8528	if (!hw->phy.ops.handle_lasi)
 8529		return;
 8530
 8531	hw->phy.ops.handle_lasi(&adapter->hw, &overtemp);
 8532	if (overtemp)
 8533		e_crit(drv, "%s\n", ixgbe_overheat_msg);
 8534}
 8535
 8536static void ixgbe_reset_subtask(struct ixgbe_adapter *adapter)
 8537{
 8538	if (!test_and_clear_bit(__IXGBE_RESET_REQUESTED, &adapter->state))
 8539		return;
 8540
 8541	rtnl_lock();
 8542	/* If we're already down, removing or resetting, just bail */
 8543	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
 8544	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
 8545	    test_bit(__IXGBE_RESETTING, &adapter->state)) {
 8546		rtnl_unlock();
 8547		return;
 8548	}
 8549
 8550	ixgbe_dump(adapter);
 8551	netdev_err(adapter->netdev, "Reset adapter\n");
 8552	adapter->tx_timeout_count++;
 8553
 8554	ixgbe_reinit_locked(adapter);
 8555	rtnl_unlock();
 8556}
 8557
 8558static int ixgbe_check_fw_api_mismatch(struct ixgbe_adapter *adapter)
 8559{
 8560	struct ixgbe_hw *hw = &adapter->hw;
 8561
 8562	if (hw->mac.type != ixgbe_mac_e610)
 8563		return 0;
 8564
 8565	if (hw->mac.ops.get_fw_ver && hw->mac.ops.get_fw_ver(hw))
 8566		return 0;
 8567
 8568	if (hw->api_maj_ver > IXGBE_FW_API_VER_MAJOR) {
 8569		e_dev_err("The driver for the device stopped because the NVM image is newer than expected. You must install the most recent version of the network driver.\n");
 8570
 8571		adapter->flags2 |= IXGBE_FLAG2_API_MISMATCH;
 8572		return -EOPNOTSUPP;
 8573	} else if (hw->api_maj_ver == IXGBE_FW_API_VER_MAJOR &&
 8574		   hw->api_min_ver > IXGBE_FW_API_VER_MINOR + IXGBE_FW_API_VER_DIFF_ALLOWED) {
 8575		e_dev_info("The driver for the device detected a newer version of the NVM image than expected. Please install the most recent version of the network driver.\n");
 8576		adapter->flags2 |= IXGBE_FLAG2_API_MISMATCH;
 8577	} else if (hw->api_maj_ver < IXGBE_FW_API_VER_MAJOR ||
 8578		   hw->api_min_ver < IXGBE_FW_API_VER_MINOR - IXGBE_FW_API_VER_DIFF_ALLOWED) {
 8579		e_dev_info("The driver for the device detected an older version of the NVM image than expected. Please update the NVM image.\n");
 8580		adapter->flags2 |= IXGBE_FLAG2_API_MISMATCH;
 8581	}
 8582
 8583	return 0;
 8584}
 8585
 8586/**
 8587 * ixgbe_check_fw_error - Check firmware for errors
 8588 * @adapter: the adapter private structure
 8589 *
 8590 * Check firmware errors in register FWSM
 8591 */
 8592static bool ixgbe_check_fw_error(struct ixgbe_adapter *adapter)
 8593{
 8594	struct ixgbe_hw *hw = &adapter->hw;
 8595	u32 fwsm;
 8596	int err;
 8597
 8598	/* read fwsm.ext_err_ind register and log errors */
 8599	fwsm = IXGBE_READ_REG(hw, IXGBE_FWSM(hw));
 8600
 8601	/* skip if E610's FW is reloading, warning in that case may be misleading */
 8602	if (fwsm & IXGBE_FWSM_EXT_ERR_IND_MASK ||
 8603	    (!(fwsm & IXGBE_FWSM_FW_VAL_BIT) && !(hw->mac.type == ixgbe_mac_e610)))
 8604		e_dev_warn("Warning firmware error detected FWSM: 0x%08X\n",
 8605			   fwsm);
 8606
 8607	if (hw->mac.ops.fw_recovery_mode && hw->mac.ops.fw_recovery_mode(hw)) {
 8608		e_dev_err("Firmware recovery mode detected. Limiting functionality. Refer to the Intel(R) Ethernet Adapters and Devices User Guide for details on firmware recovery mode.\n");
 8609		return true;
 8610	}
 8611	if (!(adapter->flags2 & IXGBE_FLAG2_API_MISMATCH)) {
 8612		err = ixgbe_check_fw_api_mismatch(adapter);
 8613		if (err)
 8614			return true;
 8615	}
 8616
 8617	/* return here if FW rollback mode has been already detected */
 8618	if (adapter->flags2 & IXGBE_FLAG2_FW_ROLLBACK)
 8619		return false;
 8620
 8621	if (hw->mac.ops.fw_rollback_mode && hw->mac.ops.fw_rollback_mode(hw)) {
 8622		struct ixgbe_nvm_info *nvm_info = &adapter->hw.flash.nvm;
 8623		char ver_buff[64] = "";
 8624
 8625		if (hw->mac.ops.get_fw_ver && hw->mac.ops.get_fw_ver(hw))
 8626			goto no_version;
 8627
 8628		if (hw->mac.ops.get_nvm_ver &&
 8629		    hw->mac.ops.get_nvm_ver(hw, nvm_info))
 8630			goto no_version;
 8631
 8632		snprintf(ver_buff, sizeof(ver_buff),
 8633			 "Current version is NVM:%x.%x.%x, FW:%d.%d. ",
 8634			 nvm_info->major, nvm_info->minor, nvm_info->eetrack,
 8635			 hw->fw_maj_ver, hw->fw_maj_ver);
 8636no_version:
 8637		e_dev_warn("Firmware rollback mode detected. %sDevice may exhibit limited functionality. Refer to the Intel(R) Ethernet Adapters and Devices User Guide for details on firmware rollback mode.",
 8638			   ver_buff);
 8639
 8640		adapter->flags2 |= IXGBE_FLAG2_FW_ROLLBACK;
 8641	}
 8642
 8643	return false;
 8644}
 8645
 8646static void ixgbe_recovery_service_task(struct work_struct *work)
 8647{
 8648	struct ixgbe_adapter *adapter = container_of(work,
 8649						     struct ixgbe_adapter,
 8650						     service_task);
 8651
 8652	ixgbe_handle_fw_event(adapter);
 8653	ixgbe_service_event_complete(adapter);
 8654
 8655	mod_timer(&adapter->service_timer, jiffies + msecs_to_jiffies(100));
 8656}
 8657
 8658/**
 8659 * ixgbe_service_task - manages and runs subtasks
 8660 * @work: pointer to work_struct containing our data
 8661 **/
 8662static void ixgbe_service_task(struct work_struct *work)
 8663{
 8664	struct ixgbe_adapter *adapter = container_of(work,
 8665						     struct ixgbe_adapter,
 8666						     service_task);
 8667	if (ixgbe_removed(adapter->hw.hw_addr)) {
 8668		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
 8669			rtnl_lock();
 8670			ixgbe_down(adapter);
 8671			rtnl_unlock();
 8672		}
 8673		ixgbe_service_event_complete(adapter);
 8674		return;
 8675	}
 8676	if (ixgbe_check_fw_error(adapter)) {
 8677		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
 8678			if (adapter->mii_bus) {
 8679				mdiobus_unregister(adapter->mii_bus);
 8680				adapter->mii_bus = NULL;
 8681			}
 8682			unregister_netdev(adapter->netdev);
 8683		}
 8684		ixgbe_service_event_complete(adapter);
 8685		return;
 8686	}
 8687	if (adapter->hw.mac.type == ixgbe_mac_e610) {
 8688		if (adapter->flags2 & IXGBE_FLAG2_FW_ASYNC_EVENT)
 8689			ixgbe_handle_fw_event(adapter);
 8690		ixgbe_check_media_subtask(adapter);
 8691	}
 8692	ixgbe_reset_subtask(adapter);
 8693	ixgbe_phy_interrupt_subtask(adapter);
 8694	ixgbe_sfp_detection_subtask(adapter);
 8695	ixgbe_sfp_link_config_subtask(adapter);
 8696	ixgbe_check_overtemp_subtask(adapter);
 8697	ixgbe_watchdog_subtask(adapter);
 8698	ixgbe_fdir_reinit_subtask(adapter);
 8699	ixgbe_check_hang_subtask(adapter);
 8700
 8701	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state)) {
 8702		ixgbe_ptp_overflow_check(adapter);
 8703		if (adapter->flags & IXGBE_FLAG_RX_HWTSTAMP_IN_REGISTER)
 8704			ixgbe_ptp_rx_hang(adapter);
 8705		ixgbe_ptp_tx_hang(adapter);
 8706	}
 8707
 8708	ixgbe_service_event_complete(adapter);
 8709}
 8710
 8711static int ixgbe_tso(struct ixgbe_ring *tx_ring,
 8712		     struct ixgbe_tx_buffer *first,
 8713		     u8 *hdr_len,
 8714		     struct ixgbe_ipsec_tx_data *itd)
 8715{
 8716	u32 vlan_macip_lens, type_tucmd, mss_l4len_idx;
 8717	struct sk_buff *skb = first->skb;
 8718	union {
 8719		struct iphdr *v4;
 8720		struct ipv6hdr *v6;
 8721		unsigned char *hdr;
 8722	} ip;
 8723	union {
 8724		struct tcphdr *tcp;
 8725		struct udphdr *udp;
 8726		unsigned char *hdr;
 8727	} l4;
 8728	u32 paylen, l4_offset;
 8729	u32 fceof_saidx = 0;
 8730	int err;
 8731
 8732	if (skb->ip_summed != CHECKSUM_PARTIAL)
 8733		return 0;
 8734
 8735	if (!skb_is_gso(skb))
 8736		return 0;
 8737
 8738	err = skb_cow_head(skb, 0);
 8739	if (err < 0)
 8740		return err;
 8741
 8742	if (eth_p_mpls(first->protocol))
 8743		ip.hdr = skb_inner_network_header(skb);
 8744	else
 8745		ip.hdr = skb_network_header(skb);
 8746	l4.hdr = skb_checksum_start(skb);
 8747
 8748	/* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
 8749	type_tucmd = (skb_shinfo(skb)->gso_type & SKB_GSO_UDP_L4) ?
 8750		      IXGBE_ADVTXD_TUCMD_L4T_UDP : IXGBE_ADVTXD_TUCMD_L4T_TCP;
 8751
 8752	/* initialize outer IP header fields */
 8753	if (ip.v4->version == 4) {
 8754		unsigned char *csum_start = skb_checksum_start(skb);
 8755		unsigned char *trans_start = ip.hdr + (ip.v4->ihl * 4);
 8756		int len = csum_start - trans_start;
 8757
 8758		/* IP header will have to cancel out any data that
 8759		 * is not a part of the outer IP header, so set to
 8760		 * a reverse csum if needed, else init check to 0.
 8761		 */
 8762		ip.v4->check = (skb_shinfo(skb)->gso_type & SKB_GSO_PARTIAL) ?
 8763					   csum_fold(csum_partial(trans_start,
 8764								  len, 0)) : 0;
 8765		type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
 8766
 8767		ip.v4->tot_len = 0;
 8768		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
 8769				   IXGBE_TX_FLAGS_CSUM |
 8770				   IXGBE_TX_FLAGS_IPV4;
 8771	} else {
 8772		ip.v6->payload_len = 0;
 8773		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
 8774				   IXGBE_TX_FLAGS_CSUM;
 8775	}
 8776
 8777	/* determine offset of inner transport header */
 8778	l4_offset = l4.hdr - skb->data;
 8779
 8780	/* remove payload length from inner checksum */
 8781	paylen = skb->len - l4_offset;
 8782
 8783	if (type_tucmd & IXGBE_ADVTXD_TUCMD_L4T_TCP) {
 8784		/* compute length of segmentation header */
 8785		*hdr_len = (l4.tcp->doff * 4) + l4_offset;
 8786		csum_replace_by_diff(&l4.tcp->check,
 8787				     (__force __wsum)htonl(paylen));
 8788	} else {
 8789		/* compute length of segmentation header */
 8790		*hdr_len = sizeof(*l4.udp) + l4_offset;
 8791		csum_replace_by_diff(&l4.udp->check,
 8792				     (__force __wsum)htonl(paylen));
 8793	}
 8794
 8795	/* update gso size and bytecount with header size */
 8796	first->gso_segs = skb_shinfo(skb)->gso_segs;
 8797	first->bytecount += (first->gso_segs - 1) * *hdr_len;
 8798
 8799	/* mss_l4len_id: use 0 as index for TSO */
 8800	mss_l4len_idx = (*hdr_len - l4_offset) << IXGBE_ADVTXD_L4LEN_SHIFT;
 8801	mss_l4len_idx |= skb_shinfo(skb)->gso_size << IXGBE_ADVTXD_MSS_SHIFT;
 8802
 8803	fceof_saidx |= itd->sa_idx;
 8804	type_tucmd |= itd->flags | itd->trailer_len;
 8805
 8806	/* vlan_macip_lens: HEADLEN, MACLEN, VLAN tag */
 8807	vlan_macip_lens = l4.hdr - ip.hdr;
 8808	vlan_macip_lens |= (ip.hdr - skb->data) << IXGBE_ADVTXD_MACLEN_SHIFT;
 8809	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
 8810
 8811	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, fceof_saidx, type_tucmd,
 8812			  mss_l4len_idx);
 8813
 8814	return 1;
 8815}
 8816
 8817static void ixgbe_tx_csum(struct ixgbe_ring *tx_ring,
 8818			  struct ixgbe_tx_buffer *first,
 8819			  struct ixgbe_ipsec_tx_data *itd)
 8820{
 8821	struct sk_buff *skb = first->skb;
 8822	u32 vlan_macip_lens = 0;
 8823	u32 fceof_saidx = 0;
 8824	u32 type_tucmd = 0;
 8825
 8826	if (skb->ip_summed != CHECKSUM_PARTIAL) {
 8827csum_failed:
 8828		if (!(first->tx_flags & (IXGBE_TX_FLAGS_HW_VLAN |
 8829					 IXGBE_TX_FLAGS_CC)))
 8830			return;
 8831		goto no_csum;
 8832	}
 8833
 8834	switch (skb->csum_offset) {
 8835	case offsetof(struct tcphdr, check):
 8836		type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;
 8837		fallthrough;
 8838	case offsetof(struct udphdr, check):
 8839		break;
 8840	case offsetof(struct sctphdr, checksum):
 8841		/* validate that this is actually an SCTP request */
 8842		if (skb_csum_is_sctp(skb)) {
 8843			type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_SCTP;
 8844			break;
 8845		}
 8846		fallthrough;
 8847	default:
 8848		skb_checksum_help(skb);
 8849		goto csum_failed;
 8850	}
 8851
 8852	/* update TX checksum flag */
 8853	first->tx_flags |= IXGBE_TX_FLAGS_CSUM;
 8854	vlan_macip_lens = skb_checksum_start_offset(skb) -
 8855			  skb_network_offset(skb);
 8856no_csum:
 8857	/* vlan_macip_lens: MACLEN, VLAN tag */
 8858	vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
 8859	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
 8860
 8861	fceof_saidx |= itd->sa_idx;
 8862	type_tucmd |= itd->flags | itd->trailer_len;
 8863
 8864	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, fceof_saidx, type_tucmd, 0);
 8865}
 8866
 8867#define IXGBE_SET_FLAG(_input, _flag, _result) \
 8868	((_flag <= _result) ? \
 8869	 ((u32)(_input & _flag) * (_result / _flag)) : \
 8870	 ((u32)(_input & _flag) / (_flag / _result)))
 8871
 8872static u32 ixgbe_tx_cmd_type(struct sk_buff *skb, u32 tx_flags)
 8873{
 8874	/* set type for advanced descriptor with frame checksum insertion */
 8875	u32 cmd_type = IXGBE_ADVTXD_DTYP_DATA |
 8876		       IXGBE_ADVTXD_DCMD_DEXT |
 8877		       IXGBE_ADVTXD_DCMD_IFCS;
 8878
 8879	/* set HW vlan bit if vlan is present */
 8880	cmd_type |= IXGBE_SET_FLAG(tx_flags, IXGBE_TX_FLAGS_HW_VLAN,
 8881				   IXGBE_ADVTXD_DCMD_VLE);
 8882
 8883	/* set segmentation enable bits for TSO/FSO */
 8884	cmd_type |= IXGBE_SET_FLAG(tx_flags, IXGBE_TX_FLAGS_TSO,
 8885				   IXGBE_ADVTXD_DCMD_TSE);
 8886
 8887	/* set timestamp bit if present */
 8888	cmd_type |= IXGBE_SET_FLAG(tx_flags, IXGBE_TX_FLAGS_TSTAMP,
 8889				   IXGBE_ADVTXD_MAC_TSTAMP);
 8890
 8891	/* insert frame checksum */
 8892	cmd_type ^= IXGBE_SET_FLAG(skb->no_fcs, 1, IXGBE_ADVTXD_DCMD_IFCS);
 8893
 8894	return cmd_type;
 8895}
 8896
 8897static void ixgbe_tx_olinfo_status(union ixgbe_adv_tx_desc *tx_desc,
 8898				   u32 tx_flags, unsigned int paylen)
 8899{
 8900	u32 olinfo_status = paylen << IXGBE_ADVTXD_PAYLEN_SHIFT;
 8901
 8902	/* enable L4 checksum for TSO and TX checksum offload */
 8903	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
 8904					IXGBE_TX_FLAGS_CSUM,
 8905					IXGBE_ADVTXD_POPTS_TXSM);
 8906
 8907	/* enable IPv4 checksum for TSO */
 8908	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
 8909					IXGBE_TX_FLAGS_IPV4,
 8910					IXGBE_ADVTXD_POPTS_IXSM);
 8911
 8912	/* enable IPsec */
 8913	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
 8914					IXGBE_TX_FLAGS_IPSEC,
 8915					IXGBE_ADVTXD_POPTS_IPSEC);
 8916
 8917	/*
 8918	 * Check Context must be set if Tx switch is enabled, which it
 8919	 * always is for case where virtual functions are running
 8920	 */
 8921	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
 8922					IXGBE_TX_FLAGS_CC,
 8923					IXGBE_ADVTXD_CC);
 8924
 8925	tx_desc->read.olinfo_status = cpu_to_le32(olinfo_status);
 8926}
 8927
 8928static int __ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
 8929{
 8930	if (!netif_subqueue_try_stop(tx_ring->netdev, tx_ring->queue_index,
 8931				     ixgbe_desc_unused(tx_ring), size))
 8932		return -EBUSY;
 8933
 8934	++tx_ring->tx_stats.restart_queue;
 8935	return 0;
 8936}
 8937
 8938static inline int ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
 8939{
 8940	if (likely(ixgbe_desc_unused(tx_ring) >= size))
 8941		return 0;
 8942
 8943	return __ixgbe_maybe_stop_tx(tx_ring, size);
 8944}
 8945
 8946static int ixgbe_tx_map(struct ixgbe_ring *tx_ring,
 8947			struct ixgbe_tx_buffer *first,
 8948			const u8 hdr_len)
 8949{
 8950	struct sk_buff *skb = first->skb;
 8951	struct ixgbe_tx_buffer *tx_buffer;
 8952	union ixgbe_adv_tx_desc *tx_desc;
 8953	skb_frag_t *frag;
 8954	dma_addr_t dma;
 8955	unsigned int data_len, size;
 8956	u32 tx_flags = first->tx_flags;
 8957	u32 cmd_type = ixgbe_tx_cmd_type(skb, tx_flags);
 8958	u16 i = tx_ring->next_to_use;
 8959
 8960	tx_desc = IXGBE_TX_DESC(tx_ring, i);
 8961
 8962	ixgbe_tx_olinfo_status(tx_desc, tx_flags, skb->len - hdr_len);
 8963
 8964	size = skb_headlen(skb);
 8965	data_len = skb->data_len;
 8966
 8967#ifdef IXGBE_FCOE
 8968	if (tx_flags & IXGBE_TX_FLAGS_FCOE) {
 8969		if (data_len < sizeof(struct fcoe_crc_eof)) {
 8970			size -= sizeof(struct fcoe_crc_eof) - data_len;
 8971			data_len = 0;
 8972		} else {
 8973			data_len -= sizeof(struct fcoe_crc_eof);
 8974		}
 8975	}
 8976
 8977#endif
 8978	dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
 8979
 8980	tx_buffer = first;
 8981
 8982	for (frag = &skb_shinfo(skb)->frags[0];; frag++) {
 8983		if (dma_mapping_error(tx_ring->dev, dma))
 8984			goto dma_error;
 8985
 8986		/* record length, and DMA address */
 8987		dma_unmap_len_set(tx_buffer, len, size);
 8988		dma_unmap_addr_set(tx_buffer, dma, dma);
 8989
 8990		tx_desc->read.buffer_addr = cpu_to_le64(dma);
 8991
 8992		while (unlikely(size > IXGBE_MAX_DATA_PER_TXD)) {
 8993			tx_desc->read.cmd_type_len =
 8994				cpu_to_le32(cmd_type ^ IXGBE_MAX_DATA_PER_TXD);
 8995
 8996			i++;
 8997			tx_desc++;
 8998			if (i == tx_ring->count) {
 8999				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
 9000				i = 0;
 9001			}
 9002			tx_desc->read.olinfo_status = 0;
 9003
 9004			dma += IXGBE_MAX_DATA_PER_TXD;
 9005			size -= IXGBE_MAX_DATA_PER_TXD;
 9006
 9007			tx_desc->read.buffer_addr = cpu_to_le64(dma);
 9008		}
 9009
 9010		if (likely(!data_len))
 9011			break;
 9012
 9013		tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type ^ size);
 9014
 9015		i++;
 9016		tx_desc++;
 9017		if (i == tx_ring->count) {
 9018			tx_desc = IXGBE_TX_DESC(tx_ring, 0);
 9019			i = 0;
 9020		}
 9021		tx_desc->read.olinfo_status = 0;
 9022
 9023#ifdef IXGBE_FCOE
 9024		size = min_t(unsigned int, data_len, skb_frag_size(frag));
 9025#else
 9026		size = skb_frag_size(frag);
 9027#endif
 9028		data_len -= size;
 9029
 9030		dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
 9031				       DMA_TO_DEVICE);
 9032
 9033		tx_buffer = &tx_ring->tx_buffer_info[i];
 9034	}
 9035
 9036	/* write last descriptor with RS and EOP bits */
 9037	cmd_type |= size | IXGBE_TXD_CMD;
 9038	tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type);
 9039
 9040	netdev_tx_sent_queue(txring_txq(tx_ring), first->bytecount);
 9041
 9042	/* set the timestamp */
 9043	first->time_stamp = jiffies;
 9044
 9045	skb_tx_timestamp(skb);
 9046
 9047	/*
 9048	 * Force memory writes to complete before letting h/w know there
 9049	 * are new descriptors to fetch.  (Only applicable for weak-ordered
 9050	 * memory model archs, such as IA-64).
 9051	 *
 9052	 * We also need this memory barrier to make certain all of the
 9053	 * status bits have been updated before next_to_watch is written.
 9054	 */
 9055	wmb();
 9056
 9057	/* set next_to_watch value indicating a packet is present */
 9058	first->next_to_watch = tx_desc;
 9059
 9060	i++;
 9061	if (i == tx_ring->count)
 9062		i = 0;
 9063
 9064	tx_ring->next_to_use = i;
 9065
 9066	ixgbe_maybe_stop_tx(tx_ring, DESC_NEEDED);
 9067
 9068	if (netif_xmit_stopped(txring_txq(tx_ring)) || !netdev_xmit_more()) {
 9069		writel(i, tx_ring->tail);
 9070	}
 9071
 9072	return 0;
 9073dma_error:
 9074	dev_err(tx_ring->dev, "TX DMA map failed\n");
 9075
 9076	/* clear dma mappings for failed tx_buffer_info map */
 9077	for (;;) {
 9078		tx_buffer = &tx_ring->tx_buffer_info[i];
 9079		if (dma_unmap_len(tx_buffer, len))
 9080			dma_unmap_page(tx_ring->dev,
 9081				       dma_unmap_addr(tx_buffer, dma),
 9082				       dma_unmap_len(tx_buffer, len),
 9083				       DMA_TO_DEVICE);
 9084		dma_unmap_len_set(tx_buffer, len, 0);
 9085		if (tx_buffer == first)
 9086			break;
 9087		if (i == 0)
 9088			i += tx_ring->count;
 9089		i--;
 9090	}
 9091
 9092	dev_kfree_skb_any(first->skb);
 9093	first->skb = NULL;
 9094
 9095	tx_ring->next_to_use = i;
 9096
 9097	return -1;
 9098}
 9099
 9100static void ixgbe_atr(struct ixgbe_ring *ring,
 9101		      struct ixgbe_tx_buffer *first)
 9102{
 9103	struct ixgbe_q_vector *q_vector = ring->q_vector;
 9104	union ixgbe_atr_hash_dword input = { .dword = 0 };
 9105	union ixgbe_atr_hash_dword common = { .dword = 0 };
 9106	union {
 9107		unsigned char *network;
 9108		struct iphdr *ipv4;
 9109		struct ipv6hdr *ipv6;
 9110	} hdr;
 9111	struct tcphdr *th;
 9112	unsigned int hlen;
 9113	struct sk_buff *skb;
 9114	__be16 vlan_id;
 9115	int l4_proto;
 9116
 9117	/* if ring doesn't have a interrupt vector, cannot perform ATR */
 9118	if (!q_vector)
 9119		return;
 9120
 9121	/* do nothing if sampling is disabled */
 9122	if (!ring->atr_sample_rate)
 9123		return;
 9124
 9125	ring->atr_count++;
 9126
 9127	/* currently only IPv4/IPv6 with TCP is supported */
 9128	if ((first->protocol != htons(ETH_P_IP)) &&
 9129	    (first->protocol != htons(ETH_P_IPV6)))
 9130		return;
 9131
 9132	/* snag network header to get L4 type and address */
 9133	skb = first->skb;
 9134	hdr.network = skb_network_header(skb);
 9135	if (unlikely(hdr.network <= skb->data))
 9136		return;
 9137	if (skb->encapsulation &&
 9138	    first->protocol == htons(ETH_P_IP) &&
 9139	    hdr.ipv4->protocol == IPPROTO_UDP) {
 9140		struct ixgbe_adapter *adapter = q_vector->adapter;
 9141
 9142		if (unlikely(skb_tail_pointer(skb) < hdr.network +
 9143			     vxlan_headroom(0)))
 9144			return;
 9145
 9146		/* verify the port is recognized as VXLAN */
 9147		if (adapter->vxlan_port &&
 9148		    udp_hdr(skb)->dest == adapter->vxlan_port)
 9149			hdr.network = skb_inner_network_header(skb);
 9150
 9151		if (adapter->geneve_port &&
 9152		    udp_hdr(skb)->dest == adapter->geneve_port)
 9153			hdr.network = skb_inner_network_header(skb);
 9154	}
 9155
 9156	/* Make sure we have at least [minimum IPv4 header + TCP]
 9157	 * or [IPv6 header] bytes
 9158	 */
 9159	if (unlikely(skb_tail_pointer(skb) < hdr.network + 40))
 9160		return;
 9161
 9162	/* Currently only IPv4/IPv6 with TCP is supported */
 9163	switch (hdr.ipv4->version) {
 9164	case IPVERSION:
 9165		/* access ihl as u8 to avoid unaligned access on ia64 */
 9166		hlen = (hdr.network[0] & 0x0F) << 2;
 9167		l4_proto = hdr.ipv4->protocol;
 9168		break;
 9169	case 6:
 9170		hlen = hdr.network - skb->data;
 9171		l4_proto = ipv6_find_hdr(skb, &hlen, IPPROTO_TCP, NULL, NULL);
 9172		hlen -= hdr.network - skb->data;
 9173		break;
 9174	default:
 9175		return;
 9176	}
 9177
 9178	if (l4_proto != IPPROTO_TCP)
 9179		return;
 9180
 9181	if (unlikely(skb_tail_pointer(skb) < hdr.network +
 9182		     hlen + sizeof(struct tcphdr)))
 9183		return;
 9184
 9185	th = (struct tcphdr *)(hdr.network + hlen);
 9186
 9187	/* skip this packet since the socket is closing */
 9188	if (th->fin)
 9189		return;
 9190
 9191	/* sample on all syn packets or once every atr sample count */
 9192	if (!th->syn && (ring->atr_count < ring->atr_sample_rate))
 9193		return;
 9194
 9195	/* reset sample count */
 9196	ring->atr_count = 0;
 9197
 9198	vlan_id = htons(first->tx_flags >> IXGBE_TX_FLAGS_VLAN_SHIFT);
 9199
 9200	/*
 9201	 * src and dst are inverted, think how the receiver sees them
 9202	 *
 9203	 * The input is broken into two sections, a non-compressed section
 9204	 * containing vm_pool, vlan_id, and flow_type.  The rest of the data
 9205	 * is XORed together and stored in the compressed dword.
 9206	 */
 9207	input.formatted.vlan_id = vlan_id;
 9208
 9209	/*
 9210	 * since src port and flex bytes occupy the same word XOR them together
 9211	 * and write the value to source port portion of compressed dword
 9212	 */
 9213	if (first->tx_flags & (IXGBE_TX_FLAGS_SW_VLAN | IXGBE_TX_FLAGS_HW_VLAN))
 9214		common.port.src ^= th->dest ^ htons(ETH_P_8021Q);
 9215	else
 9216		common.port.src ^= th->dest ^ first->protocol;
 9217	common.port.dst ^= th->source;
 9218
 9219	switch (hdr.ipv4->version) {
 9220	case IPVERSION:
 9221		input.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_TCPV4;
 9222		common.ip ^= hdr.ipv4->saddr ^ hdr.ipv4->daddr;
 9223		break;
 9224	case 6:
 9225		input.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_TCPV6;
 9226		common.ip ^= hdr.ipv6->saddr.s6_addr32[0] ^
 9227			     hdr.ipv6->saddr.s6_addr32[1] ^
 9228			     hdr.ipv6->saddr.s6_addr32[2] ^
 9229			     hdr.ipv6->saddr.s6_addr32[3] ^
 9230			     hdr.ipv6->daddr.s6_addr32[0] ^
 9231			     hdr.ipv6->daddr.s6_addr32[1] ^
 9232			     hdr.ipv6->daddr.s6_addr32[2] ^
 9233			     hdr.ipv6->daddr.s6_addr32[3];
 9234		break;
 9235	default:
 9236		break;
 9237	}
 9238
 9239	if (hdr.network != skb_network_header(skb))
 9240		input.formatted.flow_type |= IXGBE_ATR_L4TYPE_TUNNEL_MASK;
 9241
 9242	/* This assumes the Rx queue and Tx queue are bound to the same CPU */
 9243	ixgbe_fdir_add_signature_filter_82599(&q_vector->adapter->hw,
 9244					      input, common, ring->queue_index);
 9245}
 9246
 9247#ifdef IXGBE_FCOE
 9248static u16 ixgbe_select_queue(struct net_device *dev, struct sk_buff *skb,
 9249			      struct net_device *sb_dev)
 9250{
 9251	struct ixgbe_adapter *adapter;
 9252	struct ixgbe_ring_feature *f;
 9253	int txq;
 9254
 9255	if (sb_dev) {
 9256		u8 tc = netdev_get_prio_tc_map(dev, skb->priority);
 9257		struct net_device *vdev = sb_dev;
 9258
 9259		txq = vdev->tc_to_txq[tc].offset;
 9260		txq += reciprocal_scale(skb_get_hash(skb),
 9261					vdev->tc_to_txq[tc].count);
 9262
 9263		return txq;
 9264	}
 9265
 9266	/*
 9267	 * only execute the code below if protocol is FCoE
 9268	 * or FIP and we have FCoE enabled on the adapter
 9269	 */
 9270	switch (vlan_get_protocol(skb)) {
 9271	case htons(ETH_P_FCOE):
 9272	case htons(ETH_P_FIP):
 9273		adapter = ixgbe_from_netdev(dev);
 9274
 9275		if (!sb_dev && (adapter->flags & IXGBE_FLAG_FCOE_ENABLED))
 9276			break;
 9277		fallthrough;
 9278	default:
 9279		return netdev_pick_tx(dev, skb, sb_dev);
 9280	}
 9281
 9282	f = &adapter->ring_feature[RING_F_FCOE];
 9283
 9284	txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) :
 9285					   smp_processor_id();
 9286
 9287	while (txq >= f->indices)
 9288		txq -= f->indices;
 9289
 9290	return txq + f->offset;
 9291}
 9292
 9293#endif
 9294int ixgbe_xmit_xdp_ring(struct ixgbe_ring *ring,
 9295			struct xdp_frame *xdpf)
 9296{
 9297	struct skb_shared_info *sinfo = xdp_get_shared_info_from_frame(xdpf);
 9298	u8 nr_frags = unlikely(xdp_frame_has_frags(xdpf)) ? sinfo->nr_frags : 0;
 9299	u16 i = 0, index = ring->next_to_use;
 9300	struct ixgbe_tx_buffer *tx_head = &ring->tx_buffer_info[index];
 9301	struct ixgbe_tx_buffer *tx_buff = tx_head;
 9302	union ixgbe_adv_tx_desc *tx_desc = IXGBE_TX_DESC(ring, index);
 9303	u32 cmd_type, len = xdpf->len;
 9304	void *data = xdpf->data;
 9305
 9306	if (unlikely(ixgbe_desc_unused(ring) < 1 + nr_frags))
 9307		return IXGBE_XDP_CONSUMED;
 9308
 9309	tx_head->bytecount = xdp_get_frame_len(xdpf);
 9310	tx_head->gso_segs = 1;
 9311	tx_head->xdpf = xdpf;
 9312
 9313	tx_desc->read.olinfo_status =
 9314		cpu_to_le32(tx_head->bytecount << IXGBE_ADVTXD_PAYLEN_SHIFT);
 9315
 9316	for (;;) {
 9317		dma_addr_t dma;
 9318
 9319		dma = dma_map_single(ring->dev, data, len, DMA_TO_DEVICE);
 9320		if (dma_mapping_error(ring->dev, dma))
 9321			goto unmap;
 9322
 9323		dma_unmap_len_set(tx_buff, len, len);
 9324		dma_unmap_addr_set(tx_buff, dma, dma);
 9325
 9326		cmd_type = IXGBE_ADVTXD_DTYP_DATA | IXGBE_ADVTXD_DCMD_DEXT |
 9327			   IXGBE_ADVTXD_DCMD_IFCS | len;
 9328		tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type);
 9329		tx_desc->read.buffer_addr = cpu_to_le64(dma);
 9330		tx_buff->protocol = 0;
 9331
 9332		if (++index == ring->count)
 9333			index = 0;
 9334
 9335		if (i == nr_frags)
 9336			break;
 9337
 9338		tx_buff = &ring->tx_buffer_info[index];
 9339		tx_desc = IXGBE_TX_DESC(ring, index);
 9340		tx_desc->read.olinfo_status = 0;
 9341
 9342		data = skb_frag_address(&sinfo->frags[i]);
 9343		len = skb_frag_size(&sinfo->frags[i]);
 9344		i++;
 9345	}
 9346	/* put descriptor type bits */
 9347	tx_desc->read.cmd_type_len |= cpu_to_le32(IXGBE_TXD_CMD);
 9348
 9349	/* Avoid any potential race with xdp_xmit and cleanup */
 9350	smp_wmb();
 9351
 9352	tx_head->next_to_watch = tx_desc;
 9353	ring->next_to_use = index;
 9354
 9355	return IXGBE_XDP_TX;
 9356
 9357unmap:
 9358	for (;;) {
 9359		tx_buff = &ring->tx_buffer_info[index];
 9360		if (dma_unmap_len(tx_buff, len))
 9361			dma_unmap_page(ring->dev, dma_unmap_addr(tx_buff, dma),
 9362				       dma_unmap_len(tx_buff, len),
 9363				       DMA_TO_DEVICE);
 9364		dma_unmap_len_set(tx_buff, len, 0);
 9365		if (tx_buff == tx_head)
 9366			break;
 9367
 9368		if (!index)
 9369			index += ring->count;
 9370		index--;
 9371	}
 9372
 9373	return IXGBE_XDP_CONSUMED;
 9374}
 9375
 9376netdev_tx_t ixgbe_xmit_frame_ring(struct sk_buff *skb,
 9377			  struct ixgbe_adapter *adapter,
 9378			  struct ixgbe_ring *tx_ring)
 9379{
 9380	struct ixgbe_tx_buffer *first;
 9381	int tso;
 9382	u32 tx_flags = 0;
 9383	unsigned short f;
 9384	u16 count = TXD_USE_COUNT(skb_headlen(skb));
 9385	struct ixgbe_ipsec_tx_data ipsec_tx = { 0 };
 9386	__be16 protocol = skb->protocol;
 9387	u8 hdr_len = 0;
 9388
 9389	/*
 9390	 * need: 1 descriptor per page * PAGE_SIZE/IXGBE_MAX_DATA_PER_TXD,
 9391	 *       + 1 desc for skb_headlen/IXGBE_MAX_DATA_PER_TXD,
 9392	 *       + 2 desc gap to keep tail from touching head,
 9393	 *       + 1 desc for context descriptor,
 9394	 * otherwise try next time
 9395	 */
 9396	for (f = 0; f < skb_shinfo(skb)->nr_frags; f++)
 9397		count += TXD_USE_COUNT(skb_frag_size(
 9398						&skb_shinfo(skb)->frags[f]));
 9399
 9400	if (ixgbe_maybe_stop_tx(tx_ring, count + 3)) {
 9401		tx_ring->tx_stats.tx_busy++;
 9402		return NETDEV_TX_BUSY;
 9403	}
 9404
 9405	/* record the location of the first descriptor for this packet */
 9406	first = &tx_ring->tx_buffer_info[tx_ring->next_to_use];
 9407	first->skb = skb;
 9408	first->bytecount = skb->len;
 9409	first->gso_segs = 1;
 9410
 9411	/* if we have a HW VLAN tag being added default to the HW one */
 9412	if (skb_vlan_tag_present(skb)) {
 9413		tx_flags |= skb_vlan_tag_get(skb) << IXGBE_TX_FLAGS_VLAN_SHIFT;
 9414		tx_flags |= IXGBE_TX_FLAGS_HW_VLAN;
 9415	/* else if it is a SW VLAN check the next protocol and store the tag */
 9416	} else if (protocol == htons(ETH_P_8021Q)) {
 9417		struct vlan_hdr *vhdr, _vhdr;
 9418		vhdr = skb_header_pointer(skb, ETH_HLEN, sizeof(_vhdr), &_vhdr);
 9419		if (!vhdr)
 9420			goto out_drop;
 9421
 9422		tx_flags |= ntohs(vhdr->h_vlan_TCI) <<
 9423				  IXGBE_TX_FLAGS_VLAN_SHIFT;
 9424		tx_flags |= IXGBE_TX_FLAGS_SW_VLAN;
 9425	}
 9426	protocol = vlan_get_protocol(skb);
 9427
 9428	if (unlikely(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP) &&
 9429	    adapter->ptp_clock) {
 9430		if (adapter->tstamp_config.tx_type == HWTSTAMP_TX_ON &&
 9431		    !test_and_set_bit_lock(__IXGBE_PTP_TX_IN_PROGRESS,
 9432					   &adapter->state)) {
 9433			skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
 9434			tx_flags |= IXGBE_TX_FLAGS_TSTAMP;
 9435
 9436			/* schedule check for Tx timestamp */
 9437			adapter->ptp_tx_skb = skb_get(skb);
 9438			adapter->ptp_tx_start = jiffies;
 9439			schedule_work(&adapter->ptp_tx_work);
 9440		} else {
 9441			adapter->tx_hwtstamp_skipped++;
 9442		}
 9443	}
 9444
 9445#ifdef CONFIG_PCI_IOV
 9446	/*
 9447	 * Use the l2switch_enable flag - would be false if the DMA
 9448	 * Tx switch had been disabled.
 9449	 */
 9450	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
 9451		tx_flags |= IXGBE_TX_FLAGS_CC;
 9452
 9453#endif
 9454	/* DCB maps skb priorities 0-7 onto 3 bit PCP of VLAN tag. */
 9455	if ((adapter->flags & IXGBE_FLAG_DCB_ENABLED) &&
 9456	    ((tx_flags & (IXGBE_TX_FLAGS_HW_VLAN | IXGBE_TX_FLAGS_SW_VLAN)) ||
 9457	     (skb->priority != TC_PRIO_CONTROL))) {
 9458		tx_flags &= ~IXGBE_TX_FLAGS_VLAN_PRIO_MASK;
 9459		tx_flags |= (skb->priority & 0x7) <<
 9460					IXGBE_TX_FLAGS_VLAN_PRIO_SHIFT;
 9461		if (tx_flags & IXGBE_TX_FLAGS_SW_VLAN) {
 9462			struct vlan_ethhdr *vhdr;
 9463
 9464			if (skb_cow_head(skb, 0))
 9465				goto out_drop;
 9466			vhdr = skb_vlan_eth_hdr(skb);
 9467			vhdr->h_vlan_TCI = htons(tx_flags >>
 9468						 IXGBE_TX_FLAGS_VLAN_SHIFT);
 9469		} else {
 9470			tx_flags |= IXGBE_TX_FLAGS_HW_VLAN;
 9471		}
 9472	}
 9473
 9474	/* record initial flags and protocol */
 9475	first->tx_flags = tx_flags;
 9476	first->protocol = protocol;
 9477
 9478#ifdef IXGBE_FCOE
 9479	/* setup tx offload for FCoE */
 9480	if ((protocol == htons(ETH_P_FCOE)) &&
 9481	    (tx_ring->netdev->features & (NETIF_F_FSO | NETIF_F_FCOE_CRC))) {
 9482		tso = ixgbe_fso(tx_ring, first, &hdr_len);
 9483		if (tso < 0)
 9484			goto out_drop;
 9485
 9486		goto xmit_fcoe;
 9487	}
 9488
 9489#endif /* IXGBE_FCOE */
 9490
 9491#ifdef CONFIG_IXGBE_IPSEC
 9492	if (xfrm_offload(skb) &&
 9493	    !ixgbe_ipsec_tx(tx_ring, first, &ipsec_tx))
 9494		goto out_drop;
 9495#endif
 9496	tso = ixgbe_tso(tx_ring, first, &hdr_len, &ipsec_tx);
 9497	if (tso < 0)
 9498		goto out_drop;
 9499	else if (!tso)
 9500		ixgbe_tx_csum(tx_ring, first, &ipsec_tx);
 9501
 9502	/* add the ATR filter if ATR is on */
 9503	if (test_bit(__IXGBE_TX_FDIR_INIT_DONE, &tx_ring->state))
 9504		ixgbe_atr(tx_ring, first);
 9505
 9506#ifdef IXGBE_FCOE
 9507xmit_fcoe:
 9508#endif /* IXGBE_FCOE */
 9509	if (ixgbe_tx_map(tx_ring, first, hdr_len))
 9510		goto cleanup_tx_timestamp;
 9511
 9512	return NETDEV_TX_OK;
 9513
 9514out_drop:
 9515	dev_kfree_skb_any(first->skb);
 9516	first->skb = NULL;
 9517cleanup_tx_timestamp:
 9518	if (unlikely(tx_flags & IXGBE_TX_FLAGS_TSTAMP)) {
 9519		dev_kfree_skb_any(adapter->ptp_tx_skb);
 9520		adapter->ptp_tx_skb = NULL;
 9521		cancel_work_sync(&adapter->ptp_tx_work);
 9522		clear_bit_unlock(__IXGBE_PTP_TX_IN_PROGRESS, &adapter->state);
 9523	}
 9524
 9525	return NETDEV_TX_OK;
 9526}
 9527
 9528static netdev_tx_t __ixgbe_xmit_frame(struct sk_buff *skb,
 9529				      struct net_device *netdev,
 9530				      struct ixgbe_ring *ring)
 9531{
 9532	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 9533	struct ixgbe_ring *tx_ring;
 9534
 9535	/*
 9536	 * The minimum packet size for olinfo paylen is 17 so pad the skb
 9537	 * in order to meet this minimum size requirement.
 9538	 */
 9539	if (skb_put_padto(skb, 17))
 9540		return NETDEV_TX_OK;
 9541
 9542	tx_ring = ring ? ring : adapter->tx_ring[skb_get_queue_mapping(skb)];
 9543	if (unlikely(test_bit(__IXGBE_TX_DISABLED, &tx_ring->state)))
 9544		return NETDEV_TX_BUSY;
 9545
 9546	return ixgbe_xmit_frame_ring(skb, adapter, tx_ring);
 9547}
 9548
 9549static netdev_tx_t ixgbe_xmit_frame(struct sk_buff *skb,
 9550				    struct net_device *netdev)
 9551{
 9552	return __ixgbe_xmit_frame(skb, netdev, NULL);
 9553}
 9554
 9555/**
 9556 * ixgbe_set_mac - Change the Ethernet Address of the NIC
 9557 * @netdev: network interface device structure
 9558 * @p: pointer to an address structure
 9559 *
 9560 * Returns 0 on success, negative on failure
 9561 **/
 9562static int ixgbe_set_mac(struct net_device *netdev, void *p)
 9563{
 9564	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 9565	struct ixgbe_hw *hw = &adapter->hw;
 9566	struct sockaddr *addr = p;
 9567
 9568	if (!is_valid_ether_addr(addr->sa_data))
 9569		return -EADDRNOTAVAIL;
 9570
 9571	eth_hw_addr_set(netdev, addr->sa_data);
 9572	memcpy(hw->mac.addr, addr->sa_data, netdev->addr_len);
 9573
 9574	ixgbe_mac_set_default_filter(adapter);
 9575
 9576	return 0;
 9577}
 9578
 9579static int
 9580ixgbe_mdio_read(struct net_device *netdev, int prtad, int devad, u16 addr)
 9581{
 9582	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 9583	struct ixgbe_hw *hw = &adapter->hw;
 9584	u16 value;
 9585	int rc;
 9586
 9587	if (adapter->mii_bus) {
 9588		int regnum = addr;
 9589
 9590		if (devad != MDIO_DEVAD_NONE)
 9591			return mdiobus_c45_read(adapter->mii_bus, prtad,
 9592						devad, regnum);
 9593
 9594		return mdiobus_read(adapter->mii_bus, prtad, regnum);
 9595	}
 9596
 9597	if (prtad != hw->phy.mdio.prtad)
 9598		return -EINVAL;
 9599	rc = hw->phy.ops.read_reg(hw, addr, devad, &value);
 9600	if (!rc)
 9601		rc = value;
 9602	return rc;
 9603}
 9604
 9605static int ixgbe_mdio_write(struct net_device *netdev, int prtad, int devad,
 9606			    u16 addr, u16 value)
 9607{
 9608	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 9609	struct ixgbe_hw *hw = &adapter->hw;
 9610
 9611	if (adapter->mii_bus) {
 9612		int regnum = addr;
 9613
 9614		if (devad != MDIO_DEVAD_NONE)
 9615			return mdiobus_c45_write(adapter->mii_bus, prtad, devad,
 9616						 regnum, value);
 9617
 9618		return mdiobus_write(adapter->mii_bus, prtad, regnum, value);
 9619	}
 9620
 9621	if (prtad != hw->phy.mdio.prtad)
 9622		return -EINVAL;
 9623	return hw->phy.ops.write_reg(hw, addr, devad, value);
 9624}
 9625
 9626static int ixgbe_ioctl(struct net_device *netdev, struct ifreq *req, int cmd)
 9627{
 9628	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 9629
 9630	switch (cmd) {
 9631	case SIOCGMIIPHY:
 9632		if (!adapter->hw.phy.ops.read_reg)
 9633			return -EOPNOTSUPP;
 9634		fallthrough;
 9635	default:
 9636		return mdio_mii_ioctl(&adapter->hw.phy.mdio, if_mii(req), cmd);
 9637	}
 9638}
 9639
 9640/**
 9641 * ixgbe_add_sanmac_netdev - Add the SAN MAC address to the corresponding
 9642 * netdev->dev_addrs
 9643 * @dev: network interface device structure
 9644 *
 9645 * Returns non-zero on failure
 9646 **/
 9647static int ixgbe_add_sanmac_netdev(struct net_device *dev)
 9648{
 9649	int err = 0;
 9650	struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
 9651	struct ixgbe_hw *hw = &adapter->hw;
 9652
 9653	if (is_valid_ether_addr(hw->mac.san_addr)) {
 9654		rtnl_lock();
 9655		err = dev_addr_add(dev, hw->mac.san_addr, NETDEV_HW_ADDR_T_SAN);
 9656		rtnl_unlock();
 9657
 9658		/* update SAN MAC vmdq pool selection */
 9659		hw->mac.ops.set_vmdq_san_mac(hw, VMDQ_P(0));
 9660	}
 9661	return err;
 9662}
 9663
 9664/**
 9665 * ixgbe_del_sanmac_netdev - Removes the SAN MAC address to the corresponding
 9666 * netdev->dev_addrs
 9667 * @dev: network interface device structure
 9668 *
 9669 * Returns non-zero on failure
 9670 **/
 9671static int ixgbe_del_sanmac_netdev(struct net_device *dev)
 9672{
 9673	int err = 0;
 9674	struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
 9675	struct ixgbe_mac_info *mac = &adapter->hw.mac;
 9676
 9677	if (is_valid_ether_addr(mac->san_addr)) {
 9678		rtnl_lock();
 9679		err = dev_addr_del(dev, mac->san_addr, NETDEV_HW_ADDR_T_SAN);
 9680		rtnl_unlock();
 9681	}
 9682	return err;
 9683}
 9684
 9685static void ixgbe_get_ring_stats64(struct rtnl_link_stats64 *stats,
 9686				   struct ixgbe_ring *ring)
 9687{
 9688	u64 bytes, packets;
 9689	unsigned int start;
 9690
 9691	if (ring) {
 9692		do {
 9693			start = u64_stats_fetch_begin(&ring->syncp);
 9694			packets = ring->stats.packets;
 9695			bytes   = ring->stats.bytes;
 9696		} while (u64_stats_fetch_retry(&ring->syncp, start));
 9697		stats->tx_packets += packets;
 9698		stats->tx_bytes   += bytes;
 9699	}
 9700}
 9701
 9702static void ixgbe_get_stats64(struct net_device *netdev,
 9703			      struct rtnl_link_stats64 *stats)
 9704{
 9705	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 9706	int i;
 9707
 9708	rcu_read_lock();
 9709	for (i = 0; i < adapter->num_rx_queues; i++) {
 9710		struct ixgbe_ring *ring = READ_ONCE(adapter->rx_ring[i]);
 9711		u64 bytes, packets;
 9712		unsigned int start;
 9713
 9714		if (ring) {
 9715			do {
 9716				start = u64_stats_fetch_begin(&ring->syncp);
 9717				packets = ring->stats.packets;
 9718				bytes   = ring->stats.bytes;
 9719			} while (u64_stats_fetch_retry(&ring->syncp, start));
 9720			stats->rx_packets += packets;
 9721			stats->rx_bytes   += bytes;
 9722		}
 9723	}
 9724
 9725	for (i = 0; i < adapter->num_tx_queues; i++) {
 9726		struct ixgbe_ring *ring = READ_ONCE(adapter->tx_ring[i]);
 9727
 9728		ixgbe_get_ring_stats64(stats, ring);
 9729	}
 9730	for (i = 0; i < adapter->num_xdp_queues; i++) {
 9731		struct ixgbe_ring *ring = READ_ONCE(adapter->xdp_ring[i]);
 9732
 9733		ixgbe_get_ring_stats64(stats, ring);
 9734	}
 9735	rcu_read_unlock();
 9736
 9737	/* following stats updated by ixgbe_watchdog_task() */
 9738	stats->multicast	= netdev->stats.multicast;
 9739	stats->rx_errors	= netdev->stats.rx_errors;
 9740	stats->rx_length_errors	= netdev->stats.rx_length_errors;
 9741	stats->rx_crc_errors	= netdev->stats.rx_crc_errors;
 9742	stats->rx_missed_errors	= netdev->stats.rx_missed_errors;
 9743}
 9744
 9745static int ixgbe_ndo_get_vf_stats(struct net_device *netdev, int vf,
 9746				  struct ifla_vf_stats *vf_stats)
 9747{
 9748	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
 9749
 9750	if (vf < 0 || vf >= adapter->num_vfs)
 9751		return -EINVAL;
 9752
 9753	vf_stats->rx_packets = adapter->vfinfo[vf].vfstats.gprc;
 9754	vf_stats->rx_bytes   = adapter->vfinfo[vf].vfstats.gorc;
 9755	vf_stats->tx_packets = adapter->vfinfo[vf].vfstats.gptc;
 9756	vf_stats->tx_bytes   = adapter->vfinfo[vf].vfstats.gotc;
 9757	vf_stats->multicast  = adapter->vfinfo[vf].vfstats.mprc;
 9758
 9759	return 0;
 9760}
 9761
 9762#ifdef CONFIG_IXGBE_DCB
 9763/**
 9764 * ixgbe_validate_rtr - verify 802.1Qp to Rx packet buffer mapping is valid.
 9765 * @adapter: pointer to ixgbe_adapter
 9766 * @tc: number of traffic classes currently enabled
 9767 *
 9768 * Configure a valid 802.1Qp to Rx packet buffer mapping ie confirm
 9769 * 802.1Q priority maps to a packet buffer that exists.
 9770 */
 9771static void ixgbe_validate_rtr(struct ixgbe_adapter *adapter, u8 tc)
 9772{
 9773	struct ixgbe_hw *hw = &adapter->hw;
 9774	u32 reg, rsave;
 9775	int i;
 9776
 9777	/* 82598 have a static priority to TC mapping that can not
 9778	 * be changed so no validation is needed.
 9779	 */
 9780	if (hw->mac.type == ixgbe_mac_82598EB)
 9781		return;
 9782
 9783	reg = IXGBE_READ_REG(hw, IXGBE_RTRUP2TC);
 9784	rsave = reg;
 9785
 9786	for (i = 0; i < MAX_TRAFFIC_CLASS; i++) {
 9787		u8 up2tc = reg >> (i * IXGBE_RTRUP2TC_UP_SHIFT);
 9788
 9789		/* If up2tc is out of bounds default to zero */
 9790		if (up2tc > tc)
 9791			reg &= ~(0x7 << IXGBE_RTRUP2TC_UP_SHIFT);
 9792	}
 9793
 9794	if (reg != rsave)
 9795		IXGBE_WRITE_REG(hw, IXGBE_RTRUP2TC, reg);
 9796
 9797	return;
 9798}
 9799
 9800/**
 9801 * ixgbe_set_prio_tc_map - Configure netdev prio tc map
 9802 * @adapter: Pointer to adapter struct
 9803 *
 9804 * Populate the netdev user priority to tc map
 9805 */
 9806static void ixgbe_set_prio_tc_map(struct ixgbe_adapter *adapter)
 9807{
 9808	struct net_device *dev = adapter->netdev;
 9809	struct ixgbe_dcb_config *dcb_cfg = &adapter->dcb_cfg;
 9810	struct ieee_ets *ets = adapter->ixgbe_ieee_ets;
 9811	u8 prio;
 9812
 9813	for (prio = 0; prio < MAX_USER_PRIORITY; prio++) {
 9814		u8 tc = 0;
 9815
 9816		if (adapter->dcbx_cap & DCB_CAP_DCBX_VER_CEE)
 9817			tc = ixgbe_dcb_get_tc_from_up(dcb_cfg, 0, prio);
 9818		else if (ets)
 9819			tc = ets->prio_tc[prio];
 9820
 9821		netdev_set_prio_tc_map(dev, prio, tc);
 9822	}
 9823}
 9824
 9825#endif /* CONFIG_IXGBE_DCB */
 9826static int ixgbe_reassign_macvlan_pool(struct net_device *vdev,
 9827				       struct netdev_nested_priv *priv)
 9828{
 9829	struct ixgbe_adapter *adapter = (struct ixgbe_adapter *)priv->data;
 9830	struct ixgbe_fwd_adapter *accel;
 9831	int pool;
 9832
 9833	/* we only care about macvlans... */
 9834	if (!netif_is_macvlan(vdev))
 9835		return 0;
 9836
 9837	/* that have hardware offload enabled... */
 9838	accel = macvlan_accel_priv(vdev);
 9839	if (!accel)
 9840		return 0;
 9841
 9842	/* If we can relocate to a different bit do so */
 9843	pool = find_first_zero_bit(adapter->fwd_bitmask, adapter->num_rx_pools);
 9844	if (pool < adapter->num_rx_pools) {
 9845		set_bit(pool, adapter->fwd_bitmask);
 9846		accel->pool = pool;
 9847		return 0;
 9848	}
 9849
 9850	/* if we cannot find a free pool then disable the offload */
 9851	netdev_err(vdev, "L2FW offload disabled due to lack of queue resources\n");
 9852	macvlan_release_l2fw_offload(vdev);
 9853
 9854	/* unbind the queues and drop the subordinate channel config */
 9855	netdev_unbind_sb_channel(adapter->netdev, vdev);
 9856	netdev_set_sb_channel(vdev, 0);
 9857
 9858	kfree(accel);
 9859
 9860	return 0;
 9861}
 9862
 9863static void ixgbe_defrag_macvlan_pools(struct net_device *dev)
 9864{
 9865	struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
 9866	struct netdev_nested_priv priv = {
 9867		.data = (void *)adapter,
 9868	};
 9869
 9870	/* flush any stale bits out of the fwd bitmask */
 9871	bitmap_clear(adapter->fwd_bitmask, 1, 63);
 9872
 9873	/* walk through upper devices reassigning pools */
 9874	netdev_walk_all_upper_dev_rcu(dev, ixgbe_reassign_macvlan_pool,
 9875				      &priv);
 9876}
 9877
 9878/**
 9879 * ixgbe_setup_tc - configure net_device for multiple traffic classes
 9880 *
 9881 * @dev: net device to configure
 9882 * @tc: number of traffic classes to enable
 9883 */
 9884int ixgbe_setup_tc(struct net_device *dev, u8 tc)
 9885{
 9886	struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
 9887	struct ixgbe_hw *hw = &adapter->hw;
 9888
 9889	/* Hardware supports up to 8 traffic classes */
 9890	if (tc > adapter->dcb_cfg.num_tcs.pg_tcs)
 9891		return -EINVAL;
 9892
 9893	if (hw->mac.type == ixgbe_mac_82598EB && tc && tc < MAX_TRAFFIC_CLASS)
 9894		return -EINVAL;
 9895
 9896	/* Hardware has to reinitialize queues and interrupts to
 9897	 * match packet buffer alignment. Unfortunately, the
 9898	 * hardware is not flexible enough to do this dynamically.
 9899	 */
 9900	if (netif_running(dev))
 9901		ixgbe_close(dev);
 9902	else
 9903		ixgbe_reset(adapter);
 9904
 9905	ixgbe_clear_interrupt_scheme(adapter);
 9906
 9907#ifdef CONFIG_IXGBE_DCB
 9908	if (tc) {
 9909		if (adapter->xdp_prog) {
 9910			e_warn(probe, "DCB is not supported with XDP\n");
 9911
 9912			ixgbe_init_interrupt_scheme(adapter);
 9913			if (netif_running(dev))
 9914				ixgbe_open(dev);
 9915			return -EINVAL;
 9916		}
 9917
 9918		netdev_set_num_tc(dev, tc);
 9919		ixgbe_set_prio_tc_map(adapter);
 9920
 9921		adapter->hw_tcs = tc;
 9922		adapter->flags |= IXGBE_FLAG_DCB_ENABLED;
 9923
 9924		if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
 9925			adapter->last_lfc_mode = adapter->hw.fc.requested_mode;
 9926			adapter->hw.fc.requested_mode = ixgbe_fc_none;
 9927		}
 9928	} else {
 9929		netdev_reset_tc(dev);
 9930
 9931		if (adapter->hw.mac.type == ixgbe_mac_82598EB)
 9932			adapter->hw.fc.requested_mode = adapter->last_lfc_mode;
 9933
 9934		adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;
 9935		adapter->hw_tcs = tc;
 9936
 9937		adapter->temp_dcb_cfg.pfc_mode_enable = false;
 9938		adapter->dcb_cfg.pfc_mode_enable = false;
 9939	}
 9940
 9941	ixgbe_validate_rtr(adapter, tc);
 9942
 9943#endif /* CONFIG_IXGBE_DCB */
 9944	ixgbe_init_interrupt_scheme(adapter);
 9945
 9946	ixgbe_defrag_macvlan_pools(dev);
 9947
 9948	if (netif_running(dev))
 9949		return ixgbe_open(dev);
 9950
 9951	return 0;
 9952}
 9953
 9954static int ixgbe_delete_clsu32(struct ixgbe_adapter *adapter,
 9955			       struct tc_cls_u32_offload *cls)
 9956{
 9957	u32 hdl = cls->knode.handle;
 9958	u32 uhtid = TC_U32_USERHTID(cls->knode.handle);
 9959	u32 loc = cls->knode.handle & 0xfffff;
 9960	int err = 0, i, j;
 9961	struct ixgbe_jump_table *jump = NULL;
 9962
 9963	if (loc > IXGBE_MAX_HW_ENTRIES)
 9964		return -EINVAL;
 9965
 9966	if ((uhtid != 0x800) && (uhtid >= IXGBE_MAX_LINK_HANDLE))
 9967		return -EINVAL;
 9968
 9969	/* Clear this filter in the link data it is associated with */
 9970	if (uhtid != 0x800) {
 9971		jump = adapter->jump_tables[uhtid];
 9972		if (!jump)
 9973			return -EINVAL;
 9974		if (!test_bit(loc - 1, jump->child_loc_map))
 9975			return -EINVAL;
 9976		clear_bit(loc - 1, jump->child_loc_map);
 9977	}
 9978
 9979	/* Check if the filter being deleted is a link */
 9980	for (i = 1; i < IXGBE_MAX_LINK_HANDLE; i++) {
 9981		jump = adapter->jump_tables[i];
 9982		if (jump && jump->link_hdl == hdl) {
 9983			/* Delete filters in the hardware in the child hash
 9984			 * table associated with this link
 9985			 */
 9986			for (j = 0; j < IXGBE_MAX_HW_ENTRIES; j++) {
 9987				if (!test_bit(j, jump->child_loc_map))
 9988					continue;
 9989				spin_lock(&adapter->fdir_perfect_lock);
 9990				err = ixgbe_update_ethtool_fdir_entry(adapter,
 9991								      NULL,
 9992								      j + 1);
 9993				spin_unlock(&adapter->fdir_perfect_lock);
 9994				clear_bit(j, jump->child_loc_map);
 9995			}
 9996			/* Remove resources for this link */
 9997			kfree(jump->input);
 9998			kfree(jump->mask);
 9999			kfree(jump);
10000			adapter->jump_tables[i] = NULL;
10001			return err;
10002		}
10003	}
10004
10005	spin_lock(&adapter->fdir_perfect_lock);
10006	err = ixgbe_update_ethtool_fdir_entry(adapter, NULL, loc);
10007	spin_unlock(&adapter->fdir_perfect_lock);
10008	return err;
10009}
10010
10011static int ixgbe_configure_clsu32_add_hnode(struct ixgbe_adapter *adapter,
10012					    struct tc_cls_u32_offload *cls)
10013{
10014	u32 uhtid = TC_U32_USERHTID(cls->hnode.handle);
10015
10016	if (uhtid >= IXGBE_MAX_LINK_HANDLE)
10017		return -EINVAL;
10018
10019	/* This ixgbe devices do not support hash tables at the moment
10020	 * so abort when given hash tables.
10021	 */
10022	if (cls->hnode.divisor > 0)
10023		return -EINVAL;
10024
10025	set_bit(uhtid - 1, &adapter->tables);
10026	return 0;
10027}
10028
10029static int ixgbe_configure_clsu32_del_hnode(struct ixgbe_adapter *adapter,
10030					    struct tc_cls_u32_offload *cls)
10031{
10032	u32 uhtid = TC_U32_USERHTID(cls->hnode.handle);
10033
10034	if (uhtid >= IXGBE_MAX_LINK_HANDLE)
10035		return -EINVAL;
10036
10037	clear_bit(uhtid - 1, &adapter->tables);
10038	return 0;
10039}
10040
10041#ifdef CONFIG_NET_CLS_ACT
10042struct upper_walk_data {
10043	struct ixgbe_adapter *adapter;
10044	u64 action;
10045	int ifindex;
10046	u8 queue;
10047};
10048
10049static int get_macvlan_queue(struct net_device *upper,
10050			     struct netdev_nested_priv *priv)
10051{
10052	if (netif_is_macvlan(upper)) {
10053		struct ixgbe_fwd_adapter *vadapter = macvlan_accel_priv(upper);
10054		struct ixgbe_adapter *adapter;
10055		struct upper_walk_data *data;
10056		int ifindex;
10057
10058		data = (struct upper_walk_data *)priv->data;
10059		ifindex = data->ifindex;
10060		adapter = data->adapter;
10061		if (vadapter && upper->ifindex == ifindex) {
10062			data->queue = adapter->rx_ring[vadapter->rx_base_queue]->reg_idx;
10063			data->action = data->queue;
10064			return 1;
10065		}
10066	}
10067
10068	return 0;
10069}
10070
10071static int handle_redirect_action(struct ixgbe_adapter *adapter, int ifindex,
10072				  u8 *queue, u64 *action)
10073{
10074	struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
10075	unsigned int num_vfs = adapter->num_vfs, vf;
10076	struct netdev_nested_priv priv;
10077	struct upper_walk_data data;
10078	struct net_device *upper;
10079
10080	/* redirect to a SRIOV VF */
10081	for (vf = 0; vf < num_vfs; ++vf) {
10082		upper = pci_get_drvdata(adapter->vfinfo[vf].vfdev);
10083		if (upper->ifindex == ifindex) {
10084			*queue = vf * __ALIGN_MASK(1, ~vmdq->mask);
10085			*action = vf + 1;
10086			*action <<= ETHTOOL_RX_FLOW_SPEC_RING_VF_OFF;
10087			return 0;
10088		}
10089	}
10090
10091	/* redirect to a offloaded macvlan netdev */
10092	data.adapter = adapter;
10093	data.ifindex = ifindex;
10094	data.action = 0;
10095	data.queue = 0;
10096	priv.data = (void *)&data;
10097	if (netdev_walk_all_upper_dev_rcu(adapter->netdev,
10098					  get_macvlan_queue, &priv)) {
10099		*action = data.action;
10100		*queue = data.queue;
10101
10102		return 0;
10103	}
10104
10105	return -EINVAL;
10106}
10107
10108static int parse_tc_actions(struct ixgbe_adapter *adapter,
10109			    struct tcf_exts *exts, u64 *action, u8 *queue)
10110{
10111	const struct tc_action *a;
10112	int i;
10113
10114	if (!tcf_exts_has_actions(exts))
10115		return -EINVAL;
10116
10117	tcf_exts_for_each_action(i, a, exts) {
10118		/* Drop action */
10119		if (is_tcf_gact_shot(a)) {
10120			*action = IXGBE_FDIR_DROP_QUEUE;
10121			*queue = IXGBE_FDIR_DROP_QUEUE;
10122			return 0;
10123		}
10124
10125		/* Redirect to a VF or a offloaded macvlan */
10126		if (is_tcf_mirred_egress_redirect(a)) {
10127			struct net_device *dev = tcf_mirred_dev(a);
10128
10129			if (!dev)
10130				return -EINVAL;
10131			return handle_redirect_action(adapter, dev->ifindex,
10132						      queue, action);
10133		}
10134
10135		return -EINVAL;
10136	}
10137
10138	return -EINVAL;
10139}
10140#else
10141static int parse_tc_actions(struct ixgbe_adapter *adapter,
10142			    struct tcf_exts *exts, u64 *action, u8 *queue)
10143{
10144	return -EINVAL;
10145}
10146#endif /* CONFIG_NET_CLS_ACT */
10147
10148static int ixgbe_clsu32_build_input(struct ixgbe_fdir_filter *input,
10149				    union ixgbe_atr_input *mask,
10150				    struct tc_cls_u32_offload *cls,
10151				    struct ixgbe_mat_field *field_ptr,
10152				    struct ixgbe_nexthdr *nexthdr)
10153{
10154	int i, j, off;
10155	__be32 val, m;
10156	bool found_entry = false, found_jump_field = false;
10157
10158	for (i = 0; i < cls->knode.sel->nkeys; i++) {
10159		off = cls->knode.sel->keys[i].off;
10160		val = cls->knode.sel->keys[i].val;
10161		m = cls->knode.sel->keys[i].mask;
10162
10163		for (j = 0; field_ptr[j].val; j++) {
10164			if (field_ptr[j].off == off) {
10165				field_ptr[j].val(input, mask, (__force u32)val,
10166						 (__force u32)m);
10167				input->filter.formatted.flow_type |=
10168					field_ptr[j].type;
10169				found_entry = true;
10170				break;
10171			}
10172		}
10173		if (nexthdr) {
10174			if (nexthdr->off == cls->knode.sel->keys[i].off &&
10175			    nexthdr->val ==
10176			    (__force u32)cls->knode.sel->keys[i].val &&
10177			    nexthdr->mask ==
10178			    (__force u32)cls->knode.sel->keys[i].mask)
10179				found_jump_field = true;
10180			else
10181				continue;
10182		}
10183	}
10184
10185	if (nexthdr && !found_jump_field)
10186		return -EINVAL;
10187
10188	if (!found_entry)
10189		return 0;
10190
10191	mask->formatted.flow_type = IXGBE_ATR_L4TYPE_IPV6_MASK |
10192				    IXGBE_ATR_L4TYPE_MASK;
10193
10194	if (input->filter.formatted.flow_type == IXGBE_ATR_FLOW_TYPE_IPV4)
10195		mask->formatted.flow_type &= IXGBE_ATR_L4TYPE_IPV6_MASK;
10196
10197	return 0;
10198}
10199
10200static int ixgbe_configure_clsu32(struct ixgbe_adapter *adapter,
10201				  struct tc_cls_u32_offload *cls)
10202{
10203	__be16 protocol = cls->common.protocol;
10204	u32 loc = cls->knode.handle & 0xfffff;
10205	struct ixgbe_hw *hw = &adapter->hw;
10206	struct ixgbe_mat_field *field_ptr;
10207	struct ixgbe_fdir_filter *input = NULL;
10208	union ixgbe_atr_input *mask = NULL;
10209	struct ixgbe_jump_table *jump = NULL;
10210	int i, err = -EINVAL;
10211	u8 queue;
10212	u32 uhtid, link_uhtid;
10213
10214	uhtid = TC_U32_USERHTID(cls->knode.handle);
10215	link_uhtid = TC_U32_USERHTID(cls->knode.link_handle);
10216
10217	/* At the moment cls_u32 jumps to network layer and skips past
10218	 * L2 headers. The canonical method to match L2 frames is to use
10219	 * negative values. However this is error prone at best but really
10220	 * just broken because there is no way to "know" what sort of hdr
10221	 * is in front of the network layer. Fix cls_u32 to support L2
10222	 * headers when needed.
10223	 */
10224	if (protocol != htons(ETH_P_IP))
10225		return err;
10226
10227	if (loc >= ((1024 << adapter->fdir_pballoc) - 2)) {
10228		e_err(drv, "Location out of range\n");
10229		return err;
10230	}
10231
10232	/* cls u32 is a graph starting at root node 0x800. The driver tracks
10233	 * links and also the fields used to advance the parser across each
10234	 * link (e.g. nexthdr/eat parameters from 'tc'). This way we can map
10235	 * the u32 graph onto the hardware parse graph denoted in ixgbe_model.h
10236	 * To add support for new nodes update ixgbe_model.h parse structures
10237	 * this function _should_ be generic try not to hardcode values here.
10238	 */
10239	if (uhtid == 0x800) {
10240		field_ptr = (adapter->jump_tables[0])->mat;
10241	} else {
10242		if (uhtid >= IXGBE_MAX_LINK_HANDLE)
10243			return err;
10244		if (!adapter->jump_tables[uhtid])
10245			return err;
10246		field_ptr = (adapter->jump_tables[uhtid])->mat;
10247	}
10248
10249	if (!field_ptr)
10250		return err;
10251
10252	/* At this point we know the field_ptr is valid and need to either
10253	 * build cls_u32 link or attach filter. Because adding a link to
10254	 * a handle that does not exist is invalid and the same for adding
10255	 * rules to handles that don't exist.
10256	 */
10257
10258	if (link_uhtid) {
10259		struct ixgbe_nexthdr *nexthdr = ixgbe_ipv4_jumps;
10260
10261		if (link_uhtid >= IXGBE_MAX_LINK_HANDLE)
10262			return err;
10263
10264		if (!test_bit(link_uhtid - 1, &adapter->tables))
10265			return err;
10266
10267		/* Multiple filters as links to the same hash table are not
10268		 * supported. To add a new filter with the same next header
10269		 * but different match/jump conditions, create a new hash table
10270		 * and link to it.
10271		 */
10272		if (adapter->jump_tables[link_uhtid] &&
10273		    (adapter->jump_tables[link_uhtid])->link_hdl) {
10274			e_err(drv, "Link filter exists for link: %x\n",
10275			      link_uhtid);
10276			return err;
10277		}
10278
10279		for (i = 0; nexthdr[i].jump; i++) {
10280			if (nexthdr[i].o != cls->knode.sel->offoff ||
10281			    nexthdr[i].s != cls->knode.sel->offshift ||
10282			    nexthdr[i].m !=
10283			    (__force u32)cls->knode.sel->offmask)
10284				return err;
10285
10286			jump = kzalloc(sizeof(*jump), GFP_KERNEL);
10287			if (!jump)
10288				return -ENOMEM;
10289			input = kzalloc(sizeof(*input), GFP_KERNEL);
10290			if (!input) {
10291				err = -ENOMEM;
10292				goto free_jump;
10293			}
10294			mask = kzalloc(sizeof(*mask), GFP_KERNEL);
10295			if (!mask) {
10296				err = -ENOMEM;
10297				goto free_input;
10298			}
10299			jump->input = input;
10300			jump->mask = mask;
10301			jump->link_hdl = cls->knode.handle;
10302
10303			err = ixgbe_clsu32_build_input(input, mask, cls,
10304						       field_ptr, &nexthdr[i]);
10305			if (!err) {
10306				jump->mat = nexthdr[i].jump;
10307				adapter->jump_tables[link_uhtid] = jump;
10308				break;
10309			} else {
10310				kfree(mask);
10311				kfree(input);
10312				kfree(jump);
10313			}
10314		}
10315		return 0;
10316	}
10317
10318	input = kzalloc(sizeof(*input), GFP_KERNEL);
10319	if (!input)
10320		return -ENOMEM;
10321	mask = kzalloc(sizeof(*mask), GFP_KERNEL);
10322	if (!mask) {
10323		err = -ENOMEM;
10324		goto free_input;
10325	}
10326
10327	if ((uhtid != 0x800) && (adapter->jump_tables[uhtid])) {
10328		if ((adapter->jump_tables[uhtid])->input)
10329			memcpy(input, (adapter->jump_tables[uhtid])->input,
10330			       sizeof(*input));
10331		if ((adapter->jump_tables[uhtid])->mask)
10332			memcpy(mask, (adapter->jump_tables[uhtid])->mask,
10333			       sizeof(*mask));
10334
10335		/* Lookup in all child hash tables if this location is already
10336		 * filled with a filter
10337		 */
10338		for (i = 1; i < IXGBE_MAX_LINK_HANDLE; i++) {
10339			struct ixgbe_jump_table *link = adapter->jump_tables[i];
10340
10341			if (link && (test_bit(loc - 1, link->child_loc_map))) {
10342				e_err(drv, "Filter exists in location: %x\n",
10343				      loc);
10344				err = -EINVAL;
10345				goto err_out;
10346			}
10347		}
10348	}
10349	err = ixgbe_clsu32_build_input(input, mask, cls, field_ptr, NULL);
10350	if (err)
10351		goto err_out;
10352
10353	err = parse_tc_actions(adapter, cls->knode.exts, &input->action,
10354			       &queue);
10355	if (err < 0)
10356		goto err_out;
10357
10358	input->sw_idx = loc;
10359
10360	spin_lock(&adapter->fdir_perfect_lock);
10361
10362	if (hlist_empty(&adapter->fdir_filter_list)) {
10363		memcpy(&adapter->fdir_mask, mask, sizeof(*mask));
10364		err = ixgbe_fdir_set_input_mask_82599(hw, mask);
10365		if (err)
10366			goto err_out_w_lock;
10367	} else if (memcmp(&adapter->fdir_mask, mask, sizeof(*mask))) {
10368		err = -EINVAL;
10369		goto err_out_w_lock;
10370	}
10371
10372	ixgbe_atr_compute_perfect_hash_82599(&input->filter, mask);
10373	err = ixgbe_fdir_write_perfect_filter_82599(hw, &input->filter,
10374						    input->sw_idx, queue);
10375	if (err)
10376		goto err_out_w_lock;
10377
10378	ixgbe_update_ethtool_fdir_entry(adapter, input, input->sw_idx);
10379	spin_unlock(&adapter->fdir_perfect_lock);
10380
10381	if ((uhtid != 0x800) && (adapter->jump_tables[uhtid]))
10382		set_bit(loc - 1, (adapter->jump_tables[uhtid])->child_loc_map);
10383
10384	kfree(mask);
10385	return err;
10386err_out_w_lock:
10387	spin_unlock(&adapter->fdir_perfect_lock);
10388err_out:
10389	kfree(mask);
10390free_input:
10391	kfree(input);
10392free_jump:
10393	kfree(jump);
10394	return err;
10395}
10396
10397static int ixgbe_setup_tc_cls_u32(struct ixgbe_adapter *adapter,
10398				  struct tc_cls_u32_offload *cls_u32)
10399{
10400	switch (cls_u32->command) {
10401	case TC_CLSU32_NEW_KNODE:
10402	case TC_CLSU32_REPLACE_KNODE:
10403		return ixgbe_configure_clsu32(adapter, cls_u32);
10404	case TC_CLSU32_DELETE_KNODE:
10405		return ixgbe_delete_clsu32(adapter, cls_u32);
10406	case TC_CLSU32_NEW_HNODE:
10407	case TC_CLSU32_REPLACE_HNODE:
10408		return ixgbe_configure_clsu32_add_hnode(adapter, cls_u32);
10409	case TC_CLSU32_DELETE_HNODE:
10410		return ixgbe_configure_clsu32_del_hnode(adapter, cls_u32);
10411	default:
10412		return -EOPNOTSUPP;
10413	}
10414}
10415
10416static int ixgbe_setup_tc_block_cb(enum tc_setup_type type, void *type_data,
10417				   void *cb_priv)
10418{
10419	struct ixgbe_adapter *adapter = cb_priv;
10420
10421	if (!tc_cls_can_offload_and_chain0(adapter->netdev, type_data))
10422		return -EOPNOTSUPP;
10423
10424	switch (type) {
10425	case TC_SETUP_CLSU32:
10426		return ixgbe_setup_tc_cls_u32(adapter, type_data);
10427	default:
10428		return -EOPNOTSUPP;
10429	}
10430}
10431
10432static int ixgbe_setup_tc_mqprio(struct net_device *dev,
10433				 struct tc_mqprio_qopt *mqprio)
10434{
10435	mqprio->hw = TC_MQPRIO_HW_OFFLOAD_TCS;
10436	return ixgbe_setup_tc(dev, mqprio->num_tc);
10437}
10438
10439static LIST_HEAD(ixgbe_block_cb_list);
10440
10441static int __ixgbe_setup_tc(struct net_device *dev, enum tc_setup_type type,
10442			    void *type_data)
10443{
10444	struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
10445
10446	switch (type) {
10447	case TC_SETUP_BLOCK:
10448		return flow_block_cb_setup_simple(type_data,
10449						  &ixgbe_block_cb_list,
10450						  ixgbe_setup_tc_block_cb,
10451						  adapter, adapter, true);
10452	case TC_SETUP_QDISC_MQPRIO:
10453		return ixgbe_setup_tc_mqprio(dev, type_data);
10454	default:
10455		return -EOPNOTSUPP;
10456	}
10457}
10458
10459#ifdef CONFIG_PCI_IOV
10460void ixgbe_sriov_reinit(struct ixgbe_adapter *adapter)
10461{
10462	struct net_device *netdev = adapter->netdev;
10463
10464	rtnl_lock();
10465	ixgbe_setup_tc(netdev, adapter->hw_tcs);
10466	rtnl_unlock();
10467}
10468
10469#endif
10470void ixgbe_do_reset(struct net_device *netdev)
10471{
10472	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
10473
10474	if (netif_running(netdev))
10475		ixgbe_reinit_locked(adapter);
10476	else
10477		ixgbe_reset(adapter);
10478}
10479
10480static netdev_features_t ixgbe_fix_features(struct net_device *netdev,
10481					    netdev_features_t features)
10482{
10483	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
10484
10485	/* If Rx checksum is disabled, then RSC/LRO should also be disabled */
10486	if (!(features & NETIF_F_RXCSUM))
10487		features &= ~NETIF_F_LRO;
10488
10489	/* Turn off LRO if not RSC capable */
10490	if (!(adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE))
10491		features &= ~NETIF_F_LRO;
10492
10493	if (adapter->xdp_prog && (features & NETIF_F_LRO)) {
10494		e_dev_err("LRO is not supported with XDP\n");
10495		features &= ~NETIF_F_LRO;
10496	}
10497
10498	return features;
10499}
10500
10501static void ixgbe_reset_l2fw_offload(struct ixgbe_adapter *adapter)
10502{
10503	int rss = min_t(int, ixgbe_max_rss_indices(adapter),
10504			num_online_cpus());
10505
10506	/* go back to full RSS if we're not running SR-IOV */
10507	if (!adapter->ring_feature[RING_F_VMDQ].offset)
10508		adapter->flags &= ~(IXGBE_FLAG_VMDQ_ENABLED |
10509				    IXGBE_FLAG_SRIOV_ENABLED);
10510
10511	adapter->ring_feature[RING_F_RSS].limit = rss;
10512	adapter->ring_feature[RING_F_VMDQ].limit = 1;
10513
10514	ixgbe_setup_tc(adapter->netdev, adapter->hw_tcs);
10515}
10516
10517static int ixgbe_set_features(struct net_device *netdev,
10518			      netdev_features_t features)
10519{
10520	struct ixgbe_adapter *adapter = ixgbe_from_netdev(netdev);
10521	netdev_features_t changed = netdev->features ^ features;
10522	bool need_reset = false;
10523
10524	/* Make sure RSC matches LRO, reset if change */
10525	if (!(features & NETIF_F_LRO)) {
10526		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
10527			need_reset = true;
10528		adapter->flags2 &= ~IXGBE_FLAG2_RSC_ENABLED;
10529	} else if ((adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE) &&
10530		   !(adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)) {
10531		if (adapter->rx_itr_setting == 1 ||
10532		    adapter->rx_itr_setting > IXGBE_MIN_RSC_ITR) {
10533			adapter->flags2 |= IXGBE_FLAG2_RSC_ENABLED;
10534			need_reset = true;
10535		} else if ((changed ^ features) & NETIF_F_LRO) {
10536			e_info(probe, "rx-usecs set too low, "
10537			       "disabling RSC\n");
10538		}
10539	}
10540
10541	/*
10542	 * Check if Flow Director n-tuple support or hw_tc support was
10543	 * enabled or disabled.  If the state changed, we need to reset.
10544	 */
10545	if ((features & NETIF_F_NTUPLE) || (features & NETIF_F_HW_TC)) {
10546		/* turn off ATR, enable perfect filters and reset */
10547		if (!(adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE))
10548			need_reset = true;
10549
10550		adapter->flags &= ~IXGBE_FLAG_FDIR_HASH_CAPABLE;
10551		adapter->flags |= IXGBE_FLAG_FDIR_PERFECT_CAPABLE;
10552	} else {
10553		/* turn off perfect filters, enable ATR and reset */
10554		if (adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE)
10555			need_reset = true;
10556
10557		adapter->flags &= ~IXGBE_FLAG_FDIR_PERFECT_CAPABLE;
10558
10559		/* We cannot enable ATR if SR-IOV is enabled */
10560		if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED ||
10561		    /* We cannot enable ATR if we have 2 or more tcs */
10562		    (adapter->hw_tcs > 1) ||
10563		    /* We cannot enable ATR if RSS is disabled */
10564		    (adapter->ring_feature[RING_F_RSS].limit <= 1) ||
10565		    /* A sample rate of 0 indicates ATR disabled */
10566		    (!adapter->atr_sample_rate))
10567			; /* do nothing not supported */
10568		else /* otherwise supported and set the flag */
10569			adapter->flags |= IXGBE_FLAG_FDIR_HASH_CAPABLE;
10570	}
10571
10572	if (changed & NETIF_F_RXALL)
10573		need_reset = true;
10574
10575	netdev->features = features;
10576
10577	if ((changed & NETIF_F_HW_L2FW_DOFFLOAD) && adapter->num_rx_pools > 1)
10578		ixgbe_reset_l2fw_offload(adapter);
10579	else if (need_reset)
10580		ixgbe_do_reset(netdev);
10581	else if (changed & (NETIF_F_HW_VLAN_CTAG_RX |
10582			    NETIF_F_HW_VLAN_CTAG_FILTER))
10583		ixgbe_set_rx_mode(netdev);
10584
10585	return 1;
10586}
10587
10588static int ixgbe_ndo_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
10589			     struct net_device *dev,
10590			     const unsigned char *addr, u16 vid,
10591			     u16 flags, bool *notified,
10592			     struct netlink_ext_ack *extack)
10593{
10594	/* guarantee we can provide a unique filter for the unicast address */
10595	if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) {
10596		struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
10597		u16 pool = VMDQ_P(0);
10598
10599		if (netdev_uc_count(dev) >= ixgbe_available_rars(adapter, pool))
10600			return -ENOMEM;
10601	}
10602
10603	return ndo_dflt_fdb_add(ndm, tb, dev, addr, vid, flags);
10604}
10605
10606/**
10607 * ixgbe_configure_bridge_mode - set various bridge modes
10608 * @adapter: the private structure
10609 * @mode: requested bridge mode
10610 *
10611 * Configure some settings require for various bridge modes.
10612 **/
10613static int ixgbe_configure_bridge_mode(struct ixgbe_adapter *adapter,
10614				       __u16 mode)
10615{
10616	struct ixgbe_hw *hw = &adapter->hw;
10617	unsigned int p, num_pools;
10618	u32 vmdctl;
10619
10620	switch (mode) {
10621	case BRIDGE_MODE_VEPA:
10622		/* disable Tx loopback, rely on switch hairpin mode */
10623		IXGBE_WRITE_REG(&adapter->hw, IXGBE_PFDTXGSWC, 0);
10624
10625		/* must enable Rx switching replication to allow multicast
10626		 * packet reception on all VFs, and to enable source address
10627		 * pruning.
10628		 */
10629		vmdctl = IXGBE_READ_REG(hw, IXGBE_VMD_CTL);
10630		vmdctl |= IXGBE_VT_CTL_REPLEN;
10631		IXGBE_WRITE_REG(hw, IXGBE_VMD_CTL, vmdctl);
10632
10633		/* enable Rx source address pruning. Note, this requires
10634		 * replication to be enabled or else it does nothing.
10635		 */
10636		num_pools = adapter->num_vfs + adapter->num_rx_pools;
10637		for (p = 0; p < num_pools; p++) {
10638			if (hw->mac.ops.set_source_address_pruning)
10639				hw->mac.ops.set_source_address_pruning(hw,
10640								       true,
10641								       p);
10642		}
10643		break;
10644	case BRIDGE_MODE_VEB:
10645		/* enable Tx loopback for internal VF/PF communication */
10646		IXGBE_WRITE_REG(&adapter->hw, IXGBE_PFDTXGSWC,
10647				IXGBE_PFDTXGSWC_VT_LBEN);
10648
10649		/* disable Rx switching replication unless we have SR-IOV
10650		 * virtual functions
10651		 */
10652		vmdctl = IXGBE_READ_REG(hw, IXGBE_VMD_CTL);
10653		if (!adapter->num_vfs)
10654			vmdctl &= ~IXGBE_VT_CTL_REPLEN;
10655		IXGBE_WRITE_REG(hw, IXGBE_VMD_CTL, vmdctl);
10656
10657		/* disable Rx source address pruning, since we don't expect to
10658		 * be receiving external loopback of our transmitted frames.
10659		 */
10660		num_pools = adapter->num_vfs + adapter->num_rx_pools;
10661		for (p = 0; p < num_pools; p++) {
10662			if (hw->mac.ops.set_source_address_pruning)
10663				hw->mac.ops.set_source_address_pruning(hw,
10664								       false,
10665								       p);
10666		}
10667		break;
10668	default:
10669		return -EINVAL;
10670	}
10671
10672	adapter->bridge_mode = mode;
10673
10674	e_info(drv, "enabling bridge mode: %s\n",
10675	       mode == BRIDGE_MODE_VEPA ? "VEPA" : "VEB");
10676
10677	return 0;
10678}
10679
10680static int ixgbe_ndo_bridge_setlink(struct net_device *dev,
10681				    struct nlmsghdr *nlh, u16 flags,
10682				    struct netlink_ext_ack *extack)
10683{
10684	struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
10685	struct nlattr *attr, *br_spec;
10686	int rem;
10687
10688	if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
10689		return -EOPNOTSUPP;
10690
10691	br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
10692	if (!br_spec)
10693		return -EINVAL;
10694
10695	nla_for_each_nested_type(attr, IFLA_BRIDGE_MODE, br_spec, rem) {
10696		__u16 mode = nla_get_u16(attr);
10697		int status = ixgbe_configure_bridge_mode(adapter, mode);
10698
10699		if (status)
10700			return status;
10701
10702		break;
10703	}
10704
10705	return 0;
10706}
10707
10708static int ixgbe_ndo_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq,
10709				    struct net_device *dev,
10710				    u32 filter_mask, int nlflags)
10711{
10712	struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
10713
10714	if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
10715		return 0;
10716
10717	return ndo_dflt_bridge_getlink(skb, pid, seq, dev,
10718				       adapter->bridge_mode, 0, 0, nlflags,
10719				       filter_mask, NULL);
10720}
10721
10722static void *ixgbe_fwd_add(struct net_device *pdev, struct net_device *vdev)
10723{
10724	struct ixgbe_adapter *adapter = ixgbe_from_netdev(pdev);
10725	struct ixgbe_fwd_adapter *accel;
10726	int tcs = adapter->hw_tcs ? : 1;
10727	int pool, err;
10728
10729	if (adapter->xdp_prog) {
10730		e_warn(probe, "L2FW offload is not supported with XDP\n");
10731		return ERR_PTR(-EINVAL);
10732	}
10733
10734	/* The hardware supported by ixgbe only filters on the destination MAC
10735	 * address. In order to avoid issues we only support offloading modes
10736	 * where the hardware can actually provide the functionality.
10737	 */
10738	if (!macvlan_supports_dest_filter(vdev))
10739		return ERR_PTR(-EMEDIUMTYPE);
10740
10741	/* We need to lock down the macvlan to be a single queue device so that
10742	 * we can reuse the tc_to_txq field in the macvlan netdev to represent
10743	 * the queue mapping to our netdev.
10744	 */
10745	if (netif_is_multiqueue(vdev))
10746		return ERR_PTR(-ERANGE);
10747
10748	pool = find_first_zero_bit(adapter->fwd_bitmask, adapter->num_rx_pools);
10749	if (pool == adapter->num_rx_pools) {
10750		u16 used_pools = adapter->num_vfs + adapter->num_rx_pools;
10751		u16 reserved_pools;
10752
10753		if (((adapter->flags & IXGBE_FLAG_DCB_ENABLED) &&
10754		     adapter->num_rx_pools >= (MAX_TX_QUEUES / tcs)) ||
10755		    adapter->num_rx_pools > IXGBE_MAX_MACVLANS)
10756			return ERR_PTR(-EBUSY);
10757
10758		/* Hardware has a limited number of available pools. Each VF,
10759		 * and the PF require a pool. Check to ensure we don't
10760		 * attempt to use more then the available number of pools.
10761		 */
10762		if (used_pools >= IXGBE_MAX_VF_FUNCTIONS)
10763			return ERR_PTR(-EBUSY);
10764
10765		/* Enable VMDq flag so device will be set in VM mode */
10766		adapter->flags |= IXGBE_FLAG_VMDQ_ENABLED |
10767				  IXGBE_FLAG_SRIOV_ENABLED;
10768
10769		/* Try to reserve as many queues per pool as possible,
10770		 * we start with the configurations that support 4 queues
10771		 * per pools, followed by 2, and then by just 1 per pool.
10772		 */
10773		if (used_pools < 32 && adapter->num_rx_pools < 16)
10774			reserved_pools = min_t(u16,
10775					       32 - used_pools,
10776					       16 - adapter->num_rx_pools);
10777		else if (adapter->num_rx_pools < 32)
10778			reserved_pools = min_t(u16,
10779					       64 - used_pools,
10780					       32 - adapter->num_rx_pools);
10781		else
10782			reserved_pools = 64 - used_pools;
10783
10784
10785		if (!reserved_pools)
10786			return ERR_PTR(-EBUSY);
10787
10788		adapter->ring_feature[RING_F_VMDQ].limit += reserved_pools;
10789
10790		/* Force reinit of ring allocation with VMDQ enabled */
10791		err = ixgbe_setup_tc(pdev, adapter->hw_tcs);
10792		if (err)
10793			return ERR_PTR(err);
10794
10795		if (pool >= adapter->num_rx_pools)
10796			return ERR_PTR(-ENOMEM);
10797	}
10798
10799	accel = kzalloc(sizeof(*accel), GFP_KERNEL);
10800	if (!accel)
10801		return ERR_PTR(-ENOMEM);
10802
10803	set_bit(pool, adapter->fwd_bitmask);
10804	netdev_set_sb_channel(vdev, pool);
10805	accel->pool = pool;
10806	accel->netdev = vdev;
10807
10808	if (!netif_running(pdev))
10809		return accel;
10810
10811	err = ixgbe_fwd_ring_up(adapter, accel);
10812	if (err)
10813		return ERR_PTR(err);
10814
10815	return accel;
10816}
10817
10818static void ixgbe_fwd_del(struct net_device *pdev, void *priv)
10819{
10820	struct ixgbe_fwd_adapter *accel = priv;
10821	struct ixgbe_adapter *adapter = ixgbe_from_netdev(pdev);
10822	unsigned int rxbase = accel->rx_base_queue;
10823	unsigned int i;
10824
10825	/* delete unicast filter associated with offloaded interface */
10826	ixgbe_del_mac_filter(adapter, accel->netdev->dev_addr,
10827			     VMDQ_P(accel->pool));
10828
10829	/* Allow remaining Rx packets to get flushed out of the
10830	 * Rx FIFO before we drop the netdev for the ring.
10831	 */
10832	usleep_range(10000, 20000);
10833
10834	for (i = 0; i < adapter->num_rx_queues_per_pool; i++) {
10835		struct ixgbe_ring *ring = adapter->rx_ring[rxbase + i];
10836		struct ixgbe_q_vector *qv = ring->q_vector;
10837
10838		/* Make sure we aren't processing any packets and clear
10839		 * netdev to shut down the ring.
10840		 */
10841		if (netif_running(adapter->netdev))
10842			napi_synchronize(&qv->napi);
10843		ring->netdev = NULL;
10844	}
10845
10846	/* unbind the queues and drop the subordinate channel config */
10847	netdev_unbind_sb_channel(pdev, accel->netdev);
10848	netdev_set_sb_channel(accel->netdev, 0);
10849
10850	clear_bit(accel->pool, adapter->fwd_bitmask);
10851	kfree(accel);
10852}
10853
10854#define IXGBE_MAX_MAC_HDR_LEN		127
10855#define IXGBE_MAX_NETWORK_HDR_LEN	511
10856
10857static netdev_features_t
10858ixgbe_features_check(struct sk_buff *skb, struct net_device *dev,
10859		     netdev_features_t features)
10860{
10861	unsigned int network_hdr_len, mac_hdr_len;
10862
10863	/* Make certain the headers can be described by a context descriptor */
10864	mac_hdr_len = skb_network_offset(skb);
10865	if (unlikely(mac_hdr_len > IXGBE_MAX_MAC_HDR_LEN))
10866		return features & ~(NETIF_F_HW_CSUM |
10867				    NETIF_F_SCTP_CRC |
10868				    NETIF_F_GSO_UDP_L4 |
10869				    NETIF_F_HW_VLAN_CTAG_TX |
10870				    NETIF_F_TSO |
10871				    NETIF_F_TSO6);
10872
10873	network_hdr_len = skb_checksum_start(skb) - skb_network_header(skb);
10874	if (unlikely(network_hdr_len >  IXGBE_MAX_NETWORK_HDR_LEN))
10875		return features & ~(NETIF_F_HW_CSUM |
10876				    NETIF_F_SCTP_CRC |
10877				    NETIF_F_GSO_UDP_L4 |
10878				    NETIF_F_TSO |
10879				    NETIF_F_TSO6);
10880
10881	/* We can only support IPV4 TSO in tunnels if we can mangle the
10882	 * inner IP ID field, so strip TSO if MANGLEID is not supported.
10883	 * IPsec offoad sets skb->encapsulation but still can handle
10884	 * the TSO, so it's the exception.
10885	 */
10886	if (skb->encapsulation && !(features & NETIF_F_TSO_MANGLEID)) {
10887#ifdef CONFIG_IXGBE_IPSEC
10888		if (!secpath_exists(skb))
10889#endif
10890			features &= ~NETIF_F_TSO;
10891	}
10892
10893	return features;
10894}
10895
10896static int ixgbe_xdp_setup(struct net_device *dev, struct bpf_prog *prog)
10897{
10898	int i, frame_size = dev->mtu + ETH_HLEN + ETH_FCS_LEN + VLAN_HLEN;
10899	struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
10900	struct bpf_prog *old_prog;
10901	bool need_reset;
10902	int num_queues;
10903
10904	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
10905		return -EINVAL;
10906
10907	if (adapter->flags & IXGBE_FLAG_DCB_ENABLED)
10908		return -EINVAL;
10909
10910	/* verify ixgbe ring attributes are sufficient for XDP */
10911	for (i = 0; i < adapter->num_rx_queues; i++) {
10912		struct ixgbe_ring *ring = adapter->rx_ring[i];
10913
10914		if (ring_is_rsc_enabled(ring))
10915			return -EINVAL;
10916
10917		if (frame_size > ixgbe_rx_bufsz(ring))
10918			return -EINVAL;
10919	}
10920
10921	/* if the number of cpus is much larger than the maximum of queues,
10922	 * we should stop it and then return with ENOMEM like before.
10923	 */
10924	if (nr_cpu_ids > IXGBE_MAX_XDP_QS * 2)
10925		return -ENOMEM;
10926
10927	old_prog = xchg(&adapter->xdp_prog, prog);
10928	need_reset = (!!prog != !!old_prog);
10929
10930	/* If transitioning XDP modes reconfigure rings */
10931	if (need_reset) {
10932		int err;
10933
10934		if (!prog)
10935			/* Wait until ndo_xsk_wakeup completes. */
10936			synchronize_rcu();
10937		err = ixgbe_setup_tc(dev, adapter->hw_tcs);
10938
10939		if (err)
10940			return -EINVAL;
10941		if (!prog)
10942			xdp_features_clear_redirect_target(dev);
10943	} else {
10944		for (i = 0; i < adapter->num_rx_queues; i++) {
10945			WRITE_ONCE(adapter->rx_ring[i]->xdp_prog,
10946				   adapter->xdp_prog);
10947		}
10948	}
10949
10950	if (old_prog)
10951		bpf_prog_put(old_prog);
10952
10953	/* Kick start the NAPI context if there is an AF_XDP socket open
10954	 * on that queue id. This so that receiving will start.
10955	 */
10956	if (need_reset && prog) {
10957		num_queues = min_t(int, adapter->num_rx_queues,
10958				   adapter->num_xdp_queues);
10959		for (i = 0; i < num_queues; i++)
10960			if (adapter->xdp_ring[i]->xsk_pool)
10961				(void)ixgbe_xsk_wakeup(adapter->netdev, i,
10962						       XDP_WAKEUP_RX);
10963		xdp_features_set_redirect_target(dev, true);
10964	}
10965
10966	return 0;
10967}
10968
10969static int ixgbe_xdp(struct net_device *dev, struct netdev_bpf *xdp)
10970{
10971	struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
10972
10973	switch (xdp->command) {
10974	case XDP_SETUP_PROG:
10975		return ixgbe_xdp_setup(dev, xdp->prog);
10976	case XDP_SETUP_XSK_POOL:
10977		return ixgbe_xsk_pool_setup(adapter, xdp->xsk.pool,
10978					    xdp->xsk.queue_id);
10979
10980	default:
10981		return -EINVAL;
10982	}
10983}
10984
10985void ixgbe_xdp_ring_update_tail(struct ixgbe_ring *ring)
10986{
10987	/* Force memory writes to complete before letting h/w know there
10988	 * are new descriptors to fetch.
10989	 */
10990	wmb();
10991	writel(ring->next_to_use, ring->tail);
10992}
10993
10994void ixgbe_xdp_ring_update_tail_locked(struct ixgbe_ring *ring)
10995{
10996	if (static_branch_unlikely(&ixgbe_xdp_locking_key))
10997		spin_lock(&ring->tx_lock);
10998	ixgbe_xdp_ring_update_tail(ring);
10999	if (static_branch_unlikely(&ixgbe_xdp_locking_key))
11000		spin_unlock(&ring->tx_lock);
11001}
11002
11003static int ixgbe_xdp_xmit(struct net_device *dev, int n,
11004			  struct xdp_frame **frames, u32 flags)
11005{
11006	struct ixgbe_adapter *adapter = ixgbe_from_netdev(dev);
11007	struct ixgbe_ring *ring;
11008	int nxmit = 0;
11009	int i;
11010
11011	if (unlikely(test_bit(__IXGBE_DOWN, &adapter->state)))
11012		return -ENETDOWN;
11013
11014	if (!netif_carrier_ok(adapter->netdev) ||
11015	    !netif_running(adapter->netdev))
11016		return -ENETDOWN;
11017
11018	if (unlikely(flags & ~XDP_XMIT_FLAGS_MASK))
11019		return -EINVAL;
11020
11021	/* During program transitions its possible adapter->xdp_prog is assigned
11022	 * but ring has not been configured yet. In this case simply abort xmit.
11023	 */
11024	ring = adapter->xdp_prog ? ixgbe_determine_xdp_ring(adapter) : NULL;
11025	if (unlikely(!ring))
11026		return -ENXIO;
11027
11028	if (unlikely(test_bit(__IXGBE_TX_DISABLED, &ring->state)))
11029		return -ENXIO;
11030
11031	if (static_branch_unlikely(&ixgbe_xdp_locking_key))
11032		spin_lock(&ring->tx_lock);
11033
11034	for (i = 0; i < n; i++) {
11035		struct xdp_frame *xdpf = frames[i];
11036		int err;
11037
11038		err = ixgbe_xmit_xdp_ring(ring, xdpf);
11039		if (err != IXGBE_XDP_TX)
11040			break;
11041		nxmit++;
11042	}
11043
11044	if (unlikely(flags & XDP_XMIT_FLUSH))
11045		ixgbe_xdp_ring_update_tail(ring);
11046
11047	if (static_branch_unlikely(&ixgbe_xdp_locking_key))
11048		spin_unlock(&ring->tx_lock);
11049
11050	return nxmit;
11051}
11052
11053static const struct net_device_ops ixgbe_netdev_ops = {
11054	.ndo_open		= ixgbe_open,
11055	.ndo_stop		= ixgbe_close,
11056	.ndo_start_xmit		= ixgbe_xmit_frame,
11057	.ndo_set_rx_mode	= ixgbe_set_rx_mode,
11058	.ndo_validate_addr	= eth_validate_addr,
11059	.ndo_set_mac_address	= ixgbe_set_mac,
11060	.ndo_change_mtu		= ixgbe_change_mtu,
11061	.ndo_tx_timeout		= ixgbe_tx_timeout,
11062	.ndo_set_tx_maxrate	= ixgbe_tx_maxrate,
11063	.ndo_vlan_rx_add_vid	= ixgbe_vlan_rx_add_vid,
11064	.ndo_vlan_rx_kill_vid	= ixgbe_vlan_rx_kill_vid,
11065	.ndo_eth_ioctl		= ixgbe_ioctl,
11066	.ndo_set_vf_mac		= ixgbe_ndo_set_vf_mac,
11067	.ndo_set_vf_vlan	= ixgbe_ndo_set_vf_vlan,
11068	.ndo_set_vf_rate	= ixgbe_ndo_set_vf_bw,
11069	.ndo_set_vf_spoofchk	= ixgbe_ndo_set_vf_spoofchk,
11070	.ndo_set_vf_link_state	= ixgbe_ndo_set_vf_link_state,
11071	.ndo_set_vf_rss_query_en = ixgbe_ndo_set_vf_rss_query_en,
11072	.ndo_set_vf_trust	= ixgbe_ndo_set_vf_trust,
11073	.ndo_get_vf_config	= ixgbe_ndo_get_vf_config,
11074	.ndo_get_vf_stats	= ixgbe_ndo_get_vf_stats,
11075	.ndo_get_stats64	= ixgbe_get_stats64,
11076	.ndo_setup_tc		= __ixgbe_setup_tc,
11077#ifdef IXGBE_FCOE
11078	.ndo_select_queue	= ixgbe_select_queue,
11079	.ndo_fcoe_ddp_setup = ixgbe_fcoe_ddp_get,
11080	.ndo_fcoe_ddp_target = ixgbe_fcoe_ddp_target,
11081	.ndo_fcoe_ddp_done = ixgbe_fcoe_ddp_put,
11082	.ndo_fcoe_enable = ixgbe_fcoe_enable,
11083	.ndo_fcoe_disable = ixgbe_fcoe_disable,
11084	.ndo_fcoe_get_wwn = ixgbe_fcoe_get_wwn,
11085	.ndo_fcoe_get_hbainfo = ixgbe_fcoe_get_hbainfo,
11086#endif /* IXGBE_FCOE */
11087	.ndo_set_features = ixgbe_set_features,
11088	.ndo_fix_features = ixgbe_fix_features,
11089	.ndo_fdb_add		= ixgbe_ndo_fdb_add,
11090	.ndo_bridge_setlink	= ixgbe_ndo_bridge_setlink,
11091	.ndo_bridge_getlink	= ixgbe_ndo_bridge_getlink,
11092	.ndo_dfwd_add_station	= ixgbe_fwd_add,
11093	.ndo_dfwd_del_station	= ixgbe_fwd_del,
11094	.ndo_features_check	= ixgbe_features_check,
11095	.ndo_bpf		= ixgbe_xdp,
11096	.ndo_xdp_xmit		= ixgbe_xdp_xmit,
11097	.ndo_xsk_wakeup         = ixgbe_xsk_wakeup,
11098	.ndo_hwtstamp_get	= ixgbe_ptp_hwtstamp_get,
11099	.ndo_hwtstamp_set	= ixgbe_ptp_hwtstamp_set,
11100};
11101
11102static void ixgbe_disable_txr_hw(struct ixgbe_adapter *adapter,
11103				 struct ixgbe_ring *tx_ring)
11104{
11105	unsigned long wait_delay, delay_interval;
11106	struct ixgbe_hw *hw = &adapter->hw;
11107	u8 reg_idx = tx_ring->reg_idx;
11108	int wait_loop;
11109	u32 txdctl;
11110
11111	IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), IXGBE_TXDCTL_SWFLSH);
11112
11113	/* delay mechanism from ixgbe_disable_tx */
11114	delay_interval = ixgbe_get_completion_timeout(adapter) / 100;
11115
11116	wait_loop = IXGBE_MAX_RX_DESC_POLL;
11117	wait_delay = delay_interval;
11118
11119	while (wait_loop--) {
11120		usleep_range(wait_delay, wait_delay + 10);
11121		wait_delay += delay_interval * 2;
11122		txdctl = IXGBE_READ_REG(hw, IXGBE_TXDCTL(reg_idx));
11123
11124		if (!(txdctl & IXGBE_TXDCTL_ENABLE))
11125			return;
11126	}
11127
11128	e_err(drv, "TXDCTL.ENABLE not cleared within the polling period\n");
11129}
11130
11131static void ixgbe_disable_txr(struct ixgbe_adapter *adapter,
11132			      struct ixgbe_ring *tx_ring)
11133{
11134	set_bit(__IXGBE_TX_DISABLED, &tx_ring->state);
11135	ixgbe_disable_txr_hw(adapter, tx_ring);
11136}
11137
11138static void ixgbe_disable_rxr_hw(struct ixgbe_adapter *adapter,
11139				 struct ixgbe_ring *rx_ring)
11140{
11141	unsigned long wait_delay, delay_interval;
11142	struct ixgbe_hw *hw = &adapter->hw;
11143	u8 reg_idx = rx_ring->reg_idx;
11144	int wait_loop;
11145	u32 rxdctl;
11146
11147	rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
11148	rxdctl &= ~IXGBE_RXDCTL_ENABLE;
11149	rxdctl |= IXGBE_RXDCTL_SWFLSH;
11150
11151	/* write value back with RXDCTL.ENABLE bit cleared */
11152	IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(reg_idx), rxdctl);
11153
11154	/* RXDCTL.EN may not change on 82598 if link is down, so skip it */
11155	if (hw->mac.type == ixgbe_mac_82598EB &&
11156	    !(IXGBE_READ_REG(hw, IXGBE_LINKS) & IXGBE_LINKS_UP))
11157		return;
11158
11159	/* delay mechanism from ixgbe_disable_rx */
11160	delay_interval = ixgbe_get_completion_timeout(adapter) / 100;
11161
11162	wait_loop = IXGBE_MAX_RX_DESC_POLL;
11163	wait_delay = delay_interval;
11164
11165	while (wait_loop--) {
11166		usleep_range(wait_delay, wait_delay + 10);
11167		wait_delay += delay_interval * 2;
11168		rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
11169
11170		if (!(rxdctl & IXGBE_RXDCTL_ENABLE))
11171			return;
11172	}
11173
11174	e_err(drv, "RXDCTL.ENABLE not cleared within the polling period\n");
11175}
11176
11177static void ixgbe_reset_txr_stats(struct ixgbe_ring *tx_ring)
11178{
11179	memset(&tx_ring->stats, 0, sizeof(tx_ring->stats));
11180	memset(&tx_ring->tx_stats, 0, sizeof(tx_ring->tx_stats));
11181}
11182
11183static void ixgbe_reset_rxr_stats(struct ixgbe_ring *rx_ring)
11184{
11185	memset(&rx_ring->stats, 0, sizeof(rx_ring->stats));
11186	memset(&rx_ring->rx_stats, 0, sizeof(rx_ring->rx_stats));
11187}
11188
11189/**
11190 * ixgbe_irq_disable_single - Disable single IRQ vector
11191 * @adapter: adapter structure
11192 * @ring: ring index
11193 **/
11194static void ixgbe_irq_disable_single(struct ixgbe_adapter *adapter, u32 ring)
11195{
11196	struct ixgbe_hw *hw = &adapter->hw;
11197	u64 qmask = BIT_ULL(ring);
11198	u32 mask;
11199
11200	switch (adapter->hw.mac.type) {
11201	case ixgbe_mac_82598EB:
11202		mask = qmask & IXGBE_EIMC_RTX_QUEUE;
11203		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, mask);
11204		break;
11205	case ixgbe_mac_82599EB:
11206	case ixgbe_mac_X540:
11207	case ixgbe_mac_X550:
11208	case ixgbe_mac_X550EM_x:
11209	case ixgbe_mac_x550em_a:
11210		mask = (qmask & 0xFFFFFFFF);
11211		if (mask)
11212			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(0), mask);
11213		mask = (qmask >> 32);
11214		if (mask)
11215			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(1), mask);
11216		break;
11217	default:
11218		break;
11219	}
11220	IXGBE_WRITE_FLUSH(&adapter->hw);
11221	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
11222		synchronize_irq(adapter->msix_entries[ring].vector);
11223	else
11224		synchronize_irq(adapter->pdev->irq);
11225}
11226
11227/**
11228 * ixgbe_txrx_ring_disable - Disable Rx/Tx/XDP Tx rings
11229 * @adapter: adapter structure
11230 * @ring: ring index
11231 *
11232 * This function disables a certain Rx/Tx/XDP Tx ring. The function
11233 * assumes that the netdev is running.
11234 **/
11235void ixgbe_txrx_ring_disable(struct ixgbe_adapter *adapter, int ring)
11236{
11237	struct ixgbe_ring *rx_ring, *tx_ring, *xdp_ring;
11238
11239	rx_ring = adapter->rx_ring[ring];
11240	tx_ring = adapter->tx_ring[ring];
11241	xdp_ring = adapter->xdp_ring[ring];
11242
11243	ixgbe_irq_disable_single(adapter, ring);
11244
11245	/* Rx/Tx/XDP Tx share the same napi context. */
11246	napi_disable(&rx_ring->q_vector->napi);
11247
11248	ixgbe_disable_txr(adapter, tx_ring);
11249	if (xdp_ring)
11250		ixgbe_disable_txr(adapter, xdp_ring);
11251	ixgbe_disable_rxr_hw(adapter, rx_ring);
11252
11253	if (xdp_ring)
11254		synchronize_rcu();
11255
11256	ixgbe_clean_tx_ring(tx_ring);
11257	if (xdp_ring)
11258		ixgbe_clean_tx_ring(xdp_ring);
11259	ixgbe_clean_rx_ring(rx_ring);
11260
11261	ixgbe_reset_txr_stats(tx_ring);
11262	if (xdp_ring)
11263		ixgbe_reset_txr_stats(xdp_ring);
11264	ixgbe_reset_rxr_stats(rx_ring);
11265}
11266
11267/**
11268 * ixgbe_txrx_ring_enable - Enable Rx/Tx/XDP Tx rings
11269 * @adapter: adapter structure
11270 * @ring: ring index
11271 *
11272 * This function enables a certain Rx/Tx/XDP Tx ring. The function
11273 * assumes that the netdev is running.
11274 **/
11275void ixgbe_txrx_ring_enable(struct ixgbe_adapter *adapter, int ring)
11276{
11277	struct ixgbe_ring *rx_ring, *tx_ring, *xdp_ring;
11278
11279	rx_ring = adapter->rx_ring[ring];
11280	tx_ring = adapter->tx_ring[ring];
11281	xdp_ring = adapter->xdp_ring[ring];
11282
11283	ixgbe_configure_tx_ring(adapter, tx_ring);
11284	if (xdp_ring)
11285		ixgbe_configure_tx_ring(adapter, xdp_ring);
11286	ixgbe_configure_rx_ring(adapter, rx_ring);
11287
11288	clear_bit(__IXGBE_TX_DISABLED, &tx_ring->state);
11289	if (xdp_ring)
11290		clear_bit(__IXGBE_TX_DISABLED, &xdp_ring->state);
11291
11292	/* Rx/Tx/XDP Tx share the same napi context. */
11293	napi_enable(&rx_ring->q_vector->napi);
11294	ixgbe_irq_enable_queues(adapter, BIT_ULL(ring));
11295	IXGBE_WRITE_FLUSH(&adapter->hw);
11296}
11297
11298/**
11299 * ixgbe_enumerate_functions - Get the number of ports this device has
11300 * @adapter: adapter structure
11301 *
11302 * This function enumerates the physical functions co-located on a single slot,
11303 * in order to determine how many ports a device has. This is most useful in
11304 * determining the required GT/s of PCIe bandwidth necessary for optimal
11305 * performance.
11306 **/
11307static inline int ixgbe_enumerate_functions(struct ixgbe_adapter *adapter)
11308{
11309	struct pci_dev *entry, *pdev = adapter->pdev;
11310	int physfns = 0;
11311
11312	/* Some cards can not use the generic count PCIe functions method,
11313	 * because they are behind a parent switch, so we hardcode these with
11314	 * the correct number of functions.
11315	 */
11316	if (ixgbe_pcie_from_parent(&adapter->hw))
11317		physfns = 4;
11318
11319	list_for_each_entry(entry, &adapter->pdev->bus->devices, bus_list) {
11320		/* don't count virtual functions */
11321		if (entry->is_virtfn)
11322			continue;
11323
11324		/* When the devices on the bus don't all match our device ID,
11325		 * we can't reliably determine the correct number of
11326		 * functions. This can occur if a function has been direct
11327		 * attached to a virtual machine using VT-d, for example. In
11328		 * this case, simply return -1 to indicate this.
11329		 */
11330		if ((entry->vendor != pdev->vendor) ||
11331		    (entry->device != pdev->device))
11332			return -1;
11333
11334		physfns++;
11335	}
11336
11337	return physfns;
11338}
11339
11340/**
11341 * ixgbe_wol_supported - Check whether device supports WoL
11342 * @adapter: the adapter private structure
11343 * @device_id: the device ID
11344 * @subdevice_id: the subsystem device ID
11345 *
11346 * This function is used by probe and ethtool to determine
11347 * which devices have WoL support
11348 *
11349 **/
11350bool ixgbe_wol_supported(struct ixgbe_adapter *adapter, u16 device_id,
11351			 u16 subdevice_id)
11352{
11353	struct ixgbe_hw *hw = &adapter->hw;
11354	u16 wol_cap = adapter->eeprom_cap & IXGBE_DEVICE_CAPS_WOL_MASK;
11355
11356	/* WOL not supported on 82598 */
11357	if (hw->mac.type == ixgbe_mac_82598EB)
11358		return false;
11359
11360	/* check eeprom to see if WOL is enabled for X540 and newer */
11361	if (hw->mac.type >= ixgbe_mac_X540) {
11362		if ((wol_cap == IXGBE_DEVICE_CAPS_WOL_PORT0_1) ||
11363		    ((wol_cap == IXGBE_DEVICE_CAPS_WOL_PORT0) &&
11364		     (hw->bus.func == 0)))
11365			return true;
11366	}
11367
11368	/* WOL is determined based on device IDs for 82599 MACs */
11369	switch (device_id) {
11370	case IXGBE_DEV_ID_82599_SFP:
11371		/* Only these subdevices could supports WOL */
11372		switch (subdevice_id) {
11373		case IXGBE_SUBDEV_ID_82599_560FLR:
11374		case IXGBE_SUBDEV_ID_82599_LOM_SNAP6:
11375		case IXGBE_SUBDEV_ID_82599_SFP_WOL0:
11376		case IXGBE_SUBDEV_ID_82599_SFP_2OCP:
11377			/* only support first port */
11378			if (hw->bus.func != 0)
11379				break;
11380			fallthrough;
11381		case IXGBE_SUBDEV_ID_82599_SP_560FLR:
11382		case IXGBE_SUBDEV_ID_82599_SFP:
11383		case IXGBE_SUBDEV_ID_82599_RNDC:
11384		case IXGBE_SUBDEV_ID_82599_ECNA_DP:
11385		case IXGBE_SUBDEV_ID_82599_SFP_1OCP:
11386		case IXGBE_SUBDEV_ID_82599_SFP_LOM_OEM1:
11387		case IXGBE_SUBDEV_ID_82599_SFP_LOM_OEM2:
11388			return true;
11389		}
11390		break;
11391	case IXGBE_DEV_ID_82599EN_SFP:
11392		/* Only these subdevices support WOL */
11393		switch (subdevice_id) {
11394		case IXGBE_SUBDEV_ID_82599EN_SFP_OCP1:
11395			return true;
11396		}
11397		break;
11398	case IXGBE_DEV_ID_82599_COMBO_BACKPLANE:
11399		/* All except this subdevice support WOL */
11400		if (subdevice_id != IXGBE_SUBDEV_ID_82599_KX4_KR_MEZZ)
11401			return true;
11402		break;
11403	case IXGBE_DEV_ID_82599_KX4:
11404		return  true;
11405	default:
11406		break;
11407	}
11408
11409	return false;
11410}
11411
11412/**
11413 * ixgbe_set_fw_version_e610 - Set FW version specifically on E610 adapters
11414 * @adapter: the adapter private structure
11415 *
11416 * This function is used by probe and ethtool to determine the FW version to
11417 * format to display. The FW version is taken from the EEPROM/NVM.
11418 *
11419 */
11420void ixgbe_set_fw_version_e610(struct ixgbe_adapter *adapter)
11421{
11422	struct ixgbe_orom_info *orom = &adapter->hw.flash.orom;
11423	struct ixgbe_nvm_info *nvm = &adapter->hw.flash.nvm;
11424
11425	snprintf(adapter->eeprom_id, sizeof(adapter->eeprom_id),
11426		 "%x.%02x 0x%x %d.%d.%d", nvm->major, nvm->minor,
11427		 nvm->eetrack, orom->major, orom->build, orom->patch);
11428}
11429
11430/**
11431 * ixgbe_set_fw_version - Set FW version
11432 * @adapter: the adapter private structure
11433 *
11434 * This function is used by probe and ethtool to determine the FW version to
11435 * format to display. The FW version is taken from the EEPROM/NVM.
11436 */
11437static void ixgbe_set_fw_version(struct ixgbe_adapter *adapter)
11438{
11439	struct ixgbe_hw *hw = &adapter->hw;
11440	struct ixgbe_nvm_version nvm_ver;
11441
11442	if (adapter->hw.mac.type == ixgbe_mac_e610) {
11443		ixgbe_set_fw_version_e610(adapter);
11444		return;
11445	}
11446
11447	ixgbe_get_oem_prod_version(hw, &nvm_ver);
11448	if (nvm_ver.oem_valid) {
11449		snprintf(adapter->eeprom_id, sizeof(adapter->eeprom_id),
11450			 "%x.%x.%x", nvm_ver.oem_major, nvm_ver.oem_minor,
11451			 nvm_ver.oem_release);
11452		return;
11453	}
11454
11455	ixgbe_get_etk_id(hw, &nvm_ver);
11456	ixgbe_get_orom_version(hw, &nvm_ver);
11457
11458	if (nvm_ver.or_valid) {
11459		snprintf(adapter->eeprom_id, sizeof(adapter->eeprom_id),
11460			 "0x%08x, %d.%d.%d", nvm_ver.etk_id, nvm_ver.or_major,
11461			 nvm_ver.or_build, nvm_ver.or_patch);
11462		return;
11463	}
11464
11465	/* Set ETrack ID format */
11466	snprintf(adapter->eeprom_id, sizeof(adapter->eeprom_id),
11467		 "0x%08x", nvm_ver.etk_id);
11468}
11469
11470/**
11471 * ixgbe_recovery_probe - Handle FW recovery mode during probe
11472 * @adapter: the adapter private structure
11473 *
11474 * Perform limited driver initialization when FW error is detected.
11475 *
11476 * Return: 0 on successful probe for E610, -EIO if recovery mode is detected
11477 * for non-E610 adapter, error status code on any other case.
11478 */
11479static int ixgbe_recovery_probe(struct ixgbe_adapter *adapter)
11480{
11481	struct pci_dev *pdev = adapter->pdev;
11482	struct ixgbe_hw *hw = &adapter->hw;
11483	int err = -EIO;
11484
11485	if (hw->mac.type != ixgbe_mac_e610)
11486		return err;
11487
11488	ixgbe_get_hw_control(adapter);
11489	err = ixgbe_get_flash_data(&adapter->hw);
11490	if (err)
11491		goto err_release_hw_control;
11492
11493	timer_setup(&adapter->service_timer, ixgbe_service_timer, 0);
11494	INIT_WORK(&adapter->service_task, ixgbe_recovery_service_task);
11495	set_bit(__IXGBE_SERVICE_INITED, &adapter->state);
11496	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
11497
11498	if (hw->mac.ops.get_bus_info)
11499		hw->mac.ops.get_bus_info(hw);
11500
11501	pci_set_drvdata(pdev, adapter);
11502	/* We are creating devlink interface so NIC can be managed,
11503	 * e.g. new NVM image loaded
11504	 */
11505	devl_lock(adapter->devlink);
11506	ixgbe_devlink_register_port(adapter);
11507	SET_NETDEV_DEVLINK_PORT(adapter->netdev,
11508				&adapter->devlink_port);
11509	ixgbe_devlink_init_regions(adapter);
11510	devl_register(adapter->devlink);
11511	devl_unlock(adapter->devlink);
11512
11513	return 0;
11514err_release_hw_control:
11515	ixgbe_release_hw_control(adapter);
11516	return err;
11517}
11518
11519/**
11520 * ixgbe_probe - Device Initialization Routine
11521 * @pdev: PCI device information struct
11522 * @ent: entry in ixgbe_pci_tbl
11523 *
11524 * Returns 0 on success, negative on failure
11525 *
11526 * ixgbe_probe initializes an adapter identified by a pci_dev structure.
11527 * The OS initialization, configuring of the adapter private structure,
11528 * and a hardware reset occur.
11529 **/
11530static int ixgbe_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
11531{
11532	struct net_device *netdev;
11533	struct ixgbe_netdevice_priv *netdev_priv_wrapper;
11534	struct ixgbe_adapter *adapter = NULL;
11535	struct ixgbe_hw *hw;
11536	const struct ixgbe_info *ii = ixgbe_info_tbl[ent->driver_data];
11537	unsigned int indices = MAX_TX_QUEUES;
11538	u8 part_str[IXGBE_PBANUM_LENGTH];
11539	int i, err, expected_gts;
11540	bool disable_dev = false;
11541#ifdef IXGBE_FCOE
11542	u16 device_caps;
11543#endif
11544	u32 eec;
11545
11546	/* Catch broken hardware that put the wrong VF device ID in
11547	 * the PCIe SR-IOV capability.
11548	 */
11549	if (pdev->is_virtfn) {
11550		WARN(1, KERN_ERR "%s (%hx:%hx) should not be a VF!\n",
11551		     pci_name(pdev), pdev->vendor, pdev->device);
11552		return -EINVAL;
11553	}
11554
11555	err = pci_enable_device_mem(pdev);
11556	if (err)
11557		return err;
11558
11559	err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
11560	if (err) {
11561		dev_err(&pdev->dev,
11562			"No usable DMA configuration, aborting\n");
11563		goto err_dma;
11564	}
11565
11566	err = pci_request_mem_regions(pdev, ixgbe_driver_name);
11567	if (err) {
11568		dev_err(&pdev->dev,
11569			"pci_request_selected_regions failed 0x%x\n", err);
11570		goto err_pci_reg;
11571	}
11572
11573	pci_set_master(pdev);
11574	pci_save_state(pdev);
11575
11576	if (ii->mac == ixgbe_mac_82598EB) {
11577#ifdef CONFIG_IXGBE_DCB
11578		/* 8 TC w/ 4 queues per TC */
11579		indices = 4 * MAX_TRAFFIC_CLASS;
11580#else
11581		indices = IXGBE_MAX_RSS_INDICES;
11582#endif
11583	} else if (ii->mac == ixgbe_mac_e610) {
11584		indices = IXGBE_MAX_RSS_INDICES_X550;
11585	}
11586
11587	adapter = ixgbe_allocate_devlink(&pdev->dev);
11588	if (IS_ERR(adapter)) {
11589		err = PTR_ERR(adapter);
11590		goto err_devlink;
11591	}
11592
11593	netdev = alloc_etherdev_mq(sizeof(*netdev_priv_wrapper), indices);
11594	if (!netdev) {
11595		err = -ENOMEM;
11596		goto err_alloc_etherdev;
11597	}
11598
11599	SET_NETDEV_DEV(netdev, &pdev->dev);
11600
11601	netdev_priv_wrapper = netdev_priv(netdev);
11602	netdev_priv_wrapper->adapter = adapter;
11603
11604	adapter->netdev = netdev;
11605	adapter->pdev = pdev;
11606	hw = &adapter->hw;
11607	hw->back = adapter;
11608	adapter->msg_enable = netif_msg_init(debug, DEFAULT_MSG_ENABLE);
11609
11610	hw->hw_addr = ioremap(pci_resource_start(pdev, 0),
11611			      pci_resource_len(pdev, 0));
11612	adapter->io_addr = hw->hw_addr;
11613	if (!hw->hw_addr) {
11614		err = -EIO;
11615		goto err_ioremap;
11616	}
11617
11618	/* Setup hw api */
11619	hw->mac.ops   = *ii->mac_ops;
11620	hw->mac.type  = ii->mac;
11621	hw->mvals     = ii->mvals;
11622	if (ii->link_ops)
11623		hw->link.ops  = *ii->link_ops;
11624
11625	/* EEPROM */
11626	hw->eeprom.ops = *ii->eeprom_ops;
11627	eec = IXGBE_READ_REG(hw, IXGBE_EEC(hw));
11628	if (ixgbe_removed(hw->hw_addr)) {
11629		err = -EIO;
11630		goto err_ioremap;
11631	}
11632	/* If EEPROM is valid (bit 8 = 1), use default otherwise use bit bang */
11633	if (!(eec & BIT(8)))
11634		hw->eeprom.ops.read = &ixgbe_read_eeprom_bit_bang_generic;
11635
11636	/* PHY */
11637	hw->phy.ops = *ii->phy_ops;
11638	hw->phy.sfp_type = ixgbe_sfp_type_unknown;
11639	/* ixgbe_identify_phy_generic will set prtad and mmds properly */
11640	hw->phy.mdio.prtad = MDIO_PRTAD_NONE;
11641	hw->phy.mdio.mmds = 0;
11642	hw->phy.mdio.mode_support = MDIO_SUPPORTS_C45 | MDIO_EMULATE_C22;
11643	hw->phy.mdio.dev = netdev;
11644	hw->phy.mdio.mdio_read = ixgbe_mdio_read;
11645	hw->phy.mdio.mdio_write = ixgbe_mdio_write;
11646
11647	netdev->netdev_ops = &ixgbe_netdev_ops;
11648	ixgbe_set_ethtool_ops(netdev);
11649	netdev->watchdog_timeo = 5 * HZ;
11650	strscpy(netdev->name, pci_name(pdev), sizeof(netdev->name));
11651
11652	/* setup the private structure */
11653	err = ixgbe_sw_init(adapter, ii);
11654	if (err)
11655		goto err_sw_init;
11656
11657	if (ixgbe_check_fw_error(adapter)) {
11658		err = ixgbe_recovery_probe(adapter);
11659		if (err)
11660			goto err_sw_init;
11661
11662		return 0;
11663	}
11664
11665	if (adapter->hw.mac.type == ixgbe_mac_e610) {
11666		err = ixgbe_get_caps(&adapter->hw);
11667		if (err)
11668			dev_err(&pdev->dev, "ixgbe_get_caps failed %d\n", err);
11669
11670		err = ixgbe_get_flash_data(&adapter->hw);
11671		if (err)
11672			goto err_sw_init;
11673	}
11674
11675	if (adapter->hw.mac.type == ixgbe_mac_82599EB)
11676		adapter->flags2 |= IXGBE_FLAG2_AUTO_DISABLE_VF;
11677
11678	switch (adapter->hw.mac.type) {
11679	case ixgbe_mac_X550:
11680	case ixgbe_mac_X550EM_x:
11681	case ixgbe_mac_e610:
11682		netdev->udp_tunnel_nic_info = &ixgbe_udp_tunnels_x550;
11683		break;
11684	case ixgbe_mac_x550em_a:
11685		netdev->udp_tunnel_nic_info = &ixgbe_udp_tunnels_x550em_a;
11686		break;
11687	default:
11688		break;
11689	}
11690
11691	/* Make it possible the adapter to be woken up via WOL */
11692	switch (adapter->hw.mac.type) {
11693	case ixgbe_mac_82599EB:
11694	case ixgbe_mac_X540:
11695	case ixgbe_mac_X550:
11696	case ixgbe_mac_X550EM_x:
11697	case ixgbe_mac_x550em_a:
11698	case ixgbe_mac_e610:
11699		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
11700		break;
11701	default:
11702		break;
11703	}
11704
11705	/*
11706	 * If there is a fan on this device and it has failed log the
11707	 * failure.
11708	 */
11709	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE) {
11710		u32 esdp = IXGBE_READ_REG(hw, IXGBE_ESDP);
11711		if (esdp & IXGBE_ESDP_SDP1)
11712			e_crit(probe, "Fan has stopped, replace the adapter\n");
11713	}
11714
11715	if (allow_unsupported_sfp)
11716		hw->allow_unsupported_sfp = allow_unsupported_sfp;
11717
11718	/* reset_hw fills in the perm_addr as well */
11719	hw->phy.reset_if_overtemp = true;
11720	err = hw->mac.ops.reset_hw(hw);
11721	hw->phy.reset_if_overtemp = false;
11722	ixgbe_set_eee_capable(adapter);
11723	if (err == -ENOENT) {
11724		err = 0;
11725	} else if (err == -EOPNOTSUPP) {
11726		e_dev_err("failed to load because an unsupported SFP+ or QSFP module type was detected.\n");
11727		e_dev_err("Reload the driver after installing a supported module.\n");
11728		goto err_sw_init;
11729	} else if (err) {
11730		e_dev_err("HW Init failed: %d\n", err);
11731		goto err_sw_init;
11732	}
11733
11734#ifdef CONFIG_PCI_IOV
11735	/* SR-IOV not supported on the 82598 */
11736	if (adapter->hw.mac.type == ixgbe_mac_82598EB)
11737		goto skip_sriov;
11738	/* Mailbox */
11739	ixgbe_init_mbx_params_pf(hw);
11740	hw->mbx.ops = ii->mbx_ops;
11741	pci_sriov_set_totalvfs(pdev, IXGBE_MAX_VFS_DRV_LIMIT);
11742	ixgbe_enable_sriov(adapter, max_vfs);
11743skip_sriov:
11744
11745#endif
11746	netdev->features = NETIF_F_SG |
11747			   NETIF_F_TSO |
11748			   NETIF_F_TSO6 |
11749			   NETIF_F_RXHASH |
11750			   NETIF_F_RXCSUM |
11751			   NETIF_F_HW_CSUM;
11752
11753#define IXGBE_GSO_PARTIAL_FEATURES (NETIF_F_GSO_GRE | \
11754				    NETIF_F_GSO_GRE_CSUM | \
11755				    NETIF_F_GSO_IPXIP4 | \
11756				    NETIF_F_GSO_IPXIP6 | \
11757				    NETIF_F_GSO_UDP_TUNNEL | \
11758				    NETIF_F_GSO_UDP_TUNNEL_CSUM)
11759
11760	netdev->gso_partial_features = IXGBE_GSO_PARTIAL_FEATURES;
11761	netdev->features |= NETIF_F_GSO_PARTIAL |
11762			    IXGBE_GSO_PARTIAL_FEATURES;
11763
11764	if (hw->mac.type >= ixgbe_mac_82599EB)
11765		netdev->features |= NETIF_F_SCTP_CRC | NETIF_F_GSO_UDP_L4;
11766
11767#ifdef CONFIG_IXGBE_IPSEC
11768#define IXGBE_ESP_FEATURES	(NETIF_F_HW_ESP | \
11769				 NETIF_F_HW_ESP_TX_CSUM | \
11770				 NETIF_F_GSO_ESP)
11771
11772	if (adapter->ipsec)
11773		netdev->features |= IXGBE_ESP_FEATURES;
11774#endif
11775	/* copy netdev features into list of user selectable features */
11776	netdev->hw_features |= netdev->features |
11777			       NETIF_F_HW_VLAN_CTAG_FILTER |
11778			       NETIF_F_HW_VLAN_CTAG_RX |
11779			       NETIF_F_HW_VLAN_CTAG_TX |
11780			       NETIF_F_RXALL |
11781			       NETIF_F_HW_L2FW_DOFFLOAD;
11782
11783	if (hw->mac.type >= ixgbe_mac_82599EB)
11784		netdev->hw_features |= NETIF_F_NTUPLE |
11785				       NETIF_F_HW_TC;
11786
11787	netdev->features |= NETIF_F_HIGHDMA;
11788
11789	netdev->vlan_features |= netdev->features | NETIF_F_TSO_MANGLEID;
11790	netdev->hw_enc_features |= netdev->vlan_features;
11791	netdev->mpls_features |= NETIF_F_SG |
11792				 NETIF_F_TSO |
11793				 NETIF_F_TSO6 |
11794				 NETIF_F_HW_CSUM;
11795	netdev->mpls_features |= IXGBE_GSO_PARTIAL_FEATURES;
11796
11797	/* set this bit last since it cannot be part of vlan_features */
11798	netdev->features |= NETIF_F_HW_VLAN_CTAG_FILTER |
11799			    NETIF_F_HW_VLAN_CTAG_RX |
11800			    NETIF_F_HW_VLAN_CTAG_TX;
11801
11802	netdev->priv_flags |= IFF_UNICAST_FLT;
11803	netdev->priv_flags |= IFF_SUPP_NOFCS;
11804
11805	netdev->xdp_features = NETDEV_XDP_ACT_BASIC | NETDEV_XDP_ACT_REDIRECT |
11806			       NETDEV_XDP_ACT_XSK_ZEROCOPY;
11807
11808	/* MTU range: 68 - 9710 */
11809	netdev->min_mtu = ETH_MIN_MTU;
11810	netdev->max_mtu = IXGBE_MAX_JUMBO_FRAME_SIZE - (ETH_HLEN + ETH_FCS_LEN);
11811
11812#ifdef CONFIG_IXGBE_DCB
11813	if (adapter->flags & IXGBE_FLAG_DCB_CAPABLE)
11814		netdev->dcbnl_ops = &ixgbe_dcbnl_ops;
11815#endif
11816
11817#ifdef IXGBE_FCOE
11818	if (adapter->flags & IXGBE_FLAG_FCOE_CAPABLE) {
11819		unsigned int fcoe_l;
11820
11821		if (hw->mac.ops.get_device_caps) {
11822			hw->mac.ops.get_device_caps(hw, &device_caps);
11823			if (device_caps & IXGBE_DEVICE_CAPS_FCOE_OFFLOADS)
11824				adapter->flags &= ~IXGBE_FLAG_FCOE_CAPABLE;
11825		}
11826
11827
11828		fcoe_l = min_t(int, IXGBE_FCRETA_SIZE, num_online_cpus());
11829		adapter->ring_feature[RING_F_FCOE].limit = fcoe_l;
11830
11831		netdev->features |= NETIF_F_FSO |
11832				    NETIF_F_FCOE_CRC;
11833
11834		netdev->vlan_features |= NETIF_F_FSO |
11835					 NETIF_F_FCOE_CRC;
11836	}
11837#endif /* IXGBE_FCOE */
11838	if (adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE)
11839		netdev->hw_features |= NETIF_F_LRO;
11840	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
11841		netdev->features |= NETIF_F_LRO;
11842
11843	/* make sure the EEPROM is good */
11844	if (hw->eeprom.ops.validate_checksum(hw, NULL) < 0) {
11845		e_dev_err("The EEPROM Checksum Is Not Valid\n");
11846		err = -EIO;
11847		goto err_sw_init;
11848	}
11849
11850	eth_platform_get_mac_address(&adapter->pdev->dev,
11851				     adapter->hw.mac.perm_addr);
11852
11853	eth_hw_addr_set(netdev, hw->mac.perm_addr);
11854
11855	if (!is_valid_ether_addr(netdev->dev_addr)) {
11856		e_dev_err("invalid MAC address\n");
11857		err = -EIO;
11858		goto err_sw_init;
11859	}
11860
11861	/* Set hw->mac.addr to permanent MAC address */
11862	ether_addr_copy(hw->mac.addr, hw->mac.perm_addr);
11863	ixgbe_mac_set_default_filter(adapter);
11864
11865	timer_setup(&adapter->service_timer, ixgbe_service_timer, 0);
11866
11867	if (ixgbe_removed(hw->hw_addr)) {
11868		err = -EIO;
11869		goto err_sw_init;
11870	}
11871	INIT_WORK(&adapter->service_task, ixgbe_service_task);
11872	set_bit(__IXGBE_SERVICE_INITED, &adapter->state);
11873	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
11874
11875	err = ixgbe_init_interrupt_scheme(adapter);
11876	if (err)
11877		goto err_sw_init;
11878
11879	for (i = 0; i < adapter->num_rx_queues; i++)
11880		u64_stats_init(&adapter->rx_ring[i]->syncp);
11881	for (i = 0; i < adapter->num_tx_queues; i++)
11882		u64_stats_init(&adapter->tx_ring[i]->syncp);
11883	for (i = 0; i < adapter->num_xdp_queues; i++)
11884		u64_stats_init(&adapter->xdp_ring[i]->syncp);
11885
11886	/* WOL not supported for all devices */
11887	adapter->wol = 0;
11888	hw->eeprom.ops.read(hw, 0x2c, &adapter->eeprom_cap);
11889	hw->wol_enabled = ixgbe_wol_supported(adapter, pdev->device,
11890						pdev->subsystem_device);
11891	if (hw->wol_enabled)
11892		adapter->wol = IXGBE_WUFC_MAG;
11893
11894	device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);
11895
11896	/* save off EEPROM version number */
11897	ixgbe_set_fw_version(adapter);
11898
11899	/* pick up the PCI bus settings for reporting later */
11900	if (ixgbe_pcie_from_parent(hw))
11901		ixgbe_get_parent_bus_info(adapter);
11902	else
11903		 hw->mac.ops.get_bus_info(hw);
11904
11905	/* calculate the expected PCIe bandwidth required for optimal
11906	 * performance. Note that some older parts will never have enough
11907	 * bandwidth due to being older generation PCIe parts. We clamp these
11908	 * parts to ensure no warning is displayed if it can't be fixed.
11909	 */
11910	switch (hw->mac.type) {
11911	case ixgbe_mac_82598EB:
11912		expected_gts = min(ixgbe_enumerate_functions(adapter) * 10, 16);
11913		break;
11914	default:
11915		expected_gts = ixgbe_enumerate_functions(adapter) * 10;
11916		break;
11917	}
11918
11919	/* don't check link if we failed to enumerate functions */
11920	if (expected_gts > 0)
11921		ixgbe_check_minimum_link(adapter, expected_gts);
11922
11923	err = hw->eeprom.ops.read_pba_string(hw, part_str, sizeof(part_str));
11924	if (err)
11925		strscpy(part_str, "Unknown", sizeof(part_str));
11926	if (ixgbe_is_sfp(hw) && hw->phy.sfp_type != ixgbe_sfp_type_not_present)
11927		e_dev_info("MAC: %d, PHY: %d, SFP+: %d, PBA No: %s\n",
11928			   hw->mac.type, hw->phy.type, hw->phy.sfp_type,
11929			   part_str);
11930	else
11931		e_dev_info("MAC: %d, PHY: %d, PBA No: %s\n",
11932			   hw->mac.type, hw->phy.type, part_str);
11933
11934	e_dev_info("%pM\n", netdev->dev_addr);
11935
11936	/* reset the hardware with the new settings */
11937	err = hw->mac.ops.start_hw(hw);
11938	if (err == -EACCES) {
11939		/* We are running on a pre-production device, log a warning */
11940		e_dev_warn("This device is a pre-production adapter/LOM. "
11941			   "Please be aware there may be issues associated "
11942			   "with your hardware.  If you are experiencing "
11943			   "problems please contact your Intel or hardware "
11944			   "representative who provided you with this "
11945			   "hardware.\n");
11946	}
11947	strcpy(netdev->name, "eth%d");
11948	pci_set_drvdata(pdev, adapter);
11949
11950	devl_lock(adapter->devlink);
11951	ixgbe_devlink_register_port(adapter);
11952	SET_NETDEV_DEVLINK_PORT(adapter->netdev, &adapter->devlink_port);
11953
11954	err = register_netdev(netdev);
11955	if (err)
11956		goto err_register;
11957
11958
11959	/* power down the optics for 82599 SFP+ fiber */
11960	if (hw->mac.ops.disable_tx_laser)
11961		hw->mac.ops.disable_tx_laser(hw);
11962
11963	/* carrier off reporting is important to ethtool even BEFORE open */
11964	netif_carrier_off(netdev);
11965
11966#ifdef CONFIG_IXGBE_DCA
11967	if (dca_add_requester(&pdev->dev) == 0) {
11968		adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
11969		ixgbe_setup_dca(adapter);
11970	}
11971#endif
11972	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
11973		e_info(probe, "IOV is enabled with %d VFs\n", adapter->num_vfs);
11974		for (i = 0; i < adapter->num_vfs; i++)
11975			ixgbe_vf_configuration(pdev, (i | 0x10000000));
11976	}
11977
11978	/* firmware requires driver version to be 0xFFFFFFFF
11979	 * since os does not support feature
11980	 */
11981	if (hw->mac.ops.set_fw_drv_ver)
11982		hw->mac.ops.set_fw_drv_ver(hw, 0xFF, 0xFF, 0xFF, 0xFF,
11983					   sizeof(UTS_RELEASE) - 1,
11984					   UTS_RELEASE);
11985
11986	/* add san mac addr to netdev */
11987	ixgbe_add_sanmac_netdev(netdev);
11988
11989	e_dev_info("%s\n", ixgbe_default_device_descr);
11990
11991#ifdef CONFIG_IXGBE_HWMON
11992	if (ixgbe_sysfs_init(adapter))
11993		e_err(probe, "failed to allocate sysfs resources\n");
11994#endif /* CONFIG_IXGBE_HWMON */
11995
11996	ixgbe_dbg_adapter_init(adapter);
11997
11998	/* setup link for SFP devices with MNG FW, else wait for IXGBE_UP */
11999	if (ixgbe_mng_enabled(hw) && ixgbe_is_sfp(hw) && hw->mac.ops.setup_link)
12000		hw->mac.ops.setup_link(hw,
12001			IXGBE_LINK_SPEED_10GB_FULL | IXGBE_LINK_SPEED_1GB_FULL,
12002			true);
12003
12004	err = ixgbe_mii_bus_init(hw);
12005	if (err)
12006		goto err_netdev;
12007
12008	ixgbe_devlink_init_regions(adapter);
12009	devl_register(adapter->devlink);
12010	devl_unlock(adapter->devlink);
12011
12012	if (ixgbe_fwlog_init(hw))
12013		e_dev_info("Firmware logging not supported\n");
12014
12015	return 0;
12016
12017err_netdev:
12018	unregister_netdev(netdev);
12019err_register:
12020	devl_port_unregister(&adapter->devlink_port);
12021	devl_unlock(adapter->devlink);
12022	ixgbe_release_hw_control(adapter);
12023	ixgbe_clear_interrupt_scheme(adapter);
12024err_sw_init:
12025	if (hw->mac.type == ixgbe_mac_e610)
12026		mutex_destroy(&adapter->hw.aci.lock);
12027	ixgbe_disable_sriov(adapter);
12028	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
12029	iounmap(adapter->io_addr);
12030	kfree(adapter->jump_tables[0]);
12031	kfree(adapter->mac_table);
12032	kfree(adapter->rss_key);
12033	bitmap_free(adapter->af_xdp_zc_qps);
12034err_ioremap:
12035	disable_dev = !test_and_set_bit(__IXGBE_DISABLED, &adapter->state);
12036	free_netdev(netdev);
12037err_alloc_etherdev:
12038	devlink_free(adapter->devlink);
12039	pci_release_mem_regions(pdev);
12040err_devlink:
12041err_pci_reg:
12042err_dma:
12043	if (!adapter || disable_dev)
12044		pci_disable_device(pdev);
12045	return err;
12046}
12047
12048/**
12049 * ixgbe_remove - Device Removal Routine
12050 * @pdev: PCI device information struct
12051 *
12052 * ixgbe_remove is called by the PCI subsystem to alert the driver
12053 * that it should release a PCI device.  This could be caused by a
12054 * Hot-Plug event, or because the driver is going to be removed from
12055 * memory.
12056 **/
12057static void ixgbe_remove(struct pci_dev *pdev)
12058{
12059	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
12060	struct net_device *netdev;
12061	bool disable_dev;
12062	int i;
12063
12064	/* if !adapter then we already cleaned up in probe */
12065	if (!adapter)
12066		return;
12067
12068	netdev  = adapter->netdev;
12069	devl_lock(adapter->devlink);
12070	devl_unregister(adapter->devlink);
12071	ixgbe_devlink_destroy_regions(adapter);
12072	ixgbe_fwlog_deinit(&adapter->hw);
12073	ixgbe_dbg_adapter_exit(adapter);
12074
12075	set_bit(__IXGBE_REMOVING, &adapter->state);
12076	cancel_work_sync(&adapter->service_task);
12077
12078	if (adapter->hw.mac.type == ixgbe_mac_e610)
12079		ixgbe_disable_link_status_events(adapter);
12080
12081	if (adapter->mii_bus)
12082		mdiobus_unregister(adapter->mii_bus);
12083
12084#ifdef CONFIG_IXGBE_DCA
12085	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED) {
12086		adapter->flags &= ~IXGBE_FLAG_DCA_ENABLED;
12087		dca_remove_requester(&pdev->dev);
12088		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
12089				IXGBE_DCA_CTRL_DCA_DISABLE);
12090	}
12091
12092#endif
12093#ifdef CONFIG_IXGBE_HWMON
12094	ixgbe_sysfs_exit(adapter);
12095#endif /* CONFIG_IXGBE_HWMON */
12096
12097	/* remove the added san mac */
12098	ixgbe_del_sanmac_netdev(netdev);
12099
12100#ifdef CONFIG_PCI_IOV
12101	ixgbe_disable_sriov(adapter);
12102#endif
12103	if (netdev->reg_state == NETREG_REGISTERED)
12104		unregister_netdev(netdev);
12105
12106	devl_port_unregister(&adapter->devlink_port);
12107	devl_unlock(adapter->devlink);
12108
12109	ixgbe_stop_ipsec_offload(adapter);
12110	ixgbe_clear_interrupt_scheme(adapter);
12111
12112	ixgbe_release_hw_control(adapter);
12113
12114#ifdef CONFIG_DCB
12115	kfree(adapter->ixgbe_ieee_pfc);
12116	kfree(adapter->ixgbe_ieee_ets);
12117
12118#endif
12119	iounmap(adapter->io_addr);
12120	pci_release_mem_regions(pdev);
12121
12122	e_dev_info("complete\n");
12123
12124	for (i = 0; i < IXGBE_MAX_LINK_HANDLE; i++) {
12125		if (adapter->jump_tables[i]) {
12126			kfree(adapter->jump_tables[i]->input);
12127			kfree(adapter->jump_tables[i]->mask);
12128		}
12129		kfree(adapter->jump_tables[i]);
12130	}
12131
12132	kfree(adapter->mac_table);
12133	kfree(adapter->rss_key);
12134	bitmap_free(adapter->af_xdp_zc_qps);
12135	disable_dev = !test_and_set_bit(__IXGBE_DISABLED, &adapter->state);
12136	free_netdev(netdev);
12137
12138	if (adapter->hw.mac.type == ixgbe_mac_e610)
12139		mutex_destroy(&adapter->hw.aci.lock);
12140
12141	if (disable_dev)
12142		pci_disable_device(pdev);
12143
12144	devlink_free(adapter->devlink);
12145}
12146
12147/**
12148 * ixgbe_io_error_detected - called when PCI error is detected
12149 * @pdev: Pointer to PCI device
12150 * @state: The current pci connection state
12151 *
12152 * This function is called after a PCI bus error affecting
12153 * this device has been detected.
12154 */
12155static pci_ers_result_t ixgbe_io_error_detected(struct pci_dev *pdev,
12156						pci_channel_state_t state)
12157{
12158	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
12159	struct net_device *netdev = adapter->netdev;
12160
12161#ifdef CONFIG_PCI_IOV
12162	struct ixgbe_hw *hw = &adapter->hw;
12163	struct pci_dev *bdev, *vfdev;
12164	u32 dw0, dw1, dw2, dw3;
12165	int vf, pos;
12166	u16 req_id, pf_func;
12167
12168	if (adapter->hw.mac.type == ixgbe_mac_82598EB ||
12169	    adapter->num_vfs == 0)
12170		goto skip_bad_vf_detection;
12171
12172	bdev = pdev->bus->self;
12173	while (bdev && (pci_pcie_type(bdev) != PCI_EXP_TYPE_ROOT_PORT))
12174		bdev = bdev->bus->self;
12175
12176	if (!bdev)
12177		goto skip_bad_vf_detection;
12178
12179	pos = pci_find_ext_capability(bdev, PCI_EXT_CAP_ID_ERR);
12180	if (!pos)
12181		goto skip_bad_vf_detection;
12182
12183	dw0 = ixgbe_read_pci_cfg_dword(hw, pos + PCI_ERR_HEADER_LOG);
12184	dw1 = ixgbe_read_pci_cfg_dword(hw, pos + PCI_ERR_HEADER_LOG + 4);
12185	dw2 = ixgbe_read_pci_cfg_dword(hw, pos + PCI_ERR_HEADER_LOG + 8);
12186	dw3 = ixgbe_read_pci_cfg_dword(hw, pos + PCI_ERR_HEADER_LOG + 12);
12187	if (ixgbe_removed(hw->hw_addr))
12188		goto skip_bad_vf_detection;
12189
12190	req_id = dw1 >> 16;
12191	/* On the 82599 if bit 7 of the requestor ID is set then it's a VF */
12192	if (!(req_id & 0x0080))
12193		goto skip_bad_vf_detection;
12194
12195	pf_func = req_id & 0x01;
12196	if ((pf_func & 1) == (pdev->devfn & 1)) {
12197		unsigned int device_id;
12198
12199		vf = FIELD_GET(0x7F, req_id);
12200		e_dev_err("VF %d has caused a PCIe error\n", vf);
12201		e_dev_err("TLP: dw0: %8.8x\tdw1: %8.8x\tdw2: "
12202				"%8.8x\tdw3: %8.8x\n",
12203		dw0, dw1, dw2, dw3);
12204		switch (adapter->hw.mac.type) {
12205		case ixgbe_mac_82599EB:
12206			device_id = IXGBE_82599_VF_DEVICE_ID;
12207			break;
12208		case ixgbe_mac_X540:
12209			device_id = IXGBE_X540_VF_DEVICE_ID;
12210			break;
12211		case ixgbe_mac_X550:
12212			device_id = IXGBE_DEV_ID_X550_VF;
12213			break;
12214		case ixgbe_mac_X550EM_x:
12215			device_id = IXGBE_DEV_ID_X550EM_X_VF;
12216			break;
12217		case ixgbe_mac_x550em_a:
12218			device_id = IXGBE_DEV_ID_X550EM_A_VF;
12219			break;
12220		case ixgbe_mac_e610:
12221			device_id = IXGBE_DEV_ID_E610_VF;
12222			break;
12223		default:
12224			device_id = 0;
12225			break;
12226		}
12227
12228		/* Find the pci device of the offending VF */
12229		vfdev = pci_get_device(PCI_VENDOR_ID_INTEL, device_id, NULL);
12230		while (vfdev) {
12231			if (vfdev->devfn == (req_id & 0xFF))
12232				break;
12233			vfdev = pci_get_device(PCI_VENDOR_ID_INTEL,
12234					       device_id, vfdev);
12235		}
12236		/*
12237		 * There's a slim chance the VF could have been hot plugged,
12238		 * so if it is no longer present we don't need to issue the
12239		 * VFLR.  Just clean up the AER in that case.
12240		 */
12241		if (vfdev) {
12242			pcie_flr(vfdev);
12243			/* Free device reference count */
12244			pci_dev_put(vfdev);
12245		}
12246	}
12247
12248	/*
12249	 * Even though the error may have occurred on the other port
12250	 * we still need to increment the vf error reference count for
12251	 * both ports because the I/O resume function will be called
12252	 * for both of them.
12253	 */
12254	adapter->vferr_refcount++;
12255
12256	return PCI_ERS_RESULT_RECOVERED;
12257
12258skip_bad_vf_detection:
12259#endif /* CONFIG_PCI_IOV */
12260	if (!test_bit(__IXGBE_SERVICE_INITED, &adapter->state))
12261		return PCI_ERS_RESULT_DISCONNECT;
12262
12263	if (!netif_device_present(netdev))
12264		return PCI_ERS_RESULT_DISCONNECT;
12265
12266	rtnl_lock();
12267	netif_device_detach(netdev);
12268
12269	if (netif_running(netdev))
12270		ixgbe_close_suspend(adapter);
12271
12272	if (state == pci_channel_io_perm_failure) {
12273		rtnl_unlock();
12274		return PCI_ERS_RESULT_DISCONNECT;
12275	}
12276
12277	if (!test_and_set_bit(__IXGBE_DISABLED, &adapter->state))
12278		pci_disable_device(pdev);
12279	rtnl_unlock();
12280
12281	/* Request a slot reset. */
12282	return PCI_ERS_RESULT_NEED_RESET;
12283}
12284
12285/**
12286 * ixgbe_io_slot_reset - called after the pci bus has been reset.
12287 * @pdev: Pointer to PCI device
12288 *
12289 * Restart the card from scratch, as if from a cold-boot.
12290 */
12291static pci_ers_result_t ixgbe_io_slot_reset(struct pci_dev *pdev)
12292{
12293	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
12294	pci_ers_result_t result;
12295
12296	if (pci_enable_device_mem(pdev)) {
12297		e_err(probe, "Cannot re-enable PCI device after reset.\n");
12298		result = PCI_ERS_RESULT_DISCONNECT;
12299	} else {
12300		smp_mb__before_atomic();
12301		clear_bit(__IXGBE_DISABLED, &adapter->state);
12302		adapter->hw.hw_addr = adapter->io_addr;
12303		pci_set_master(pdev);
12304		pci_restore_state(pdev);
12305
12306		pci_wake_from_d3(pdev, false);
12307
12308		ixgbe_reset(adapter);
12309		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
12310		result = PCI_ERS_RESULT_RECOVERED;
12311	}
12312
12313	return result;
12314}
12315
12316/**
12317 * ixgbe_io_resume - called when traffic can start flowing again.
12318 * @pdev: Pointer to PCI device
12319 *
12320 * This callback is called when the error recovery driver tells us that
12321 * its OK to resume normal operation.
12322 */
12323static void ixgbe_io_resume(struct pci_dev *pdev)
12324{
12325	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
12326	struct net_device *netdev = adapter->netdev;
12327
12328#ifdef CONFIG_PCI_IOV
12329	if (adapter->vferr_refcount) {
12330		e_info(drv, "Resuming after VF err\n");
12331		adapter->vferr_refcount--;
12332		return;
12333	}
12334
12335#endif
12336	rtnl_lock();
12337	if (netif_running(netdev))
12338		ixgbe_open(netdev);
12339
12340	netif_device_attach(netdev);
12341	rtnl_unlock();
12342}
12343
12344static const struct pci_error_handlers ixgbe_err_handler = {
12345	.error_detected = ixgbe_io_error_detected,
12346	.slot_reset = ixgbe_io_slot_reset,
12347	.resume = ixgbe_io_resume,
12348};
12349
12350static DEFINE_SIMPLE_DEV_PM_OPS(ixgbe_pm_ops, ixgbe_suspend, ixgbe_resume);
12351
12352static struct pci_driver ixgbe_driver = {
12353	.name      = ixgbe_driver_name,
12354	.id_table  = ixgbe_pci_tbl,
12355	.probe     = ixgbe_probe,
12356	.remove    = ixgbe_remove,
12357	.driver.pm = pm_sleep_ptr(&ixgbe_pm_ops),
12358	.shutdown  = ixgbe_shutdown,
12359	.sriov_configure = ixgbe_pci_sriov_configure,
12360	.err_handler = &ixgbe_err_handler
12361};
12362
12363/**
12364 * ixgbe_init_module - Driver Registration Routine
12365 *
12366 * ixgbe_init_module is the first routine called when the driver is
12367 * loaded. All it does is register with the PCI subsystem.
12368 **/
12369static int __init ixgbe_init_module(void)
12370{
12371	int ret;
12372	pr_info("%s\n", ixgbe_driver_string);
12373	pr_info("%s\n", ixgbe_copyright);
12374
12375	ixgbe_wq = create_singlethread_workqueue(ixgbe_driver_name);
12376	if (!ixgbe_wq) {
12377		pr_err("%s: Failed to create workqueue\n", ixgbe_driver_name);
12378		return -ENOMEM;
12379	}
12380
12381	ixgbe_dbg_init();
12382
12383	ret = pci_register_driver(&ixgbe_driver);
12384	if (ret) {
12385		destroy_workqueue(ixgbe_wq);
12386		ixgbe_dbg_exit();
12387		return ret;
12388	}
12389
12390#ifdef CONFIG_IXGBE_DCA
12391	dca_register_notify(&dca_notifier);
12392#endif
12393
12394	return 0;
12395}
12396
12397module_init(ixgbe_init_module);
12398
12399/**
12400 * ixgbe_exit_module - Driver Exit Cleanup Routine
12401 *
12402 * ixgbe_exit_module is called just before the driver is removed
12403 * from memory.
12404 **/
12405static void __exit ixgbe_exit_module(void)
12406{
12407#ifdef CONFIG_IXGBE_DCA
12408	dca_unregister_notify(&dca_notifier);
12409#endif
12410	pci_unregister_driver(&ixgbe_driver);
12411
12412	ixgbe_dbg_exit();
12413	if (ixgbe_wq) {
12414		destroy_workqueue(ixgbe_wq);
12415		ixgbe_wq = NULL;
12416	}
12417}
12418
12419#ifdef CONFIG_IXGBE_DCA
12420static int ixgbe_notify_dca(struct notifier_block *nb, unsigned long event,
12421			    void *p)
12422{
12423	int ret_val;
12424
12425	ret_val = driver_for_each_device(&ixgbe_driver.driver, NULL, &event,
12426					 __ixgbe_notify_dca);
12427
12428	return ret_val ? NOTIFY_BAD : NOTIFY_DONE;
12429}
12430
12431#endif /* CONFIG_IXGBE_DCA */
12432
12433module_exit(ixgbe_exit_module);
12434
12435/* ixgbe_main.c */
~/ Read-only file preview.