ixgbe_main.c 284.0 KB
Newer Older
1 2 3
/*******************************************************************************

  Intel 10 Gigabit PCI Express Linux driver
4
  Copyright(c) 1999 - 2016 Intel Corporation.
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22

  This program is free software; you can redistribute it and/or modify it
  under the terms and conditions of the GNU General Public License,
  version 2, as published by the Free Software Foundation.

  This program is distributed in the hope it will be useful, but WITHOUT
  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  more details.

  You should have received a copy of the GNU General Public License along with
  this program; if not, write to the Free Software Foundation, Inc.,
  51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.

  The full GNU General Public License is included in this distribution in
  the file called "COPYING".

  Contact Information:
23
  Linux NICS <linux.nics@intel.com>
24 25 26 27 28 29 30 31 32 33 34 35
  e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
  Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497

*******************************************************************************/

#include <linux/types.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/netdevice.h>
#include <linux/vmalloc.h>
#include <linux/string.h>
#include <linux/in.h>
36
#include <linux/interrupt.h>
37 38
#include <linux/ip.h>
#include <linux/tcp.h>
39
#include <linux/sctp.h>
40
#include <linux/pkt_sched.h>
41
#include <linux/ipv6.h>
42
#include <linux/slab.h>
43 44
#include <net/checksum.h>
#include <net/ip6_checksum.h>
45
#include <linux/etherdevice.h>
46
#include <linux/ethtool.h>
47
#include <linux/if.h>
48
#include <linux/if_vlan.h>
49
#include <linux/if_macvlan.h>
50
#include <linux/if_bridge.h>
51
#include <linux/prefetch.h>
52
#include <scsi/fc/fc_fcoe.h>
53
#include <net/udp_tunnel.h>
54 55
#include <net/pkt_cls.h>
#include <net/tc_act/tc_gact.h>
56
#include <net/tc_act/tc_mirred.h>
57
#include <net/vxlan.h>
58 59 60

#include "ixgbe.h"
#include "ixgbe_common.h"
61
#include "ixgbe_dcb_82599.h"
62
#include "ixgbe_sriov.h"
63
#include "ixgbe_model.h"
64 65

char ixgbe_driver_name[] = "ixgbe";
S
Stephen Hemminger 已提交
66
static const char ixgbe_driver_string[] =
67
			      "Intel(R) 10 Gigabit PCI Express Network Driver";
68
#ifdef IXGBE_FCOE
69 70
char ixgbe_default_device_descr[] =
			      "Intel(R) 10 Gigabit Network Connection";
71 72 73 74
#else
static char ixgbe_default_device_descr[] =
			      "Intel(R) 10 Gigabit Network Connection";
#endif
75
#define DRV_VERSION "5.0.0-k"
S
Stephen Hemminger 已提交
76
const char ixgbe_driver_version[] = DRV_VERSION;
77
static const char ixgbe_copyright[] =
78
				"Copyright (c) 1999-2016 Intel Corporation.";
79

80 81
static 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";

82
static const struct ixgbe_info *ixgbe_info_tbl[] = {
83 84 85 86 87
	[board_82598]		= &ixgbe_82598_info,
	[board_82599]		= &ixgbe_82599_info,
	[board_X540]		= &ixgbe_X540_info,
	[board_X550]		= &ixgbe_X550_info,
	[board_X550EM_x]	= &ixgbe_X550EM_x_info,
88
	[board_x550em_a]	= &ixgbe_x550em_a_info,
89
	[board_x550em_a_fw]	= &ixgbe_x550em_a_fw_info,
90 91 92 93 94 95 96 97 98 99
};

/* ixgbe_pci_tbl - PCI Device ID Table
 *
 * Wildcard entries (PCI_ANY_ID) should come last
 * Last entry must be all 0s
 *
 * { Vendor ID, Device ID, SubVendor ID, SubDevice ID,
 *   Class, Class Mask, private data (not used) }
 */
100
static const struct pci_device_id ixgbe_pci_tbl[] = {
101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598AF_DUAL_PORT), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598AF_SINGLE_PORT), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598AT), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598AT2), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598EB_CX4), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598_CX4_DUAL_PORT), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598_DA_DUAL_PORT), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598_SR_DUAL_PORT_EM), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598EB_XF_LR), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598EB_SFP_LOM), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82598_BX), board_82598 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_KX4), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_XAUI_LOM), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_KR), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP_EM), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_KX4_MEZZ), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_CX4), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_BACKPLANE_FCOE), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP_FCOE), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_T3_LOM), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_COMBO_BACKPLANE), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X540T), board_X540 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP_SF2), board_82599 },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_LS), board_82599 },
127
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_QSFP_SF_QP), board_82599 },
128
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599EN_SFP), board_82599 },
129
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP_SF_QP), board_82599 },
130
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X540T1), board_X540 },
131
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550T), board_X550},
132
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550T1), board_X550},
133
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_KX4), board_X550EM_x},
134
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_XFI), board_X550EM_x},
135
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_KR), board_X550EM_x},
136
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_10G_T), board_X550EM_x},
137
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_SFP), board_X550EM_x},
138 139
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_KR), board_x550em_a },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_KR_L), board_x550em_a },
140
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SFP_N), board_x550em_a },
141 142
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SGMII), board_x550em_a },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SGMII_L), board_x550em_a },
143
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_10G_T), board_x550em_a},
144
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SFP), board_x550em_a },
145 146
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_1G_T), board_x550em_a_fw },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_1G_T_L), board_x550em_a_fw },
147 148 149 150 151
	/* required last entry */
	{0, }
};
MODULE_DEVICE_TABLE(pci, ixgbe_pci_tbl);

152
#ifdef CONFIG_IXGBE_DCA
153
static int ixgbe_notify_dca(struct notifier_block *, unsigned long event,
154
			    void *p);
155 156 157 158 159 160 161
static struct notifier_block dca_notifier = {
	.notifier_call = ixgbe_notify_dca,
	.next          = NULL,
	.priority      = 0
};
#endif

162 163 164
#ifdef CONFIG_PCI_IOV
static unsigned int max_vfs;
module_param(max_vfs, uint, 0);
165
MODULE_PARM_DESC(max_vfs,
166
		 "Maximum number of virtual functions to allocate per physical function - default is zero and maximum value is 63. (Deprecated)");
167 168
#endif /* CONFIG_PCI_IOV */

169 170 171 172 173
static unsigned int allow_unsupported_sfp;
module_param(allow_unsupported_sfp, uint, 0);
MODULE_PARM_DESC(allow_unsupported_sfp,
		 "Allow unsupported and untested SFP+ modules on 82599-based adapters");

174 175 176 177 178
#define DEFAULT_MSG_ENABLE (NETIF_MSG_DRV|NETIF_MSG_PROBE|NETIF_MSG_LINK)
static int debug = -1;
module_param(debug, int, 0);
MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)");

179 180 181 182 183
MODULE_AUTHOR("Intel Corporation, <linux.nics@intel.com>");
MODULE_DESCRIPTION("Intel(R) 10 Gigabit PCI Express Network Driver");
MODULE_LICENSE("GPL");
MODULE_VERSION(DRV_VERSION);

184 185
static struct workqueue_struct *ixgbe_wq;

186
static bool ixgbe_check_cfg_remove(struct ixgbe_hw *hw, struct pci_dev *pdev);
187
static void ixgbe_watchdog_link_is_down(struct ixgbe_adapter *);
188

189 190 191 192 193 194 195 196 197 198 199 200 201 202
static int ixgbe_read_pci_cfg_word_parent(struct ixgbe_adapter *adapter,
					  u32 reg, u16 *value)
{
	struct pci_dev *parent_dev;
	struct pci_bus *parent_bus;

	parent_bus = adapter->pdev->bus->parent;
	if (!parent_bus)
		return -1;

	parent_dev = parent_bus->self;
	if (!parent_dev)
		return -1;

203
	if (!pci_is_pcie(parent_dev))
204 205
		return -1;

206
	pcie_capability_read_word(parent_dev, reg, value);
207 208 209
	if (*value == IXGBE_FAILED_READ_CFG_WORD &&
	    ixgbe_check_cfg_remove(&adapter->hw, parent_dev))
		return -1;
210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235
	return 0;
}

static s32 ixgbe_get_parent_bus_info(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u16 link_status = 0;
	int err;

	hw->bus.type = ixgbe_bus_type_pci_express;

	/* Get the negotiated link width and speed from PCI config space of the
	 * parent, as this device is behind a switch
	 */
	err = ixgbe_read_pci_cfg_word_parent(adapter, 18, &link_status);

	/* assume caller will handle error case */
	if (err)
		return err;

	hw->bus.width = ixgbe_convert_bus_width(link_status);
	hw->bus.speed = ixgbe_convert_bus_speed(link_status);

	return 0;
}

236 237 238 239 240 241 242 243 244 245 246 247 248
/**
 * ixgbe_check_from_parent - Determine whether PCIe info should come from parent
 * @hw: hw specific details
 *
 * This function is used by probe to determine whether a device's PCI-Express
 * bandwidth details should be gathered from the parent bus instead of from the
 * device. Used to ensure that various locations all have the correct device ID
 * checks.
 */
static inline bool ixgbe_pcie_from_parent(struct ixgbe_hw *hw)
{
	switch (hw->device_id) {
	case IXGBE_DEV_ID_82599_SFP_SF_QP:
249
	case IXGBE_DEV_ID_82599_QSFP_SF_QP:
250 251 252 253 254 255 256 257 258
		return true;
	default:
		return false;
	}
}

static void ixgbe_check_minimum_link(struct ixgbe_adapter *adapter,
				     int expected_gts)
{
259
	struct ixgbe_hw *hw = &adapter->hw;
260 261 262 263 264
	int max_gts = 0;
	enum pci_bus_speed speed = PCI_SPEED_UNKNOWN;
	enum pcie_link_width width = PCIE_LNK_WIDTH_UNKNOWN;
	struct pci_dev *pdev;

265 266 267 268 269 270 271
	/* Some devices are not connected over PCIe and thus do not negotiate
	 * speed. These devices do not have valid bus info, and thus any report
	 * we generate may not be correct.
	 */
	if (hw->bus.type == ixgbe_bus_type_internal)
		return;

272
	/* determine whether to use the parent device */
273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293
	if (ixgbe_pcie_from_parent(&adapter->hw))
		pdev = adapter->pdev->bus->parent->self;
	else
		pdev = adapter->pdev;

	if (pcie_get_minimum_link(pdev, &speed, &width) ||
	    speed == PCI_SPEED_UNKNOWN || width == PCIE_LNK_WIDTH_UNKNOWN) {
		e_dev_warn("Unable to determine PCI Express bandwidth.\n");
		return;
	}

	switch (speed) {
	case PCIE_SPEED_2_5GT:
		/* 8b/10b encoding reduces max throughput by 20% */
		max_gts = 2 * width;
		break;
	case PCIE_SPEED_5_0GT:
		/* 8b/10b encoding reduces max throughput by 20% */
		max_gts = 4 * width;
		break;
	case PCIE_SPEED_8_0GT:
294
		/* 128b/130b encoding reduces throughput by less than 2% */
295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311
		max_gts = 8 * width;
		break;
	default:
		e_dev_warn("Unable to determine PCI Express bandwidth.\n");
		return;
	}

	e_dev_info("PCI Express bandwidth of %dGT/s available\n",
		   max_gts);
	e_dev_info("(Speed:%s, Width: x%d, Encoding Loss:%s)\n",
		   (speed == PCIE_SPEED_8_0GT ? "8.0GT/s" :
		    speed == PCIE_SPEED_5_0GT ? "5.0GT/s" :
		    speed == PCIE_SPEED_2_5GT ? "2.5GT/s" :
		    "Unknown"),
		   width,
		   (speed == PCIE_SPEED_2_5GT ? "20%" :
		    speed == PCIE_SPEED_5_0GT ? "20%" :
312
		    speed == PCIE_SPEED_8_0GT ? "<2%" :
313 314 315 316 317 318 319 320 321 322
		    "Unknown"));

	if (max_gts < expected_gts) {
		e_dev_warn("This is not sufficient for optimal performance of this card.\n");
		e_dev_warn("For optimal performance, at least %dGT/s of bandwidth is required.\n",
			expected_gts);
		e_dev_warn("A slot with more lanes and/or higher speed is suggested.\n");
	}
}

323 324 325
static void ixgbe_service_event_schedule(struct ixgbe_adapter *adapter)
{
	if (!test_bit(__IXGBE_DOWN, &adapter->state) &&
326
	    !test_bit(__IXGBE_REMOVING, &adapter->state) &&
327
	    !test_and_set_bit(__IXGBE_SERVICE_SCHED, &adapter->state))
328
		queue_work(ixgbe_wq, &adapter->service_task);
329 330
}

331 332 333 334 335 336 337 338
static void ixgbe_remove_adapter(struct ixgbe_hw *hw)
{
	struct ixgbe_adapter *adapter = hw->back;

	if (!hw->hw_addr)
		return;
	hw->hw_addr = NULL;
	e_dev_err("Adapter removed\n");
339 340
	if (test_bit(__IXGBE_SERVICE_INITED, &adapter->state))
		ixgbe_service_event_schedule(adapter);
341 342
}

343
static void ixgbe_check_remove(struct ixgbe_hw *hw, u32 reg)
344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361
{
	u32 value;

	/* The following check not only optimizes a bit by not
	 * performing a read on the status register when the
	 * register just read was a status register read that
	 * returned IXGBE_FAILED_READ_REG. It also blocks any
	 * potential recursion.
	 */
	if (reg == IXGBE_STATUS) {
		ixgbe_remove_adapter(hw);
		return;
	}
	value = ixgbe_read_reg(hw, IXGBE_STATUS);
	if (value == IXGBE_FAILED_READ_REG)
		ixgbe_remove_adapter(hw);
}

362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381
/**
 * ixgbe_read_reg - Read from device register
 * @hw: hw specific details
 * @reg: offset of register to read
 *
 * Returns : value read or IXGBE_FAILED_READ_REG if removed
 *
 * This function is used to read device registers. It checks for device
 * removal by confirming any read that returns all ones by checking the
 * status register value for all ones. This function avoids reading from
 * the hardware if a removal was previously detected in which case it
 * returns IXGBE_FAILED_READ_REG (all ones).
 */
u32 ixgbe_read_reg(struct ixgbe_hw *hw, u32 reg)
{
	u8 __iomem *reg_addr = ACCESS_ONCE(hw->hw_addr);
	u32 value;

	if (ixgbe_removed(reg_addr))
		return IXGBE_FAILED_READ_REG;
382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402
	if (unlikely(hw->phy.nw_mng_if_sel &
		     IXGBE_NW_MNG_IF_SEL_ENABLE_10_100M)) {
		struct ixgbe_adapter *adapter;
		int i;

		for (i = 0; i < 200; ++i) {
			value = readl(reg_addr + IXGBE_MAC_SGMII_BUSY);
			if (likely(!value))
				goto writes_completed;
			if (value == IXGBE_FAILED_READ_REG) {
				ixgbe_remove_adapter(hw);
				return IXGBE_FAILED_READ_REG;
			}
			udelay(5);
		}

		adapter = hw->back;
		e_warn(hw, "register writes incomplete %08x\n", value);
	}

writes_completed:
403 404 405 406 407 408
	value = readl(reg_addr + reg);
	if (unlikely(value == IXGBE_FAILED_READ_REG))
		ixgbe_check_remove(hw, reg);
	return value;
}

409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450
static bool ixgbe_check_cfg_remove(struct ixgbe_hw *hw, struct pci_dev *pdev)
{
	u16 value;

	pci_read_config_word(pdev, PCI_VENDOR_ID, &value);
	if (value == IXGBE_FAILED_READ_CFG_WORD) {
		ixgbe_remove_adapter(hw);
		return true;
	}
	return false;
}

u16 ixgbe_read_pci_cfg_word(struct ixgbe_hw *hw, u32 reg)
{
	struct ixgbe_adapter *adapter = hw->back;
	u16 value;

	if (ixgbe_removed(hw->hw_addr))
		return IXGBE_FAILED_READ_CFG_WORD;
	pci_read_config_word(adapter->pdev, reg, &value);
	if (value == IXGBE_FAILED_READ_CFG_WORD &&
	    ixgbe_check_cfg_remove(hw, adapter->pdev))
		return IXGBE_FAILED_READ_CFG_WORD;
	return value;
}

#ifdef CONFIG_PCI_IOV
static u32 ixgbe_read_pci_cfg_dword(struct ixgbe_hw *hw, u32 reg)
{
	struct ixgbe_adapter *adapter = hw->back;
	u32 value;

	if (ixgbe_removed(hw->hw_addr))
		return IXGBE_FAILED_READ_CFG_DWORD;
	pci_read_config_dword(adapter->pdev, reg, &value);
	if (value == IXGBE_FAILED_READ_CFG_DWORD &&
	    ixgbe_check_cfg_remove(hw, adapter->pdev))
		return IXGBE_FAILED_READ_CFG_DWORD;
	return value;
}
#endif /* CONFIG_PCI_IOV */

451 452 453 454 455 456 457 458 459
void ixgbe_write_pci_cfg_word(struct ixgbe_hw *hw, u32 reg, u16 value)
{
	struct ixgbe_adapter *adapter = hw->back;

	if (ixgbe_removed(hw->hw_addr))
		return;
	pci_write_config_word(adapter->pdev, reg, value);
}

460 461 462 463
static void ixgbe_service_event_complete(struct ixgbe_adapter *adapter)
{
	BUG_ON(!test_bit(__IXGBE_SERVICE_SCHED, &adapter->state));

S
Stephen Hemminger 已提交
464
	/* flush memory to make sure state is correct before next watchdog */
465
	smp_mb__before_atomic();
466 467 468
	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
}

469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502
struct ixgbe_reg_info {
	u32 ofs;
	char *name;
};

static const struct ixgbe_reg_info ixgbe_reg_info_tbl[] = {

	/* General Registers */
	{IXGBE_CTRL, "CTRL"},
	{IXGBE_STATUS, "STATUS"},
	{IXGBE_CTRL_EXT, "CTRL_EXT"},

	/* Interrupt Registers */
	{IXGBE_EICR, "EICR"},

	/* RX Registers */
	{IXGBE_SRRCTL(0), "SRRCTL"},
	{IXGBE_DCA_RXCTRL(0), "DRXCTL"},
	{IXGBE_RDLEN(0), "RDLEN"},
	{IXGBE_RDH(0), "RDH"},
	{IXGBE_RDT(0), "RDT"},
	{IXGBE_RXDCTL(0), "RXDCTL"},
	{IXGBE_RDBAL(0), "RDBAL"},
	{IXGBE_RDBAH(0), "RDBAH"},

	/* TX Registers */
	{IXGBE_TDBAL(0), "TDBAL"},
	{IXGBE_TDBAH(0), "TDBAH"},
	{IXGBE_TDLEN(0), "TDLEN"},
	{IXGBE_TDH(0), "TDH"},
	{IXGBE_TDT(0), "TDT"},
	{IXGBE_TXDCTL(0), "TXDCTL"},

	/* List Terminator */
503
	{ .name = NULL }
504 505 506 507 508 509 510 511
};


/*
 * ixgbe_regdump - register printout routine
 */
static void ixgbe_regdump(struct ixgbe_hw *hw, struct ixgbe_reg_info *reginfo)
{
J
Joe Perches 已提交
512
	int i;
513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573
	char rname[16];
	u32 regs[64];

	switch (reginfo->ofs) {
	case IXGBE_SRRCTL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_SRRCTL(i));
		break;
	case IXGBE_DCA_RXCTRL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_DCA_RXCTRL(i));
		break;
	case IXGBE_RDLEN(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDLEN(i));
		break;
	case IXGBE_RDH(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDH(i));
		break;
	case IXGBE_RDT(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDT(i));
		break;
	case IXGBE_RXDCTL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RXDCTL(i));
		break;
	case IXGBE_RDBAL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDBAL(i));
		break;
	case IXGBE_RDBAH(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDBAH(i));
		break;
	case IXGBE_TDBAL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDBAL(i));
		break;
	case IXGBE_TDBAH(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDBAH(i));
		break;
	case IXGBE_TDLEN(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDLEN(i));
		break;
	case IXGBE_TDH(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDH(i));
		break;
	case IXGBE_TDT(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDT(i));
		break;
	case IXGBE_TXDCTL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TXDCTL(i));
		break;
	default:
J
Joe Perches 已提交
574 575
		pr_info("%-15s %08x\n",
			reginfo->name, IXGBE_READ_REG(hw, reginfo->ofs));
576 577 578
		return;
	}

J
Joe Perches 已提交
579 580 581 582 583 584 585
	i = 0;
	while (i < 64) {
		int j;
		char buf[9 * 8 + 1];
		char *p = buf;

		snprintf(rname, 16, "%s[%d-%d]", reginfo->name, i, i + 7);
586
		for (j = 0; j < 8; j++)
J
Joe Perches 已提交
587 588
			p += sprintf(p, " %08x", regs[i++]);
		pr_err("%-15s%s\n", rname, buf);
589 590 591 592 593 594 595 596 597 598 599 600 601 602
	}

}

/*
 * ixgbe_dump - Print registers, tx-rings and rx-rings
 */
static void ixgbe_dump(struct ixgbe_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_reg_info *reginfo;
	int n = 0;
	struct ixgbe_ring *tx_ring;
603
	struct ixgbe_tx_buffer *tx_buffer;
604 605 606 607 608 609 610 611 612 613 614 615 616 617
	union ixgbe_adv_tx_desc *tx_desc;
	struct my_u0 { u64 a; u64 b; } *u0;
	struct ixgbe_ring *rx_ring;
	union ixgbe_adv_rx_desc *rx_desc;
	struct ixgbe_rx_buffer *rx_buffer_info;
	u32 staterr;
	int i = 0;

	if (!netif_msg_hw(adapter))
		return;

	/* Print netdevice Info */
	if (netdev) {
		dev_info(&adapter->pdev->dev, "Net device Info\n");
618
		pr_info("Device Name     state            "
619 620
			"trans_start\n");
		pr_info("%-15s %016lX %016lX\n",
621 622
			netdev->name,
			netdev->state,
623
			dev_trans_start(netdev));
624 625 626 627
	}

	/* Print Registers */
	dev_info(&adapter->pdev->dev, "Register Dump\n");
628
	pr_info(" Register Name   Value\n");
629 630 631 632 633 634 635
	for (reginfo = (struct ixgbe_reg_info *)ixgbe_reg_info_tbl;
	     reginfo->name; reginfo++) {
		ixgbe_regdump(hw, reginfo);
	}

	/* Print TX Ring Summary */
	if (!netdev || !netif_running(netdev))
636
		return;
637 638

	dev_info(&adapter->pdev->dev, "TX Rings Summary\n");
J
Josh Hay 已提交
639 640 641
	pr_info(" %s     %s              %s        %s\n",
		"Queue [NTU] [NTC] [bi(ntc)->dma  ]",
		"leng", "ntw", "timestamp");
642 643
	for (n = 0; n < adapter->num_tx_queues; n++) {
		tx_ring = adapter->tx_ring[n];
644
		tx_buffer = &tx_ring->tx_buffer_info[tx_ring->next_to_clean];
J
Josh Hay 已提交
645
		pr_info(" %5d %5X %5X %016llX %08X %p %016llX\n",
646
			   n, tx_ring->next_to_use, tx_ring->next_to_clean,
647 648 649 650
			   (u64)dma_unmap_addr(tx_buffer, dma),
			   dma_unmap_len(tx_buffer, len),
			   tx_buffer->next_to_watch,
			   (u64)tx_buffer->time_stamp);
651 652 653 654 655 656 657 658 659 660
	}

	/* Print TX Rings */
	if (!netif_msg_tx_done(adapter))
		goto rx_ring_summary;

	dev_info(&adapter->pdev->dev, "TX Rings Dump\n");

	/* Transmit Descriptor Formats
	 *
661
	 * 82598 Advanced Transmit Descriptor
662 663 664
	 *   +--------------------------------------------------------------+
	 * 0 |         Buffer Address [63:0]                                |
	 *   +--------------------------------------------------------------+
665
	 * 8 |  PAYLEN  | POPTS  | IDX | STA | DCMD  |DTYP |  RSV |  DTALEN |
666 667
	 *   +--------------------------------------------------------------+
	 *   63       46 45    40 39 36 35 32 31   24 23 20 19              0
668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691
	 *
	 * 82598 Advanced Transmit Descriptor (Write-Back Format)
	 *   +--------------------------------------------------------------+
	 * 0 |                          RSV [63:0]                          |
	 *   +--------------------------------------------------------------+
	 * 8 |            RSV           |  STA  |          NXTSEQ           |
	 *   +--------------------------------------------------------------+
	 *   63                       36 35   32 31                         0
	 *
	 * 82599+ Advanced Transmit Descriptor
	 *   +--------------------------------------------------------------+
	 * 0 |         Buffer Address [63:0]                                |
	 *   +--------------------------------------------------------------+
	 * 8 |PAYLEN  |POPTS|CC|IDX  |STA  |DCMD  |DTYP |MAC  |RSV  |DTALEN |
	 *   +--------------------------------------------------------------+
	 *   63     46 45 40 39 38 36 35 32 31  24 23 20 19 18 17 16 15     0
	 *
	 * 82599+ Advanced Transmit Descriptor (Write-Back Format)
	 *   +--------------------------------------------------------------+
	 * 0 |                          RSV [63:0]                          |
	 *   +--------------------------------------------------------------+
	 * 8 |            RSV           |  STA  |           RSV             |
	 *   +--------------------------------------------------------------+
	 *   63                       36 35   32 31                         0
692 693 694 695
	 */

	for (n = 0; n < adapter->num_tx_queues; n++) {
		tx_ring = adapter->tx_ring[n];
696 697 698
		pr_info("------------------------------------\n");
		pr_info("TX QUEUE INDEX = %d\n", tx_ring->queue_index);
		pr_info("------------------------------------\n");
J
Josh Hay 已提交
699 700 701 702
		pr_info("%s%s    %s              %s        %s          %s\n",
			"T [desc]     [address 63:0  ] ",
			"[PlPOIdStDDt Ln] [bi->dma       ] ",
			"leng", "ntw", "timestamp", "bi->skb");
703 704

		for (i = 0; tx_ring->desc && (i < tx_ring->count); i++) {
705
			tx_desc = IXGBE_TX_DESC(tx_ring, i);
706
			tx_buffer = &tx_ring->tx_buffer_info[i];
707
			u0 = (struct my_u0 *)tx_desc;
J
Josh Hay 已提交
708
			if (dma_unmap_len(tx_buffer, len) > 0) {
J
Joe Perches 已提交
709 710 711 712 713 714 715 716 717 718 719 720
				const char *ring_desc;

				if (i == tx_ring->next_to_use &&
				    i == tx_ring->next_to_clean)
					ring_desc = " NTC/U";
				else if (i == tx_ring->next_to_use)
					ring_desc = " NTU";
				else if (i == tx_ring->next_to_clean)
					ring_desc = " NTC";
				else
					ring_desc = "";
				pr_info("T [0x%03X]    %016llX %016llX %016llX %08X %p %016llX %p%s",
J
Josh Hay 已提交
721 722 723 724
					i,
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
					(u64)dma_unmap_addr(tx_buffer, dma),
725
					dma_unmap_len(tx_buffer, len),
J
Josh Hay 已提交
726 727
					tx_buffer->next_to_watch,
					(u64)tx_buffer->time_stamp,
J
Joe Perches 已提交
728 729
					tx_buffer->skb,
					ring_desc);
J
Josh Hay 已提交
730 731 732 733 734 735 736 737 738

				if (netif_msg_pktdata(adapter) &&
				    tx_buffer->skb)
					print_hex_dump(KERN_INFO, "",
						DUMP_PREFIX_ADDRESS, 16, 1,
						tx_buffer->skb->data,
						dma_unmap_len(tx_buffer, len),
						true);
			}
739 740 741 742 743 744
		}
	}

	/* Print RX Rings Summary */
rx_ring_summary:
	dev_info(&adapter->pdev->dev, "RX Rings Summary\n");
745
	pr_info("Queue [NTU] [NTC]\n");
746 747
	for (n = 0; n < adapter->num_rx_queues; n++) {
		rx_ring = adapter->rx_ring[n];
748 749
		pr_info("%5d %5X %5X\n",
			n, rx_ring->next_to_use, rx_ring->next_to_clean);
750 751 752 753
	}

	/* Print RX Rings */
	if (!netif_msg_rx_status(adapter))
754
		return;
755 756 757

	dev_info(&adapter->pdev->dev, "RX Rings Dump\n");

758 759 760
	/* Receive Descriptor Formats
	 *
	 * 82598 Advanced Receive Descriptor (Read) Format
761 762 763 764 765 766 767 768
	 *    63                                           1        0
	 *    +-----------------------------------------------------+
	 *  0 |       Packet Buffer Address [63:1]           |A0/NSE|
	 *    +----------------------------------------------+------+
	 *  8 |       Header Buffer Address [63:1]           |  DD  |
	 *    +-----------------------------------------------------+
	 *
	 *
769
	 * 82598 Advanced Receive Descriptor (Write-Back) Format
770 771 772
	 *
	 *   63       48 47    32 31  30      21 20 16 15   4 3     0
	 *   +------------------------------------------------------+
773 774 775
	 * 0 |       RSS Hash /  |SPH| HDR_LEN  | RSV |Packet|  RSS |
	 *   | Packet   | IP     |   |          |     | Type | Type |
	 *   | Checksum | Ident  |   |          |     |      |      |
776 777 778 779
	 *   +------------------------------------------------------+
	 * 8 | VLAN Tag | Length | Extended Error | Extended Status |
	 *   +------------------------------------------------------+
	 *   63       48 47    32 31            20 19               0
780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800
	 *
	 * 82599+ Advanced Receive Descriptor (Read) Format
	 *    63                                           1        0
	 *    +-----------------------------------------------------+
	 *  0 |       Packet Buffer Address [63:1]           |A0/NSE|
	 *    +----------------------------------------------+------+
	 *  8 |       Header Buffer Address [63:1]           |  DD  |
	 *    +-----------------------------------------------------+
	 *
	 *
	 * 82599+ Advanced Receive Descriptor (Write-Back) Format
	 *
	 *   63       48 47    32 31  30      21 20 17 16   4 3     0
	 *   +------------------------------------------------------+
	 * 0 |RSS / Frag Checksum|SPH| HDR_LEN  |RSC- |Packet|  RSS |
	 *   |/ RTT / PCoE_PARAM |   |          | CNT | Type | Type |
	 *   |/ Flow Dir Flt ID  |   |          |     |      |      |
	 *   +------------------------------------------------------+
	 * 8 | VLAN Tag | Length |Extended Error| Xtnd Status/NEXTP |
	 *   +------------------------------------------------------+
	 *   63       48 47    32 31          20 19                 0
801
	 */
802

803 804
	for (n = 0; n < adapter->num_rx_queues; n++) {
		rx_ring = adapter->rx_ring[n];
805 806 807
		pr_info("------------------------------------\n");
		pr_info("RX QUEUE INDEX = %d\n", rx_ring->queue_index);
		pr_info("------------------------------------\n");
J
Joe Perches 已提交
808
		pr_info("%s%s%s\n",
J
Josh Hay 已提交
809 810
			"R  [desc]      [ PktBuf     A0] ",
			"[  HeadBuf   DD] [bi->dma       ] [bi->skb       ] ",
J
Joe Perches 已提交
811 812
			"<-- Adv Rx Read format");
		pr_info("%s%s%s\n",
J
Josh Hay 已提交
813 814
			"RWB[desc]      [PcsmIpSHl PtRs] ",
			"[vl er S cks ln] ---------------- [bi->skb       ] ",
J
Joe Perches 已提交
815
			"<-- Adv Rx Write-Back format");
816 817

		for (i = 0; i < rx_ring->count; i++) {
J
Joe Perches 已提交
818 819 820 821 822 823 824 825 826
			const char *ring_desc;

			if (i == rx_ring->next_to_use)
				ring_desc = " NTU";
			else if (i == rx_ring->next_to_clean)
				ring_desc = " NTC";
			else
				ring_desc = "";

827
			rx_buffer_info = &rx_ring->rx_buffer_info[i];
828
			rx_desc = IXGBE_RX_DESC(rx_ring, i);
829 830 831 832
			u0 = (struct my_u0 *)rx_desc;
			staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
			if (staterr & IXGBE_RXD_STAT_DD) {
				/* Descriptor Done */
J
Joe Perches 已提交
833 834
				pr_info("RWB[0x%03X]     %016llX %016llX ---------------- %p%s\n",
					i,
835 836
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
J
Joe Perches 已提交
837 838
					rx_buffer_info->skb,
					ring_desc);
839
			} else {
J
Joe Perches 已提交
840 841
				pr_info("R  [0x%03X]     %016llX %016llX %016llX %p%s\n",
					i,
842 843 844
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
					(u64)rx_buffer_info->dma,
J
Joe Perches 已提交
845 846
					rx_buffer_info->skb,
					ring_desc);
847

848 849
				if (netif_msg_pktdata(adapter) &&
				    rx_buffer_info->dma) {
850 851
					print_hex_dump(KERN_INFO, "",
					   DUMP_PREFIX_ADDRESS, 16, 1,
852 853
					   page_address(rx_buffer_info->page) +
						    rx_buffer_info->page_offset,
854
					   ixgbe_rx_bufsz(rx_ring), true);
855 856 857 858 859 860
				}
			}
		}
	}
}

861 862 863 864 865 866 867
static void ixgbe_release_hw_control(struct ixgbe_adapter *adapter)
{
	u32 ctrl_ext;

	/* Let firmware take over control of h/w */
	ctrl_ext = IXGBE_READ_REG(&adapter->hw, IXGBE_CTRL_EXT);
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_CTRL_EXT,
868
			ctrl_ext & ~IXGBE_CTRL_EXT_DRV_LOAD);
869 870 871 872 873 874 875 876 877
}

static void ixgbe_get_hw_control(struct ixgbe_adapter *adapter)
{
	u32 ctrl_ext;

	/* Let firmware know the driver has taken over */
	ctrl_ext = IXGBE_READ_REG(&adapter->hw, IXGBE_CTRL_EXT);
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_CTRL_EXT,
878
			ctrl_ext | IXGBE_CTRL_EXT_DRV_LOAD);
879
}
880

881
/**
882 883 884 885 886 887 888 889
 * ixgbe_set_ivar - set the IVAR registers, mapping interrupt causes to vectors
 * @adapter: pointer to adapter struct
 * @direction: 0 for Rx, 1 for Tx, -1 for other causes
 * @queue: queue to map the corresponding interrupt to
 * @msix_vector: the vector to map to the corresponding queue
 *
 */
static void ixgbe_set_ivar(struct ixgbe_adapter *adapter, s8 direction,
890
			   u8 queue, u8 msix_vector)
891 892
{
	u32 ivar, index;
893 894 895 896 897 898 899 900 901 902 903 904 905
	struct ixgbe_hw *hw = &adapter->hw;
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
		msix_vector |= IXGBE_IVAR_ALLOC_VAL;
		if (direction == -1)
			direction = 0;
		index = (((direction * 64) + queue) >> 2) & 0x1F;
		ivar = IXGBE_READ_REG(hw, IXGBE_IVAR(index));
		ivar &= ~(0xFF << (8 * (queue & 0x3)));
		ivar |= (msix_vector << (8 * (queue & 0x3)));
		IXGBE_WRITE_REG(hw, IXGBE_IVAR(index), ivar);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
906
	case ixgbe_mac_X540:
907 908
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
909
	case ixgbe_mac_x550em_a:
910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931
		if (direction == -1) {
			/* other causes */
			msix_vector |= IXGBE_IVAR_ALLOC_VAL;
			index = ((queue & 1) * 8);
			ivar = IXGBE_READ_REG(&adapter->hw, IXGBE_IVAR_MISC);
			ivar &= ~(0xFF << index);
			ivar |= (msix_vector << index);
			IXGBE_WRITE_REG(&adapter->hw, IXGBE_IVAR_MISC, ivar);
			break;
		} else {
			/* tx or rx causes */
			msix_vector |= IXGBE_IVAR_ALLOC_VAL;
			index = ((16 * (queue & 1)) + (8 * direction));
			ivar = IXGBE_READ_REG(hw, IXGBE_IVAR(queue >> 1));
			ivar &= ~(0xFF << index);
			ivar |= (msix_vector << index);
			IXGBE_WRITE_REG(hw, IXGBE_IVAR(queue >> 1), ivar);
			break;
		}
	default:
		break;
	}
932 933
}

934
static inline void ixgbe_irq_rearm_queues(struct ixgbe_adapter *adapter,
935
					  u64 qmask)
936 937 938
{
	u32 mask;

939 940
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
941 942
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS, mask);
943 944
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
945
	case ixgbe_mac_X540:
946 947
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
948
	case ixgbe_mac_x550em_a:
949 950 951 952
		mask = (qmask & 0xFFFFFFFF);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS_EX(0), mask);
		mask = (qmask >> 32);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS_EX(1), mask);
953 954 955
		break;
	default:
		break;
956 957 958
	}
}

959
static void ixgbe_update_xoff_rx_lfc(struct ixgbe_adapter *adapter)
960 961 962 963
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_hw_stats *hwstats = &adapter->stats;
	int i;
964
	u32 data;
965

966 967 968
	if ((hw->fc.current_mode != ixgbe_fc_full) &&
	    (hw->fc.current_mode != ixgbe_fc_rx_pause))
		return;
969

970 971 972 973 974 975 976 977
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
		data = IXGBE_READ_REG(hw, IXGBE_LXOFFRXC);
		break;
	default:
		data = IXGBE_READ_REG(hw, IXGBE_LXOFFRXCNT);
	}
	hwstats->lxoffrxc += data;
978

979 980
	/* refill credits (no tx hang) if we received xoff */
	if (!data)
981
		return;
982 983 984 985 986 987 988 989 990 991 992

	for (i = 0; i < adapter->num_tx_queues; i++)
		clear_bit(__IXGBE_HANG_CHECK_ARMED,
			  &adapter->tx_ring[i]->state);
}

static void ixgbe_update_xoff_received(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_hw_stats *hwstats = &adapter->stats;
	u32 xoff[8] = {0};
993
	u8 tc;
994 995 996 997 998 999 1000 1001
	int i;
	bool pfc_en = adapter->dcb_cfg.pfc_mode_enable;

	if (adapter->ixgbe_ieee_pfc)
		pfc_en |= !!(adapter->ixgbe_ieee_pfc->pfc_en);

	if (!(adapter->flags & IXGBE_FLAG_DCB_ENABLED) || !pfc_en) {
		ixgbe_update_xoff_rx_lfc(adapter);
1002
		return;
1003
	}
1004 1005 1006

	/* update stats for each tc, only valid with PFC enabled */
	for (i = 0; i < MAX_TX_PACKET_BUFFERS; i++) {
1007 1008
		u32 pxoffrxc;

1009 1010
		switch (hw->mac.type) {
		case ixgbe_mac_82598EB:
1011
			pxoffrxc = IXGBE_READ_REG(hw, IXGBE_PXOFFRXC(i));
1012
			break;
1013
		default:
1014
			pxoffrxc = IXGBE_READ_REG(hw, IXGBE_PXOFFRXCNT(i));
1015
		}
1016 1017 1018 1019
		hwstats->pxoffrxc[i] += pxoffrxc;
		/* Get the TC for given UP */
		tc = netdev_get_prio_tc_map(adapter->netdev, i);
		xoff[tc] += pxoffrxc;
1020 1021 1022 1023 1024 1025
	}

	/* disarm tx queues that have received xoff frames */
	for (i = 0; i < adapter->num_tx_queues; i++) {
		struct ixgbe_ring *tx_ring = adapter->tx_ring[i];

1026
		tc = tx_ring->dcb_tc;
1027 1028
		if (xoff[tc])
			clear_bit(__IXGBE_HANG_CHECK_ARMED, &tx_ring->state);
1029 1030 1031
	}
}

1032
static u64 ixgbe_get_tx_completed(struct ixgbe_ring *ring)
1033
{
1034
	return ring->stats.packets;
1035 1036 1037 1038
}

static u64 ixgbe_get_tx_pending(struct ixgbe_ring *ring)
{
1039 1040 1041 1042 1043 1044 1045 1046
	struct ixgbe_adapter *adapter;
	struct ixgbe_hw *hw;
	u32 head, tail;

	if (ring->l2_accel_priv)
		adapter = ring->l2_accel_priv->real_adapter;
	else
		adapter = netdev_priv(ring->netdev);
1047

1048 1049 1050
	hw = &adapter->hw;
	head = IXGBE_READ_REG(hw, IXGBE_TDH(ring->reg_idx));
	tail = IXGBE_READ_REG(hw, IXGBE_TDT(ring->reg_idx));
1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064

	if (head != tail)
		return (head < tail) ?
			tail - head : (tail + ring->count - head);

	return 0;
}

static inline bool ixgbe_check_tx_hang(struct ixgbe_ring *tx_ring)
{
	u32 tx_done = ixgbe_get_tx_completed(tx_ring);
	u32 tx_done_old = tx_ring->tx_stats.tx_done_old;
	u32 tx_pending = ixgbe_get_tx_pending(tx_ring);

A
Alexander Duyck 已提交
1065
	clear_check_for_tx_hang(tx_ring);
1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078

	/*
	 * Check for a hung queue, but be thorough. This verifies
	 * that a transmit has been completed since the previous
	 * check AND there is at least one packet pending. The
	 * ARMED bit is set to indicate a potential hang. The
	 * bit is cleared if a pause frame is received to remove
	 * false hang detection due to PFC or 802.3x frames. By
	 * requiring this to fail twice we avoid races with
	 * pfc clearing the ARMED bit and conditions where we
	 * run the check_tx_hang logic with a transmit completion
	 * pending but without time to complete it yet.
	 */
1079
	if (tx_done_old == tx_done && tx_pending)
1080
		/* make sure it is true for two checks in a row */
1081 1082 1083 1084 1085 1086
		return test_and_set_bit(__IXGBE_HANG_CHECK_ARMED,
					&tx_ring->state);
	/* update completed stats and continue */
	tx_ring->tx_stats.tx_done_old = tx_done;
	/* reset the countdown */
	clear_bit(__IXGBE_HANG_CHECK_ARMED, &tx_ring->state);
1087

1088
	return false;
1089 1090
}

1091 1092 1093 1094 1095 1096 1097 1098 1099
/**
 * ixgbe_tx_timeout_reset - initiate reset due to Tx timeout
 * @adapter: driver private struct
 **/
static void ixgbe_tx_timeout_reset(struct ixgbe_adapter *adapter)
{

	/* Do the reset outside of interrupt context */
	if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
1100
		set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
1101
		e_warn(drv, "initiating reset due to tx timeout\n");
1102 1103 1104
		ixgbe_service_event_schedule(adapter);
	}
}
1105

1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135
/**
 * ixgbe_tx_maxrate - callback to set the maximum per-queue bitrate
 **/
static int ixgbe_tx_maxrate(struct net_device *netdev,
			    int queue_index, u32 maxrate)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;
	u32 bcnrc_val = ixgbe_link_mbps(adapter);

	if (!maxrate)
		return 0;

	/* Calculate the rate factor values to set */
	bcnrc_val <<= IXGBE_RTTBCNRC_RF_INT_SHIFT;
	bcnrc_val /= maxrate;

	/* clear everything but the rate factor */
	bcnrc_val &= IXGBE_RTTBCNRC_RF_INT_MASK |
	IXGBE_RTTBCNRC_RF_DEC_MASK;

	/* enable the rate scheduler */
	bcnrc_val |= IXGBE_RTTBCNRC_RS_ENA;

	IXGBE_WRITE_REG(hw, IXGBE_RTTDQSEL, queue_index);
	IXGBE_WRITE_REG(hw, IXGBE_RTTBCNRC, bcnrc_val);

	return 0;
}

1136 1137
/**
 * ixgbe_clean_tx_irq - Reclaim resources after transmit completes
1138
 * @q_vector: structure containing interrupt and ring information
1139
 * @tx_ring: tx ring to clean
1140
 * @napi_budget: Used to determine if we are in netpoll
1141
 **/
1142
static bool ixgbe_clean_tx_irq(struct ixgbe_q_vector *q_vector,
1143
			       struct ixgbe_ring *tx_ring, int napi_budget)
1144
{
1145
	struct ixgbe_adapter *adapter = q_vector->adapter;
1146 1147
	struct ixgbe_tx_buffer *tx_buffer;
	union ixgbe_adv_tx_desc *tx_desc;
1148
	unsigned int total_bytes = 0, total_packets = 0;
1149
	unsigned int budget = q_vector->tx.work_limit;
1150 1151 1152 1153
	unsigned int i = tx_ring->next_to_clean;

	if (test_bit(__IXGBE_DOWN, &adapter->state))
		return true;
1154

1155
	tx_buffer = &tx_ring->tx_buffer_info[i];
1156
	tx_desc = IXGBE_TX_DESC(tx_ring, i);
1157
	i -= tx_ring->count;
1158

1159
	do {
1160 1161 1162 1163 1164 1165
		union ixgbe_adv_tx_desc *eop_desc = tx_buffer->next_to_watch;

		/* if next_to_watch is not set then there is no work pending */
		if (!eop_desc)
			break;

1166
		/* prevent any other reads prior to eop_desc */
1167
		read_barrier_depends();
1168

1169 1170 1171
		/* if DD is not set pending work has not been completed */
		if (!(eop_desc->wb.status & cpu_to_le32(IXGBE_TXD_STAT_DD)))
			break;
1172

1173 1174
		/* clear next_to_watch to prevent false hangs */
		tx_buffer->next_to_watch = NULL;
1175

1176 1177 1178 1179
		/* update the statistics for this packet */
		total_bytes += tx_buffer->bytecount;
		total_packets += tx_buffer->gso_segs;

1180
		/* free the skb */
1181
		napi_consume_skb(tx_buffer->skb, napi_budget);
1182

1183 1184 1185 1186 1187 1188
		/* unmap skb header data */
		dma_unmap_single(tx_ring->dev,
				 dma_unmap_addr(tx_buffer, dma),
				 dma_unmap_len(tx_buffer, len),
				 DMA_TO_DEVICE);

1189
		/* clear tx_buffer data */
1190
		dma_unmap_len_set(tx_buffer, len, 0);
1191

1192 1193
		/* unmap remaining buffers */
		while (tx_desc != eop_desc) {
1194 1195
			tx_buffer++;
			tx_desc++;
1196
			i++;
1197 1198
			if (unlikely(!i)) {
				i -= tx_ring->count;
1199
				tx_buffer = tx_ring->tx_buffer_info;
1200
				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
1201
			}
1202

1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224
			/* unmap any remaining paged data */
			if (dma_unmap_len(tx_buffer, len)) {
				dma_unmap_page(tx_ring->dev,
					       dma_unmap_addr(tx_buffer, dma),
					       dma_unmap_len(tx_buffer, len),
					       DMA_TO_DEVICE);
				dma_unmap_len_set(tx_buffer, len, 0);
			}
		}

		/* move us one more past the eop_desc for start of next pkt */
		tx_buffer++;
		tx_desc++;
		i++;
		if (unlikely(!i)) {
			i -= tx_ring->count;
			tx_buffer = tx_ring->tx_buffer_info;
			tx_desc = IXGBE_TX_DESC(tx_ring, 0);
		}

		/* issue prefetch for next Tx descriptor */
		prefetch(tx_desc);
1225

1226 1227 1228 1229 1230
		/* update budget accounting */
		budget--;
	} while (likely(budget));

	i += tx_ring->count;
1231
	tx_ring->next_to_clean = i;
1232
	u64_stats_update_begin(&tx_ring->syncp);
1233
	tx_ring->stats.bytes += total_bytes;
1234
	tx_ring->stats.packets += total_packets;
1235
	u64_stats_update_end(&tx_ring->syncp);
1236 1237
	q_vector->tx.total_bytes += total_bytes;
	q_vector->tx.total_packets += total_packets;
1238

1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252
	if (check_for_tx_hang(tx_ring) && ixgbe_check_tx_hang(tx_ring)) {
		/* schedule immediate reset if we believe we hung */
		struct ixgbe_hw *hw = &adapter->hw;
		e_err(drv, "Detected Tx Unit Hang\n"
			"  Tx Queue             <%d>\n"
			"  TDH, TDT             <%x>, <%x>\n"
			"  next_to_use          <%x>\n"
			"  next_to_clean        <%x>\n"
			"tx_buffer_info[next_to_clean]\n"
			"  time_stamp           <%lx>\n"
			"  jiffies              <%lx>\n",
			tx_ring->queue_index,
			IXGBE_READ_REG(hw, IXGBE_TDH(tx_ring->reg_idx)),
			IXGBE_READ_REG(hw, IXGBE_TDT(tx_ring->reg_idx)),
1253 1254
			tx_ring->next_to_use, i,
			tx_ring->tx_buffer_info[i].time_stamp, jiffies);
1255 1256 1257 1258 1259 1260 1261

		netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);

		e_info(probe,
		       "tx hang %d detected on queue %d, resetting adapter\n",
			adapter->tx_timeout_count + 1, tx_ring->queue_index);

1262
		/* schedule immediate reset if we believe we hung */
1263
		ixgbe_tx_timeout_reset(adapter);
1264 1265

		/* the adapter is about to reset, no point in enabling stuff */
1266
		return true;
1267
	}
1268

1269 1270 1271
	netdev_tx_completed_queue(txring_txq(tx_ring),
				  total_packets, total_bytes);

1272
#define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
1273
	if (unlikely(total_packets && netif_carrier_ok(tx_ring->netdev) &&
1274
		     (ixgbe_desc_unused(tx_ring) >= TX_WAKE_THRESHOLD))) {
1275 1276 1277 1278
		/* Make sure that anybody stopping the queue after this
		 * sees the new next_to_clean.
		 */
		smp_mb();
1279 1280 1281 1282 1283
		if (__netif_subqueue_stopped(tx_ring->netdev,
					     tx_ring->queue_index)
		    && !test_bit(__IXGBE_DOWN, &adapter->state)) {
			netif_wake_subqueue(tx_ring->netdev,
					    tx_ring->queue_index);
1284
			++tx_ring->tx_stats.restart_queue;
1285
		}
1286
	}
1287

1288
	return !!budget;
1289 1290
}

1291
#ifdef CONFIG_IXGBE_DCA
1292 1293
static void ixgbe_update_tx_dca(struct ixgbe_adapter *adapter,
				struct ixgbe_ring *tx_ring,
1294
				int cpu)
1295
{
1296
	struct ixgbe_hw *hw = &adapter->hw;
1297
	u32 txctrl = 0;
1298
	u16 reg_offset;
1299

1300 1301 1302
	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
		txctrl = dca3_get_tag(tx_ring->dev, cpu);

1303 1304
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
1305
		reg_offset = IXGBE_DCA_TXCTRL(tx_ring->reg_idx);
1306 1307
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
1308
	case ixgbe_mac_X540:
1309 1310
		reg_offset = IXGBE_DCA_TXCTRL_82599(tx_ring->reg_idx);
		txctrl <<= IXGBE_DCA_TXCTRL_CPUID_SHIFT_82599;
1311 1312
		break;
	default:
1313 1314
		/* for unknown hardware do not write register */
		return;
1315
	}
1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326

	/*
	 * We can enable relaxed ordering for reads, but not writes when
	 * DCA is enabled.  This is due to a known issue in some chipsets
	 * which will cause the DCA tag to be cleared.
	 */
	txctrl |= IXGBE_DCA_TXCTRL_DESC_RRO_EN |
		  IXGBE_DCA_TXCTRL_DATA_RRO_EN |
		  IXGBE_DCA_TXCTRL_DESC_DCA_EN;

	IXGBE_WRITE_REG(hw, reg_offset, txctrl);
1327 1328
}

1329 1330
static void ixgbe_update_rx_dca(struct ixgbe_adapter *adapter,
				struct ixgbe_ring *rx_ring,
1331
				int cpu)
1332
{
1333
	struct ixgbe_hw *hw = &adapter->hw;
1334
	u32 rxctrl = 0;
1335 1336
	u8 reg_idx = rx_ring->reg_idx;

1337 1338
	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
		rxctrl = dca3_get_tag(rx_ring->dev, cpu);
1339 1340 1341

	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
1342
	case ixgbe_mac_X540:
1343
		rxctrl <<= IXGBE_DCA_RXCTRL_CPUID_SHIFT_82599;
1344 1345 1346 1347
		break;
	default:
		break;
	}
1348 1349 1350 1351 1352 1353 1354

	/*
	 * We can enable relaxed ordering for reads, but not writes when
	 * DCA is enabled.  This is due to a known issue in some chipsets
	 * which will cause the DCA tag to be cleared.
	 */
	rxctrl |= IXGBE_DCA_RXCTRL_DESC_RRO_EN |
1355
		  IXGBE_DCA_RXCTRL_DATA_DCA_EN |
1356 1357 1358
		  IXGBE_DCA_RXCTRL_DESC_DCA_EN;

	IXGBE_WRITE_REG(hw, IXGBE_DCA_RXCTRL(reg_idx), rxctrl);
1359 1360 1361 1362 1363
}

static void ixgbe_update_dca(struct ixgbe_q_vector *q_vector)
{
	struct ixgbe_adapter *adapter = q_vector->adapter;
1364
	struct ixgbe_ring *ring;
1365 1366
	int cpu = get_cpu();

1367 1368 1369
	if (q_vector->cpu == cpu)
		goto out_no_update;

1370
	ixgbe_for_each_ring(ring, q_vector->tx)
1371
		ixgbe_update_tx_dca(adapter, ring, cpu);
1372

1373
	ixgbe_for_each_ring(ring, q_vector->rx)
1374
		ixgbe_update_rx_dca(adapter, ring, cpu);
1375 1376 1377

	q_vector->cpu = cpu;
out_no_update:
1378 1379 1380 1381 1382 1383 1384
	put_cpu();
}

static void ixgbe_setup_dca(struct ixgbe_adapter *adapter)
{
	int i;

1385
	/* always use CB2 mode, difference is masked in the CB driver */
1386 1387 1388 1389 1390 1391
	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
				IXGBE_DCA_CTRL_DCA_MODE_CB2);
	else
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
				IXGBE_DCA_CTRL_DCA_DISABLE);
1392

1393
	for (i = 0; i < adapter->num_q_vectors; i++) {
1394 1395
		adapter->q_vector[i]->cpu = -1;
		ixgbe_update_dca(adapter->q_vector[i]);
1396 1397 1398 1399 1400
	}
}

static int __ixgbe_notify_dca(struct device *dev, void *data)
{
1401
	struct ixgbe_adapter *adapter = dev_get_drvdata(dev);
1402 1403
	unsigned long event = *(unsigned long *)data;

1404
	if (!(adapter->flags & IXGBE_FLAG_DCA_CAPABLE))
1405 1406
		return 0;

1407 1408
	switch (event) {
	case DCA_PROVIDER_ADD:
1409 1410 1411
		/* if we're already enabled, don't do it again */
		if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
			break;
1412
		if (dca_add_requester(dev) == 0) {
1413
			adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
1414 1415
			IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
					IXGBE_DCA_CTRL_DCA_MODE_CB2);
1416 1417 1418 1419 1420 1421 1422
			break;
		}
		/* Fall Through since DCA is disabled. */
	case DCA_PROVIDER_REMOVE:
		if (adapter->flags & IXGBE_FLAG_DCA_ENABLED) {
			dca_remove_requester(dev);
			adapter->flags &= ~IXGBE_FLAG_DCA_ENABLED;
1423 1424
			IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
					IXGBE_DCA_CTRL_DCA_DISABLE);
1425 1426 1427 1428
		}
		break;
	}

1429
	return 0;
1430
}
E
Emil Tantilov 已提交
1431

1432
#endif /* CONFIG_IXGBE_DCA */
1433 1434 1435 1436 1437 1438 1439

#define IXGBE_RSS_L4_TYPES_MASK \
	((1ul << IXGBE_RXDADV_RSSTYPE_IPV4_TCP) | \
	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV4_UDP) | \
	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV6_TCP) | \
	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV6_UDP))

1440 1441
static inline void ixgbe_rx_hash(struct ixgbe_ring *ring,
				 union ixgbe_adv_rx_desc *rx_desc,
E
Emil Tantilov 已提交
1442 1443
				 struct sk_buff *skb)
{
1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457
	u16 rss_type;

	if (!(ring->netdev->features & NETIF_F_RXHASH))
		return;

	rss_type = le16_to_cpu(rx_desc->wb.lower.lo_dword.hs_rss.pkt_info) &
		   IXGBE_RXDADV_RSSTYPE_MASK;

	if (!rss_type)
		return;

	skb_set_hash(skb, le32_to_cpu(rx_desc->wb.lower.hi_dword.rss),
		     (IXGBE_RSS_L4_TYPES_MASK & (1ul << rss_type)) ?
		     PKT_HASH_TYPE_L4 : PKT_HASH_TYPE_L3);
E
Emil Tantilov 已提交
1458 1459
}

1460
#ifdef IXGBE_FCOE
1461 1462
/**
 * ixgbe_rx_is_fcoe - check the rx desc for incoming pkt type
1463
 * @ring: structure containing ring specific data
1464 1465 1466 1467
 * @rx_desc: advanced rx descriptor
 *
 * Returns : true if it is FCoE pkt
 */
1468
static inline bool ixgbe_rx_is_fcoe(struct ixgbe_ring *ring,
1469 1470 1471 1472
				    union ixgbe_adv_rx_desc *rx_desc)
{
	__le16 pkt_info = rx_desc->wb.lower.lo_dword.hs_rss.pkt_info;

1473
	return test_bit(__IXGBE_RX_FCOE, &ring->state) &&
1474 1475 1476 1477 1478
	       ((pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_ETQF_MASK)) ==
		(cpu_to_le16(IXGBE_ETQF_FILTER_FCOE <<
			     IXGBE_RXDADV_PKTTYPE_ETQF_SHIFT)));
}

1479
#endif /* IXGBE_FCOE */
1480 1481
/**
 * ixgbe_rx_checksum - indicate in skb if hw indicated a good cksum
1482 1483
 * @ring: structure containing ring specific data
 * @rx_desc: current Rx descriptor being processed
1484 1485
 * @skb: skb currently being received and modified
 **/
1486
static inline void ixgbe_rx_checksum(struct ixgbe_ring *ring,
1487
				     union ixgbe_adv_rx_desc *rx_desc,
1488
				     struct sk_buff *skb)
1489
{
1490 1491 1492
	__le16 pkt_info = rx_desc->wb.lower.lo_dword.hs_rss.pkt_info;
	bool encap_pkt = false;

1493
	skb_checksum_none_assert(skb);
1494

1495
	/* Rx csum disabled */
1496
	if (!(ring->netdev->features & NETIF_F_RXCSUM))
1497
		return;
1498

1499 1500
	/* check for VXLAN and Geneve packets */
	if (pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_VXLAN)) {
1501 1502 1503 1504
		encap_pkt = true;
		skb->encapsulation = 1;
	}

1505
	/* if IP and error */
1506 1507
	if (ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_IPCS) &&
	    ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_IPE)) {
1508
		ring->rx_stats.csum_err++;
1509 1510
		return;
	}
1511

1512
	if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_L4CS))
1513 1514
		return;

1515
	if (ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_TCPE)) {
1516 1517 1518 1519
		/*
		 * 82599 errata, UDP frames with a 0 checksum can be marked as
		 * checksum errors.
		 */
1520 1521
		if ((pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_UDP)) &&
		    test_bit(__IXGBE_RX_CSUM_UDP_ZERO_ERR, &ring->state))
1522 1523
			return;

1524
		ring->rx_stats.csum_err++;
1525 1526 1527
		return;
	}

1528
	/* It must be a TCP or UDP packet with a valid checksum */
1529
	skb->ip_summed = CHECKSUM_UNNECESSARY;
1530 1531 1532 1533 1534
	if (encap_pkt) {
		if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_OUTERIPCS))
			return;

		if (ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_OUTERIPER)) {
1535
			skb->ip_summed = CHECKSUM_NONE;
1536 1537 1538 1539 1540
			return;
		}
		/* If we checked the outer header let the stack know */
		skb->csum_level = 1;
	}
1541 1542
}

1543 1544 1545 1546 1547
static inline unsigned int ixgbe_rx_offset(struct ixgbe_ring *rx_ring)
{
	return ring_uses_build_skb(rx_ring) ? IXGBE_SKB_PAD : 0;
}

1548 1549 1550 1551
static bool ixgbe_alloc_mapped_page(struct ixgbe_ring *rx_ring,
				    struct ixgbe_rx_buffer *bi)
{
	struct page *page = bi->page;
A
Alexander Duyck 已提交
1552
	dma_addr_t dma;
1553

1554
	/* since we are recycling buffers we should seldom need to alloc */
A
Alexander Duyck 已提交
1555
	if (likely(page))
1556 1557
		return true;

1558
	/* alloc new page for storage */
A
Alexander Duyck 已提交
1559 1560 1561 1562
	page = dev_alloc_pages(ixgbe_rx_pg_order(rx_ring));
	if (unlikely(!page)) {
		rx_ring->rx_stats.alloc_rx_page_failed++;
		return false;
1563 1564
	}

1565
	/* map page for use */
1566 1567 1568 1569
	dma = dma_map_page_attrs(rx_ring->dev, page, 0,
				 ixgbe_rx_pg_size(rx_ring),
				 DMA_FROM_DEVICE,
				 IXGBE_RX_DMA_ATTR);
1570 1571 1572 1573 1574 1575

	/*
	 * if mapping failed free memory back to system since
	 * there isn't much point in holding memory we can't use
	 */
	if (dma_mapping_error(rx_ring->dev, dma)) {
1576
		__free_pages(page, ixgbe_rx_pg_order(rx_ring));
1577 1578 1579 1580 1581

		rx_ring->rx_stats.alloc_rx_page_failed++;
		return false;
	}

1582
	bi->dma = dma;
A
Alexander Duyck 已提交
1583
	bi->page = page;
1584
	bi->page_offset = ixgbe_rx_offset(rx_ring);
1585
	bi->pagecnt_bias = 1;
1586

1587 1588 1589
	return true;
}

1590
/**
1591
 * ixgbe_alloc_rx_buffers - Replace used receive buffers
1592 1593
 * @rx_ring: ring to place buffers on
 * @cleaned_count: number of buffers to replace
1594
 **/
1595
void ixgbe_alloc_rx_buffers(struct ixgbe_ring *rx_ring, u16 cleaned_count)
1596 1597
{
	union ixgbe_adv_rx_desc *rx_desc;
1598
	struct ixgbe_rx_buffer *bi;
1599
	u16 i = rx_ring->next_to_use;
1600
	u16 bufsz;
1601

1602 1603
	/* nothing to do */
	if (!cleaned_count)
1604 1605
		return;

1606
	rx_desc = IXGBE_RX_DESC(rx_ring, i);
1607 1608
	bi = &rx_ring->rx_buffer_info[i];
	i -= rx_ring->count;
1609

1610 1611
	bufsz = ixgbe_rx_bufsz(rx_ring);

1612 1613
	do {
		if (!ixgbe_alloc_mapped_page(rx_ring, bi))
1614
			break;
1615

1616 1617
		/* sync the buffer for use by the device */
		dma_sync_single_range_for_device(rx_ring->dev, bi->dma,
1618
						 bi->page_offset, bufsz,
1619 1620
						 DMA_FROM_DEVICE);

1621 1622 1623 1624 1625
		/*
		 * Refresh the desc even if buffer_addrs didn't change
		 * because each write-back erases this info.
		 */
		rx_desc->read.pkt_addr = cpu_to_le64(bi->dma + bi->page_offset);
1626

1627 1628
		rx_desc++;
		bi++;
1629
		i++;
1630
		if (unlikely(!i)) {
1631
			rx_desc = IXGBE_RX_DESC(rx_ring, 0);
1632 1633 1634 1635
			bi = rx_ring->rx_buffer_info;
			i -= rx_ring->count;
		}

1636 1637
		/* clear the length for the next_to_use descriptor */
		rx_desc->wb.upper.length = 0;
1638 1639 1640

		cleaned_count--;
	} while (cleaned_count);
1641

1642 1643
	i += rx_ring->count;

1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657
	if (rx_ring->next_to_use != i) {
		rx_ring->next_to_use = i;

		/* update next to alloc since we have filled the ring */
		rx_ring->next_to_alloc = i;

		/* Force memory writes to complete before letting h/w
		 * know there are new descriptors to fetch.  (Only
		 * applicable for weak-ordered memory model archs,
		 * such as IA-64).
		 */
		wmb();
		writel(i, rx_ring->tail);
	}
1658 1659
}

1660 1661 1662
static void ixgbe_set_rsc_gso_size(struct ixgbe_ring *ring,
				   struct sk_buff *skb)
{
1663
	u16 hdr_len = skb_headlen(skb);
1664 1665 1666 1667

	/* set gso_size to avoid messing up TCP MSS */
	skb_shinfo(skb)->gso_size = DIV_ROUND_UP((skb->len - hdr_len),
						 IXGBE_CB(skb)->append_cnt);
1668
	skb_shinfo(skb)->gso_type = SKB_GSO_TCPV4;
1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686
}

static void ixgbe_update_rsc_stats(struct ixgbe_ring *rx_ring,
				   struct sk_buff *skb)
{
	/* if append_cnt is 0 then frame is not RSC */
	if (!IXGBE_CB(skb)->append_cnt)
		return;

	rx_ring->rx_stats.rsc_count += IXGBE_CB(skb)->append_cnt;
	rx_ring->rx_stats.rsc_flush++;

	ixgbe_set_rsc_gso_size(rx_ring, skb);

	/* gso_size is computed using append_cnt so always clear it last */
	IXGBE_CB(skb)->append_cnt = 0;
}

1687 1688 1689 1690 1691
/**
 * ixgbe_process_skb_fields - Populate skb header fields from Rx descriptor
 * @rx_ring: rx descriptor ring packet is being transacted on
 * @rx_desc: pointer to the EOP Rx descriptor
 * @skb: pointer to current skb being populated
A
Alexander Duyck 已提交
1692
 *
1693 1694 1695
 * This function checks the ring, descriptor, and packet information in
 * order to populate the hash, checksum, VLAN, timestamp, protocol, and
 * other fields within the skb.
A
Alexander Duyck 已提交
1696
 **/
1697 1698 1699
static void ixgbe_process_skb_fields(struct ixgbe_ring *rx_ring,
				     union ixgbe_adv_rx_desc *rx_desc,
				     struct sk_buff *skb)
A
Alexander Duyck 已提交
1700
{
1701
	struct net_device *dev = rx_ring->netdev;
1702
	u32 flags = rx_ring->q_vector->adapter->flags;
1703

1704 1705 1706
	ixgbe_update_rsc_stats(rx_ring, skb);

	ixgbe_rx_hash(rx_ring, rx_desc, skb);
A
Alexander Duyck 已提交
1707

1708 1709
	ixgbe_rx_checksum(rx_ring, rx_desc, skb);

1710 1711
	if (unlikely(flags & IXGBE_FLAG_RX_HWTSTAMP_ENABLED))
		ixgbe_ptp_rx_hwtstamp(rx_ring, rx_desc, skb);
1712

1713
	if ((dev->features & NETIF_F_HW_VLAN_CTAG_RX) &&
1714
	    ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_VP)) {
1715
		u16 vid = le16_to_cpu(rx_desc->wb.upper.vlan);
1716
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vid);
A
Alexander Duyck 已提交
1717 1718
	}

1719
	skb_record_rx_queue(skb, rx_ring->queue_index);
1720

1721
	skb->protocol = eth_type_trans(skb, dev);
A
Alexander Duyck 已提交
1722 1723
}

1724 1725
static void ixgbe_rx_skb(struct ixgbe_q_vector *q_vector,
			 struct sk_buff *skb)
1726
{
1727
	napi_gro_receive(&q_vector->napi, skb);
1728
}
1729

1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752
/**
 * ixgbe_is_non_eop - process handling of non-EOP buffers
 * @rx_ring: Rx ring being processed
 * @rx_desc: Rx descriptor for current buffer
 * @skb: Current socket buffer containing buffer in progress
 *
 * This function updates next to clean.  If the buffer is an EOP buffer
 * this function exits returning false, otherwise it will place the
 * sk_buff in the next buffer to be chained and return true indicating
 * that this is in fact a non-EOP buffer.
 **/
static bool ixgbe_is_non_eop(struct ixgbe_ring *rx_ring,
			     union ixgbe_adv_rx_desc *rx_desc,
			     struct sk_buff *skb)
{
	u32 ntc = rx_ring->next_to_clean + 1;

	/* fetch, update, and store next to clean */
	ntc = (ntc < rx_ring->count) ? ntc : 0;
	rx_ring->next_to_clean = ntc;

	prefetch(IXGBE_RX_DESC(rx_ring, ntc));

1753 1754 1755 1756 1757 1758 1759 1760 1761 1762
	/* update RSC append count if present */
	if (ring_is_rsc_enabled(rx_ring)) {
		__le32 rsc_enabled = rx_desc->wb.lower.lo_dword.data &
				     cpu_to_le32(IXGBE_RXDADV_RSCCNT_MASK);

		if (unlikely(rsc_enabled)) {
			u32 rsc_cnt = le32_to_cpu(rsc_enabled);

			rsc_cnt >>= IXGBE_RXDADV_RSCCNT_SHIFT;
			IXGBE_CB(skb)->append_cnt += rsc_cnt - 1;
1763

1764 1765 1766 1767 1768
			/* update ntc based on RSC value */
			ntc = le32_to_cpu(rx_desc->wb.upper.status_error);
			ntc &= IXGBE_RXDADV_NEXTP_MASK;
			ntc >>= IXGBE_RXDADV_NEXTP_SHIFT;
		}
1769 1770
	}

1771 1772 1773 1774
	/* if we are the last buffer then there is nothing else to do */
	if (likely(ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP)))
		return false;

1775 1776 1777 1778 1779 1780 1781
	/* place skb in next buffer to be received */
	rx_ring->rx_buffer_info[ntc].skb = skb;
	rx_ring->rx_stats.non_eop_descs++;

	return true;
}

1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811
/**
 * ixgbe_pull_tail - ixgbe specific version of skb_pull_tail
 * @rx_ring: rx descriptor ring packet is being transacted on
 * @skb: pointer to current skb being adjusted
 *
 * This function is an ixgbe specific version of __pskb_pull_tail.  The
 * main difference between this version and the original function is that
 * this function can make several assumptions about the state of things
 * that allow for significant optimizations versus the standard function.
 * As a result we can do things like drop a frag and maintain an accurate
 * truesize for the skb.
 */
static void ixgbe_pull_tail(struct ixgbe_ring *rx_ring,
			    struct sk_buff *skb)
{
	struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[0];
	unsigned char *va;
	unsigned int pull_len;

	/*
	 * it is valid to use page_address instead of kmap since we are
	 * working with pages allocated out of the lomem pool per
	 * alloc_page(GFP_ATOMIC)
	 */
	va = skb_frag_address(frag);

	/*
	 * we need the header to contain the greater of either ETH_HLEN or
	 * 60 bytes if the skb->len is less than 60 for skb_pad.
	 */
1812
	pull_len = eth_get_headlen(va, IXGBE_RX_HDR_SIZE);
1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823

	/* align pull length to size of long to optimize memcpy performance */
	skb_copy_to_linear_data(skb, va, ALIGN(pull_len, sizeof(long)));

	/* update all of the pointers */
	skb_frag_size_sub(frag, pull_len);
	frag->page_offset += pull_len;
	skb->data_len -= pull_len;
	skb->tail += pull_len;
}

1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838
/**
 * ixgbe_dma_sync_frag - perform DMA sync for first frag of SKB
 * @rx_ring: rx descriptor ring packet is being transacted on
 * @skb: pointer to current skb being updated
 *
 * This function provides a basic DMA sync up for the first fragment of an
 * skb.  The reason for doing this is that the first fragment cannot be
 * unmapped until we have reached the end of packet descriptor for a buffer
 * chain.
 */
static void ixgbe_dma_sync_frag(struct ixgbe_ring *rx_ring,
				struct sk_buff *skb)
{
	/* if the page was released unmap it, else just sync our portion */
	if (unlikely(IXGBE_CB(skb)->page_released)) {
1839 1840 1841 1842
		dma_unmap_page_attrs(rx_ring->dev, IXGBE_CB(skb)->dma,
				     ixgbe_rx_pg_size(rx_ring),
				     DMA_FROM_DEVICE,
				     IXGBE_RX_DMA_ATTR);
1843 1844 1845 1846 1847 1848
	} else {
		struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[0];

		dma_sync_single_range_for_cpu(rx_ring->dev,
					      IXGBE_CB(skb)->dma,
					      frag->page_offset,
1849
					      skb_frag_size(frag),
1850 1851 1852 1853
					      DMA_FROM_DEVICE);
	}
}

1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885
/**
 * ixgbe_cleanup_headers - Correct corrupted or empty headers
 * @rx_ring: rx descriptor ring packet is being transacted on
 * @rx_desc: pointer to the EOP Rx descriptor
 * @skb: pointer to current skb being fixed
 *
 * Check for corrupted packet headers caused by senders on the local L2
 * embedded NIC switch not setting up their Tx Descriptors right.  These
 * should be very rare.
 *
 * Also address the case where we are pulling data in on pages only
 * and as such no data is present in the skb header.
 *
 * In addition if skb is not at least 60 bytes we need to pad it so that
 * it is large enough to qualify as a valid Ethernet frame.
 *
 * Returns true if an error was encountered and skb was freed.
 **/
static bool ixgbe_cleanup_headers(struct ixgbe_ring *rx_ring,
				  union ixgbe_adv_rx_desc *rx_desc,
				  struct sk_buff *skb)
{
	struct net_device *netdev = rx_ring->netdev;

	/* verify that the packet does not have any known errors */
	if (unlikely(ixgbe_test_staterr(rx_desc,
					IXGBE_RXDADV_ERR_FRAME_ERR_MASK) &&
	    !(netdev->features & NETIF_F_RXALL))) {
		dev_kfree_skb_any(skb);
		return true;
	}

1886
	/* place header in linear portion of buffer */
1887
	if (!skb_headlen(skb))
1888
		ixgbe_pull_tail(rx_ring, skb);
1889

1890 1891 1892 1893 1894 1895
#ifdef IXGBE_FCOE
	/* do not attempt to pad FCoE Frames as this will disrupt DDP */
	if (ixgbe_rx_is_fcoe(rx_ring, rx_desc))
		return false;

#endif
1896 1897 1898
	/* if eth_skb_pad returns an error the skb was freed */
	if (eth_skb_pad(skb))
		return true;
1899 1900 1901 1902 1903 1904 1905 1906 1907

	return false;
}

/**
 * ixgbe_reuse_rx_page - page flip buffer and store it back on the ring
 * @rx_ring: rx descriptor ring to store buffers on
 * @old_buff: donor buffer to have page reused
 *
1908
 * Synchronizes page for reuse by the adapter
1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921
 **/
static void ixgbe_reuse_rx_page(struct ixgbe_ring *rx_ring,
				struct ixgbe_rx_buffer *old_buff)
{
	struct ixgbe_rx_buffer *new_buff;
	u16 nta = rx_ring->next_to_alloc;

	new_buff = &rx_ring->rx_buffer_info[nta];

	/* update, and store next to alloc */
	nta++;
	rx_ring->next_to_alloc = (nta < rx_ring->count) ? nta : 0;

1922 1923 1924 1925 1926 1927 1928 1929
	/* Transfer page from old buffer to new buffer.
	 * Move each member individually to avoid possible store
	 * forwarding stalls and unnecessary copy of skb.
	 */
	new_buff->dma		= old_buff->dma;
	new_buff->page		= old_buff->page;
	new_buff->page_offset	= old_buff->page_offset;
	new_buff->pagecnt_bias	= old_buff->pagecnt_bias;
1930 1931
}

A
Alexander Duyck 已提交
1932 1933
static inline bool ixgbe_page_is_reserved(struct page *page)
{
1934
	return (page_to_nid(page) != numa_mem_id()) || page_is_pfmemalloc(page);
A
Alexander Duyck 已提交
1935 1936
}

1937
static bool ixgbe_can_reuse_rx_page(struct ixgbe_rx_buffer *rx_buffer)
1938
{
1939 1940
	unsigned int pagecnt_bias = rx_buffer->pagecnt_bias;
	struct page *page = rx_buffer->page;
1941

1942 1943 1944 1945 1946 1947
	/* avoid re-using remote pages */
	if (unlikely(ixgbe_page_is_reserved(page)))
		return false;

#if (PAGE_SIZE < 8192)
	/* if we are only owner of page we can reuse it */
1948
	if (unlikely((page_ref_count(page) - pagecnt_bias) > 1))
1949 1950
		return false;
#else
1951 1952 1953 1954 1955 1956 1957 1958
	/* The last offset is a bit aggressive in that we assume the
	 * worst case of FCoE being enabled and using a 3K buffer.
	 * However this should have minimal impact as the 1K extra is
	 * still less than one buffer in size.
	 */
#define IXGBE_LAST_OFFSET \
	(SKB_WITH_OVERHEAD(PAGE_SIZE) - IXGBE_RXBUFFER_3K)
	if (rx_buffer->page_offset > IXGBE_LAST_OFFSET)
1959 1960 1961
		return false;
#endif

1962 1963 1964
	/* If we have drained the page fragment pool we need to update
	 * the pagecnt_bias and page count so that we fully restock the
	 * number of references the driver holds.
1965
	 */
1966
	if (unlikely(!pagecnt_bias)) {
1967 1968 1969
		page_ref_add(page, USHRT_MAX);
		rx_buffer->pagecnt_bias = USHRT_MAX;
	}
1970 1971 1972 1973

	return true;
}

1974 1975 1976 1977 1978 1979 1980
/**
 * ixgbe_add_rx_frag - Add contents of Rx buffer to sk_buff
 * @rx_ring: rx descriptor ring to transact packets on
 * @rx_buffer: buffer containing page to add
 * @rx_desc: descriptor containing length of buffer written by hardware
 * @skb: sk_buff to place the data into
 *
1981 1982 1983 1984 1985 1986 1987
 * This function will add the data contained in rx_buffer->page to the skb.
 * This is done either through a direct copy if the data in the buffer is
 * less than the skb header size, otherwise it will just attach the page as
 * a frag to the skb.
 *
 * The function will then update the page offset if necessary and return
 * true if the buffer can be reused by the adapter.
1988
 **/
1989
static void ixgbe_add_rx_frag(struct ixgbe_ring *rx_ring,
1990
			      struct ixgbe_rx_buffer *rx_buffer,
1991 1992
			      struct sk_buff *skb,
			      unsigned int size)
1993
{
1994
#if (PAGE_SIZE < 8192)
1995
	unsigned int truesize = ixgbe_rx_pg_size(rx_ring) / 2;
1996
#else
1997 1998 1999
	unsigned int truesize = ring_uses_build_skb(rx_ring) ?
				SKB_DATA_ALIGN(IXGBE_SKB_PAD + size) :
				SKB_DATA_ALIGN(size);
2000
#endif
2001
	skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, rx_buffer->page,
2002
			rx_buffer->page_offset, size, truesize);
2003 2004 2005 2006 2007
#if (PAGE_SIZE < 8192)
	rx_buffer->page_offset ^= truesize;
#else
	rx_buffer->page_offset += truesize;
#endif
2008 2009
}

2010 2011 2012 2013
static struct ixgbe_rx_buffer *ixgbe_get_rx_buffer(struct ixgbe_ring *rx_ring,
						   union ixgbe_adv_rx_desc *rx_desc,
						   struct sk_buff **skb,
						   const unsigned int size)
2014 2015 2016 2017
{
	struct ixgbe_rx_buffer *rx_buffer;

	rx_buffer = &rx_ring->rx_buffer_info[rx_ring->next_to_clean];
2018 2019
	prefetchw(rx_buffer->page);
	*skb = rx_buffer->skb;
2020

2021 2022 2023 2024 2025 2026 2027
	/* Delay unmapping of the first packet. It carries the header
	 * information, HW may still access the header after the writeback.
	 * Only unmap it when EOP is reached
	 */
	if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP)) {
		if (!*skb)
			goto skip_sync;
2028
	} else {
2029 2030 2031
		if (*skb)
			ixgbe_dma_sync_frag(rx_ring, *skb);
	}
2032

2033 2034 2035 2036 2037 2038 2039 2040
	/* we are reusing so sync this buffer for CPU use */
	dma_sync_single_range_for_cpu(rx_ring->dev,
				      rx_buffer->dma,
				      rx_buffer->page_offset,
				      size,
				      DMA_FROM_DEVICE);
skip_sync:
	rx_buffer->pagecnt_bias--;
A
Alexander Duyck 已提交
2041

2042 2043
	return rx_buffer;
}
2044

2045 2046 2047 2048 2049
static void ixgbe_put_rx_buffer(struct ixgbe_ring *rx_ring,
				struct ixgbe_rx_buffer *rx_buffer,
				struct sk_buff *skb)
{
	if (ixgbe_can_reuse_rx_page(rx_buffer)) {
2050 2051 2052
		/* hand second half of page back to the ring */
		ixgbe_reuse_rx_page(rx_ring, rx_buffer);
	} else {
2053 2054 2055 2056 2057 2058 2059 2060 2061 2062
		if (IXGBE_CB(skb)->dma == rx_buffer->dma) {
			/* the page has been released from the ring */
			IXGBE_CB(skb)->page_released = true;
		} else {
			/* we are not reusing the buffer so unmap it */
			dma_unmap_page_attrs(rx_ring->dev, rx_buffer->dma,
					     ixgbe_rx_pg_size(rx_ring),
					     DMA_FROM_DEVICE,
					     IXGBE_RX_DMA_ATTR);
		}
2063
		__page_frag_cache_drain(rx_buffer->page,
2064
					rx_buffer->pagecnt_bias);
2065 2066
	}

2067
	/* clear contents of rx_buffer */
2068
	rx_buffer->page = NULL;
2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080
	rx_buffer->skb = NULL;
}

static struct sk_buff *ixgbe_construct_skb(struct ixgbe_ring *rx_ring,
					   struct ixgbe_rx_buffer *rx_buffer,
					   union ixgbe_adv_rx_desc *rx_desc,
					   unsigned int size)
{
	void *va = page_address(rx_buffer->page) + rx_buffer->page_offset;
#if (PAGE_SIZE < 8192)
	unsigned int truesize = ixgbe_rx_pg_size(rx_ring) / 2;
#else
2081
	unsigned int truesize = SKB_DATA_ALIGN(size);
2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111
#endif
	struct sk_buff *skb;

	/* prefetch first cache line of first page */
	prefetch(va);
#if L1_CACHE_BYTES < 128
	prefetch(va + L1_CACHE_BYTES);
#endif

	/* allocate a skb to store the frags */
	skb = napi_alloc_skb(&rx_ring->q_vector->napi, IXGBE_RX_HDR_SIZE);
	if (unlikely(!skb))
		return NULL;

	if (size > IXGBE_RX_HDR_SIZE) {
		if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP))
			IXGBE_CB(skb)->dma = rx_buffer->dma;

		skb_add_rx_frag(skb, 0, rx_buffer->page,
				rx_buffer->page_offset,
				size, truesize);
#if (PAGE_SIZE < 8192)
		rx_buffer->page_offset ^= truesize;
#else
		rx_buffer->page_offset += truesize;
#endif
	} else {
		memcpy(__skb_put(skb, size), va, ALIGN(size, sizeof(long)));
		rx_buffer->pagecnt_bias++;
	}
2112 2113

	return skb;
2114 2115
}

2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135
static struct sk_buff *ixgbe_build_skb(struct ixgbe_ring *rx_ring,
				       struct ixgbe_rx_buffer *rx_buffer,
				       union ixgbe_adv_rx_desc *rx_desc,
				       unsigned int size)
{
	void *va = page_address(rx_buffer->page) + rx_buffer->page_offset;
#if (PAGE_SIZE < 8192)
	unsigned int truesize = ixgbe_rx_pg_size(rx_ring) / 2;
#else
	unsigned int truesize = SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) +
				SKB_DATA_ALIGN(IXGBE_SKB_PAD + size);
#endif
	struct sk_buff *skb;

	/* prefetch first cache line of first page */
	prefetch(va);
#if L1_CACHE_BYTES < 128
	prefetch(va + L1_CACHE_BYTES);
#endif

2136
	/* build an skb around the page buffer */
2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158
	skb = build_skb(va - IXGBE_SKB_PAD, truesize);
	if (unlikely(!skb))
		return NULL;

	/* update pointers within the skb to store the data */
	skb_reserve(skb, IXGBE_SKB_PAD);
	__skb_put(skb, size);

	/* record DMA address if this is the start of a chain of buffers */
	if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP))
		IXGBE_CB(skb)->dma = rx_buffer->dma;

	/* update buffer offset */
#if (PAGE_SIZE < 8192)
	rx_buffer->page_offset ^= truesize;
#else
	rx_buffer->page_offset += truesize;
#endif

	return skb;
}

2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169
/**
 * ixgbe_clean_rx_irq - Clean completed descriptors from Rx ring - bounce buf
 * @q_vector: structure containing interrupt and ring information
 * @rx_ring: rx descriptor ring to transact packets on
 * @budget: Total limit on number of packets to process
 *
 * This function provides a "bounce buffer" approach to Rx interrupt
 * processing.  The advantage to this is that on systems that have
 * expensive overhead for IOMMU access this provides a means of avoiding
 * it by maintaining the mapping of the page to the syste.
 *
2170
 * Returns amount of work completed
2171
 **/
2172
static int ixgbe_clean_rx_irq(struct ixgbe_q_vector *q_vector,
2173
			       struct ixgbe_ring *rx_ring,
2174
			       const int budget)
2175
{
2176
	unsigned int total_rx_bytes = 0, total_rx_packets = 0;
B
Ben Greear 已提交
2177
#ifdef IXGBE_FCOE
2178
	struct ixgbe_adapter *adapter = q_vector->adapter;
2179 2180
	int ddp_bytes;
	unsigned int mss = 0;
2181
#endif /* IXGBE_FCOE */
2182
	u16 cleaned_count = ixgbe_desc_unused(rx_ring);
2183

2184
	while (likely(total_rx_packets < budget)) {
2185
		union ixgbe_adv_rx_desc *rx_desc;
2186
		struct ixgbe_rx_buffer *rx_buffer;
2187
		struct sk_buff *skb;
2188
		unsigned int size;
2189 2190 2191 2192 2193 2194 2195

		/* return some buffers to hardware, one at a time is too slow */
		if (cleaned_count >= IXGBE_RX_BUFFER_WRITE) {
			ixgbe_alloc_rx_buffers(rx_ring, cleaned_count);
			cleaned_count = 0;
		}

2196
		rx_desc = IXGBE_RX_DESC(rx_ring, rx_ring->next_to_clean);
2197 2198
		size = le16_to_cpu(rx_desc->wb.upper.length);
		if (!size)
2199
			break;
2200

2201
		/* This memory barrier is needed to keep us from reading
2202
		 * any other fields out of the rx_desc until we know the
2203
		 * descriptor has been written back
2204
		 */
2205
		dma_rmb();
2206

2207 2208
		rx_buffer = ixgbe_get_rx_buffer(rx_ring, rx_desc, &skb, size);

2209
		/* retrieve a buffer from the ring */
2210 2211
		if (skb)
			ixgbe_add_rx_frag(rx_ring, rx_buffer, skb, size);
2212 2213 2214
		else if (ring_uses_build_skb(rx_ring))
			skb = ixgbe_build_skb(rx_ring, rx_buffer,
					      rx_desc, size);
2215 2216 2217
		else
			skb = ixgbe_construct_skb(rx_ring, rx_buffer,
						  rx_desc, size);
2218

2219
		/* exit if we failed to retrieve a buffer */
2220 2221 2222
		if (!skb) {
			rx_ring->rx_stats.alloc_rx_buff_failed++;
			rx_buffer->pagecnt_bias++;
2223
			break;
2224
		}
2225

2226
		ixgbe_put_rx_buffer(rx_ring, rx_buffer, skb);
2227
		cleaned_count++;
A
Alexander Duyck 已提交
2228

2229 2230 2231
		/* place incomplete frames back on ring for completion */
		if (ixgbe_is_non_eop(rx_ring, rx_desc, skb))
			continue;
2232

2233 2234 2235
		/* verify the packet layout is correct */
		if (ixgbe_cleanup_headers(rx_ring, rx_desc, skb))
			continue;
2236

2237 2238 2239
		/* probably a little skewed due to removing CRC */
		total_rx_bytes += skb->len;

2240 2241 2242
		/* populate checksum, timestamp, VLAN, and protocol */
		ixgbe_process_skb_fields(rx_ring, rx_desc, skb);

2243 2244
#ifdef IXGBE_FCOE
		/* if ddp, not passing to ULD unless for FCP_RSP or error */
2245
		if (ixgbe_rx_is_fcoe(rx_ring, rx_desc)) {
2246
			ddp_bytes = ixgbe_fcoe_ddp(adapter, rx_desc, skb);
2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260
			/* include DDPed FCoE data */
			if (ddp_bytes > 0) {
				if (!mss) {
					mss = rx_ring->netdev->mtu -
						sizeof(struct fcoe_hdr) -
						sizeof(struct fc_frame_header) -
						sizeof(struct fcoe_crc_eof);
					if (mss > 512)
						mss &= ~511;
				}
				total_rx_bytes += ddp_bytes;
				total_rx_packets += DIV_ROUND_UP(ddp_bytes,
								 mss);
			}
2261 2262
			if (!ddp_bytes) {
				dev_kfree_skb_any(skb);
2263
				continue;
2264
			}
2265
		}
2266

2267
#endif /* IXGBE_FCOE */
2268
		ixgbe_rx_skb(q_vector, skb);
2269

2270
		/* update budget accounting */
2271
		total_rx_packets++;
2272
	}
2273

2274 2275 2276 2277
	u64_stats_update_begin(&rx_ring->syncp);
	rx_ring->stats.packets += total_rx_packets;
	rx_ring->stats.bytes += total_rx_bytes;
	u64_stats_update_end(&rx_ring->syncp);
2278 2279
	q_vector->rx.total_packets += total_rx_packets;
	q_vector->rx.total_bytes += total_rx_bytes;
2280

2281
	return total_rx_packets;
2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292
}

/**
 * ixgbe_configure_msix - Configure MSI-X hardware
 * @adapter: board private structure
 *
 * ixgbe_configure_msix sets up the hardware to properly generate MSI-X
 * interrupts.
 **/
static void ixgbe_configure_msix(struct ixgbe_adapter *adapter)
{
2293
	struct ixgbe_q_vector *q_vector;
2294
	int v_idx;
2295
	u32 mask;
2296

2297 2298
	/* Populate MSIX to EITR Select */
	if (adapter->num_vfs > 32) {
J
Jacob Keller 已提交
2299
		u32 eitrsel = BIT(adapter->num_vfs - 32) - 1;
2300 2301 2302
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITRSEL, eitrsel);
	}

2303 2304
	/*
	 * Populate the IVAR table and set the ITR values to the
2305 2306
	 * corresponding register.
	 */
2307
	for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
2308
		struct ixgbe_ring *ring;
2309
		q_vector = adapter->q_vector[v_idx];
2310

2311
		ixgbe_for_each_ring(ring, q_vector->rx)
2312 2313
			ixgbe_set_ivar(adapter, 0, ring->reg_idx, v_idx);

2314
		ixgbe_for_each_ring(ring, q_vector->tx)
2315 2316
			ixgbe_set_ivar(adapter, 1, ring->reg_idx, v_idx);

2317
		ixgbe_write_eitr(q_vector);
2318 2319
	}

2320 2321
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
2322
		ixgbe_set_ivar(adapter, -1, IXGBE_IVAR_OTHER_CAUSES_INDEX,
2323
			       v_idx);
2324 2325
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2326
	case ixgbe_mac_X540:
2327 2328
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
2329
	case ixgbe_mac_x550em_a:
2330
		ixgbe_set_ivar(adapter, -1, 1, v_idx);
2331 2332 2333 2334
		break;
	default:
		break;
	}
2335 2336
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITR(v_idx), 1950);

2337
	/* set up to autoclear timer, and the vectors */
2338
	mask = IXGBE_EIMS_ENABLE_MASK;
2339 2340 2341 2342
	mask &= ~(IXGBE_EIMS_OTHER |
		  IXGBE_EIMS_MAILBOX |
		  IXGBE_EIMS_LSC);

2343
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIAC, mask);
2344 2345
}

2346 2347 2348 2349 2350 2351 2352 2353 2354
enum latency_range {
	lowest_latency = 0,
	low_latency = 1,
	bulk_latency = 2,
	latency_invalid = 255
};

/**
 * ixgbe_update_itr - update the dynamic ITR value based on statistics
2355 2356
 * @q_vector: structure containing interrupt and ring information
 * @ring_container: structure containing ring performance data
2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367
 *
 *      Stores a new ITR value based on packets and byte
 *      counts during the last interrupt.  The advantage of per interrupt
 *      computation is faster updates and more accurate ITR for the current
 *      traffic pattern.  Constants in this function were computed
 *      based on theoretical maximum wire speed and thresholds were set based
 *      on testing data as well as attempting to minimize response time
 *      while increasing bulk throughput.
 *      this functionality is controlled by the InterruptThrottleRate module
 *      parameter (see ixgbe_param.c)
 **/
2368 2369
static void ixgbe_update_itr(struct ixgbe_q_vector *q_vector,
			     struct ixgbe_ring_container *ring_container)
2370
{
2371 2372 2373
	int bytes = ring_container->total_bytes;
	int packets = ring_container->total_packets;
	u32 timepassed_us;
2374
	u64 bytes_perint;
2375
	u8 itr_setting = ring_container->itr;
2376 2377

	if (packets == 0)
2378
		return;
2379 2380

	/* simple throttlerate management
2381 2382
	 *   0-10MB/s   lowest (100000 ints/s)
	 *  10-20MB/s   low    (20000 ints/s)
2383
	 *  20-1249MB/s bulk   (12000 ints/s)
2384 2385
	 */
	/* what was last interrupt timeslice? */
2386
	timepassed_us = q_vector->itr >> 2;
2387 2388 2389
	if (timepassed_us == 0)
		return;

2390 2391 2392 2393
	bytes_perint = bytes / timepassed_us; /* bytes/usec */

	switch (itr_setting) {
	case lowest_latency:
2394
		if (bytes_perint > 10)
2395
			itr_setting = low_latency;
2396 2397
		break;
	case low_latency:
2398
		if (bytes_perint > 20)
2399
			itr_setting = bulk_latency;
2400
		else if (bytes_perint <= 10)
2401
			itr_setting = lowest_latency;
2402 2403
		break;
	case bulk_latency:
2404
		if (bytes_perint <= 20)
2405
			itr_setting = low_latency;
2406 2407 2408
		break;
	}

2409 2410 2411 2412 2413 2414
	/* clear work counters since we have the values we need */
	ring_container->total_bytes = 0;
	ring_container->total_packets = 0;

	/* write updated itr to ring container */
	ring_container->itr = itr_setting;
2415 2416
}

2417 2418
/**
 * ixgbe_write_eitr - write EITR register in hardware specific way
2419
 * @q_vector: structure containing interrupt and ring information
2420 2421 2422 2423 2424
 *
 * This function is made to be called by ethtool and by the driver
 * when it needs to update EITR registers at runtime.  Hardware
 * specific quirks/differences are taken care of here.
 */
2425
void ixgbe_write_eitr(struct ixgbe_q_vector *q_vector)
2426
{
2427
	struct ixgbe_adapter *adapter = q_vector->adapter;
2428
	struct ixgbe_hw *hw = &adapter->hw;
2429
	int v_idx = q_vector->v_idx;
2430
	u32 itr_reg = q_vector->itr & IXGBE_MAX_EITR;
2431

2432 2433
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
2434 2435
		/* must write high and low 16 bits to reset counter */
		itr_reg |= (itr_reg << 16);
2436 2437
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2438
	case ixgbe_mac_X540:
2439 2440
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
2441
	case ixgbe_mac_x550em_a:
2442 2443 2444 2445 2446
		/*
		 * set the WDIS bit to not clear the timer bits and cause an
		 * immediate assertion of the interrupt
		 */
		itr_reg |= IXGBE_EITR_CNT_WDIS;
2447 2448 2449
		break;
	default:
		break;
2450 2451 2452 2453
	}
	IXGBE_WRITE_REG(hw, IXGBE_EITR(v_idx), itr_reg);
}

2454
static void ixgbe_set_itr(struct ixgbe_q_vector *q_vector)
2455
{
2456
	u32 new_itr = q_vector->itr;
2457
	u8 current_itr;
2458

2459 2460
	ixgbe_update_itr(q_vector, &q_vector->tx);
	ixgbe_update_itr(q_vector, &q_vector->rx);
2461

2462
	current_itr = max(q_vector->rx.itr, q_vector->tx.itr);
2463 2464 2465 2466

	switch (current_itr) {
	/* counts and packets in update_itr are dependent on these numbers */
	case lowest_latency:
2467
		new_itr = IXGBE_100K_ITR;
2468 2469
		break;
	case low_latency:
2470
		new_itr = IXGBE_20K_ITR;
2471 2472
		break;
	case bulk_latency:
2473
		new_itr = IXGBE_12K_ITR;
2474
		break;
2475 2476
	default:
		break;
2477 2478
	}

2479
	if (new_itr != q_vector->itr) {
2480
		/* do an exponential smoothing */
2481 2482
		new_itr = (10 * new_itr * q_vector->itr) /
			  ((9 * new_itr) + q_vector->itr);
2483

2484
		/* save the algorithm value here */
2485
		q_vector->itr = new_itr;
2486 2487

		ixgbe_write_eitr(q_vector);
2488 2489 2490
	}
}

2491
/**
2492
 * ixgbe_check_overtemp_subtask - check for over temperature
2493
 * @adapter: pointer to adapter
2494
 **/
2495
static void ixgbe_check_overtemp_subtask(struct ixgbe_adapter *adapter)
2496 2497 2498
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 eicr = adapter->interrupt_event;
2499
	s32 rc;
2500

2501
	if (test_bit(__IXGBE_DOWN, &adapter->state))
2502 2503
		return;

2504 2505 2506 2507 2508 2509
	if (!(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE) &&
	    !(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_EVENT))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_TEMP_SENSOR_EVENT;

2510
	switch (hw->device_id) {
2511 2512 2513 2514 2515 2516 2517 2518
	case IXGBE_DEV_ID_82599_T3_LOM:
		/*
		 * Since the warning interrupt is for both ports
		 * we don't have to check if:
		 *  - This interrupt wasn't for our port.
		 *  - We may have missed the interrupt so always have to
		 *    check if we  got a LSC
		 */
2519
		if (!(eicr & IXGBE_EICR_GPI_SDP0_8259X) &&
2520 2521 2522 2523
		    !(eicr & IXGBE_EICR_LSC))
			return;

		if (!(eicr & IXGBE_EICR_LSC) && hw->mac.ops.check_link) {
J
Josh Hay 已提交
2524
			u32 speed;
2525
			bool link_up = false;
2526

J
Josh Hay 已提交
2527
			hw->mac.ops.check_link(hw, &speed, &link_up, false);
2528

2529 2530 2531 2532 2533 2534 2535 2536 2537
			if (link_up)
				return;
		}

		/* Check if this is not due to overtemp */
		if (hw->phy.ops.check_overtemp(hw) != IXGBE_ERR_OVERTEMP)
			return;

		break;
2538 2539 2540 2541 2542 2543
	case IXGBE_DEV_ID_X550EM_A_1G_T:
	case IXGBE_DEV_ID_X550EM_A_1G_T_L:
		rc = hw->phy.ops.check_overtemp(hw);
		if (rc != IXGBE_ERR_OVERTEMP)
			return;
		break;
2544
	default:
2545 2546
		if (adapter->hw.mac.type >= ixgbe_mac_X540)
			return;
2547
		if (!(eicr & IXGBE_EICR_GPI_SDP0(hw)))
2548
			return;
2549
		break;
2550
	}
2551
	e_crit(drv, "%s\n", ixgbe_overheat_msg);
2552 2553

	adapter->interrupt_event = 0;
2554 2555
}

2556 2557 2558 2559 2560
static void ixgbe_check_fan_failure(struct ixgbe_adapter *adapter, u32 eicr)
{
	struct ixgbe_hw *hw = &adapter->hw;

	if ((adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE) &&
2561
	    (eicr & IXGBE_EICR_GPI_SDP1(hw))) {
2562
		e_crit(probe, "Fan has stopped, replace the adapter\n");
2563
		/* write to clear the interrupt */
2564
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1(hw));
2565 2566
	}
}
2567

2568 2569
static void ixgbe_check_overtemp_event(struct ixgbe_adapter *adapter, u32 eicr)
{
2570 2571
	struct ixgbe_hw *hw = &adapter->hw;

2572 2573 2574 2575 2576 2577 2578 2579 2580
	if (!(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE))
		return;

	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
		/*
		 * Need to check link state so complete overtemp check
		 * on service task
		 */
2581 2582
		if (((eicr & IXGBE_EICR_GPI_SDP0(hw)) ||
		     (eicr & IXGBE_EICR_LSC)) &&
2583 2584 2585 2586 2587 2588 2589
		    (!test_bit(__IXGBE_DOWN, &adapter->state))) {
			adapter->interrupt_event = eicr;
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_EVENT;
			ixgbe_service_event_schedule(adapter);
			return;
		}
		return;
2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601
	case ixgbe_mac_x550em_a:
		if (eicr & IXGBE_EICR_GPI_SDP0_X550EM_a) {
			adapter->interrupt_event = eicr;
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_EVENT;
			ixgbe_service_event_schedule(adapter);
			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC,
					IXGBE_EICR_GPI_SDP0_X550EM_a);
			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICR,
					IXGBE_EICR_GPI_SDP0_X550EM_a);
		}
		return;
	case ixgbe_mac_X550:
2602 2603 2604 2605 2606 2607 2608 2609
	case ixgbe_mac_X540:
		if (!(eicr & IXGBE_EICR_TS))
			return;
		break;
	default:
		return;
	}

2610
	e_crit(drv, "%s\n", ixgbe_overheat_msg);
2611 2612
}

2613 2614 2615 2616 2617 2618 2619 2620 2621
static inline bool ixgbe_is_sfp(struct ixgbe_hw *hw)
{
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
		if (hw->phy.type == ixgbe_phy_nl)
			return true;
		return false;
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X550EM_x:
2622
	case ixgbe_mac_x550em_a:
2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633 2634
		switch (hw->mac.ops.get_media_type(hw)) {
		case ixgbe_media_type_fiber:
		case ixgbe_media_type_fiber_qsfp:
			return true;
		default:
			return false;
		}
	default:
		return false;
	}
}

2635 2636 2637
static void ixgbe_check_sfp_event(struct ixgbe_adapter *adapter, u32 eicr)
{
	struct ixgbe_hw *hw = &adapter->hw;
2638
	u32 eicr_mask = IXGBE_EICR_GPI_SDP2(hw);
2639

2640 2641 2642 2643 2644 2645 2646 2647
	if (!ixgbe_is_sfp(hw))
		return;

	/* Later MAC's use different SDP */
	if (hw->mac.type >= ixgbe_mac_X540)
		eicr_mask = IXGBE_EICR_GPI_SDP0_X540;

	if (eicr & eicr_mask) {
2648
		/* Clear the interrupt */
2649
		IXGBE_WRITE_REG(hw, IXGBE_EICR, eicr_mask);
2650 2651
		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
			adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
M
Mark Rustad 已提交
2652
			adapter->sfp_poll_time = 0;
2653 2654
			ixgbe_service_event_schedule(adapter);
		}
2655 2656
	}

2657 2658
	if (adapter->hw.mac.type == ixgbe_mac_82599EB &&
	    (eicr & IXGBE_EICR_GPI_SDP1(hw))) {
2659
		/* Clear the interrupt */
2660
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1(hw));
2661 2662 2663 2664
		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
			adapter->flags |= IXGBE_FLAG_NEED_LINK_CONFIG;
			ixgbe_service_event_schedule(adapter);
		}
2665 2666 2667
	}
}

2668 2669 2670 2671 2672 2673 2674 2675 2676
static void ixgbe_check_lsc(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;

	adapter->lsc_int++;
	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
	adapter->link_check_timeout = jiffies;
	if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
		IXGBE_WRITE_REG(hw, IXGBE_EIMC, IXGBE_EIMC_LSC);
2677
		IXGBE_WRITE_FLUSH(hw);
2678
		ixgbe_service_event_schedule(adapter);
2679 2680 2681
	}
}

2682 2683 2684 2685
static inline void ixgbe_irq_enable_queues(struct ixgbe_adapter *adapter,
					   u64 qmask)
{
	u32 mask;
2686
	struct ixgbe_hw *hw = &adapter->hw;
2687

2688 2689
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
2690
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
2691 2692 2693
		IXGBE_WRITE_REG(hw, IXGBE_EIMS, mask);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2694
	case ixgbe_mac_X540:
2695 2696
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
2697
	case ixgbe_mac_x550em_a:
2698
		mask = (qmask & 0xFFFFFFFF);
2699 2700
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(0), mask);
2701
		mask = (qmask >> 32);
2702 2703 2704 2705 2706
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(1), mask);
		break;
	default:
		break;
2707 2708 2709 2710 2711
	}
	/* skip the flush */
}

static inline void ixgbe_irq_disable_queues(struct ixgbe_adapter *adapter,
2712
					    u64 qmask)
2713 2714
{
	u32 mask;
2715
	struct ixgbe_hw *hw = &adapter->hw;
2716

2717 2718
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
2719
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
2720 2721 2722
		IXGBE_WRITE_REG(hw, IXGBE_EIMC, mask);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2723
	case ixgbe_mac_X540:
2724 2725
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
2726
	case ixgbe_mac_x550em_a:
2727
		mask = (qmask & 0xFFFFFFFF);
2728 2729
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMC_EX(0), mask);
2730
		mask = (qmask >> 32);
2731 2732 2733 2734 2735
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMC_EX(1), mask);
		break;
	default:
		break;
2736 2737 2738 2739
	}
	/* skip the flush */
}

2740
/**
2741 2742
 * ixgbe_irq_enable - Enable default interrupt generation settings
 * @adapter: board private structure
2743
 **/
2744 2745
static inline void ixgbe_irq_enable(struct ixgbe_adapter *adapter, bool queues,
				    bool flush)
2746
{
2747
	struct ixgbe_hw *hw = &adapter->hw;
2748
	u32 mask = (IXGBE_EIMS_ENABLE_MASK & ~IXGBE_EIMS_RTX_QUEUE);
2749

2750 2751 2752
	/* don't reenable LSC while waiting for link */
	if (adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE)
		mask &= ~IXGBE_EIMS_LSC;
2753

2754
	if (adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE)
2755 2756
		switch (adapter->hw.mac.type) {
		case ixgbe_mac_82599EB:
2757
			mask |= IXGBE_EIMS_GPI_SDP0(hw);
2758 2759
			break;
		case ixgbe_mac_X540:
2760 2761
		case ixgbe_mac_X550:
		case ixgbe_mac_X550EM_x:
2762
		case ixgbe_mac_x550em_a:
2763 2764 2765 2766 2767
			mask |= IXGBE_EIMS_TS;
			break;
		default:
			break;
		}
2768
	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE)
2769
		mask |= IXGBE_EIMS_GPI_SDP1(hw);
2770 2771
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
2772 2773
		mask |= IXGBE_EIMS_GPI_SDP1(hw);
		mask |= IXGBE_EIMS_GPI_SDP2(hw);
2774
		/* fall through */
2775
	case ixgbe_mac_X540:
2776 2777
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
2778 2779
	case ixgbe_mac_x550em_a:
		if (adapter->hw.device_id == IXGBE_DEV_ID_X550EM_X_SFP ||
2780
		    adapter->hw.device_id == IXGBE_DEV_ID_X550EM_A_SFP ||
2781
		    adapter->hw.device_id == IXGBE_DEV_ID_X550EM_A_SFP_N)
2782
			mask |= IXGBE_EIMS_GPI_SDP0(&adapter->hw);
2783 2784
		if (adapter->hw.phy.type == ixgbe_phy_x550em_ext_t)
			mask |= IXGBE_EICR_GPI_SDP0_X540;
2785
		mask |= IXGBE_EIMS_ECC;
2786 2787 2788 2789
		mask |= IXGBE_EIMS_MAILBOX;
		break;
	default:
		break;
2790
	}
J
Jacob Keller 已提交
2791

2792 2793 2794
	if ((adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) &&
	    !(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
		mask |= IXGBE_EIMS_FLOW_DIR;
2795

2796 2797 2798 2799 2800
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMS, mask);
	if (queues)
		ixgbe_irq_enable_queues(adapter, ~0);
	if (flush)
		IXGBE_WRITE_FLUSH(&adapter->hw);
2801 2802
}

2803
static irqreturn_t ixgbe_msix_other(int irq, void *data)
2804
{
2805
	struct ixgbe_adapter *adapter = data;
2806
	struct ixgbe_hw *hw = &adapter->hw;
2807
	u32 eicr;
2808

2809 2810 2811 2812 2813 2814 2815
	/*
	 * Workaround for Silicon errata.  Use clear-by-write instead
	 * of clear-by-read.  Reading with EICS will return the
	 * interrupt causes without clearing, which later be done
	 * with the write to EICR.
	 */
	eicr = IXGBE_READ_REG(hw, IXGBE_EICS);
2816 2817

	/* The lower 16bits of the EICR register are for the queue interrupts
2818
	 * which should be masked here in order to not accidentally clear them if
2819 2820 2821 2822 2823 2824 2825
	 * the bits are high when ixgbe_msix_other is called. There is a race
	 * condition otherwise which results in possible performance loss
	 * especially if the ixgbe_msix_other interrupt is triggering
	 * consistently (as it would when PPS is turned on for the X540 device)
	 */
	eicr &= 0xFFFF0000;

2826
	IXGBE_WRITE_REG(hw, IXGBE_EICR, eicr);
2827

2828 2829
	if (eicr & IXGBE_EICR_LSC)
		ixgbe_check_lsc(adapter);
2830

2831 2832
	if (eicr & IXGBE_EICR_MAILBOX)
		ixgbe_msg_task(adapter);
2833

2834 2835
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2836
	case ixgbe_mac_X540:
2837 2838
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
2839
	case ixgbe_mac_x550em_a:
2840 2841 2842 2843 2844 2845 2846
		if (hw->phy.type == ixgbe_phy_x550em_ext_t &&
		    (eicr & IXGBE_EICR_GPI_SDP0_X540)) {
			adapter->flags2 |= IXGBE_FLAG2_PHY_INTERRUPT;
			ixgbe_service_event_schedule(adapter);
			IXGBE_WRITE_REG(hw, IXGBE_EICR,
					IXGBE_EICR_GPI_SDP0_X540);
		}
2847 2848
		if (eicr & IXGBE_EICR_ECC) {
			e_info(link, "Received ECC Err, initiating reset\n");
2849
			set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
2850 2851 2852
			ixgbe_service_event_schedule(adapter);
			IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_ECC);
		}
2853 2854
		/* Handle Flow Director Full threshold interrupt */
		if (eicr & IXGBE_EICR_FLOW_DIR) {
2855
			int reinit_count = 0;
2856 2857
			int i;
			for (i = 0; i < adapter->num_tx_queues; i++) {
2858
				struct ixgbe_ring *ring = adapter->tx_ring[i];
A
Alexander Duyck 已提交
2859
				if (test_and_clear_bit(__IXGBE_TX_FDIR_INIT_DONE,
2860 2861 2862 2863 2864 2865 2866 2867
						       &ring->state))
					reinit_count++;
			}
			if (reinit_count) {
				/* no more flow director interrupts until after init */
				IXGBE_WRITE_REG(hw, IXGBE_EIMC, IXGBE_EIMC_FLOW_DIR);
				adapter->flags2 |= IXGBE_FLAG2_FDIR_REQUIRES_REINIT;
				ixgbe_service_event_schedule(adapter);
2868 2869
			}
		}
2870
		ixgbe_check_sfp_event(adapter, eicr);
2871
		ixgbe_check_overtemp_event(adapter, eicr);
2872 2873 2874
		break;
	default:
		break;
2875
	}
2876

2877
	ixgbe_check_fan_failure(adapter, eicr);
J
Jacob Keller 已提交
2878 2879

	if (unlikely(eicr & IXGBE_EICR_TIMESYNC))
2880
		ixgbe_ptp_check_pps_event(adapter);
2881

2882
	/* re-enable the original interrupt state, no lsc, no queues */
2883
	if (!test_bit(__IXGBE_DOWN, &adapter->state))
2884
		ixgbe_irq_enable(adapter, false, false);
2885

2886
	return IRQ_HANDLED;
2887
}
2888

2889
static irqreturn_t ixgbe_msix_clean_rings(int irq, void *data)
2890
{
2891
	struct ixgbe_q_vector *q_vector = data;
2892

2893
	/* EIAM disabled interrupts (on this vector) for us */
2894

2895
	if (q_vector->rx.ring || q_vector->tx.ring)
2896
		napi_schedule_irqoff(&q_vector->napi);
2897

2898
	return IRQ_HANDLED;
2899 2900
}

2901 2902 2903 2904 2905 2906 2907
/**
 * ixgbe_poll - NAPI Rx polling callback
 * @napi: structure for representing this polling device
 * @budget: how many packets driver is allowed to clean
 *
 * This function is used for legacy and MSI, NAPI mode
 **/
2908
int ixgbe_poll(struct napi_struct *napi, int budget)
2909 2910 2911 2912 2913
{
	struct ixgbe_q_vector *q_vector =
				container_of(napi, struct ixgbe_q_vector, napi);
	struct ixgbe_adapter *adapter = q_vector->adapter;
	struct ixgbe_ring *ring;
2914
	int per_ring_budget, work_done = 0;
2915 2916 2917 2918 2919 2920 2921
	bool clean_complete = true;

#ifdef CONFIG_IXGBE_DCA
	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
		ixgbe_update_dca(q_vector);
#endif

2922 2923 2924 2925
	ixgbe_for_each_ring(ring, q_vector->tx) {
		if (!ixgbe_clean_tx_irq(q_vector, ring, budget))
			clean_complete = false;
	}
2926

2927 2928
	/* Exit if we are called by netpoll */
	if (budget <= 0)
2929 2930
		return budget;

2931 2932 2933 2934 2935 2936 2937
	/* attempt to distribute budget to each queue fairly, but don't allow
	 * the budget to go below 1 because we'll exit polling */
	if (q_vector->rx.count > 1)
		per_ring_budget = max(budget/q_vector->rx.count, 1);
	else
		per_ring_budget = budget;

2938 2939 2940 2941 2942
	ixgbe_for_each_ring(ring, q_vector->rx) {
		int cleaned = ixgbe_clean_rx_irq(q_vector, ring,
						 per_ring_budget);

		work_done += cleaned;
2943 2944
		if (cleaned >= per_ring_budget)
			clean_complete = false;
2945
	}
2946 2947 2948 2949 2950 2951

	/* If all work not completed, return budget and keep polling */
	if (!clean_complete)
		return budget;

	/* all work done, exit the polling mode */
2952
	napi_complete_done(napi, work_done);
2953 2954 2955
	if (adapter->rx_itr_setting & 1)
		ixgbe_set_itr(q_vector);
	if (!test_bit(__IXGBE_DOWN, &adapter->state))
J
Jacob Keller 已提交
2956
		ixgbe_irq_enable_queues(adapter, BIT_ULL(q_vector->v_idx));
2957

2958
	return min(work_done, budget - 1);
2959 2960
}

2961 2962 2963 2964 2965 2966 2967 2968 2969 2970
/**
 * ixgbe_request_msix_irqs - Initialize MSI-X interrupts
 * @adapter: board private structure
 *
 * ixgbe_request_msix_irqs allocates MSI-X vectors and requests
 * interrupts from the kernel.
 **/
static int ixgbe_request_msix_irqs(struct ixgbe_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
2971
	int vector, err;
2972
	int ri = 0, ti = 0;
2973

2974
	for (vector = 0; vector < adapter->num_q_vectors; vector++) {
2975
		struct ixgbe_q_vector *q_vector = adapter->q_vector[vector];
2976
		struct msix_entry *entry = &adapter->msix_entries[vector];
R
Robert Olsson 已提交
2977

2978
		if (q_vector->tx.ring && q_vector->rx.ring) {
2979
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2980 2981 2982
				 "%s-%s-%d", netdev->name, "TxRx", ri++);
			ti++;
		} else if (q_vector->rx.ring) {
2983
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2984 2985
				 "%s-%s-%d", netdev->name, "rx", ri++);
		} else if (q_vector->tx.ring) {
2986
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2987
				 "%s-%s-%d", netdev->name, "tx", ti++);
2988 2989 2990
		} else {
			/* skip this unused q_vector */
			continue;
2991
		}
2992 2993
		err = request_irq(entry->vector, &ixgbe_msix_clean_rings, 0,
				  q_vector->name, q_vector);
2994
		if (err) {
2995
			e_err(probe, "request_irq failed for MSIX interrupt "
2996
			      "Error: %d\n", err);
2997
			goto free_queue_irqs;
2998
		}
2999 3000 3001 3002
		/* If Flow Director is enabled, set interrupt affinity */
		if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
			/* assign the mask for this irq */
			irq_set_affinity_hint(entry->vector,
3003
					      &q_vector->affinity_mask);
3004
		}
3005 3006
	}

3007
	err = request_irq(adapter->msix_entries[vector].vector,
3008
			  ixgbe_msix_other, 0, netdev->name, adapter);
3009
	if (err) {
3010
		e_err(probe, "request_irq for msix_other failed: %d\n", err);
3011
		goto free_queue_irqs;
3012 3013 3014 3015
	}

	return 0;

3016
free_queue_irqs:
3017 3018 3019 3020 3021 3022 3023
	while (vector) {
		vector--;
		irq_set_affinity_hint(adapter->msix_entries[vector].vector,
				      NULL);
		free_irq(adapter->msix_entries[vector].vector,
			 adapter->q_vector[vector]);
	}
3024 3025
	adapter->flags &= ~IXGBE_FLAG_MSIX_ENABLED;
	pci_disable_msix(adapter->pdev);
3026 3027 3028 3029 3030 3031
	kfree(adapter->msix_entries);
	adapter->msix_entries = NULL;
	return err;
}

/**
3032
 * ixgbe_intr - legacy mode Interrupt Handler
3033 3034 3035 3036 3037
 * @irq: interrupt number
 * @data: pointer to a network interface device structure
 **/
static irqreturn_t ixgbe_intr(int irq, void *data)
{
3038
	struct ixgbe_adapter *adapter = data;
3039
	struct ixgbe_hw *hw = &adapter->hw;
3040
	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
3041 3042
	u32 eicr;

3043
	/*
3044
	 * Workaround for silicon errata #26 on 82598.  Mask the interrupt
3045 3046 3047 3048
	 * before the read of EICR.
	 */
	IXGBE_WRITE_REG(hw, IXGBE_EIMC, IXGBE_IRQ_CLEAR_MASK);

3049
	/* for NAPI, using EIAM to auto-mask tx/rx interrupt bits on read
S
Stephen Hemminger 已提交
3050
	 * therefore no explicit interrupt disable is necessary */
3051
	eicr = IXGBE_READ_REG(hw, IXGBE_EICR);
3052
	if (!eicr) {
3053 3054
		/*
		 * shared interrupt alert!
3055
		 * make sure interrupts are enabled because the read will
3056 3057 3058 3059 3060 3061
		 * have disabled interrupts due to EIAM
		 * finish the workaround of silicon errata on 82598.  Unmask
		 * the interrupt that we masked before the EICR read.
		 */
		if (!test_bit(__IXGBE_DOWN, &adapter->state))
			ixgbe_irq_enable(adapter, true, true);
3062
		return IRQ_NONE;	/* Not our interrupt */
3063
	}
3064

3065 3066
	if (eicr & IXGBE_EICR_LSC)
		ixgbe_check_lsc(adapter);
3067

3068 3069
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
3070
		ixgbe_check_sfp_event(adapter, eicr);
3071 3072
		/* Fall through */
	case ixgbe_mac_X540:
3073 3074
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
3075
	case ixgbe_mac_x550em_a:
3076 3077
		if (eicr & IXGBE_EICR_ECC) {
			e_info(link, "Received ECC Err, initiating reset\n");
3078
			set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
3079 3080 3081
			ixgbe_service_event_schedule(adapter);
			IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_ECC);
		}
3082
		ixgbe_check_overtemp_event(adapter, eicr);
3083 3084 3085 3086
		break;
	default:
		break;
	}
3087

3088
	ixgbe_check_fan_failure(adapter, eicr);
J
Jacob Keller 已提交
3089
	if (unlikely(eicr & IXGBE_EICR_TIMESYNC))
3090
		ixgbe_ptp_check_pps_event(adapter);
3091

3092
	/* would disable interrupts here but EIAM disabled it */
3093
	napi_schedule_irqoff(&q_vector->napi);
3094

3095 3096 3097 3098 3099 3100 3101
	/*
	 * re-enable link(maybe) and non-queue interrupts, no flush.
	 * ixgbe_poll will re-enable the queue interrupts
	 */
	if (!test_bit(__IXGBE_DOWN, &adapter->state))
		ixgbe_irq_enable(adapter, false, false);

3102 3103 3104 3105 3106 3107 3108 3109 3110 3111
	return IRQ_HANDLED;
}

/**
 * ixgbe_request_irq - initialize interrupts
 * @adapter: board private structure
 *
 * Attempts to configure interrupts using the best available
 * capabilities of the hardware and kernel.
 **/
3112
static int ixgbe_request_irq(struct ixgbe_adapter *adapter)
3113 3114
{
	struct net_device *netdev = adapter->netdev;
3115
	int err;
3116

3117
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
3118
		err = ixgbe_request_msix_irqs(adapter);
3119
	else if (adapter->flags & IXGBE_FLAG_MSI_ENABLED)
3120
		err = request_irq(adapter->pdev->irq, ixgbe_intr, 0,
3121
				  netdev->name, adapter);
3122
	else
3123
		err = request_irq(adapter->pdev->irq, ixgbe_intr, IRQF_SHARED,
3124
				  netdev->name, adapter);
3125

3126
	if (err)
3127
		e_err(probe, "request_irq failed, Error %d\n", err);
3128 3129 3130 3131 3132 3133

	return err;
}

static void ixgbe_free_irq(struct ixgbe_adapter *adapter)
{
3134
	int vector;
3135

3136 3137 3138 3139
	if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED)) {
		free_irq(adapter->pdev->irq, adapter);
		return;
	}
3140

3141 3142 3143
	if (!adapter->msix_entries)
		return;

3144 3145 3146
	for (vector = 0; vector < adapter->num_q_vectors; vector++) {
		struct ixgbe_q_vector *q_vector = adapter->q_vector[vector];
		struct msix_entry *entry = &adapter->msix_entries[vector];
3147

3148 3149 3150
		/* free only the irqs that were actually requested */
		if (!q_vector->rx.ring && !q_vector->tx.ring)
			continue;
3151

3152 3153 3154 3155
		/* clear the affinity_mask in the IRQ descriptor */
		irq_set_affinity_hint(entry->vector, NULL);

		free_irq(entry->vector, q_vector);
3156
	}
3157

3158
	free_irq(adapter->msix_entries[vector].vector, adapter);
3159 3160
}

3161 3162 3163 3164 3165 3166
/**
 * ixgbe_irq_disable - Mask off interrupt generation on the NIC
 * @adapter: board private structure
 **/
static inline void ixgbe_irq_disable(struct ixgbe_adapter *adapter)
{
3167 3168
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
3169
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, ~0);
3170 3171
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3172
	case ixgbe_mac_X540:
3173 3174
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
3175
	case ixgbe_mac_x550em_a:
3176 3177
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFF0000);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(0), ~0);
3178
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(1), ~0);
3179 3180 3181
		break;
	default:
		break;
3182 3183 3184
	}
	IXGBE_WRITE_FLUSH(&adapter->hw);
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
3185 3186 3187 3188 3189 3190
		int vector;

		for (vector = 0; vector < adapter->num_q_vectors; vector++)
			synchronize_irq(adapter->msix_entries[vector].vector);

		synchronize_irq(adapter->msix_entries[vector++].vector);
3191 3192 3193 3194 3195
	} else {
		synchronize_irq(adapter->pdev->irq);
	}
}

3196 3197 3198 3199 3200 3201
/**
 * ixgbe_configure_msi_and_legacy - Initialize PIN (INTA...) and MSI interrupts
 *
 **/
static void ixgbe_configure_msi_and_legacy(struct ixgbe_adapter *adapter)
{
3202
	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
3203

3204
	ixgbe_write_eitr(q_vector);
3205

3206 3207
	ixgbe_set_ivar(adapter, 0, 0, 0);
	ixgbe_set_ivar(adapter, 1, 0, 0);
3208

3209
	e_info(hw, "Legacy interrupt IVAR setup done\n");
3210 3211
}

3212 3213 3214 3215 3216 3217 3218
/**
 * ixgbe_configure_tx_ring - Configure 8259x Tx ring after Reset
 * @adapter: board private structure
 * @ring: structure containing ring specific data
 *
 * Configure the Tx descriptor ring after a reset.
 **/
3219 3220
void ixgbe_configure_tx_ring(struct ixgbe_adapter *adapter,
			     struct ixgbe_ring *ring)
3221 3222 3223
{
	struct ixgbe_hw *hw = &adapter->hw;
	u64 tdba = ring->dma;
3224
	int wait_loop = 10;
3225
	u32 txdctl = IXGBE_TXDCTL_ENABLE;
3226
	u8 reg_idx = ring->reg_idx;
3227

3228
	/* disable queue to avoid issues while updating state */
3229
	IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), 0);
3230 3231
	IXGBE_WRITE_FLUSH(hw);

3232
	IXGBE_WRITE_REG(hw, IXGBE_TDBAL(reg_idx),
3233
			(tdba & DMA_BIT_MASK(32)));
3234 3235 3236 3237 3238
	IXGBE_WRITE_REG(hw, IXGBE_TDBAH(reg_idx), (tdba >> 32));
	IXGBE_WRITE_REG(hw, IXGBE_TDLEN(reg_idx),
			ring->count * sizeof(union ixgbe_adv_tx_desc));
	IXGBE_WRITE_REG(hw, IXGBE_TDH(reg_idx), 0);
	IXGBE_WRITE_REG(hw, IXGBE_TDT(reg_idx), 0);
3239
	ring->tail = adapter->io_addr + IXGBE_TDT(reg_idx);
3240

3241 3242
	/*
	 * set WTHRESH to encourage burst writeback, it should not be set
E
Emil Tantilov 已提交
3243 3244 3245
	 * higher than 1 when:
	 * - ITR is 0 as it could cause false TX hangs
	 * - ITR is set to > 100k int/sec and BQL is enabled
3246 3247 3248 3249 3250
	 *
	 * In order to avoid issues WTHRESH + PTHRESH should always be equal
	 * to or less than the number of on chip descriptors, which is
	 * currently 40.
	 */
E
Emil Tantilov 已提交
3251
	if (!ring->q_vector || (ring->q_vector->itr < IXGBE_100K_ITR))
J
Jacob Keller 已提交
3252
		txdctl |= 1u << 16;	/* WTHRESH = 1 */
3253
	else
J
Jacob Keller 已提交
3254
		txdctl |= 8u << 16;	/* WTHRESH = 8 */
3255

3256 3257 3258 3259
	/*
	 * Setting PTHRESH to 32 both improves performance
	 * and avoids a TX hang with DFP enabled
	 */
J
Jacob Keller 已提交
3260
	txdctl |= (1u << 8) |	/* HTHRESH = 1 */
3261
		   32;		/* PTHRESH = 32 */
3262 3263

	/* reinitialize flowdirector state */
3264
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
3265 3266 3267 3268 3269 3270
		ring->atr_sample_rate = adapter->atr_sample_rate;
		ring->atr_count = 0;
		set_bit(__IXGBE_TX_FDIR_INIT_DONE, &ring->state);
	} else {
		ring->atr_sample_rate = 0;
	}
3271

3272 3273 3274 3275 3276
	/* initialize XPS */
	if (!test_and_set_bit(__IXGBE_TX_XPS_INIT_DONE, &ring->state)) {
		struct ixgbe_q_vector *q_vector = ring->q_vector;

		if (q_vector)
3277
			netif_set_xps_queue(ring->netdev,
3278 3279 3280 3281
					    &q_vector->affinity_mask,
					    ring->queue_index);
	}

3282 3283
	clear_bit(__IXGBE_HANG_CHECK_ARMED, &ring->state);

3284 3285 3286 3287
	/* reinitialize tx_buffer_info */
	memset(ring->tx_buffer_info, 0,
	       sizeof(struct ixgbe_tx_buffer) * ring->count);

3288 3289 3290 3291 3292 3293 3294 3295 3296 3297
	/* enable queue */
	IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), txdctl);

	/* TXDCTL.EN will return 0 on 82598 if link is down, so skip it */
	if (hw->mac.type == ixgbe_mac_82598EB &&
	    !(IXGBE_READ_REG(hw, IXGBE_LINKS) & IXGBE_LINKS_UP))
		return;

	/* poll to verify queue is enabled */
	do {
3298
		usleep_range(1000, 2000);
3299 3300 3301
		txdctl = IXGBE_READ_REG(hw, IXGBE_TXDCTL(reg_idx));
	} while (--wait_loop && !(txdctl & IXGBE_TXDCTL_ENABLE));
	if (!wait_loop)
3302
		hw_dbg(hw, "Could not enable Tx Queue %d\n", reg_idx);
3303 3304
}

3305 3306 3307
static void ixgbe_setup_mtqc(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3308
	u32 rttdcs, mtqc;
3309
	u8 tcs = netdev_get_num_tc(adapter->netdev);
3310 3311 3312 3313 3314 3315 3316 3317 3318 3319

	if (hw->mac.type == ixgbe_mac_82598EB)
		return;

	/* disable the arbiter while setting MTQC */
	rttdcs = IXGBE_READ_REG(hw, IXGBE_RTTDCS);
	rttdcs |= IXGBE_RTTDCS_ARBDIS;
	IXGBE_WRITE_REG(hw, IXGBE_RTTDCS, rttdcs);

	/* set transmit pool layout */
3320 3321 3322 3323 3324 3325
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
		mtqc = IXGBE_MTQC_VT_ENA;
		if (tcs > 4)
			mtqc |= IXGBE_MTQC_RT_ENA | IXGBE_MTQC_8TC_8TQ;
		else if (tcs > 1)
			mtqc |= IXGBE_MTQC_RT_ENA | IXGBE_MTQC_4TC_4TQ;
3326 3327
		else if (adapter->ring_feature[RING_F_VMDQ].mask ==
			 IXGBE_82599_VMDQ_4Q_MASK)
3328 3329 3330 3331 3332 3333 3334 3335
			mtqc |= IXGBE_MTQC_32VF;
		else
			mtqc |= IXGBE_MTQC_64VF;
	} else {
		if (tcs > 4)
			mtqc = IXGBE_MTQC_RT_ENA | IXGBE_MTQC_8TC_8TQ;
		else if (tcs > 1)
			mtqc = IXGBE_MTQC_RT_ENA | IXGBE_MTQC_4TC_4TQ;
3336
		else
3337 3338
			mtqc = IXGBE_MTQC_64Q_1PB;
	}
3339

3340
	IXGBE_WRITE_REG(hw, IXGBE_MTQC, mtqc);
3341

3342 3343 3344 3345 3346
	/* Enable Security TX Buffer IFG for multiple pb */
	if (tcs) {
		u32 sectx = IXGBE_READ_REG(hw, IXGBE_SECTXMINIFG);
		sectx |= IXGBE_SECTX_DCB;
		IXGBE_WRITE_REG(hw, IXGBE_SECTXMINIFG, sectx);
3347 3348 3349 3350 3351 3352 3353
	}

	/* re-enable the arbiter */
	rttdcs &= ~IXGBE_RTTDCS_ARBDIS;
	IXGBE_WRITE_REG(hw, IXGBE_RTTDCS, rttdcs);
}

3354
/**
3355
 * ixgbe_configure_tx - Configure 8259x Transmit Unit after Reset
3356 3357 3358 3359 3360 3361
 * @adapter: board private structure
 *
 * Configure the Tx unit of the MAC after a reset.
 **/
static void ixgbe_configure_tx(struct ixgbe_adapter *adapter)
{
3362 3363
	struct ixgbe_hw *hw = &adapter->hw;
	u32 dmatxctl;
3364
	u32 i;
3365

3366 3367 3368 3369 3370 3371 3372 3373 3374
	ixgbe_setup_mtqc(adapter);

	if (hw->mac.type != ixgbe_mac_82598EB) {
		/* DMATXCTL.EN must be before Tx queues are enabled */
		dmatxctl = IXGBE_READ_REG(hw, IXGBE_DMATXCTL);
		dmatxctl |= IXGBE_DMATXCTL_TE;
		IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL, dmatxctl);
	}

3375
	/* Setup the HW Tx Head and Tail descriptor pointers */
3376 3377
	for (i = 0; i < adapter->num_tx_queues; i++)
		ixgbe_configure_tx_ring(adapter, adapter->tx_ring[i]);
3378 3379
}

3380 3381 3382 3383 3384 3385 3386 3387 3388 3389 3390 3391 3392 3393 3394 3395 3396 3397 3398 3399 3400 3401 3402 3403 3404 3405 3406 3407 3408 3409 3410 3411 3412 3413 3414 3415 3416 3417 3418 3419 3420 3421 3422 3423 3424 3425 3426 3427 3428 3429 3430 3431 3432 3433 3434
static void ixgbe_enable_rx_drop(struct ixgbe_adapter *adapter,
				 struct ixgbe_ring *ring)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u8 reg_idx = ring->reg_idx;
	u32 srrctl = IXGBE_READ_REG(hw, IXGBE_SRRCTL(reg_idx));

	srrctl |= IXGBE_SRRCTL_DROP_EN;

	IXGBE_WRITE_REG(hw, IXGBE_SRRCTL(reg_idx), srrctl);
}

static void ixgbe_disable_rx_drop(struct ixgbe_adapter *adapter,
				  struct ixgbe_ring *ring)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u8 reg_idx = ring->reg_idx;
	u32 srrctl = IXGBE_READ_REG(hw, IXGBE_SRRCTL(reg_idx));

	srrctl &= ~IXGBE_SRRCTL_DROP_EN;

	IXGBE_WRITE_REG(hw, IXGBE_SRRCTL(reg_idx), srrctl);
}

#ifdef CONFIG_IXGBE_DCB
void ixgbe_set_rx_drop_en(struct ixgbe_adapter *adapter)
#else
static void ixgbe_set_rx_drop_en(struct ixgbe_adapter *adapter)
#endif
{
	int i;
	bool pfc_en = adapter->dcb_cfg.pfc_mode_enable;

	if (adapter->ixgbe_ieee_pfc)
		pfc_en |= !!(adapter->ixgbe_ieee_pfc->pfc_en);

	/*
	 * We should set the drop enable bit if:
	 *  SR-IOV is enabled
	 *   or
	 *  Number of Rx queues > 1 and flow control is disabled
	 *
	 *  This allows us to avoid head of line blocking for security
	 *  and performance reasons.
	 */
	if (adapter->num_vfs || (adapter->num_rx_queues > 1 &&
	    !(adapter->hw.fc.current_mode & ixgbe_fc_tx_pause) && !pfc_en)) {
		for (i = 0; i < adapter->num_rx_queues; i++)
			ixgbe_enable_rx_drop(adapter, adapter->rx_ring[i]);
	} else {
		for (i = 0; i < adapter->num_rx_queues; i++)
			ixgbe_disable_rx_drop(adapter, adapter->rx_ring[i]);
	}
}

3435
#define IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT 2
3436

3437
static void ixgbe_configure_srrctl(struct ixgbe_adapter *adapter,
3438
				   struct ixgbe_ring *rx_ring)
3439
{
3440
	struct ixgbe_hw *hw = &adapter->hw;
3441
	u32 srrctl;
3442
	u8 reg_idx = rx_ring->reg_idx;
3443

3444 3445
	if (hw->mac.type == ixgbe_mac_82598EB) {
		u16 mask = adapter->ring_feature[RING_F_RSS].mask;
3446

3447 3448 3449 3450 3451 3452
		/*
		 * if VMDq is not active we must program one srrctl register
		 * per RSS queue since we have enabled RDRXCTL.MVMEN
		 */
		reg_idx &= mask;
	}
3453

3454 3455
	/* configure header buffer length, needed for RSC */
	srrctl = IXGBE_RX_HDR_SIZE << IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT;
3456

3457
	/* configure the packet buffer length */
3458 3459 3460 3461
	if (test_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state))
		srrctl |= IXGBE_RXBUFFER_3K >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
	else
		srrctl |= IXGBE_RXBUFFER_2K >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
3462 3463

	/* configure descriptor type */
3464
	srrctl |= IXGBE_SRRCTL_DESCTYPE_ADV_ONEBUF;
3465

3466
	IXGBE_WRITE_REG(hw, IXGBE_SRRCTL(reg_idx), srrctl);
3467
}
3468

3469
/**
3470
 * ixgbe_rss_indir_tbl_entries - Return RSS indirection table entries
3471 3472 3473 3474 3475 3476
 * @adapter: device handle
 *
 *  - 82598/82599/X540:     128
 *  - X550(non-SRIOV mode): 512
 *  - X550(SRIOV mode):     64
 */
3477
u32 ixgbe_rss_indir_tbl_entries(struct ixgbe_adapter *adapter)
3478 3479 3480 3481 3482 3483 3484 3485 3486
{
	if (adapter->hw.mac.type < ixgbe_mac_X550)
		return 128;
	else if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
		return 64;
	else
		return 512;
}

3487 3488 3489 3490 3491 3492 3493 3494 3495 3496 3497 3498 3499 3500 3501
/**
 * ixgbe_store_key - Write the RSS key to HW
 * @adapter: device handle
 *
 * Write the RSS key stored in adapter.rss_key to HW.
 */
void ixgbe_store_key(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int i;

	for (i = 0; i < 10; i++)
		IXGBE_WRITE_REG(hw, IXGBE_RSSRK(i), adapter->rss_key[i]);
}

3502
/**
3503
 * ixgbe_store_reta - Write the RETA table to HW
3504 3505 3506 3507
 * @adapter: device handle
 *
 * Write the RSS redirection table stored in adapter.rss_indir_tbl[] to HW.
 */
3508
void ixgbe_store_reta(struct ixgbe_adapter *adapter)
3509
{
3510
	u32 i, reta_entries = ixgbe_rss_indir_tbl_entries(adapter);
3511
	struct ixgbe_hw *hw = &adapter->hw;
3512
	u32 reta = 0;
3513 3514
	u32 indices_multi;
	u8 *indir_tbl = adapter->rss_indir_tbl;
3515

3516
	/* Fill out the redirection table as follows:
3517 3518 3519 3520
	 *  - 82598:      8 bit wide entries containing pair of 4 bit RSS
	 *    indices.
	 *  - 82599/X540: 8 bit wide entries containing 4 bit RSS index
	 *  - X550:       8 bit wide entries containing 6 bit RSS index
3521 3522 3523 3524 3525 3526
	 */
	if (adapter->hw.mac.type == ixgbe_mac_82598EB)
		indices_multi = 0x11;
	else
		indices_multi = 0x1;

3527 3528 3529
	/* Write redirection table to HW */
	for (i = 0; i < reta_entries; i++) {
		reta |= indices_multi * indir_tbl[i] << (i & 0x3) * 8;
3530 3531 3532 3533 3534 3535
		if ((i & 3) == 3) {
			if (i < 128)
				IXGBE_WRITE_REG(hw, IXGBE_RETA(i >> 2), reta);
			else
				IXGBE_WRITE_REG(hw, IXGBE_ERETA((i >> 2) - 32),
						reta);
3536
			reta = 0;
3537 3538 3539 3540
		}
	}
}

3541
/**
3542
 * ixgbe_store_vfreta - Write the RETA table to HW (x550 devices in SRIOV mode)
3543 3544 3545 3546 3547
 * @adapter: device handle
 *
 * Write the RSS redirection table stored in adapter.rss_indir_tbl[] to HW.
 */
static void ixgbe_store_vfreta(struct ixgbe_adapter *adapter)
3548
{
3549
	u32 i, reta_entries = ixgbe_rss_indir_tbl_entries(adapter);
3550 3551
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vfreta = 0;
3552 3553 3554 3555 3556 3557 3558 3559 3560 3561 3562 3563 3564 3565 3566 3567 3568 3569 3570
	unsigned int pf_pool = adapter->num_vfs;

	/* Write redirection table to HW */
	for (i = 0; i < reta_entries; i++) {
		vfreta |= (u32)adapter->rss_indir_tbl[i] << (i & 0x3) * 8;
		if ((i & 3) == 3) {
			IXGBE_WRITE_REG(hw, IXGBE_PFVFRETA(i >> 2, pf_pool),
					vfreta);
			vfreta = 0;
		}
	}
}

static void ixgbe_setup_reta(struct ixgbe_adapter *adapter)
{
	u32 i, j;
	u32 reta_entries = ixgbe_rss_indir_tbl_entries(adapter);
	u16 rss_i = adapter->ring_feature[RING_F_RSS].indices;

3571
	/* Program table for at least 4 queues w/ SR-IOV so that VFs can
3572 3573 3574
	 * make full use of any rings they may have.  We will use the
	 * PSRTYPE register to control how many rings we use within the PF.
	 */
3575 3576
	if ((adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) && (rss_i < 4))
		rss_i = 4;
3577 3578

	/* Fill out hash function seeds */
3579
	ixgbe_store_key(adapter);
3580 3581 3582 3583 3584 3585 3586 3587 3588 3589 3590 3591 3592 3593 3594 3595 3596

	/* Fill out redirection table */
	memset(adapter->rss_indir_tbl, 0, sizeof(adapter->rss_indir_tbl));

	for (i = 0, j = 0; i < reta_entries; i++, j++) {
		if (j == rss_i)
			j = 0;

		adapter->rss_indir_tbl[i] = j;
	}

	ixgbe_store_reta(adapter);
}

static void ixgbe_setup_vfreta(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3597 3598 3599 3600 3601 3602
	u16 rss_i = adapter->ring_feature[RING_F_RSS].indices;
	unsigned int pf_pool = adapter->num_vfs;
	int i, j;

	/* Fill out hash function seeds */
	for (i = 0; i < 10; i++)
3603 3604
		IXGBE_WRITE_REG(hw, IXGBE_PFVFRSSRK(i, pf_pool),
				adapter->rss_key[i]);
3605 3606 3607

	/* Fill out the redirection table */
	for (i = 0, j = 0; i < 64; i++, j++) {
3608
		if (j == rss_i)
3609
			j = 0;
3610 3611

		adapter->rss_indir_tbl[i] = j;
3612
	}
3613 3614

	ixgbe_store_vfreta(adapter);
3615 3616 3617 3618 3619
}

static void ixgbe_setup_mrqc(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3620
	u32 mrqc = 0, rss_field = 0, vfmrqc = 0;
3621
	u32 rxcsum;
3622

3623 3624 3625 3626 3627
	/* Disable indicating checksum in descriptor, enables RSS hash */
	rxcsum = IXGBE_READ_REG(hw, IXGBE_RXCSUM);
	rxcsum |= IXGBE_RXCSUM_PCSD;
	IXGBE_WRITE_REG(hw, IXGBE_RXCSUM, rxcsum);

3628
	if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
3629
		if (adapter->ring_feature[RING_F_RSS].mask)
3630
			mrqc = IXGBE_MRQC_RSSEN;
3631
	} else {
3632 3633 3634 3635 3636 3637 3638
		u8 tcs = netdev_get_num_tc(adapter->netdev);

		if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
			if (tcs > 4)
				mrqc = IXGBE_MRQC_VMDQRT8TCEN;	/* 8 TCs */
			else if (tcs > 1)
				mrqc = IXGBE_MRQC_VMDQRT4TCEN;	/* 4 TCs */
3639 3640
			else if (adapter->ring_feature[RING_F_VMDQ].mask ==
				 IXGBE_82599_VMDQ_4Q_MASK)
3641
				mrqc = IXGBE_MRQC_VMDQRSS32EN;
3642
			else
3643 3644 3645
				mrqc = IXGBE_MRQC_VMDQRSS64EN;
		} else {
			if (tcs > 4)
3646
				mrqc = IXGBE_MRQC_RTRSS8TCEN;
3647 3648 3649 3650
			else if (tcs > 1)
				mrqc = IXGBE_MRQC_RTRSS4TCEN;
			else
				mrqc = IXGBE_MRQC_RSSEN;
3651
		}
3652 3653
	}

3654
	/* Perform hash on these packet types */
3655 3656 3657 3658
	rss_field |= IXGBE_MRQC_RSS_FIELD_IPV4 |
		     IXGBE_MRQC_RSS_FIELD_IPV4_TCP |
		     IXGBE_MRQC_RSS_FIELD_IPV6 |
		     IXGBE_MRQC_RSS_FIELD_IPV6_TCP;
3659

3660
	if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV4_UDP)
3661
		rss_field |= IXGBE_MRQC_RSS_FIELD_IPV4_UDP;
3662
	if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV6_UDP)
3663
		rss_field |= IXGBE_MRQC_RSS_FIELD_IPV6_UDP;
3664

3665
	netdev_rss_key_fill(adapter->rss_key, sizeof(adapter->rss_key));
3666 3667 3668 3669 3670 3671 3672 3673 3674
	if ((hw->mac.type >= ixgbe_mac_X550) &&
	    (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)) {
		unsigned int pf_pool = adapter->num_vfs;

		/* Enable VF RSS mode */
		mrqc |= IXGBE_MRQC_MULTIPLE_RSS;
		IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);

		/* Setup RSS through the VF registers */
3675
		ixgbe_setup_vfreta(adapter);
3676 3677 3678 3679
		vfmrqc = IXGBE_MRQC_RSSEN;
		vfmrqc |= rss_field;
		IXGBE_WRITE_REG(hw, IXGBE_PFVFMRQC(pf_pool), vfmrqc);
	} else {
3680
		ixgbe_setup_reta(adapter);
3681 3682 3683
		mrqc |= rss_field;
		IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
	}
3684 3685
}

3686 3687 3688 3689 3690
/**
 * ixgbe_configure_rscctl - enable RSC for the indicated ring
 * @adapter:    address of board private structure
 * @index:      index of ring to set
 **/
3691
static void ixgbe_configure_rscctl(struct ixgbe_adapter *adapter,
3692
				   struct ixgbe_ring *ring)
3693 3694 3695
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 rscctrl;
3696
	u8 reg_idx = ring->reg_idx;
3697

A
Alexander Duyck 已提交
3698
	if (!ring_is_rsc_enabled(ring))
3699
		return;
3700

3701
	rscctrl = IXGBE_READ_REG(hw, IXGBE_RSCCTL(reg_idx));
3702 3703 3704 3705
	rscctrl |= IXGBE_RSCCTL_RSCEN;
	/*
	 * we must limit the number of descriptors so that the
	 * total size of max desc * buf_len is not greater
3706
	 * than 65536
3707
	 */
3708
	rscctrl |= IXGBE_RSCCTL_MAXDESC_16;
3709
	IXGBE_WRITE_REG(hw, IXGBE_RSCCTL(reg_idx), rscctrl);
3710 3711
}

3712 3713 3714 3715 3716 3717 3718
#define IXGBE_MAX_RX_DESC_POLL 10
static void ixgbe_rx_desc_queue_enable(struct ixgbe_adapter *adapter,
				       struct ixgbe_ring *ring)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int wait_loop = IXGBE_MAX_RX_DESC_POLL;
	u32 rxdctl;
3719
	u8 reg_idx = ring->reg_idx;
3720

3721 3722
	if (ixgbe_removed(hw->hw_addr))
		return;
3723 3724 3725 3726 3727 3728
	/* RXDCTL.EN will return 0 on 82598 if link is down, so skip it */
	if (hw->mac.type == ixgbe_mac_82598EB &&
	    !(IXGBE_READ_REG(hw, IXGBE_LINKS) & IXGBE_LINKS_UP))
		return;

	do {
3729
		usleep_range(1000, 2000);
3730 3731 3732 3733 3734 3735 3736 3737 3738
		rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
	} while (--wait_loop && !(rxdctl & IXGBE_RXDCTL_ENABLE));

	if (!wait_loop) {
		e_err(drv, "RXDCTL.ENABLE on Rx queue %d not set within "
		      "the polling period\n", reg_idx);
	}
}

3739 3740 3741 3742 3743 3744 3745 3746
void ixgbe_disable_rx_queue(struct ixgbe_adapter *adapter,
			    struct ixgbe_ring *ring)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int wait_loop = IXGBE_MAX_RX_DESC_POLL;
	u32 rxdctl;
	u8 reg_idx = ring->reg_idx;

3747 3748
	if (ixgbe_removed(hw->hw_addr))
		return;
3749 3750 3751 3752 3753 3754 3755 3756 3757 3758 3759 3760 3761 3762 3763 3764 3765 3766 3767 3768 3769 3770
	rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
	rxdctl &= ~IXGBE_RXDCTL_ENABLE;

	/* write value back with RXDCTL.ENABLE bit cleared */
	IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(reg_idx), rxdctl);

	if (hw->mac.type == ixgbe_mac_82598EB &&
	    !(IXGBE_READ_REG(hw, IXGBE_LINKS) & IXGBE_LINKS_UP))
		return;

	/* the hardware may take up to 100us to really disable the rx queue */
	do {
		udelay(10);
		rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
	} while (--wait_loop && (rxdctl & IXGBE_RXDCTL_ENABLE));

	if (!wait_loop) {
		e_err(drv, "RXDCTL.ENABLE on Rx queue %d not cleared within "
		      "the polling period\n", reg_idx);
	}
}

3771 3772
void ixgbe_configure_rx_ring(struct ixgbe_adapter *adapter,
			     struct ixgbe_ring *ring)
3773 3774
{
	struct ixgbe_hw *hw = &adapter->hw;
3775
	union ixgbe_adv_rx_desc *rx_desc;
3776
	u64 rdba = ring->dma;
3777
	u32 rxdctl;
3778
	u8 reg_idx = ring->reg_idx;
3779

3780 3781
	/* disable queue to avoid issues while updating state */
	rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
3782
	ixgbe_disable_rx_queue(adapter, ring);
3783

3784 3785 3786 3787
	IXGBE_WRITE_REG(hw, IXGBE_RDBAL(reg_idx), (rdba & DMA_BIT_MASK(32)));
	IXGBE_WRITE_REG(hw, IXGBE_RDBAH(reg_idx), (rdba >> 32));
	IXGBE_WRITE_REG(hw, IXGBE_RDLEN(reg_idx),
			ring->count * sizeof(union ixgbe_adv_rx_desc));
3788 3789 3790
	/* Force flushing of IXGBE_RDLEN to prevent MDD */
	IXGBE_WRITE_FLUSH(hw);

3791 3792
	IXGBE_WRITE_REG(hw, IXGBE_RDH(reg_idx), 0);
	IXGBE_WRITE_REG(hw, IXGBE_RDT(reg_idx), 0);
3793
	ring->tail = adapter->io_addr + IXGBE_RDT(reg_idx);
3794 3795 3796 3797 3798 3799 3800 3801 3802 3803 3804 3805 3806 3807

	ixgbe_configure_srrctl(adapter, ring);
	ixgbe_configure_rscctl(adapter, ring);

	if (hw->mac.type == ixgbe_mac_82598EB) {
		/*
		 * enable cache line friendly hardware writes:
		 * PTHRESH=32 descriptors (half the internal cache),
		 * this also removes ugly rx_no_buffer_count increment
		 * HTHRESH=4 descriptors (to minimize latency on fetch)
		 * WTHRESH=8 burst writeback up to two cache lines
		 */
		rxdctl &= ~0x3FFFFF;
		rxdctl |=  0x080420;
3808 3809 3810 3811 3812 3813 3814 3815 3816 3817 3818
#if (PAGE_SIZE < 8192)
	} else {
		rxdctl &= ~(IXGBE_RXDCTL_RLPMLMASK |
			    IXGBE_RXDCTL_RLPML_EN);

		/* Limit the maximum frame size so we don't overrun the skb */
		if (ring_uses_build_skb(ring) &&
		    !test_bit(__IXGBE_RX_3K_BUFFER, &ring->state))
			rxdctl |= IXGBE_MAX_FRAME_BUILD_SKB |
				  IXGBE_RXDCTL_RLPML_EN;
#endif
3819 3820
	}

3821 3822 3823 3824
	/* initialize rx_buffer_info */
	memset(ring->rx_buffer_info, 0,
	       sizeof(struct ixgbe_rx_buffer) * ring->count);

3825 3826 3827 3828
	/* initialize Rx descriptor 0 */
	rx_desc = IXGBE_RX_DESC(ring, 0);
	rx_desc->wb.upper.length = 0;

3829 3830 3831 3832 3833
	/* enable receive descriptor ring */
	rxdctl |= IXGBE_RXDCTL_ENABLE;
	IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(reg_idx), rxdctl);

	ixgbe_rx_desc_queue_enable(adapter, ring);
3834
	ixgbe_alloc_rx_buffers(ring, ixgbe_desc_unused(ring));
3835 3836
}

3837 3838 3839
static void ixgbe_setup_psrtype(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3840
	int rss_i = adapter->ring_feature[RING_F_RSS].indices;
3841
	u16 pool;
3842 3843 3844

	/* PSRTYPE must be initialized in non 82598 adapters */
	u32 psrtype = IXGBE_PSRTYPE_TCPHDR |
3845 3846
		      IXGBE_PSRTYPE_UDPHDR |
		      IXGBE_PSRTYPE_IPV4HDR |
3847
		      IXGBE_PSRTYPE_L2HDR |
3848
		      IXGBE_PSRTYPE_IPV6HDR;
3849 3850 3851 3852

	if (hw->mac.type == ixgbe_mac_82598EB)
		return;

3853
	if (rss_i > 3)
J
Jacob Keller 已提交
3854
		psrtype |= 2u << 29;
3855
	else if (rss_i > 1)
J
Jacob Keller 已提交
3856
		psrtype |= 1u << 29;
3857

3858 3859
	for_each_set_bit(pool, &adapter->fwd_bitmask, 32)
		IXGBE_WRITE_REG(hw, IXGBE_PSRTYPE(VMDQ_P(pool)), psrtype);
3860 3861
}

3862 3863 3864 3865
static void ixgbe_configure_virtualization(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 reg_offset, vf_shift;
3866
	u32 gcr_ext, vmdctl;
3867
	int i;
3868 3869 3870 3871 3872

	if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
		return;

	vmdctl = IXGBE_READ_REG(hw, IXGBE_VT_CTL);
3873 3874
	vmdctl |= IXGBE_VMD_CTL_VMDQ_EN;
	vmdctl &= ~IXGBE_VT_CTL_POOL_MASK;
3875
	vmdctl |= VMDQ_P(0) << IXGBE_VT_CTL_POOL_SHIFT;
3876 3877
	vmdctl |= IXGBE_VT_CTL_REPLEN;
	IXGBE_WRITE_REG(hw, IXGBE_VT_CTL, vmdctl);
3878

3879 3880
	vf_shift = VMDQ_P(0) % 32;
	reg_offset = (VMDQ_P(0) >= 32) ? 1 : 0;
3881 3882

	/* Enable only the PF's pool for Tx/Rx */
3883
	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), GENMASK(31, vf_shift));
3884
	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset ^ 1), reg_offset - 1);
3885
	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), GENMASK(31, vf_shift));
3886
	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset ^ 1), reg_offset - 1);
3887
	if (adapter->bridge_mode == BRIDGE_MODE_VEB)
3888
		IXGBE_WRITE_REG(hw, IXGBE_PFDTXGSWC, IXGBE_PFDTXGSWC_VT_LBEN);
3889 3890

	/* Map PF MAC address in RAR Entry 0 to first pool following VFs */
3891
	hw->mac.ops.set_vmdq(hw, 0, VMDQ_P(0));
3892

3893 3894 3895
	/* clear VLAN promisc flag so VFTA will be updated if necessary */
	adapter->flags2 &= ~IXGBE_FLAG2_VLAN_PROMISC;

3896 3897 3898 3899
	/*
	 * Set up VF register offsets for selected VT Mode,
	 * i.e. 32 or 64 VFs for SR-IOV
	 */
3900 3901 3902 3903 3904 3905 3906 3907 3908 3909 3910 3911
	switch (adapter->ring_feature[RING_F_VMDQ].mask) {
	case IXGBE_82599_VMDQ_8Q_MASK:
		gcr_ext = IXGBE_GCR_EXT_VT_MODE_16;
		break;
	case IXGBE_82599_VMDQ_4Q_MASK:
		gcr_ext = IXGBE_GCR_EXT_VT_MODE_32;
		break;
	default:
		gcr_ext = IXGBE_GCR_EXT_VT_MODE_64;
		break;
	}

3912 3913
	IXGBE_WRITE_REG(hw, IXGBE_GCR_EXT, gcr_ext);

3914
	for (i = 0; i < adapter->num_vfs; i++) {
3915 3916 3917
		/* configure spoof checking */
		ixgbe_ndo_set_vf_spoofchk(adapter->netdev, i,
					  adapter->vfinfo[i].spoofchk_enabled);
3918 3919 3920 3921

		/* Enable/Disable RSS query feature  */
		ixgbe_ndo_set_vf_rss_query_en(adapter->netdev, i,
					  adapter->vfinfo[i].rss_query_enabled);
3922
	}
3923 3924
}

3925
static void ixgbe_set_rx_buffer_len(struct ixgbe_adapter *adapter)
3926 3927 3928 3929
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct net_device *netdev = adapter->netdev;
	int max_frame = netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
3930 3931 3932
	struct ixgbe_ring *rx_ring;
	int i;
	u32 mhadd, hlreg0;
3933

3934
#ifdef IXGBE_FCOE
3935 3936 3937 3938
	/* adjust max frame to be able to do baby jumbo for FCoE */
	if ((adapter->flags & IXGBE_FLAG_FCOE_ENABLED) &&
	    (max_frame < IXGBE_FCOE_JUMBO_FRAME_SIZE))
		max_frame = IXGBE_FCOE_JUMBO_FRAME_SIZE;
3939

3940
#endif /* IXGBE_FCOE */
3941 3942 3943 3944 3945

	/* adjust max frame to be at least the size of a standard frame */
	if (max_frame < (ETH_FRAME_LEN + ETH_FCS_LEN))
		max_frame = (ETH_FRAME_LEN + ETH_FCS_LEN);

3946 3947 3948 3949 3950 3951 3952 3953 3954 3955 3956 3957
	mhadd = IXGBE_READ_REG(hw, IXGBE_MHADD);
	if (max_frame != (mhadd >> IXGBE_MHADD_MFS_SHIFT)) {
		mhadd &= ~IXGBE_MHADD_MFS_MASK;
		mhadd |= max_frame << IXGBE_MHADD_MFS_SHIFT;

		IXGBE_WRITE_REG(hw, IXGBE_MHADD, mhadd);
	}

	hlreg0 = IXGBE_READ_REG(hw, IXGBE_HLREG0);
	/* set jumbo enable since MHADD.MFS is keeping size locked at max_frame */
	hlreg0 |= IXGBE_HLREG0_JUMBOEN;
	IXGBE_WRITE_REG(hw, IXGBE_HLREG0, hlreg0);
3958

3959 3960 3961 3962
	/*
	 * Setup the HW Rx Head and Tail Descriptor Pointers and
	 * the Base and Length of the Rx Descriptor Ring
	 */
3963
	for (i = 0; i < adapter->num_rx_queues; i++) {
3964
		rx_ring = adapter->rx_ring[i];
3965 3966 3967

		clear_ring_rsc_enabled(rx_ring);
		clear_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state);
3968
		clear_bit(__IXGBE_RX_BUILD_SKB_ENABLED, &rx_ring->state);
3969

A
Alexander Duyck 已提交
3970 3971
		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
			set_ring_rsc_enabled(rx_ring);
3972 3973 3974

		if (test_bit(__IXGBE_RX_FCOE, &rx_ring->state))
			set_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state);
3975

3976
		clear_bit(__IXGBE_RX_BUILD_SKB_ENABLED, &rx_ring->state);
3977 3978 3979 3980 3981 3982 3983 3984 3985
		if (adapter->flags2 & IXGBE_FLAG2_RX_LEGACY)
			continue;

		set_bit(__IXGBE_RX_BUILD_SKB_ENABLED, &rx_ring->state);

#if (PAGE_SIZE < 8192)
		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
			set_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state);

3986 3987
		if ((max_frame > (ETH_FRAME_LEN + ETH_FCS_LEN)) ||
		    (max_frame > IXGBE_MAX_FRAME_BUILD_SKB))
3988 3989
			set_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state);
#endif
3990 3991 3992
	}
}

3993 3994 3995 3996 3997 3998 3999 4000 4001 4002 4003 4004 4005 4006 4007 4008 4009 4010 4011
static void ixgbe_setup_rdrxctl(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 rdrxctl = IXGBE_READ_REG(hw, IXGBE_RDRXCTL);

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
		/*
		 * For VMDq support of different descriptor types or
		 * buffer sizes through the use of multiple SRRCTL
		 * registers, RDRXCTL.MVMEN must be set to 1
		 *
		 * also, the manual doesn't mention it clearly but DCA hints
		 * will only use queue 0's tags unless this bit is set.  Side
		 * effects of setting this bit are only that SRRCTL must be
		 * fully programmed [0..15]
		 */
		rdrxctl |= IXGBE_RDRXCTL_MVMEN;
		break;
4012 4013
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
4014
	case ixgbe_mac_x550em_a:
4015 4016 4017
		if (adapter->num_vfs)
			rdrxctl |= IXGBE_RDRXCTL_PSP;
		/* fall through for older HW */
4018
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
4019
	case ixgbe_mac_X540:
4020 4021 4022 4023 4024 4025 4026 4027 4028 4029 4030 4031 4032 4033 4034 4035
		/* Disable RSC for ACK packets */
		IXGBE_WRITE_REG(hw, IXGBE_RSCDBU,
		   (IXGBE_RSCDBU_RSCACKDIS | IXGBE_READ_REG(hw, IXGBE_RSCDBU)));
		rdrxctl &= ~IXGBE_RDRXCTL_RSCFRSTSIZE;
		/* hardware requires some bits to be set by default */
		rdrxctl |= (IXGBE_RDRXCTL_RSCACKC | IXGBE_RDRXCTL_FCOE_WRFIX);
		rdrxctl |= IXGBE_RDRXCTL_CRCSTRIP;
		break;
	default:
		/* We should do nothing since we don't know this hardware */
		return;
	}

	IXGBE_WRITE_REG(hw, IXGBE_RDRXCTL, rdrxctl);
}

4036 4037 4038 4039 4040 4041 4042 4043 4044 4045
/**
 * ixgbe_configure_rx - Configure 8259x Receive Unit after Reset
 * @adapter: board private structure
 *
 * Configure the Rx unit of the MAC after a reset.
 **/
static void ixgbe_configure_rx(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int i;
4046
	u32 rxctrl, rfctl;
4047 4048

	/* disable receives while setting up the descriptors */
4049
	hw->mac.ops.disable_rx(hw);
4050 4051

	ixgbe_setup_psrtype(adapter);
4052
	ixgbe_setup_rdrxctl(adapter);
4053

4054 4055 4056 4057 4058
	/* RSC Setup */
	rfctl = IXGBE_READ_REG(hw, IXGBE_RFCTL);
	rfctl &= ~IXGBE_RFCTL_RSC_DIS;
	if (!(adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED))
		rfctl |= IXGBE_RFCTL_RSC_DIS;
4059 4060 4061

	/* disable NFS filtering */
	rfctl |= (IXGBE_RFCTL_NFSW_DIS | IXGBE_RFCTL_NFSR_DIS);
4062 4063
	IXGBE_WRITE_REG(hw, IXGBE_RFCTL, rfctl);

4064
	/* Program registers for the distribution of queues */
4065 4066
	ixgbe_setup_mrqc(adapter);

4067 4068 4069 4070 4071 4072 4073
	/* set_rx_buffer_len must be called before ring initialization */
	ixgbe_set_rx_buffer_len(adapter);

	/*
	 * Setup the HW Rx Head and Tail Descriptor Pointers and
	 * the Base and Length of the Rx Descriptor Ring
	 */
4074 4075
	for (i = 0; i < adapter->num_rx_queues; i++)
		ixgbe_configure_rx_ring(adapter, adapter->rx_ring[i]);
4076

4077
	rxctrl = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
4078 4079 4080 4081 4082 4083 4084
	/* disable drop enable for 82598 parts */
	if (hw->mac.type == ixgbe_mac_82598EB)
		rxctrl |= IXGBE_RXCTRL_DMBYPS;

	/* enable all receives */
	rxctrl |= IXGBE_RXCTRL_RXEN;
	hw->mac.ops.enable_rx_dma(hw, rxctrl);
4085 4086
}

4087 4088
static int ixgbe_vlan_rx_add_vid(struct net_device *netdev,
				 __be16 proto, u16 vid)
4089 4090 4091 4092 4093
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

	/* add VID to filter table */
4094 4095 4096
	if (!vid || !(adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
		hw->mac.ops.set_vfta(&adapter->hw, vid, VMDQ_P(0), true, !!vid);

4097
	set_bit(vid, adapter->active_vlans);
4098 4099

	return 0;
4100 4101
}

4102 4103 4104 4105 4106 4107 4108 4109 4110 4111 4112 4113 4114 4115 4116 4117 4118 4119 4120 4121 4122 4123 4124 4125 4126 4127 4128 4129 4130 4131 4132 4133 4134
static int ixgbe_find_vlvf_entry(struct ixgbe_hw *hw, u32 vlan)
{
	u32 vlvf;
	int idx;

	/* short cut the special case */
	if (vlan == 0)
		return 0;

	/* Search for the vlan id in the VLVF entries */
	for (idx = IXGBE_VLVF_ENTRIES; --idx;) {
		vlvf = IXGBE_READ_REG(hw, IXGBE_VLVF(idx));
		if ((vlvf & VLAN_VID_MASK) == vlan)
			break;
	}

	return idx;
}

void ixgbe_update_pf_promisc_vlvf(struct ixgbe_adapter *adapter, u32 vid)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 bits, word;
	int idx;

	idx = ixgbe_find_vlvf_entry(hw, vid);
	if (!idx)
		return;

	/* See if any other pools are set for this VLAN filter
	 * entry other than the PF.
	 */
	word = idx * 2 + (VMDQ_P(0) / 32);
J
Jacob Keller 已提交
4135
	bits = ~BIT(VMDQ_P(0) % 32);
4136 4137 4138 4139 4140 4141 4142 4143 4144 4145
	bits &= IXGBE_READ_REG(hw, IXGBE_VLVFB(word));

	/* Disable the filter so this falls into the default pool. */
	if (!bits && !IXGBE_READ_REG(hw, IXGBE_VLVFB(word ^ 1))) {
		if (!(adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
			IXGBE_WRITE_REG(hw, IXGBE_VLVFB(word), 0);
		IXGBE_WRITE_REG(hw, IXGBE_VLVF(idx), 0);
	}
}

4146 4147
static int ixgbe_vlan_rx_kill_vid(struct net_device *netdev,
				  __be16 proto, u16 vid)
4148 4149 4150 4151 4152
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

	/* remove VID from filter table */
4153
	if (vid && !(adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
4154 4155
		hw->mac.ops.set_vfta(hw, vid, VMDQ_P(0), false, true);

4156
	clear_bit(vid, adapter->active_vlans);
4157 4158

	return 0;
4159 4160
}

4161 4162 4163 4164 4165 4166 4167 4168
/**
 * ixgbe_vlan_strip_disable - helper to disable hw vlan stripping
 * @adapter: driver data
 */
static void ixgbe_vlan_strip_disable(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vlnctrl;
4169 4170 4171 4172
	int i, j;

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
4173 4174
		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
		vlnctrl &= ~IXGBE_VLNCTRL_VME;
4175 4176 4177
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
4178
	case ixgbe_mac_X540:
4179 4180
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
4181
	case ixgbe_mac_x550em_a:
4182
		for (i = 0; i < adapter->num_rx_queues; i++) {
4183 4184 4185 4186 4187
			struct ixgbe_ring *ring = adapter->rx_ring[i];

			if (ring->l2_accel_priv)
				continue;
			j = ring->reg_idx;
4188 4189 4190 4191 4192 4193 4194 4195 4196 4197 4198
			vlnctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(j));
			vlnctrl &= ~IXGBE_RXDCTL_VME;
			IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(j), vlnctrl);
		}
		break;
	default:
		break;
	}
}

/**
4199
 * ixgbe_vlan_strip_enable - helper to enable hw vlan stripping
4200 4201
 * @adapter: driver data
 */
4202
static void ixgbe_vlan_strip_enable(struct ixgbe_adapter *adapter)
4203 4204
{
	struct ixgbe_hw *hw = &adapter->hw;
4205
	u32 vlnctrl;
4206 4207 4208 4209
	int i, j;

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
4210 4211
		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
		vlnctrl |= IXGBE_VLNCTRL_VME;
4212 4213 4214
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
4215
	case ixgbe_mac_X540:
4216 4217
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
4218
	case ixgbe_mac_x550em_a:
4219
		for (i = 0; i < adapter->num_rx_queues; i++) {
4220 4221 4222 4223 4224
			struct ixgbe_ring *ring = adapter->rx_ring[i];

			if (ring->l2_accel_priv)
				continue;
			j = ring->reg_idx;
4225 4226 4227 4228 4229 4230 4231 4232 4233 4234
			vlnctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(j));
			vlnctrl |= IXGBE_RXDCTL_VME;
			IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(j), vlnctrl);
		}
		break;
	default:
		break;
	}
}

4235 4236 4237 4238 4239
static void ixgbe_vlan_promisc_enable(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vlnctrl, i;

4240 4241
	vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);

4242 4243 4244 4245 4246
	if (adapter->flags & IXGBE_FLAG_VMDQ_ENABLED) {
	/* For VMDq and SR-IOV we must leave VLAN filtering enabled */
		vlnctrl |= IXGBE_VLNCTRL_VFE;
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
	} else {
4247
		vlnctrl &= ~IXGBE_VLNCTRL_VFE;
4248 4249 4250 4251
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		return;
	}

4252 4253 4254 4255
	/* Nothing to do for 82598 */
	if (hw->mac.type == ixgbe_mac_82598EB)
		return;

4256 4257 4258 4259 4260 4261 4262 4263 4264 4265 4266 4267
	/* We are already in VLAN promisc, nothing to do */
	if (adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC)
		return;

	/* Set flag so we don't redo unnecessary work */
	adapter->flags2 |= IXGBE_FLAG2_VLAN_PROMISC;

	/* Add PF to all active pools */
	for (i = IXGBE_VLVF_ENTRIES; --i;) {
		u32 reg_offset = IXGBE_VLVFB(i * 2 + VMDQ_P(0) / 32);
		u32 vlvfb = IXGBE_READ_REG(hw, reg_offset);

J
Jacob Keller 已提交
4268
		vlvfb |= BIT(VMDQ_P(0) % 32);
4269 4270 4271 4272 4273 4274 4275 4276 4277 4278 4279 4280 4281 4282 4283 4284 4285 4286 4287 4288 4289 4290 4291 4292 4293 4294 4295 4296 4297
		IXGBE_WRITE_REG(hw, reg_offset, vlvfb);
	}

	/* Set all bits in the VLAN filter table array */
	for (i = hw->mac.vft_size; i--;)
		IXGBE_WRITE_REG(hw, IXGBE_VFTA(i), ~0U);
}

#define VFTA_BLOCK_SIZE 8
static void ixgbe_scrub_vfta(struct ixgbe_adapter *adapter, u32 vfta_offset)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vfta[VFTA_BLOCK_SIZE] = { 0 };
	u32 vid_start = vfta_offset * 32;
	u32 vid_end = vid_start + (VFTA_BLOCK_SIZE * 32);
	u32 i, vid, word, bits;

	for (i = IXGBE_VLVF_ENTRIES; --i;) {
		u32 vlvf = IXGBE_READ_REG(hw, IXGBE_VLVF(i));

		/* pull VLAN ID from VLVF */
		vid = vlvf & VLAN_VID_MASK;

		/* only concern outselves with a certain range */
		if (vid < vid_start || vid >= vid_end)
			continue;

		if (vlvf) {
			/* record VLAN ID in VFTA */
J
Jacob Keller 已提交
4298
			vfta[(vid - vid_start) / 32] |= BIT(vid % 32);
4299 4300 4301 4302 4303 4304 4305 4306

			/* if PF is part of this then continue */
			if (test_bit(vid, adapter->active_vlans))
				continue;
		}

		/* remove PF from the pool */
		word = i * 2 + VMDQ_P(0) / 32;
J
Jacob Keller 已提交
4307
		bits = ~BIT(VMDQ_P(0) % 32);
4308 4309 4310 4311 4312 4313 4314 4315 4316 4317 4318 4319 4320 4321 4322 4323 4324 4325 4326 4327 4328
		bits &= IXGBE_READ_REG(hw, IXGBE_VLVFB(word));
		IXGBE_WRITE_REG(hw, IXGBE_VLVFB(word), bits);
	}

	/* extract values from active_vlans and write back to VFTA */
	for (i = VFTA_BLOCK_SIZE; i--;) {
		vid = (vfta_offset + i) * 32;
		word = vid / BITS_PER_LONG;
		bits = vid % BITS_PER_LONG;

		vfta[i] |= adapter->active_vlans[word] >> bits;

		IXGBE_WRITE_REG(hw, IXGBE_VFTA(vfta_offset + i), vfta[i]);
	}
}

static void ixgbe_vlan_promisc_disable(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vlnctrl, i;

4329 4330 4331 4332 4333
	/* Set VLAN filtering to enabled */
	vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
	vlnctrl |= IXGBE_VLNCTRL_VFE;
	IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);

4334 4335
	if (!(adapter->flags & IXGBE_FLAG_VMDQ_ENABLED) ||
	    hw->mac.type == ixgbe_mac_82598EB)
4336 4337 4338 4339 4340 4341 4342 4343 4344 4345 4346 4347 4348
		return;

	/* We are not in VLAN promisc, nothing to do */
	if (!(adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC))
		return;

	/* Set flag so we don't redo unnecessary work */
	adapter->flags2 &= ~IXGBE_FLAG2_VLAN_PROMISC;

	for (i = 0; i < hw->mac.vft_size; i += VFTA_BLOCK_SIZE)
		ixgbe_scrub_vfta(adapter, i);
}

4349 4350
static void ixgbe_restore_vlan(struct ixgbe_adapter *adapter)
{
4351
	u16 vid = 1;
4352

4353
	ixgbe_vlan_rx_add_vid(adapter->netdev, htons(ETH_P_8021Q), 0);
4354

4355
	for_each_set_bit_from(vid, adapter->active_vlans, VLAN_N_VID)
4356
		ixgbe_vlan_rx_add_vid(adapter->netdev, htons(ETH_P_8021Q), vid);
4357 4358
}

4359 4360 4361 4362 4363 4364 4365 4366 4367 4368 4369 4370 4371 4372 4373 4374 4375 4376 4377 4378 4379 4380 4381
/**
 * ixgbe_write_mc_addr_list - write multicast addresses to MTA
 * @netdev: network interface device structure
 *
 * Writes multicast address list to the MTA hash table.
 * Returns: -ENOMEM on failure
 *                0 on no addresses written
 *                X on writing X addresses to MTA
 **/
static int ixgbe_write_mc_addr_list(struct net_device *netdev)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

	if (!netif_running(netdev))
		return 0;

	if (hw->mac.ops.update_mc_addr_list)
		hw->mac.ops.update_mc_addr_list(hw, netdev);
	else
		return -ENOMEM;

#ifdef CONFIG_PCI_IOV
4382
	ixgbe_restore_vf_multicasts(adapter);
4383 4384 4385 4386 4387
#endif

	return netdev_mc_count(netdev);
}

4388 4389 4390
#ifdef CONFIG_PCI_IOV
void ixgbe_full_sync_mac_table(struct ixgbe_adapter *adapter)
{
4391
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4392 4393
	struct ixgbe_hw *hw = &adapter->hw;
	int i;
4394 4395 4396 4397 4398 4399 4400 4401

	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
		mac_table->state &= ~IXGBE_MAC_STATE_MODIFIED;

		if (mac_table->state & IXGBE_MAC_STATE_IN_USE)
			hw->mac.ops.set_rar(hw, i,
					    mac_table->addr,
					    mac_table->pool,
4402 4403 4404 4405 4406 4407
					    IXGBE_RAH_AV);
		else
			hw->mac.ops.clear_rar(hw, i);
	}
}

4408
#endif
4409 4410
static void ixgbe_sync_mac_table(struct ixgbe_adapter *adapter)
{
4411
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4412 4413 4414
	struct ixgbe_hw *hw = &adapter->hw;
	int i;

4415 4416 4417 4418 4419 4420 4421 4422 4423 4424 4425 4426 4427
	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
		if (!(mac_table->state & IXGBE_MAC_STATE_MODIFIED))
			continue;

		mac_table->state &= ~IXGBE_MAC_STATE_MODIFIED;

		if (mac_table->state & IXGBE_MAC_STATE_IN_USE)
			hw->mac.ops.set_rar(hw, i,
					    mac_table->addr,
					    mac_table->pool,
					    IXGBE_RAH_AV);
		else
			hw->mac.ops.clear_rar(hw, i);
4428 4429 4430 4431 4432
	}
}

static void ixgbe_flush_sw_mac_table(struct ixgbe_adapter *adapter)
{
4433
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4434
	struct ixgbe_hw *hw = &adapter->hw;
4435
	int i;
4436

4437 4438 4439
	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
		mac_table->state |= IXGBE_MAC_STATE_MODIFIED;
		mac_table->state &= ~IXGBE_MAC_STATE_IN_USE;
4440
	}
4441

4442 4443 4444
	ixgbe_sync_mac_table(adapter);
}

4445
static int ixgbe_available_rars(struct ixgbe_adapter *adapter, u16 pool)
4446
{
4447
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4448 4449 4450
	struct ixgbe_hw *hw = &adapter->hw;
	int i, count = 0;

4451 4452 4453 4454 4455 4456 4457 4458 4459 4460 4461 4462
	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
		/* do not count default RAR as available */
		if (mac_table->state & IXGBE_MAC_STATE_DEFAULT)
			continue;

		/* only count unused and addresses that belong to us */
		if (mac_table->state & IXGBE_MAC_STATE_IN_USE) {
			if (mac_table->pool != pool)
				continue;
		}

		count++;
4463
	}
4464

4465 4466 4467 4468
	return count;
}

/* this function destroys the first RAR entry */
4469
static void ixgbe_mac_set_default_filter(struct ixgbe_adapter *adapter)
4470
{
4471
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4472 4473
	struct ixgbe_hw *hw = &adapter->hw;

4474 4475 4476 4477 4478 4479
	memcpy(&mac_table->addr, hw->mac.addr, ETH_ALEN);
	mac_table->pool = VMDQ_P(0);

	mac_table->state = IXGBE_MAC_STATE_DEFAULT | IXGBE_MAC_STATE_IN_USE;

	hw->mac.ops.set_rar(hw, 0, mac_table->addr, mac_table->pool,
4480 4481 4482
			    IXGBE_RAH_AV);
}

4483 4484
int ixgbe_add_mac_filter(struct ixgbe_adapter *adapter,
			 const u8 *addr, u16 pool)
4485
{
4486
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4487 4488 4489 4490 4491 4492
	struct ixgbe_hw *hw = &adapter->hw;
	int i;

	if (is_zero_ether_addr(addr))
		return -EINVAL;

4493 4494
	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
		if (mac_table->state & IXGBE_MAC_STATE_IN_USE)
4495
			continue;
4496 4497 4498 4499 4500 4501 4502

		ether_addr_copy(mac_table->addr, addr);
		mac_table->pool = pool;

		mac_table->state |= IXGBE_MAC_STATE_MODIFIED |
				    IXGBE_MAC_STATE_IN_USE;

4503
		ixgbe_sync_mac_table(adapter);
4504

4505 4506
		return i;
	}
4507

4508 4509 4510
	return -ENOMEM;
}

4511 4512
int ixgbe_del_mac_filter(struct ixgbe_adapter *adapter,
			 const u8 *addr, u16 pool)
4513
{
4514
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4515
	struct ixgbe_hw *hw = &adapter->hw;
4516
	int i;
4517 4518 4519 4520

	if (is_zero_ether_addr(addr))
		return -EINVAL;

4521 4522 4523 4524 4525 4526 4527 4528 4529 4530 4531 4532 4533 4534 4535 4536 4537 4538
	/* search table for addr, if found clear IN_USE flag and sync */
	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
		/* we can only delete an entry if it is in use */
		if (!(mac_table->state & IXGBE_MAC_STATE_IN_USE))
			continue;
		/* we only care about entries that belong to the given pool */
		if (mac_table->pool != pool)
			continue;
		/* we only care about a specific MAC address */
		if (!ether_addr_equal(addr, mac_table->addr))
			continue;

		mac_table->state |= IXGBE_MAC_STATE_MODIFIED;
		mac_table->state &= ~IXGBE_MAC_STATE_IN_USE;

		ixgbe_sync_mac_table(adapter);

		return 0;
4539
	}
4540

4541 4542
	return -ENOMEM;
}
4543 4544 4545 4546 4547 4548 4549 4550 4551
/**
 * ixgbe_write_uc_addr_list - write unicast addresses to RAR table
 * @netdev: network interface device structure
 *
 * Writes unicast address list to the RAR table.
 * Returns: -ENOMEM on failure/insufficient address space
 *                0 on no addresses written
 *                X on writing X addresses to the RAR table
 **/
4552
static int ixgbe_write_uc_addr_list(struct net_device *netdev, int vfn)
4553 4554 4555 4556 4557
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	int count = 0;

	/* return ENOMEM indicating insufficient memory for addresses */
4558
	if (netdev_uc_count(netdev) > ixgbe_available_rars(adapter, vfn))
4559 4560
		return -ENOMEM;

4561
	if (!netdev_uc_empty(netdev)) {
4562 4563
		struct netdev_hw_addr *ha;
		netdev_for_each_uc_addr(ha, netdev) {
4564 4565
			ixgbe_del_mac_filter(adapter, ha->addr, vfn);
			ixgbe_add_mac_filter(adapter, ha->addr, vfn);
4566 4567 4568 4569 4570 4571
			count++;
		}
	}
	return count;
}

4572 4573 4574 4575 4576 4577 4578 4579 4580 4581 4582 4583 4584 4585 4586 4587 4588 4589 4590
static int ixgbe_uc_sync(struct net_device *netdev, const unsigned char *addr)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	int ret;

	ret = ixgbe_add_mac_filter(adapter, addr, VMDQ_P(0));

	return min_t(int, ret, 0);
}

static int ixgbe_uc_unsync(struct net_device *netdev, const unsigned char *addr)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

	ixgbe_del_mac_filter(adapter, addr, VMDQ_P(0));

	return 0;
}

4591
/**
4592
 * ixgbe_set_rx_mode - Unicast, Multicast and Promiscuous mode set
4593 4594
 * @netdev: network interface device structure
 *
4595 4596 4597 4598
 * The set_rx_method entry point is called whenever the unicast/multicast
 * address list or the network interface flags are updated.  This routine is
 * responsible for configuring the hardware for proper unicast, multicast and
 * promiscuous mode.
4599
 **/
4600
void ixgbe_set_rx_mode(struct net_device *netdev)
4601 4602 4603
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;
4604
	u32 fctrl, vmolr = IXGBE_VMOLR_BAM | IXGBE_VMOLR_AUPE;
4605
	netdev_features_t features = netdev->features;
4606
	int count;
4607 4608 4609 4610

	/* Check for Promiscuous and All Multicast modes */
	fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);

4611
	/* set all bits that we expect to always be set */
B
Ben Greear 已提交
4612
	fctrl &= ~IXGBE_FCTRL_SBP; /* disable store-bad-packets */
4613 4614 4615 4616
	fctrl |= IXGBE_FCTRL_BAM;
	fctrl |= IXGBE_FCTRL_DPF; /* discard pause frames when FC enabled */
	fctrl |= IXGBE_FCTRL_PMCF;

4617 4618
	/* clear the bits we are changing the status of */
	fctrl &= ~(IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);
4619
	if (netdev->flags & IFF_PROMISC) {
4620
		hw->addr_ctrl.user_set_promisc = true;
4621
		fctrl |= (IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);
4622
		vmolr |= IXGBE_VMOLR_MPE;
4623
		features &= ~NETIF_F_HW_VLAN_CTAG_FILTER;
4624
	} else {
4625 4626
		if (netdev->flags & IFF_ALLMULTI) {
			fctrl |= IXGBE_FCTRL_MPE;
4627
			vmolr |= IXGBE_VMOLR_MPE;
4628
		}
4629
		hw->addr_ctrl.user_set_promisc = false;
4630 4631 4632 4633 4634 4635 4636
	}

	/*
	 * Write addresses to available RAR registers, if there is not
	 * sufficient space to store all the addresses then enable
	 * unicast promiscuous mode
	 */
4637
	if (__dev_uc_sync(netdev, ixgbe_uc_sync, ixgbe_uc_unsync)) {
4638 4639
		fctrl |= IXGBE_FCTRL_UPE;
		vmolr |= IXGBE_VMOLR_ROPE;
4640 4641
	}

4642 4643 4644 4645
	/* Write addresses to the MTA, if the attempt fails
	 * then we should just turn on promiscuous mode so
	 * that we can at least receive multicast traffic
	 */
4646 4647 4648 4649 4650 4651 4652
	count = ixgbe_write_mc_addr_list(netdev);
	if (count < 0) {
		fctrl |= IXGBE_FCTRL_MPE;
		vmolr |= IXGBE_VMOLR_MPE;
	} else if (count) {
		vmolr |= IXGBE_VMOLR_ROMPE;
	}
4653 4654 4655

	if (hw->mac.type != ixgbe_mac_82598EB) {
		vmolr |= IXGBE_READ_REG(hw, IXGBE_VMOLR(VMDQ_P(0))) &
4656 4657
			 ~(IXGBE_VMOLR_MPE | IXGBE_VMOLR_ROMPE |
			   IXGBE_VMOLR_ROPE);
4658
		IXGBE_WRITE_REG(hw, IXGBE_VMOLR(VMDQ_P(0)), vmolr);
4659 4660
	}

B
Ben Greear 已提交
4661
	/* This is useful for sniffing bad packets. */
4662
	if (features & NETIF_F_RXALL) {
B
Ben Greear 已提交
4663 4664 4665 4666 4667 4668 4669 4670 4671 4672
		/* UPE and MPE will be handled by normal PROMISC logic
		 * in e1000e_set_rx_mode */
		fctrl |= (IXGBE_FCTRL_SBP | /* Receive bad packets */
			  IXGBE_FCTRL_BAM | /* RX All Bcast Pkts */
			  IXGBE_FCTRL_PMCF); /* RX All MAC Ctrl Pkts */

		fctrl &= ~(IXGBE_FCTRL_DPF);
		/* NOTE:  VLAN filtering is disabled by setting PROMISC */
	}

4673
	IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
4674

4675
	if (features & NETIF_F_HW_VLAN_CTAG_RX)
4676 4677 4678
		ixgbe_vlan_strip_enable(adapter);
	else
		ixgbe_vlan_strip_disable(adapter);
4679 4680 4681 4682 4683

	if (features & NETIF_F_HW_VLAN_CTAG_FILTER)
		ixgbe_vlan_promisc_disable(adapter);
	else
		ixgbe_vlan_promisc_enable(adapter);
4684 4685
}

4686 4687 4688 4689
static void ixgbe_napi_enable_all(struct ixgbe_adapter *adapter)
{
	int q_idx;

4690
	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++)
4691
		napi_enable(&adapter->q_vector[q_idx]->napi);
4692 4693 4694 4695 4696 4697
}

static void ixgbe_napi_disable_all(struct ixgbe_adapter *adapter)
{
	int q_idx;

4698
	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++)
4699
		napi_disable(&adapter->q_vector[q_idx]->napi);
4700 4701
}

4702
static void ixgbe_clear_udp_tunnel_port(struct ixgbe_adapter *adapter, u32 mask)
4703
{
4704 4705 4706 4707 4708 4709 4710 4711 4712 4713 4714
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vxlanctrl;

	if (!(adapter->flags & (IXGBE_FLAG_VXLAN_OFFLOAD_CAPABLE |
				IXGBE_FLAG_GENEVE_OFFLOAD_CAPABLE)))
		return;

	vxlanctrl = IXGBE_READ_REG(hw, IXGBE_VXLANCTRL) && ~mask;
	IXGBE_WRITE_REG(hw, IXGBE_VXLANCTRL, vxlanctrl);

	if (mask & IXGBE_VXLANCTRL_VXLAN_UDPPORT_MASK)
4715
		adapter->vxlan_port = 0;
4716 4717 4718

	if (mask & IXGBE_VXLANCTRL_GENEVE_UDPPORT_MASK)
		adapter->geneve_port = 0;
4719 4720
}

J
Jeff Kirsher 已提交
4721
#ifdef CONFIG_IXGBE_DCB
4722
/**
4723 4724 4725 4726 4727 4728 4729 4730 4731 4732
 * ixgbe_configure_dcb - Configure DCB hardware
 * @adapter: ixgbe adapter struct
 *
 * This is called by the driver on open to configure the DCB hardware.
 * This is also called by the gennetlink interface when reconfiguring
 * the DCB state.
 */
static void ixgbe_configure_dcb(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
4733
	int max_frame = adapter->netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
4734

4735 4736 4737 4738 4739 4740 4741 4742 4743
	if (!(adapter->flags & IXGBE_FLAG_DCB_ENABLED)) {
		if (hw->mac.type == ixgbe_mac_82598EB)
			netif_set_gso_max_size(adapter->netdev, 65536);
		return;
	}

	if (hw->mac.type == ixgbe_mac_82598EB)
		netif_set_gso_max_size(adapter->netdev, 32768);

4744
#ifdef IXGBE_FCOE
4745 4746
	if (adapter->netdev->features & NETIF_F_FCOE_MTU)
		max_frame = max(max_frame, IXGBE_FCOE_JUMBO_FRAME_SIZE);
4747
#endif
4748 4749 4750

	/* reconfigure the hardware */
	if (adapter->dcbx_cap & DCB_CAP_DCBX_VER_CEE) {
4751 4752 4753 4754 4755
		ixgbe_dcb_calculate_tc_credits(hw, &adapter->dcb_cfg, max_frame,
						DCB_TX_CONFIG);
		ixgbe_dcb_calculate_tc_credits(hw, &adapter->dcb_cfg, max_frame,
						DCB_RX_CONFIG);
		ixgbe_dcb_hw_config(hw, &adapter->dcb_cfg);
4756 4757 4758 4759 4760 4761 4762
	} else if (adapter->ixgbe_ieee_ets && adapter->ixgbe_ieee_pfc) {
		ixgbe_dcb_hw_ets(&adapter->hw,
				 adapter->ixgbe_ieee_ets,
				 max_frame);
		ixgbe_dcb_hw_pfc_config(&adapter->hw,
					adapter->ixgbe_ieee_pfc->pfc_en,
					adapter->ixgbe_ieee_ets->prio_tc);
4763
	}
4764 4765 4766

	/* Enable RSS Hash per TC */
	if (hw->mac.type != ixgbe_mac_82598EB) {
4767 4768
		u32 msb = 0;
		u16 rss_i = adapter->ring_feature[RING_F_RSS].indices - 1;
4769

4770 4771 4772 4773
		while (rss_i) {
			msb++;
			rss_i >>= 1;
		}
4774

4775 4776
		/* write msb to all 8 TCs in one write */
		IXGBE_WRITE_REG(hw, IXGBE_RQTC, msb * 0x11111111);
4777
	}
4778
}
4779 4780 4781 4782 4783
#endif

/* Additional bittime to account for IXGBE framing */
#define IXGBE_ETH_FRAMING 20

4784
/**
4785 4786 4787
 * ixgbe_hpbthresh - calculate high water mark for flow control
 *
 * @adapter: board private structure to calculate for
4788
 * @pb: packet buffer to calculate
4789 4790 4791 4792 4793 4794 4795 4796 4797 4798 4799 4800 4801
 */
static int ixgbe_hpbthresh(struct ixgbe_adapter *adapter, int pb)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct net_device *dev = adapter->netdev;
	int link, tc, kb, marker;
	u32 dv_id, rx_pba;

	/* Calculate max LAN frame size */
	tc = link = dev->mtu + ETH_HLEN + ETH_FCS_LEN + IXGBE_ETH_FRAMING;

#ifdef IXGBE_FCOE
	/* FCoE traffic class uses FCOE jumbo frames */
4802 4803 4804 4805
	if ((dev->features & NETIF_F_FCOE_MTU) &&
	    (tc < IXGBE_FCOE_JUMBO_FRAME_SIZE) &&
	    (pb == ixgbe_fcoe_get_tc(adapter)))
		tc = IXGBE_FCOE_JUMBO_FRAME_SIZE;
4806
#endif
4807

4808 4809 4810
	/* Calculate delay value for device */
	switch (hw->mac.type) {
	case ixgbe_mac_X540:
4811 4812
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
4813
	case ixgbe_mac_x550em_a:
4814 4815 4816 4817 4818 4819 4820 4821 4822 4823 4824 4825 4826 4827 4828 4829 4830 4831 4832 4833 4834 4835 4836 4837 4838 4839 4840 4841 4842 4843 4844
		dv_id = IXGBE_DV_X540(link, tc);
		break;
	default:
		dv_id = IXGBE_DV(link, tc);
		break;
	}

	/* Loopback switch introduces additional latency */
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
		dv_id += IXGBE_B2BT(tc);

	/* Delay value is calculated in bit times convert to KB */
	kb = IXGBE_BT2KB(dv_id);
	rx_pba = IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(pb)) >> 10;

	marker = rx_pba - kb;

	/* It is possible that the packet buffer is not large enough
	 * to provide required headroom. In this case throw an error
	 * to user and a do the best we can.
	 */
	if (marker < 0) {
		e_warn(drv, "Packet Buffer(%i) can not provide enough"
			    "headroom to support flow control."
			    "Decrease MTU or number of traffic classes\n", pb);
		marker = tc + 1;
	}

	return marker;
}

4845
/**
4846 4847 4848
 * ixgbe_lpbthresh - calculate low water mark for for flow control
 *
 * @adapter: board private structure to calculate for
4849
 * @pb: packet buffer to calculate
4850
 */
4851
static int ixgbe_lpbthresh(struct ixgbe_adapter *adapter, int pb)
4852 4853 4854 4855 4856 4857 4858 4859 4860
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct net_device *dev = adapter->netdev;
	int tc;
	u32 dv_id;

	/* Calculate max LAN frame size */
	tc = dev->mtu + ETH_HLEN + ETH_FCS_LEN;

4861 4862 4863 4864 4865 4866 4867 4868
#ifdef IXGBE_FCOE
	/* FCoE traffic class uses FCOE jumbo frames */
	if ((dev->features & NETIF_F_FCOE_MTU) &&
	    (tc < IXGBE_FCOE_JUMBO_FRAME_SIZE) &&
	    (pb == netdev_get_prio_tc_map(dev, adapter->fcoe.up)))
		tc = IXGBE_FCOE_JUMBO_FRAME_SIZE;
#endif

4869 4870 4871
	/* Calculate delay value for device */
	switch (hw->mac.type) {
	case ixgbe_mac_X540:
4872 4873
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
4874
	case ixgbe_mac_x550em_a:
4875 4876 4877 4878 4879 4880 4881 4882 4883 4884 4885 4886 4887 4888 4889 4890 4891 4892 4893 4894 4895 4896 4897 4898 4899
		dv_id = IXGBE_LOW_DV_X540(tc);
		break;
	default:
		dv_id = IXGBE_LOW_DV(tc);
		break;
	}

	/* Delay value is calculated in bit times convert to KB */
	return IXGBE_BT2KB(dv_id);
}

/*
 * ixgbe_pbthresh_setup - calculate and setup high low water marks
 */
static void ixgbe_pbthresh_setup(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int num_tc = netdev_get_num_tc(adapter->netdev);
	int i;

	if (!num_tc)
		num_tc = 1;

	for (i = 0; i < num_tc; i++) {
		hw->fc.high_water[i] = ixgbe_hpbthresh(adapter, i);
4900
		hw->fc.low_water[i] = ixgbe_lpbthresh(adapter, i);
4901 4902

		/* Low water marks must not be larger than high water marks */
4903 4904
		if (hw->fc.low_water[i] > hw->fc.high_water[i])
			hw->fc.low_water[i] = 0;
4905
	}
4906 4907 4908

	for (; i < MAX_TRAFFIC_CLASS; i++)
		hw->fc.high_water[i] = 0;
4909 4910
}

4911 4912 4913
static void ixgbe_configure_pb(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
4914 4915
	int hdrm;
	u8 tc = netdev_get_num_tc(adapter->netdev);
4916 4917 4918

	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE ||
	    adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE)
4919 4920 4921
		hdrm = 32 << adapter->fdir_pballoc;
	else
		hdrm = 0;
4922

4923
	hw->mac.ops.set_rxpba(hw, tc, hdrm, PBA_STRATEGY_EQUAL);
4924
	ixgbe_pbthresh_setup(adapter);
4925 4926
}

4927 4928 4929
static void ixgbe_fdir_filter_restore(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
4930
	struct hlist_node *node2;
4931 4932 4933 4934 4935 4936 4937
	struct ixgbe_fdir_filter *filter;

	spin_lock(&adapter->fdir_perfect_lock);

	if (!hlist_empty(&adapter->fdir_filter_list))
		ixgbe_fdir_set_input_mask_82599(hw, &adapter->fdir_mask);

4938
	hlist_for_each_entry_safe(filter, node2,
4939 4940
				  &adapter->fdir_filter_list, fdir_node) {
		ixgbe_fdir_write_perfect_filter_82599(hw,
4941 4942 4943 4944 4945
				&filter->filter,
				filter->sw_idx,
				(filter->action == IXGBE_FDIR_DROP_QUEUE) ?
				IXGBE_FDIR_DROP_QUEUE :
				adapter->rx_ring[filter->action]->reg_idx);
4946 4947 4948 4949 4950
	}

	spin_unlock(&adapter->fdir_perfect_lock);
}

4951 4952 4953 4954 4955 4956 4957 4958 4959 4960 4961 4962 4963 4964 4965 4966 4967 4968 4969
static void ixgbe_macvlan_set_rx_mode(struct net_device *dev, unsigned int pool,
				      struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vmolr;

	/* No unicast promiscuous support for VMDQ devices. */
	vmolr = IXGBE_READ_REG(hw, IXGBE_VMOLR(pool));
	vmolr |= (IXGBE_VMOLR_ROMPE | IXGBE_VMOLR_BAM | IXGBE_VMOLR_AUPE);

	/* clear the affected bit */
	vmolr &= ~IXGBE_VMOLR_MPE;

	if (dev->flags & IFF_ALLMULTI) {
		vmolr |= IXGBE_VMOLR_MPE;
	} else {
		vmolr |= IXGBE_VMOLR_ROMPE;
		hw->mac.ops.update_mc_addr_list(hw, dev);
	}
4970
	ixgbe_write_uc_addr_list(adapter->netdev, pool);
4971 4972 4973 4974 4975 4976
	IXGBE_WRITE_REG(hw, IXGBE_VMOLR(pool), vmolr);
}

static void ixgbe_fwd_psrtype(struct ixgbe_fwd_adapter *vadapter)
{
	struct ixgbe_adapter *adapter = vadapter->real_adapter;
4977
	int rss_i = adapter->num_rx_queues_per_pool;
4978 4979 4980 4981 4982 4983 4984 4985 4986 4987 4988 4989
	struct ixgbe_hw *hw = &adapter->hw;
	u16 pool = vadapter->pool;
	u32 psrtype = IXGBE_PSRTYPE_TCPHDR |
		      IXGBE_PSRTYPE_UDPHDR |
		      IXGBE_PSRTYPE_IPV4HDR |
		      IXGBE_PSRTYPE_L2HDR |
		      IXGBE_PSRTYPE_IPV6HDR;

	if (hw->mac.type == ixgbe_mac_82598EB)
		return;

	if (rss_i > 3)
J
Jacob Keller 已提交
4990
		psrtype |= 2u << 29;
4991
	else if (rss_i > 1)
J
Jacob Keller 已提交
4992
		psrtype |= 1u << 29;
4993 4994 4995 4996 4997 4998 4999 5000 5001 5002

	IXGBE_WRITE_REG(hw, IXGBE_PSRTYPE(VMDQ_P(pool)), psrtype);
}

/**
 * ixgbe_clean_rx_ring - Free Rx Buffers per Queue
 * @rx_ring: ring to free buffers from
 **/
static void ixgbe_clean_rx_ring(struct ixgbe_ring *rx_ring)
{
5003 5004
	u16 i = rx_ring->next_to_clean;
	struct ixgbe_rx_buffer *rx_buffer = &rx_ring->rx_buffer_info[i];
5005 5006

	/* Free all the Rx ring sk_buffs */
5007
	while (i != rx_ring->next_to_alloc) {
5008 5009
		if (rx_buffer->skb) {
			struct sk_buff *skb = rx_buffer->skb;
A
Alexander Duyck 已提交
5010
			if (IXGBE_CB(skb)->page_released)
5011
				dma_unmap_page_attrs(rx_ring->dev,
5012 5013 5014 5015
						     IXGBE_CB(skb)->dma,
						     ixgbe_rx_pg_size(rx_ring),
						     DMA_FROM_DEVICE,
						     IXGBE_RX_DMA_ATTR);
5016 5017
			dev_kfree_skb(skb);
		}
A
Alexander Duyck 已提交
5018

5019 5020 5021 5022 5023 5024 5025 5026 5027 5028
		/* Invalidate cache lines that may have been written to by
		 * device so that we avoid corrupting memory.
		 */
		dma_sync_single_range_for_cpu(rx_ring->dev,
					      rx_buffer->dma,
					      rx_buffer->page_offset,
					      ixgbe_rx_bufsz(rx_ring),
					      DMA_FROM_DEVICE);

		/* free resources associated with mapping */
5029
		dma_unmap_page_attrs(rx_ring->dev, rx_buffer->dma,
5030 5031 5032
				     ixgbe_rx_pg_size(rx_ring),
				     DMA_FROM_DEVICE,
				     IXGBE_RX_DMA_ATTR);
5033 5034
		__page_frag_cache_drain(rx_buffer->page,
					rx_buffer->pagecnt_bias);
A
Alexander Duyck 已提交
5035

5036 5037 5038 5039 5040 5041
		i++;
		rx_buffer++;
		if (i == rx_ring->count) {
			i = 0;
			rx_buffer = rx_ring->rx_buffer_info;
		}
5042 5043 5044 5045 5046 5047 5048 5049 5050 5051 5052 5053 5054 5055 5056 5057
	}

	rx_ring->next_to_alloc = 0;
	rx_ring->next_to_clean = 0;
	rx_ring->next_to_use = 0;
}

static void ixgbe_disable_fwd_ring(struct ixgbe_fwd_adapter *vadapter,
				   struct ixgbe_ring *rx_ring)
{
	struct ixgbe_adapter *adapter = vadapter->real_adapter;
	int index = rx_ring->queue_index + vadapter->rx_base_queue;

	/* shutdown specific queue receive and wait for dma to settle */
	ixgbe_disable_rx_queue(adapter, rx_ring);
	usleep_range(10000, 20000);
J
Jacob Keller 已提交
5058
	ixgbe_irq_disable_queues(adapter, BIT_ULL(index));
5059 5060 5061 5062
	ixgbe_clean_rx_ring(rx_ring);
	rx_ring->l2_accel_priv = NULL;
}

5063 5064
static int ixgbe_fwd_ring_down(struct net_device *vdev,
			       struct ixgbe_fwd_adapter *accel)
5065 5066 5067 5068 5069 5070 5071 5072 5073 5074 5075 5076 5077 5078 5079 5080 5081 5082 5083 5084 5085 5086 5087 5088 5089 5090 5091 5092 5093 5094 5095 5096 5097 5098 5099 5100 5101 5102 5103 5104 5105 5106 5107 5108 5109 5110 5111 5112 5113 5114 5115 5116 5117 5118 5119 5120 5121 5122 5123 5124 5125 5126 5127 5128 5129 5130 5131 5132 5133 5134 5135 5136 5137 5138 5139 5140 5141
{
	struct ixgbe_adapter *adapter = accel->real_adapter;
	unsigned int rxbase = accel->rx_base_queue;
	unsigned int txbase = accel->tx_base_queue;
	int i;

	netif_tx_stop_all_queues(vdev);

	for (i = 0; i < adapter->num_rx_queues_per_pool; i++) {
		ixgbe_disable_fwd_ring(accel, adapter->rx_ring[rxbase + i]);
		adapter->rx_ring[rxbase + i]->netdev = adapter->netdev;
	}

	for (i = 0; i < adapter->num_rx_queues_per_pool; i++) {
		adapter->tx_ring[txbase + i]->l2_accel_priv = NULL;
		adapter->tx_ring[txbase + i]->netdev = adapter->netdev;
	}


	return 0;
}

static int ixgbe_fwd_ring_up(struct net_device *vdev,
			     struct ixgbe_fwd_adapter *accel)
{
	struct ixgbe_adapter *adapter = accel->real_adapter;
	unsigned int rxbase, txbase, queues;
	int i, baseq, err = 0;

	if (!test_bit(accel->pool, &adapter->fwd_bitmask))
		return 0;

	baseq = accel->pool * adapter->num_rx_queues_per_pool;
	netdev_dbg(vdev, "pool %i:%i queues %i:%i VSI bitmask %lx\n",
		   accel->pool, adapter->num_rx_pools,
		   baseq, baseq + adapter->num_rx_queues_per_pool,
		   adapter->fwd_bitmask);

	accel->netdev = vdev;
	accel->rx_base_queue = rxbase = baseq;
	accel->tx_base_queue = txbase = baseq;

	for (i = 0; i < adapter->num_rx_queues_per_pool; i++)
		ixgbe_disable_fwd_ring(accel, adapter->rx_ring[rxbase + i]);

	for (i = 0; i < adapter->num_rx_queues_per_pool; i++) {
		adapter->rx_ring[rxbase + i]->netdev = vdev;
		adapter->rx_ring[rxbase + i]->l2_accel_priv = accel;
		ixgbe_configure_rx_ring(adapter, adapter->rx_ring[rxbase + i]);
	}

	for (i = 0; i < adapter->num_rx_queues_per_pool; i++) {
		adapter->tx_ring[txbase + i]->netdev = vdev;
		adapter->tx_ring[txbase + i]->l2_accel_priv = accel;
	}

	queues = min_t(unsigned int,
		       adapter->num_rx_queues_per_pool, vdev->num_tx_queues);
	err = netif_set_real_num_tx_queues(vdev, queues);
	if (err)
		goto fwd_queue_err;

	err = netif_set_real_num_rx_queues(vdev, queues);
	if (err)
		goto fwd_queue_err;

	if (is_valid_ether_addr(vdev->dev_addr))
		ixgbe_add_mac_filter(adapter, vdev->dev_addr, accel->pool);

	ixgbe_fwd_psrtype(accel);
	ixgbe_macvlan_set_rx_mode(vdev, accel->pool, adapter);
	return err;
fwd_queue_err:
	ixgbe_fwd_ring_down(vdev, accel);
	return err;
}

D
David Ahern 已提交
5142
static int ixgbe_upper_dev_walk(struct net_device *upper, void *data)
5143
{
D
David Ahern 已提交
5144 5145 5146
	if (netif_is_macvlan(upper)) {
		struct macvlan_dev *dfwd = netdev_priv(upper);
		struct ixgbe_fwd_adapter *vadapter = dfwd->fwd_priv;
5147

D
David Ahern 已提交
5148 5149
		if (dfwd->fwd_priv)
			ixgbe_fwd_ring_up(upper, vadapter);
5150
	}
D
David Ahern 已提交
5151 5152 5153 5154 5155 5156 5157 5158

	return 0;
}

static void ixgbe_configure_dfwd(struct ixgbe_adapter *adapter)
{
	netdev_walk_all_upper_dev_rcu(adapter->netdev,
				      ixgbe_upper_dev_walk, NULL);
5159 5160
}

5161 5162
static void ixgbe_configure(struct ixgbe_adapter *adapter)
{
5163 5164
	struct ixgbe_hw *hw = &adapter->hw;

5165
	ixgbe_configure_pb(adapter);
J
Jeff Kirsher 已提交
5166
#ifdef CONFIG_IXGBE_DCB
5167
	ixgbe_configure_dcb(adapter);
5168
#endif
5169 5170 5171 5172 5173
	/*
	 * We must restore virtualization before VLANs or else
	 * the VLVF registers will not be populated
	 */
	ixgbe_configure_virtualization(adapter);
5174

5175
	ixgbe_set_rx_mode(adapter->netdev);
5176 5177
	ixgbe_restore_vlan(adapter);

5178 5179 5180 5181 5182 5183 5184 5185 5186
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
		hw->mac.ops.disable_rx_buff(hw);
		break;
	default:
		break;
	}

5187
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
5188 5189
		ixgbe_init_fdir_signature_82599(&adapter->hw,
						adapter->fdir_pballoc);
5190 5191 5192 5193
	} else if (adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE) {
		ixgbe_init_fdir_perfect_82599(&adapter->hw,
					      adapter->fdir_pballoc);
		ixgbe_fdir_filter_restore(adapter);
5194
	}
5195

5196 5197 5198 5199 5200 5201 5202 5203 5204
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
		hw->mac.ops.enable_rx_buff(hw);
		break;
	default:
		break;
	}

5205 5206 5207 5208 5209 5210
#ifdef CONFIG_IXGBE_DCA
	/* configure DCA */
	if (adapter->flags & IXGBE_FLAG_DCA_CAPABLE)
		ixgbe_setup_dca(adapter);
#endif /* CONFIG_IXGBE_DCA */

5211 5212 5213 5214 5215
#ifdef IXGBE_FCOE
	/* configure FCoE L2 filters, redirection table, and Rx control */
	ixgbe_configure_fcoe(adapter);

#endif /* IXGBE_FCOE */
5216 5217
	ixgbe_configure_tx(adapter);
	ixgbe_configure_rx(adapter);
5218
	ixgbe_configure_dfwd(adapter);
5219 5220
}

5221
/**
5222 5223 5224 5225 5226
 * ixgbe_sfp_link_config - set up SFP+ link
 * @adapter: pointer to private adapter struct
 **/
static void ixgbe_sfp_link_config(struct ixgbe_adapter *adapter)
{
5227
	/*
S
Stephen Hemminger 已提交
5228
	 * We are assuming the worst case scenario here, and that
5229 5230 5231 5232 5233 5234
	 * is that an SFP was inserted/removed after the reset
	 * but before SFP detection was enabled.  As such the best
	 * solution is to just start searching as soon as we start
	 */
	if (adapter->hw.mac.type == ixgbe_mac_82598EB)
		adapter->flags2 |= IXGBE_FLAG2_SEARCH_FOR_SFP;
5235

5236
	adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
M
Mark Rustad 已提交
5237
	adapter->sfp_poll_time = 0;
5238 5239 5240 5241
}

/**
 * ixgbe_non_sfp_link_config - set up non-SFP+ link
5242 5243 5244 5245
 * @hw: pointer to private hardware struct
 *
 * Returns 0 on success, negative on failure
 **/
5246
static int ixgbe_non_sfp_link_config(struct ixgbe_hw *hw)
5247
{
J
Josh Hay 已提交
5248 5249
	u32 speed;
	bool autoneg, link_up = false;
5250
	int ret = IXGBE_ERR_LINK_SETUP;
5251 5252

	if (hw->mac.ops.check_link)
J
Josh Hay 已提交
5253
		ret = hw->mac.ops.check_link(hw, &speed, &link_up, false);
5254 5255

	if (ret)
5256
		return ret;
5257

J
Josh Hay 已提交
5258 5259 5260 5261
	speed = hw->phy.autoneg_advertised;
	if ((!speed) && (hw->mac.ops.get_link_capabilities))
		ret = hw->mac.ops.get_link_capabilities(hw, &speed,
							&autoneg);
5262
	if (ret)
5263
		return ret;
5264

5265
	if (hw->mac.ops.setup_link)
J
Josh Hay 已提交
5266
		ret = hw->mac.ops.setup_link(hw, speed, link_up);
5267

5268 5269 5270
	return ret;
}

5271
static void ixgbe_setup_gpie(struct ixgbe_adapter *adapter)
5272 5273
{
	struct ixgbe_hw *hw = &adapter->hw;
5274
	u32 gpie = 0;
5275

5276
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
5277 5278 5279
		gpie = IXGBE_GPIE_MSIX_MODE | IXGBE_GPIE_PBA_SUPPORT |
		       IXGBE_GPIE_OCD;
		gpie |= IXGBE_GPIE_EIAME;
5280 5281 5282 5283 5284 5285 5286 5287 5288
		/*
		 * use EIAM to auto-mask when MSI-X interrupt is asserted
		 * this saves a register write for every interrupt
		 */
		switch (hw->mac.type) {
		case ixgbe_mac_82598EB:
			IXGBE_WRITE_REG(hw, IXGBE_EIAM, IXGBE_EICS_RTX_QUEUE);
			break;
		case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
5289
		case ixgbe_mac_X540:
5290 5291
		case ixgbe_mac_X550:
		case ixgbe_mac_X550EM_x:
5292
		case ixgbe_mac_x550em_a:
D
Don Skidmore 已提交
5293
		default:
5294 5295 5296 5297 5298
			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(0), 0xFFFFFFFF);
			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(1), 0xFFFFFFFF);
			break;
		}
	} else {
5299 5300 5301 5302
		/* legacy interrupts, use EIAM to auto-mask when reading EICR,
		 * specifically only auto mask tx and rx interrupts */
		IXGBE_WRITE_REG(hw, IXGBE_EIAM, IXGBE_EICS_RTX_QUEUE);
	}
5303

5304 5305 5306 5307 5308
	/* XXX: to interrupt immediately for EICS writes, enable this */
	/* gpie |= IXGBE_GPIE_EIMEN; */

	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
		gpie &= ~IXGBE_GPIE_VTMODE_MASK;
5309 5310 5311 5312 5313 5314 5315 5316 5317 5318 5319 5320

		switch (adapter->ring_feature[RING_F_VMDQ].mask) {
		case IXGBE_82599_VMDQ_8Q_MASK:
			gpie |= IXGBE_GPIE_VTMODE_16;
			break;
		case IXGBE_82599_VMDQ_4Q_MASK:
			gpie |= IXGBE_GPIE_VTMODE_32;
			break;
		default:
			gpie |= IXGBE_GPIE_VTMODE_64;
			break;
		}
5321 5322
	}

5323
	/* Enable Thermal over heat sensor interrupt */
5324 5325 5326
	if (adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE) {
		switch (adapter->hw.mac.type) {
		case ixgbe_mac_82599EB:
5327
			gpie |= IXGBE_SDP0_GPIEN_8259X;
5328 5329 5330 5331 5332
			break;
		default:
			break;
		}
	}
5333

5334 5335
	/* Enable fan failure interrupt */
	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE)
5336
		gpie |= IXGBE_SDP1_GPIEN(hw);
5337

5338 5339 5340 5341 5342
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
		gpie |= IXGBE_SDP1_GPIEN_8259X | IXGBE_SDP2_GPIEN_8259X;
		break;
	case ixgbe_mac_X550EM_x:
5343
	case ixgbe_mac_x550em_a:
5344 5345 5346 5347
		gpie |= IXGBE_SDP0_GPIEN_X540;
		break;
	default:
		break;
5348
	}
5349 5350 5351 5352

	IXGBE_WRITE_REG(hw, IXGBE_GPIE, gpie);
}

5353
static void ixgbe_up_complete(struct ixgbe_adapter *adapter)
5354 5355 5356 5357 5358 5359 5360
{
	struct ixgbe_hw *hw = &adapter->hw;
	int err;
	u32 ctrl_ext;

	ixgbe_get_hw_control(adapter);
	ixgbe_setup_gpie(adapter);
5361

5362 5363 5364 5365 5366
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
		ixgbe_configure_msix(adapter);
	else
		ixgbe_configure_msi_and_legacy(adapter);

5367 5368
	/* enable the optics for 82599 SFP+ fiber */
	if (hw->mac.ops.enable_tx_laser)
5369 5370
		hw->mac.ops.enable_tx_laser(hw);

5371 5372 5373
	if (hw->phy.ops.set_phy_power)
		hw->phy.ops.set_phy_power(hw, true);

5374
	smp_mb__before_atomic();
5375
	clear_bit(__IXGBE_DOWN, &adapter->state);
5376 5377
	ixgbe_napi_enable_all(adapter);

5378 5379 5380 5381 5382 5383 5384 5385
	if (ixgbe_is_sfp(hw)) {
		ixgbe_sfp_link_config(adapter);
	} else {
		err = ixgbe_non_sfp_link_config(hw);
		if (err)
			e_err(probe, "link_config FAILED %d\n", err);
	}

5386 5387
	/* clear any pending interrupts, may auto mask */
	IXGBE_READ_REG(hw, IXGBE_EICR);
5388
	ixgbe_irq_enable(adapter, true, true);
5389

5390 5391 5392 5393 5394 5395 5396
	/*
	 * If this adapter has a fan, check to see if we had a failure
	 * before we enabled the interrupt.
	 */
	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE) {
		u32 esdp = IXGBE_READ_REG(hw, IXGBE_ESDP);
		if (esdp & IXGBE_ESDP_SDP1)
5397
			e_crit(drv, "Fan has stopped, replace the adapter\n");
5398 5399
	}

5400 5401
	/* bring the link up in the watchdog, this could race with our first
	 * link up interrupt but shouldn't be a problem */
5402 5403
	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
	adapter->link_check_timeout = jiffies;
5404
	mod_timer(&adapter->service_timer, jiffies);
5405 5406 5407 5408 5409

	/* Set PF Reset Done bit so PF/VF Mail Ops can work */
	ctrl_ext = IXGBE_READ_REG(hw, IXGBE_CTRL_EXT);
	ctrl_ext |= IXGBE_CTRL_EXT_PFRSTD;
	IXGBE_WRITE_REG(hw, IXGBE_CTRL_EXT, ctrl_ext);
5410 5411
}

5412 5413 5414
void ixgbe_reinit_locked(struct ixgbe_adapter *adapter)
{
	WARN_ON(in_interrupt());
5415
	/* put off any impending NetWatchDogTimeout */
5416
	netif_trans_update(adapter->netdev);
5417

5418
	while (test_and_set_bit(__IXGBE_RESETTING, &adapter->state))
5419
		usleep_range(1000, 2000);
5420 5421
	if (adapter->hw.phy.type == ixgbe_phy_fw)
		ixgbe_watchdog_link_is_down(adapter);
5422
	ixgbe_down(adapter);
5423 5424 5425 5426 5427 5428 5429 5430
	/*
	 * If SR-IOV enabled then wait a bit before bringing the adapter
	 * back up to give the VFs time to respond to the reset.  The
	 * two second wait is based upon the watchdog timer cycle in
	 * the VF driver.
	 */
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
		msleep(2000);
5431 5432 5433 5434
	ixgbe_up(adapter);
	clear_bit(__IXGBE_RESETTING, &adapter->state);
}

5435
void ixgbe_up(struct ixgbe_adapter *adapter)
5436 5437 5438 5439
{
	/* hardware has been reset, we need to reload some things */
	ixgbe_configure(adapter);

5440
	ixgbe_up_complete(adapter);
5441 5442 5443 5444
}

void ixgbe_reset(struct ixgbe_adapter *adapter)
{
5445
	struct ixgbe_hw *hw = &adapter->hw;
5446
	struct net_device *netdev = adapter->netdev;
5447 5448
	int err;

5449 5450
	if (ixgbe_removed(hw->hw_addr))
		return;
5451 5452 5453 5454 5455 5456 5457 5458 5459
	/* lock SFP init bit to prevent race conditions with the watchdog */
	while (test_and_set_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
		usleep_range(1000, 2000);

	/* clear all SFP and link config related flags while holding SFP_INIT */
	adapter->flags2 &= ~(IXGBE_FLAG2_SEARCH_FOR_SFP |
			     IXGBE_FLAG2_SFP_NEEDS_RESET);
	adapter->flags &= ~IXGBE_FLAG_NEED_LINK_CONFIG;

5460
	err = hw->mac.ops.init_hw(hw);
5461 5462 5463
	switch (err) {
	case 0:
	case IXGBE_ERR_SFP_NOT_PRESENT:
5464
	case IXGBE_ERR_SFP_NOT_SUPPORTED:
5465 5466
		break;
	case IXGBE_ERR_MASTER_REQUESTS_PENDING:
5467
		e_dev_err("master disable timed out\n");
5468
		break;
5469 5470
	case IXGBE_ERR_EEPROM_VERSION:
		/* We are running on a pre-production device, log a warning */
5471
		e_dev_warn("This device is a pre-production adapter/LOM. "
S
Stephen Hemminger 已提交
5472
			   "Please be aware there may be issues associated with "
5473 5474 5475 5476
			   "your hardware.  If you are experiencing problems "
			   "please contact your Intel or hardware "
			   "representative who provided you with this "
			   "hardware.\n");
5477
		break;
5478
	default:
5479
		e_dev_err("Hardware Error: %d\n", err);
5480
	}
5481

5482
	clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);
5483 5484

	/* flush entries out of MAC table */
5485
	ixgbe_flush_sw_mac_table(adapter);
5486 5487 5488
	__dev_uc_unsync(netdev, NULL);

	/* do not flush user set addresses */
5489
	ixgbe_mac_set_default_filter(adapter);
5490 5491 5492 5493

	/* update SAN MAC vmdq pool selection */
	if (hw->mac.san_mac_rar_index)
		hw->mac.ops.set_vmdq_san_mac(hw, VMDQ_P(0));
5494

5495
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
5496
		ixgbe_ptp_reset(adapter);
5497 5498 5499 5500 5501 5502 5503

	if (hw->phy.ops.set_phy_power) {
		if (!netif_running(adapter->netdev) && !adapter->wol)
			hw->phy.ops.set_phy_power(hw, false);
		else
			hw->phy.ops.set_phy_power(hw, true);
	}
5504 5505 5506 5507 5508 5509
}

/**
 * ixgbe_clean_tx_ring - Free Tx Buffers
 * @tx_ring: ring to be cleaned
 **/
5510
static void ixgbe_clean_tx_ring(struct ixgbe_ring *tx_ring)
5511
{
5512 5513
	u16 i = tx_ring->next_to_clean;
	struct ixgbe_tx_buffer *tx_buffer = &tx_ring->tx_buffer_info[i];
5514

5515 5516
	while (i != tx_ring->next_to_use) {
		union ixgbe_adv_tx_desc *eop_desc, *tx_desc;
5517

5518 5519
		/* Free all the Tx ring sk_buffs */
		dev_kfree_skb_any(tx_buffer->skb);
5520

5521 5522 5523 5524 5525
		/* unmap skb header data */
		dma_unmap_single(tx_ring->dev,
				 dma_unmap_addr(tx_buffer, dma),
				 dma_unmap_len(tx_buffer, len),
				 DMA_TO_DEVICE);
5526

5527 5528 5529 5530 5531 5532 5533 5534 5535 5536 5537 5538 5539 5540
		/* check for eop_desc to determine the end of the packet */
		eop_desc = tx_buffer->next_to_watch;
		tx_desc = IXGBE_TX_DESC(tx_ring, i);

		/* unmap remaining buffers */
		while (tx_desc != eop_desc) {
			tx_buffer++;
			tx_desc++;
			i++;
			if (unlikely(i == tx_ring->count)) {
				i = 0;
				tx_buffer = tx_ring->tx_buffer_info;
				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
			}
5541

5542 5543 5544 5545 5546 5547 5548
			/* unmap any remaining paged data */
			if (dma_unmap_len(tx_buffer, len))
				dma_unmap_page(tx_ring->dev,
					       dma_unmap_addr(tx_buffer, dma),
					       dma_unmap_len(tx_buffer, len),
					       DMA_TO_DEVICE);
		}
5549

5550 5551 5552 5553 5554 5555 5556 5557 5558 5559 5560 5561 5562
		/* move us one more past the eop_desc for start of next pkt */
		tx_buffer++;
		i++;
		if (unlikely(i == tx_ring->count)) {
			i = 0;
			tx_buffer = tx_ring->tx_buffer_info;
		}
	}

	/* reset BQL for queue */
	netdev_tx_reset_queue(txring_txq(tx_ring));

	/* reset next_to_use and next_to_clean */
5563 5564 5565 5566 5567
	tx_ring->next_to_use = 0;
	tx_ring->next_to_clean = 0;
}

/**
5568
 * ixgbe_clean_all_rx_rings - Free Rx Buffers for all queues
5569 5570
 * @adapter: board private structure
 **/
5571
static void ixgbe_clean_all_rx_rings(struct ixgbe_adapter *adapter)
5572 5573 5574
{
	int i;

5575
	for (i = 0; i < adapter->num_rx_queues; i++)
5576
		ixgbe_clean_rx_ring(adapter->rx_ring[i]);
5577 5578 5579
}

/**
5580
 * ixgbe_clean_all_tx_rings - Free Tx Buffers for all queues
5581 5582
 * @adapter: board private structure
 **/
5583
static void ixgbe_clean_all_tx_rings(struct ixgbe_adapter *adapter)
5584 5585 5586
{
	int i;

5587
	for (i = 0; i < adapter->num_tx_queues; i++)
5588
		ixgbe_clean_tx_ring(adapter->tx_ring[i]);
5589 5590
}

5591 5592
static void ixgbe_fdir_filter_exit(struct ixgbe_adapter *adapter)
{
5593
	struct hlist_node *node2;
5594 5595 5596 5597
	struct ixgbe_fdir_filter *filter;

	spin_lock(&adapter->fdir_perfect_lock);

5598
	hlist_for_each_entry_safe(filter, node2,
5599 5600 5601 5602 5603 5604 5605 5606 5607
				  &adapter->fdir_filter_list, fdir_node) {
		hlist_del(&filter->fdir_node);
		kfree(filter);
	}
	adapter->fdir_filter_count = 0;

	spin_unlock(&adapter->fdir_perfect_lock);
}

D
David Ahern 已提交
5608 5609 5610 5611 5612 5613 5614 5615 5616 5617 5618 5619 5620 5621 5622
static int ixgbe_disable_macvlan(struct net_device *upper, void *data)
{
	if (netif_is_macvlan(upper)) {
		struct macvlan_dev *vlan = netdev_priv(upper);

		if (vlan->fwd_priv) {
			netif_tx_stop_all_queues(upper);
			netif_carrier_off(upper);
			netif_tx_disable(upper);
		}
	}

	return 0;
}

5623 5624 5625
void ixgbe_down(struct ixgbe_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
5626
	struct ixgbe_hw *hw = &adapter->hw;
5627
	int i;
5628 5629

	/* signal that we are down to the interrupt handler */
5630 5631
	if (test_and_set_bit(__IXGBE_DOWN, &adapter->state))
		return; /* do nothing if already down */
5632 5633

	/* disable receives */
5634
	hw->mac.ops.disable_rx(hw);
5635

5636 5637 5638 5639 5640
	/* disable all enabled rx queues */
	for (i = 0; i < adapter->num_rx_queues; i++)
		/* this call also flushes the previous write */
		ixgbe_disable_rx_queue(adapter, adapter->rx_ring[i]);

5641
	usleep_range(10000, 20000);
5642

5643 5644
	netif_tx_stop_all_queues(netdev);

5645
	/* call carrier off first to avoid false dev_watchdog timeouts */
5646 5647 5648
	netif_carrier_off(netdev);
	netif_tx_disable(netdev);

5649
	/* disable any upper devices */
D
David Ahern 已提交
5650 5651
	netdev_walk_all_upper_dev_rcu(adapter->netdev,
				      ixgbe_disable_macvlan, NULL);
5652

5653 5654 5655 5656
	ixgbe_irq_disable(adapter);

	ixgbe_napi_disable_all(adapter);

5657 5658
	clear_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
	adapter->flags2 &= ~IXGBE_FLAG2_FDIR_REQUIRES_REINIT;
5659 5660 5661 5662
	adapter->flags &= ~IXGBE_FLAG_NEED_LINK_UPDATE;

	del_timer_sync(&adapter->service_timer);

5663
	if (adapter->num_vfs) {
5664 5665
		/* Clear EITR Select mapping */
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITRSEL, 0);
5666 5667 5668

		/* Mark all the VFs as inactive */
		for (i = 0 ; i < adapter->num_vfs; i++)
5669
			adapter->vfinfo[i].clear_to_send = false;
5670 5671 5672 5673 5674 5675

		/* ping all the active vfs to let them know we are going down */
		ixgbe_ping_all_vfs(adapter);

		/* Disable all VFTE/VFRE TX/RX */
		ixgbe_disable_tx_rx(adapter);
5676 5677
	}

5678 5679
	/* disable transmits in the hardware now that interrupts are off */
	for (i = 0; i < adapter->num_tx_queues; i++) {
5680
		u8 reg_idx = adapter->tx_ring[i]->reg_idx;
5681
		IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), IXGBE_TXDCTL_SWFLSH);
5682
	}
5683

5684
	/* Disable the Tx DMA engine on 82599 and later MAC */
5685 5686
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
5687
	case ixgbe_mac_X540:
5688 5689
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
5690
	case ixgbe_mac_x550em_a:
5691
		IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL,
5692 5693
				(IXGBE_READ_REG(hw, IXGBE_DMATXCTL) &
				 ~IXGBE_DMATXCTL_TE));
5694 5695 5696 5697
		break;
	default:
		break;
	}
5698

5699 5700
	if (!pci_channel_offline(adapter->pdev))
		ixgbe_reset(adapter);
5701

5702 5703
	/* power down the optics for 82599 SFP+ fiber */
	if (hw->mac.ops.disable_tx_laser)
5704 5705
		hw->mac.ops.disable_tx_laser(hw);

5706 5707 5708 5709
	ixgbe_clean_all_tx_rings(adapter);
	ixgbe_clean_all_rx_rings(adapter);
}

5710 5711 5712 5713 5714 5715 5716 5717 5718 5719 5720 5721 5722 5723 5724 5725 5726 5727 5728 5729 5730 5731 5732 5733 5734
/**
 * ixgbe_eee_capable - helper function to determine EEE support on X550
 * @adapter: board private structure
 */
static void ixgbe_set_eee_capable(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;

	switch (hw->device_id) {
	case IXGBE_DEV_ID_X550EM_A_1G_T:
	case IXGBE_DEV_ID_X550EM_A_1G_T_L:
		if (!hw->phy.eee_speeds_supported)
			break;
		adapter->flags2 |= IXGBE_FLAG2_EEE_CAPABLE;
		if (!hw->phy.eee_speeds_advertised)
			break;
		adapter->flags2 |= IXGBE_FLAG2_EEE_ENABLED;
		break;
	default:
		adapter->flags2 &= ~IXGBE_FLAG2_EEE_CAPABLE;
		adapter->flags2 &= ~IXGBE_FLAG2_EEE_ENABLED;
		break;
	}
}

5735 5736 5737 5738 5739 5740 5741 5742 5743
/**
 * ixgbe_tx_timeout - Respond to a Tx Hang
 * @netdev: network interface device structure
 **/
static void ixgbe_tx_timeout(struct net_device *netdev)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

	/* Do the reset outside of interrupt context */
5744
	ixgbe_tx_timeout_reset(adapter);
5745 5746
}

5747 5748 5749 5750 5751 5752 5753 5754 5755 5756 5757 5758 5759 5760 5761 5762 5763 5764 5765 5766 5767 5768 5769 5770 5771 5772 5773 5774 5775 5776 5777 5778 5779 5780 5781 5782 5783 5784 5785 5786 5787 5788 5789 5790 5791 5792 5793 5794 5795 5796 5797 5798
#ifdef CONFIG_IXGBE_DCB
static void ixgbe_init_dcb(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct tc_configuration *tc;
	int j;

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
	case ixgbe_mac_82599EB:
		adapter->dcb_cfg.num_tcs.pg_tcs = MAX_TRAFFIC_CLASS;
		adapter->dcb_cfg.num_tcs.pfc_tcs = MAX_TRAFFIC_CLASS;
		break;
	case ixgbe_mac_X540:
	case ixgbe_mac_X550:
		adapter->dcb_cfg.num_tcs.pg_tcs = X540_TRAFFIC_CLASS;
		adapter->dcb_cfg.num_tcs.pfc_tcs = X540_TRAFFIC_CLASS;
		break;
	case ixgbe_mac_X550EM_x:
	case ixgbe_mac_x550em_a:
	default:
		adapter->dcb_cfg.num_tcs.pg_tcs = DEF_TRAFFIC_CLASS;
		adapter->dcb_cfg.num_tcs.pfc_tcs = DEF_TRAFFIC_CLASS;
		break;
	}

	/* Configure DCB traffic classes */
	for (j = 0; j < MAX_TRAFFIC_CLASS; j++) {
		tc = &adapter->dcb_cfg.tc_config[j];
		tc->path[DCB_TX_CONFIG].bwg_id = 0;
		tc->path[DCB_TX_CONFIG].bwg_percent = 12 + (j & 1);
		tc->path[DCB_RX_CONFIG].bwg_id = 0;
		tc->path[DCB_RX_CONFIG].bwg_percent = 12 + (j & 1);
		tc->dcb_pfc = pfc_disabled;
	}

	/* Initialize default user to priority mapping, UPx->TC0 */
	tc = &adapter->dcb_cfg.tc_config[0];
	tc->path[DCB_TX_CONFIG].up_to_tc_bitmap = 0xFF;
	tc->path[DCB_RX_CONFIG].up_to_tc_bitmap = 0xFF;

	adapter->dcb_cfg.bw_percentage[DCB_TX_CONFIG][0] = 100;
	adapter->dcb_cfg.bw_percentage[DCB_RX_CONFIG][0] = 100;
	adapter->dcb_cfg.pfc_mode_enable = false;
	adapter->dcb_set_bitmap = 0x00;
	if (adapter->flags & IXGBE_FLAG_DCB_CAPABLE)
		adapter->dcbx_cap = DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_CEE;
	memcpy(&adapter->temp_dcb_cfg, &adapter->dcb_cfg,
	       sizeof(adapter->temp_dcb_cfg));
}
#endif

5799 5800 5801 5802 5803 5804 5805 5806
/**
 * ixgbe_sw_init - Initialize general software structures (struct ixgbe_adapter)
 * @adapter: board private structure to initialize
 *
 * ixgbe_sw_init initializes the Adapter private data structure.
 * Fields are initialized based on PCI device information and
 * OS network device settings (MTU size).
 **/
5807 5808
static int ixgbe_sw_init(struct ixgbe_adapter *adapter,
			 const struct ixgbe_info *ii)
5809 5810 5811
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct pci_dev *pdev = adapter->pdev;
5812
	unsigned int rss, fdir;
5813
	u32 fwsm;
5814
	int i;
5815

5816 5817 5818 5819 5820 5821 5822 5823
	/* PCI config space info */

	hw->vendor_id = pdev->vendor;
	hw->device_id = pdev->device;
	hw->revision_id = pdev->revision;
	hw->subsystem_vendor_id = pdev->subsystem_vendor;
	hw->subsystem_device_id = pdev->subsystem_device;

5824 5825 5826
	/* get_invariants needs the device IDs */
	ii->get_invariants(hw);

5827
	/* Set common capability flags and settings */
5828
	rss = min_t(int, ixgbe_max_rss_indices(adapter), num_online_cpus());
5829
	adapter->ring_feature[RING_F_RSS].limit = rss;
5830 5831 5832
	adapter->flags2 |= IXGBE_FLAG2_RSC_CAPABLE;
	adapter->max_q_vectors = MAX_Q_VECTORS_82599;
	adapter->atr_sample_rate = 20;
5833 5834
	fdir = min_t(int, IXGBE_MAX_FDIR_INDICES, num_online_cpus());
	adapter->ring_feature[RING_F_FDIR].limit = fdir;
5835 5836 5837 5838
	adapter->fdir_pballoc = IXGBE_FDIR_PBALLOC_64K;
#ifdef CONFIG_IXGBE_DCA
	adapter->flags |= IXGBE_FLAG_DCA_CAPABLE;
#endif
5839 5840 5841 5842
#ifdef CONFIG_IXGBE_DCB
	adapter->flags |= IXGBE_FLAG_DCB_CAPABLE;
	adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;
#endif
5843 5844 5845 5846 5847 5848 5849 5850 5851
#ifdef IXGBE_FCOE
	adapter->flags |= IXGBE_FLAG_FCOE_CAPABLE;
	adapter->flags &= ~IXGBE_FLAG_FCOE_ENABLED;
#ifdef CONFIG_IXGBE_DCB
	/* Default traffic class to use for FCoE */
	adapter->fcoe.up = IXGBE_FCOE_DEFTC;
#endif /* CONFIG_IXGBE_DCB */
#endif /* IXGBE_FCOE */

5852
	/* initialize static ixgbe jump table entries */
5853 5854 5855 5856 5857 5858 5859 5860
	adapter->jump_tables[0] = kzalloc(sizeof(*adapter->jump_tables[0]),
					  GFP_KERNEL);
	if (!adapter->jump_tables[0])
		return -ENOMEM;
	adapter->jump_tables[0]->mat = ixgbe_ipv4_fields;

	for (i = 1; i < IXGBE_MAX_LINK_HANDLE; i++)
		adapter->jump_tables[i] = NULL;
5861

5862 5863 5864
	adapter->mac_table = kzalloc(sizeof(struct ixgbe_mac_addr) *
				     hw->mac.num_rar_entries,
				     GFP_ATOMIC);
5865 5866
	if (!adapter->mac_table)
		return -ENOMEM;
5867

5868
	/* Set MAC specific capability flags and exceptions */
5869 5870
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
5871 5872
		adapter->flags2 &= ~IXGBE_FLAG2_RSC_CAPABLE;

5873 5874
		if (hw->device_id == IXGBE_DEV_ID_82598AT)
			adapter->flags |= IXGBE_FLAG_FAN_FAIL_CAPABLE;
5875

5876
		adapter->max_q_vectors = MAX_Q_VECTORS_82598;
5877 5878 5879 5880 5881 5882 5883 5884 5885 5886 5887 5888 5889 5890
		adapter->ring_feature[RING_F_FDIR].limit = 0;
		adapter->atr_sample_rate = 0;
		adapter->fdir_pballoc = 0;
#ifdef IXGBE_FCOE
		adapter->flags &= ~IXGBE_FLAG_FCOE_CAPABLE;
		adapter->flags &= ~IXGBE_FLAG_FCOE_ENABLED;
#ifdef CONFIG_IXGBE_DCB
		adapter->fcoe.up = 0;
#endif /* IXGBE_DCB */
#endif /* IXGBE_FCOE */
		break;
	case ixgbe_mac_82599EB:
		if (hw->device_id == IXGBE_DEV_ID_82599_T3_LOM)
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
5891
		break;
D
Don Skidmore 已提交
5892
	case ixgbe_mac_X540:
5893
		fwsm = IXGBE_READ_REG(hw, IXGBE_FWSM(hw));
5894 5895
		if (fwsm & IXGBE_FWSM_TS_ENABLED)
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
5896
		break;
5897
	case ixgbe_mac_x550em_a:
5898
		adapter->flags |= IXGBE_FLAG_GENEVE_OFFLOAD_CAPABLE;
5899 5900 5901 5902 5903 5904 5905 5906
		switch (hw->device_id) {
		case IXGBE_DEV_ID_X550EM_A_1G_T:
		case IXGBE_DEV_ID_X550EM_A_1G_T_L:
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
			break;
		default:
			break;
		}
5907 5908
	/* fall through */
	case ixgbe_mac_X550EM_x:
5909 5910 5911 5912 5913 5914 5915 5916 5917 5918
#ifdef CONFIG_IXGBE_DCB
		adapter->flags &= ~IXGBE_FLAG_DCB_CAPABLE;
#endif
#ifdef IXGBE_FCOE
		adapter->flags &= ~IXGBE_FLAG_FCOE_CAPABLE;
#ifdef CONFIG_IXGBE_DCB
		adapter->fcoe.up = 0;
#endif /* IXGBE_DCB */
#endif /* IXGBE_FCOE */
	/* Fall Through */
5919
	case ixgbe_mac_X550:
5920 5921
		if (hw->mac.type == ixgbe_mac_X550)
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
5922 5923
#ifdef CONFIG_IXGBE_DCA
		adapter->flags &= ~IXGBE_FLAG_DCA_CAPABLE;
5924 5925
#endif
		adapter->flags |= IXGBE_FLAG_VXLAN_OFFLOAD_CAPABLE;
5926
		break;
5927 5928
	default:
		break;
A
Alexander Duyck 已提交
5929
	}
5930

5931 5932 5933 5934 5935
#ifdef IXGBE_FCOE
	/* FCoE support exists, always init the FCoE lock */
	spin_lock_init(&adapter->fcoe.lock);

#endif
5936 5937 5938
	/* n-tuple support exists, always init our spinlock */
	spin_lock_init(&adapter->fdir_perfect_lock);

J
Jeff Kirsher 已提交
5939
#ifdef CONFIG_IXGBE_DCB
5940
	ixgbe_init_dcb(adapter);
5941
#endif
5942 5943

	/* default flow control settings */
5944
	hw->fc.requested_mode = ixgbe_fc_full;
D
Don Skidmore 已提交
5945
	hw->fc.current_mode = ixgbe_fc_full;	/* init for ethtool output */
5946
	ixgbe_pbthresh_setup(adapter);
5947 5948
	hw->fc.pause_time = IXGBE_DEFAULT_FCPAUSE;
	hw->fc.send_xon = true;
5949
	hw->fc.disable_fc_autoneg = ixgbe_device_supports_autoneg_fc(hw);
5950

5951
#ifdef CONFIG_PCI_IOV
5952 5953 5954
	if (max_vfs > 0)
		e_dev_warn("Enabling SR-IOV VFs using the max_vfs module parameter is deprecated - please use the pci sysfs interface instead.\n");

5955
	/* assign number of SR-IOV VFs */
5956
	if (hw->mac.type != ixgbe_mac_82598EB) {
5957
		if (max_vfs > IXGBE_MAX_VFS_DRV_LIMIT) {
5958 5959 5960 5961 5962 5963 5964
			adapter->num_vfs = 0;
			e_dev_warn("max_vfs parameter out of range. Not assigning any SR-IOV VFs\n");
		} else {
			adapter->num_vfs = max_vfs;
		}
	}
#endif /* CONFIG_PCI_IOV */
5965

5966
	/* enable itr by default in dynamic mode */
5967 5968
	adapter->rx_itr_setting = 1;
	adapter->tx_itr_setting = 1;
5969 5970 5971 5972 5973

	/* set default ring sizes */
	adapter->tx_ring_count = IXGBE_DEFAULT_TXD;
	adapter->rx_ring_count = IXGBE_DEFAULT_RXD;

5974
	/* set default work limits */
5975
	adapter->tx_work_limit = IXGBE_DEFAULT_TX_WORK;
5976

5977
	/* initialize eeprom parameters */
5978
	if (ixgbe_init_eeprom_params_generic(hw)) {
5979
		e_dev_err("EEPROM initialization failed\n");
5980 5981 5982
		return -EIO;
	}

5983 5984
	/* PF holds first pool slot */
	set_bit(0, &adapter->fwd_bitmask);
5985 5986 5987 5988 5989 5990 5991
	set_bit(__IXGBE_DOWN, &adapter->state);

	return 0;
}

/**
 * ixgbe_setup_tx_resources - allocate Tx resources (Descriptors)
5992
 * @tx_ring:    tx descriptor ring (for a specific queue) to setup
5993 5994 5995
 *
 * Return 0 on success, negative on failure
 **/
5996
int ixgbe_setup_tx_resources(struct ixgbe_ring *tx_ring)
5997
{
5998
	struct device *dev = tx_ring->dev;
5999
	int orig_node = dev_to_node(dev);
6000
	int ring_node = -1;
6001 6002
	int size;

6003
	size = sizeof(struct ixgbe_tx_buffer) * tx_ring->count;
6004 6005

	if (tx_ring->q_vector)
6006
		ring_node = tx_ring->q_vector->numa_node;
6007

6008
	tx_ring->tx_buffer_info = vmalloc_node(size, ring_node);
6009
	if (!tx_ring->tx_buffer_info)
6010
		tx_ring->tx_buffer_info = vmalloc(size);
6011 6012
	if (!tx_ring->tx_buffer_info)
		goto err;
6013

6014 6015
	u64_stats_init(&tx_ring->syncp);

6016
	/* round up to nearest 4K */
6017
	tx_ring->size = tx_ring->count * sizeof(union ixgbe_adv_tx_desc);
6018
	tx_ring->size = ALIGN(tx_ring->size, 4096);
6019

6020
	set_dev_node(dev, ring_node);
6021 6022 6023 6024 6025 6026 6027 6028
	tx_ring->desc = dma_alloc_coherent(dev,
					   tx_ring->size,
					   &tx_ring->dma,
					   GFP_KERNEL);
	set_dev_node(dev, orig_node);
	if (!tx_ring->desc)
		tx_ring->desc = dma_alloc_coherent(dev, tx_ring->size,
						   &tx_ring->dma, GFP_KERNEL);
6029 6030
	if (!tx_ring->desc)
		goto err;
6031

6032 6033
	tx_ring->next_to_use = 0;
	tx_ring->next_to_clean = 0;
6034
	return 0;
6035 6036 6037 6038

err:
	vfree(tx_ring->tx_buffer_info);
	tx_ring->tx_buffer_info = NULL;
6039
	dev_err(dev, "Unable to allocate memory for the Tx descriptor ring\n");
6040
	return -ENOMEM;
6041 6042
}

6043 6044 6045 6046 6047 6048 6049 6050 6051 6052 6053 6054 6055 6056 6057
/**
 * ixgbe_setup_all_tx_resources - allocate all queues Tx resources
 * @adapter: board private structure
 *
 * If this function returns with an error, then it's possible one or
 * more of the rings is populated (while the rest are not).  It is the
 * callers duty to clean those orphaned rings.
 *
 * Return 0 on success, negative on failure
 **/
static int ixgbe_setup_all_tx_resources(struct ixgbe_adapter *adapter)
{
	int i, err = 0;

	for (i = 0; i < adapter->num_tx_queues; i++) {
6058
		err = ixgbe_setup_tx_resources(adapter->tx_ring[i]);
6059 6060
		if (!err)
			continue;
6061

6062
		e_err(probe, "Allocation for Tx Queue %u failed\n", i);
6063
		goto err_setup_tx;
6064 6065
	}

6066 6067 6068 6069 6070
	return 0;
err_setup_tx:
	/* rewind the index freeing the rings as we go */
	while (i--)
		ixgbe_free_tx_resources(adapter->tx_ring[i]);
6071 6072 6073
	return err;
}

6074 6075
/**
 * ixgbe_setup_rx_resources - allocate Rx resources (Descriptors)
6076
 * @rx_ring:    rx descriptor ring (for a specific queue) to setup
6077 6078 6079
 *
 * Returns 0 on success, negative on failure
 **/
6080
int ixgbe_setup_rx_resources(struct ixgbe_ring *rx_ring)
6081
{
6082
	struct device *dev = rx_ring->dev;
6083
	int orig_node = dev_to_node(dev);
6084
	int ring_node = -1;
6085
	int size;
6086

6087
	size = sizeof(struct ixgbe_rx_buffer) * rx_ring->count;
6088 6089

	if (rx_ring->q_vector)
6090
		ring_node = rx_ring->q_vector->numa_node;
6091

6092
	rx_ring->rx_buffer_info = vmalloc_node(size, ring_node);
6093
	if (!rx_ring->rx_buffer_info)
6094
		rx_ring->rx_buffer_info = vmalloc(size);
6095 6096
	if (!rx_ring->rx_buffer_info)
		goto err;
6097

6098 6099
	u64_stats_init(&rx_ring->syncp);

6100
	/* Round up to nearest 4K */
6101 6102
	rx_ring->size = rx_ring->count * sizeof(union ixgbe_adv_rx_desc);
	rx_ring->size = ALIGN(rx_ring->size, 4096);
6103

6104
	set_dev_node(dev, ring_node);
6105 6106 6107 6108 6109 6110 6111 6112
	rx_ring->desc = dma_alloc_coherent(dev,
					   rx_ring->size,
					   &rx_ring->dma,
					   GFP_KERNEL);
	set_dev_node(dev, orig_node);
	if (!rx_ring->desc)
		rx_ring->desc = dma_alloc_coherent(dev, rx_ring->size,
						   &rx_ring->dma, GFP_KERNEL);
6113 6114
	if (!rx_ring->desc)
		goto err;
6115

6116 6117
	rx_ring->next_to_clean = 0;
	rx_ring->next_to_use = 0;
6118 6119

	return 0;
6120 6121 6122 6123
err:
	vfree(rx_ring->rx_buffer_info);
	rx_ring->rx_buffer_info = NULL;
	dev_err(dev, "Unable to allocate memory for the Rx descriptor ring\n");
6124
	return -ENOMEM;
6125 6126
}

6127 6128 6129 6130 6131 6132 6133 6134 6135 6136 6137 6138 6139 6140 6141
/**
 * ixgbe_setup_all_rx_resources - allocate all queues Rx resources
 * @adapter: board private structure
 *
 * If this function returns with an error, then it's possible one or
 * more of the rings is populated (while the rest are not).  It is the
 * callers duty to clean those orphaned rings.
 *
 * Return 0 on success, negative on failure
 **/
static int ixgbe_setup_all_rx_resources(struct ixgbe_adapter *adapter)
{
	int i, err = 0;

	for (i = 0; i < adapter->num_rx_queues; i++) {
6142
		err = ixgbe_setup_rx_resources(adapter->rx_ring[i]);
6143 6144
		if (!err)
			continue;
6145

6146
		e_err(probe, "Allocation for Rx Queue %u failed\n", i);
6147
		goto err_setup_rx;
6148 6149
	}

6150 6151 6152 6153 6154
#ifdef IXGBE_FCOE
	err = ixgbe_setup_fcoe_ddp_resources(adapter);
	if (!err)
#endif
		return 0;
6155 6156 6157 6158
err_setup_rx:
	/* rewind the index freeing the rings as we go */
	while (i--)
		ixgbe_free_rx_resources(adapter->rx_ring[i]);
6159 6160 6161
	return err;
}

6162 6163 6164 6165 6166 6167
/**
 * ixgbe_free_tx_resources - Free Tx Resources per Queue
 * @tx_ring: Tx descriptor ring for a specific queue
 *
 * Free all transmit software resources
 **/
6168
void ixgbe_free_tx_resources(struct ixgbe_ring *tx_ring)
6169
{
6170
	ixgbe_clean_tx_ring(tx_ring);
6171 6172 6173 6174

	vfree(tx_ring->tx_buffer_info);
	tx_ring->tx_buffer_info = NULL;

6175 6176 6177 6178 6179 6180
	/* if not set, then don't free */
	if (!tx_ring->desc)
		return;

	dma_free_coherent(tx_ring->dev, tx_ring->size,
			  tx_ring->desc, tx_ring->dma);
6181 6182 6183 6184 6185 6186 6187 6188 6189 6190 6191 6192 6193 6194 6195

	tx_ring->desc = NULL;
}

/**
 * ixgbe_free_all_tx_resources - Free Tx Resources for All Queues
 * @adapter: board private structure
 *
 * Free all transmit software resources
 **/
static void ixgbe_free_all_tx_resources(struct ixgbe_adapter *adapter)
{
	int i;

	for (i = 0; i < adapter->num_tx_queues; i++)
6196
		if (adapter->tx_ring[i]->desc)
6197
			ixgbe_free_tx_resources(adapter->tx_ring[i]);
6198 6199 6200
}

/**
6201
 * ixgbe_free_rx_resources - Free Rx Resources
6202 6203 6204 6205
 * @rx_ring: ring to clean the resources from
 *
 * Free all receive software resources
 **/
6206
void ixgbe_free_rx_resources(struct ixgbe_ring *rx_ring)
6207
{
6208
	ixgbe_clean_rx_ring(rx_ring);
6209 6210 6211 6212

	vfree(rx_ring->rx_buffer_info);
	rx_ring->rx_buffer_info = NULL;

6213 6214 6215 6216 6217 6218
	/* if not set, then don't free */
	if (!rx_ring->desc)
		return;

	dma_free_coherent(rx_ring->dev, rx_ring->size,
			  rx_ring->desc, rx_ring->dma);
6219 6220 6221 6222 6223 6224 6225 6226 6227 6228 6229 6230 6231 6232

	rx_ring->desc = NULL;
}

/**
 * ixgbe_free_all_rx_resources - Free Rx Resources for All Queues
 * @adapter: board private structure
 *
 * Free all receive software resources
 **/
static void ixgbe_free_all_rx_resources(struct ixgbe_adapter *adapter)
{
	int i;

6233 6234 6235 6236
#ifdef IXGBE_FCOE
	ixgbe_free_fcoe_ddp_resources(adapter);

#endif
6237
	for (i = 0; i < adapter->num_rx_queues; i++)
6238
		if (adapter->rx_ring[i]->desc)
6239
			ixgbe_free_rx_resources(adapter->rx_ring[i]);
6240 6241 6242 6243 6244 6245 6246 6247 6248 6249 6250 6251
}

/**
 * ixgbe_change_mtu - Change the Maximum Transfer Unit
 * @netdev: network interface device structure
 * @new_mtu: new value for maximum frame size
 *
 * Returns 0 on success, negative on failure
 **/
static int ixgbe_change_mtu(struct net_device *netdev, int new_mtu)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
6252 6253

	/*
6254 6255 6256
	 * For 82599EB we cannot allow legacy VFs to enable their receive
	 * paths when MTU greater than 1500 is configured.  So display a
	 * warning that legacy VFs will be disabled.
6257 6258 6259
	 */
	if ((adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) &&
	    (adapter->hw.mac.type == ixgbe_mac_82599EB) &&
6260
	    (new_mtu > ETH_DATA_LEN))
6261
		e_warn(probe, "Setting MTU > 1500 will disable legacy VFs\n");
6262

6263
	e_info(probe, "changing MTU from %d to %d\n", netdev->mtu, new_mtu);
6264

6265
	/* must set new MTU before calling down or up */
6266 6267
	netdev->mtu = new_mtu;

6268 6269
	if (netif_running(netdev))
		ixgbe_reinit_locked(adapter);
6270 6271 6272 6273 6274 6275 6276 6277 6278 6279 6280 6281 6282 6283 6284 6285

	return 0;
}

/**
 * ixgbe_open - Called when a network interface is made active
 * @netdev: network interface device structure
 *
 * Returns 0 on success, negative value on failure
 *
 * The open entry point is called when a network interface is made
 * active by the system (IFF_UP).  At this point all resources needed
 * for transmit and receive operations are allocated, the interrupt
 * handler is registered with the OS, the watchdog timer is started,
 * and the stack is notified that the interface is ready.
 **/
6286
int ixgbe_open(struct net_device *netdev)
6287 6288
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
6289
	struct ixgbe_hw *hw = &adapter->hw;
6290
	int err, queues;
6291 6292 6293 6294

	/* disallow open during test */
	if (test_bit(__IXGBE_TESTING, &adapter->state))
		return -EBUSY;
6295

6296 6297
	netif_carrier_off(netdev);

6298 6299 6300 6301 6302 6303 6304 6305 6306 6307 6308 6309
	/* allocate transmit descriptors */
	err = ixgbe_setup_all_tx_resources(adapter);
	if (err)
		goto err_setup_tx;

	/* allocate receive descriptors */
	err = ixgbe_setup_all_rx_resources(adapter);
	if (err)
		goto err_setup_rx;

	ixgbe_configure(adapter);

6310
	err = ixgbe_request_irq(adapter);
6311 6312 6313
	if (err)
		goto err_req_irq;

6314
	/* Notify the stack of the actual queue counts. */
6315 6316 6317 6318 6319 6320
	if (adapter->num_rx_pools > 1)
		queues = adapter->num_rx_queues_per_pool;
	else
		queues = adapter->num_tx_queues;

	err = netif_set_real_num_tx_queues(netdev, queues);
6321 6322 6323
	if (err)
		goto err_set_queues;

6324 6325 6326 6327 6328 6329
	if (adapter->num_rx_pools > 1 &&
	    adapter->num_rx_queues > IXGBE_MAX_L2A_QUEUES)
		queues = IXGBE_MAX_L2A_QUEUES;
	else
		queues = adapter->num_rx_queues;
	err = netif_set_real_num_rx_queues(netdev, queues);
6330 6331 6332
	if (err)
		goto err_set_queues;

6333 6334
	ixgbe_ptp_init(adapter);

6335
	ixgbe_up_complete(adapter);
6336

6337
	ixgbe_clear_udp_tunnel_port(adapter, IXGBE_VXLANCTRL_ALL_UDPPORT_MASK);
6338
	udp_tunnel_get_rx_info(netdev);
6339

6340 6341
	return 0;

6342 6343
err_set_queues:
	ixgbe_free_irq(adapter);
6344
err_req_irq:
6345
	ixgbe_free_all_rx_resources(adapter);
6346 6347
	if (hw->phy.ops.set_phy_power && !adapter->wol)
		hw->phy.ops.set_phy_power(&adapter->hw, false);
6348
err_setup_rx:
6349
	ixgbe_free_all_tx_resources(adapter);
6350
err_setup_tx:
6351 6352 6353 6354 6355
	ixgbe_reset(adapter);

	return err;
}

6356 6357 6358 6359
static void ixgbe_close_suspend(struct ixgbe_adapter *adapter)
{
	ixgbe_ptp_suspend(adapter);

6360 6361 6362 6363 6364 6365 6366 6367 6368
	if (adapter->hw.phy.ops.enter_lplu) {
		adapter->hw.phy.reset_disable = true;
		ixgbe_down(adapter);
		adapter->hw.phy.ops.enter_lplu(&adapter->hw);
		adapter->hw.phy.reset_disable = false;
	} else {
		ixgbe_down(adapter);
	}

6369 6370 6371 6372 6373 6374
	ixgbe_free_irq(adapter);

	ixgbe_free_all_tx_resources(adapter);
	ixgbe_free_all_rx_resources(adapter);
}

6375 6376 6377 6378 6379 6380 6381 6382 6383 6384 6385
/**
 * ixgbe_close - Disables a network interface
 * @netdev: network interface device structure
 *
 * Returns 0, this is not allowed to fail
 *
 * The close entry point is called when an interface is de-activated
 * by the OS.  The hardware is still under the drivers control, but
 * needs to be disabled.  A global MAC reset is issued to stop the
 * hardware, and all transmit and receive resources are freed.
 **/
6386
int ixgbe_close(struct net_device *netdev)
6387 6388 6389
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

6390 6391
	ixgbe_ptp_stop(adapter);

6392 6393
	if (netif_device_present(netdev))
		ixgbe_close_suspend(adapter);
6394

6395 6396
	ixgbe_fdir_filter_exit(adapter);

6397
	ixgbe_release_hw_control(adapter);
6398 6399 6400 6401

	return 0;
}

6402 6403 6404
#ifdef CONFIG_PM
static int ixgbe_resume(struct pci_dev *pdev)
{
6405 6406
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
6407 6408
	u32 err;

6409
	adapter->hw.hw_addr = adapter->io_addr;
6410 6411
	pci_set_power_state(pdev, PCI_D0);
	pci_restore_state(pdev);
6412 6413 6414 6415 6416
	/*
	 * pci_restore_state clears dev->state_saved so call
	 * pci_save_state to restore it.
	 */
	pci_save_state(pdev);
6417 6418

	err = pci_enable_device_mem(pdev);
6419
	if (err) {
6420
		e_dev_err("Cannot enable PCI device from suspend\n");
6421 6422
		return err;
	}
6423
	smp_mb__before_atomic();
6424
	clear_bit(__IXGBE_DISABLED, &adapter->state);
6425 6426
	pci_set_master(pdev);

6427
	pci_wake_from_d3(pdev, false);
6428 6429 6430

	ixgbe_reset(adapter);

6431 6432
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);

6433 6434 6435
	rtnl_lock();
	err = ixgbe_init_interrupt_scheme(adapter);
	if (!err && netif_running(netdev))
6436
		err = ixgbe_open(netdev);
6437 6438


6439 6440 6441
	if (!err)
		netif_device_attach(netdev);
	rtnl_unlock();
6442

6443
	return err;
6444 6445
}
#endif /* CONFIG_PM */
6446 6447

static int __ixgbe_shutdown(struct pci_dev *pdev, bool *enable_wake)
6448
{
6449 6450
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
6451 6452 6453
	struct ixgbe_hw *hw = &adapter->hw;
	u32 ctrl, fctrl;
	u32 wufc = adapter->wol;
6454 6455 6456 6457
#ifdef CONFIG_PM
	int retval = 0;
#endif

6458
	rtnl_lock();
6459 6460
	netif_device_detach(netdev);

6461 6462
	if (netif_running(netdev))
		ixgbe_close_suspend(adapter);
6463

6464
	ixgbe_clear_interrupt_scheme(adapter);
6465
	rtnl_unlock();
6466

6467 6468 6469 6470
#ifdef CONFIG_PM
	retval = pci_save_state(pdev);
	if (retval)
		return retval;
6471

6472
#endif
6473 6474 6475
	if (hw->mac.ops.stop_link_on_d3)
		hw->mac.ops.stop_link_on_d3(hw);

6476 6477
	if (wufc) {
		ixgbe_set_rx_mode(netdev);
6478

6479 6480
		/* enable the optics for 82599 SFP+ fiber as we can WoL */
		if (hw->mac.ops.enable_tx_laser)
D
Don Skidmore 已提交
6481 6482
			hw->mac.ops.enable_tx_laser(hw);

6483 6484 6485 6486 6487 6488 6489 6490 6491 6492 6493 6494 6495 6496 6497 6498 6499
		/* turn on all-multi mode if wake on multicast is enabled */
		if (wufc & IXGBE_WUFC_MC) {
			fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
			fctrl |= IXGBE_FCTRL_MPE;
			IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
		}

		ctrl = IXGBE_READ_REG(hw, IXGBE_CTRL);
		ctrl |= IXGBE_CTRL_GIO_DIS;
		IXGBE_WRITE_REG(hw, IXGBE_CTRL, ctrl);

		IXGBE_WRITE_REG(hw, IXGBE_WUFC, wufc);
	} else {
		IXGBE_WRITE_REG(hw, IXGBE_WUC, 0);
		IXGBE_WRITE_REG(hw, IXGBE_WUFC, 0);
	}

6500 6501
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
6502
		pci_wake_from_d3(pdev, false);
6503 6504
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
6505
	case ixgbe_mac_X540:
6506 6507
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
6508
	case ixgbe_mac_x550em_a:
6509 6510 6511 6512 6513
		pci_wake_from_d3(pdev, !!wufc);
		break;
	default:
		break;
	}
6514

6515
	*enable_wake = !!wufc;
6516 6517
	if (hw->phy.ops.set_phy_power && !*enable_wake)
		hw->phy.ops.set_phy_power(hw, false);
6518

6519 6520
	ixgbe_release_hw_control(adapter);

6521 6522
	if (!test_and_set_bit(__IXGBE_DISABLED, &adapter->state))
		pci_disable_device(pdev);
6523

6524 6525 6526 6527 6528 6529 6530 6531 6532 6533 6534 6535 6536 6537 6538 6539 6540 6541 6542
	return 0;
}

#ifdef CONFIG_PM
static int ixgbe_suspend(struct pci_dev *pdev, pm_message_t state)
{
	int retval;
	bool wake;

	retval = __ixgbe_shutdown(pdev, &wake);
	if (retval)
		return retval;

	if (wake) {
		pci_prepare_to_sleep(pdev);
	} else {
		pci_wake_from_d3(pdev, false);
		pci_set_power_state(pdev, PCI_D3hot);
	}
6543 6544 6545

	return 0;
}
6546
#endif /* CONFIG_PM */
6547 6548 6549

static void ixgbe_shutdown(struct pci_dev *pdev)
{
6550 6551 6552 6553 6554 6555 6556 6557
	bool wake;

	__ixgbe_shutdown(pdev, &wake);

	if (system_state == SYSTEM_POWER_OFF) {
		pci_wake_from_d3(pdev, wake);
		pci_set_power_state(pdev, PCI_D3hot);
	}
6558 6559
}

6560 6561 6562 6563 6564 6565
/**
 * ixgbe_update_stats - Update the board statistics counters.
 * @adapter: board private structure
 **/
void ixgbe_update_stats(struct ixgbe_adapter *adapter)
{
6566
	struct net_device *netdev = adapter->netdev;
6567
	struct ixgbe_hw *hw = &adapter->hw;
6568
	struct ixgbe_hw_stats *hwstats = &adapter->stats;
6569 6570
	u64 total_mpc = 0;
	u32 i, missed_rx = 0, mpc, bprc, lxon, lxoff, xon_off_tot;
6571 6572
	u64 non_eop_descs = 0, restart_queue = 0, tx_busy = 0;
	u64 alloc_rx_page_failed = 0, alloc_rx_buff_failed = 0;
6573
	u64 bytes = 0, packets = 0, hw_csum_rx_error = 0;
6574

6575 6576 6577 6578
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;

6579
	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED) {
A
Alexander Duyck 已提交
6580
		u64 rsc_count = 0;
6581 6582
		u64 rsc_flush = 0;
		for (i = 0; i < adapter->num_rx_queues; i++) {
6583 6584
			rsc_count += adapter->rx_ring[i]->rx_stats.rsc_count;
			rsc_flush += adapter->rx_ring[i]->rx_stats.rsc_flush;
6585 6586 6587
		}
		adapter->rsc_total_count = rsc_count;
		adapter->rsc_total_flush = rsc_flush;
6588 6589
	}

6590 6591 6592 6593 6594
	for (i = 0; i < adapter->num_rx_queues; i++) {
		struct ixgbe_ring *rx_ring = adapter->rx_ring[i];
		non_eop_descs += rx_ring->rx_stats.non_eop_descs;
		alloc_rx_page_failed += rx_ring->rx_stats.alloc_rx_page_failed;
		alloc_rx_buff_failed += rx_ring->rx_stats.alloc_rx_buff_failed;
6595
		hw_csum_rx_error += rx_ring->rx_stats.csum_err;
6596 6597 6598 6599 6600 6601
		bytes += rx_ring->stats.bytes;
		packets += rx_ring->stats.packets;
	}
	adapter->non_eop_descs = non_eop_descs;
	adapter->alloc_rx_page_failed = alloc_rx_page_failed;
	adapter->alloc_rx_buff_failed = alloc_rx_buff_failed;
6602
	adapter->hw_csum_rx_error = hw_csum_rx_error;
6603 6604 6605 6606 6607
	netdev->stats.rx_bytes = bytes;
	netdev->stats.rx_packets = packets;

	bytes = 0;
	packets = 0;
J
Jesse Brandeburg 已提交
6608
	/* gather some stats to the adapter struct that are per queue */
6609 6610 6611 6612 6613 6614 6615
	for (i = 0; i < adapter->num_tx_queues; i++) {
		struct ixgbe_ring *tx_ring = adapter->tx_ring[i];
		restart_queue += tx_ring->tx_stats.restart_queue;
		tx_busy += tx_ring->tx_stats.tx_busy;
		bytes += tx_ring->stats.bytes;
		packets += tx_ring->stats.packets;
	}
6616
	adapter->restart_queue = restart_queue;
6617 6618 6619
	adapter->tx_busy = tx_busy;
	netdev->stats.tx_bytes = bytes;
	netdev->stats.tx_packets = packets;
J
Jesse Brandeburg 已提交
6620

6621
	hwstats->crcerrs += IXGBE_READ_REG(hw, IXGBE_CRCERRS);
6622 6623

	/* 8 register reads */
6624 6625 6626 6627
	for (i = 0; i < 8; i++) {
		/* for packet buffers not used, the register should read 0 */
		mpc = IXGBE_READ_REG(hw, IXGBE_MPC(i));
		missed_rx += mpc;
6628 6629
		hwstats->mpc[i] += mpc;
		total_mpc += hwstats->mpc[i];
6630 6631
		hwstats->pxontxc[i] += IXGBE_READ_REG(hw, IXGBE_PXONTXC(i));
		hwstats->pxofftxc[i] += IXGBE_READ_REG(hw, IXGBE_PXOFFTXC(i));
6632 6633
		switch (hw->mac.type) {
		case ixgbe_mac_82598EB:
6634 6635 6636
			hwstats->rnbc[i] += IXGBE_READ_REG(hw, IXGBE_RNBC(i));
			hwstats->qbtc[i] += IXGBE_READ_REG(hw, IXGBE_QBTC(i));
			hwstats->qbrc[i] += IXGBE_READ_REG(hw, IXGBE_QBRC(i));
6637 6638
			hwstats->pxonrxc[i] +=
				IXGBE_READ_REG(hw, IXGBE_PXONRXC(i));
6639 6640
			break;
		case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
6641
		case ixgbe_mac_X540:
6642 6643
		case ixgbe_mac_X550:
		case ixgbe_mac_X550EM_x:
6644
		case ixgbe_mac_x550em_a:
6645 6646 6647 6648 6649
			hwstats->pxonrxc[i] +=
				IXGBE_READ_REG(hw, IXGBE_PXONRXCNT(i));
			break;
		default:
			break;
6650
		}
6651
	}
6652 6653 6654 6655 6656 6657

	/*16 register reads */
	for (i = 0; i < 16; i++) {
		hwstats->qptc[i] += IXGBE_READ_REG(hw, IXGBE_QPTC(i));
		hwstats->qprc[i] += IXGBE_READ_REG(hw, IXGBE_QPRC(i));
		if ((hw->mac.type == ixgbe_mac_82599EB) ||
6658 6659
		    (hw->mac.type == ixgbe_mac_X540) ||
		    (hw->mac.type == ixgbe_mac_X550) ||
6660 6661
		    (hw->mac.type == ixgbe_mac_X550EM_x) ||
		    (hw->mac.type == ixgbe_mac_x550em_a)) {
6662 6663 6664 6665 6666 6667 6668
			hwstats->qbtc[i] += IXGBE_READ_REG(hw, IXGBE_QBTC_L(i));
			IXGBE_READ_REG(hw, IXGBE_QBTC_H(i)); /* to clear */
			hwstats->qbrc[i] += IXGBE_READ_REG(hw, IXGBE_QBRC_L(i));
			IXGBE_READ_REG(hw, IXGBE_QBRC_H(i)); /* to clear */
		}
	}

6669
	hwstats->gprc += IXGBE_READ_REG(hw, IXGBE_GPRC);
6670
	/* work around hardware counting issue */
6671
	hwstats->gprc -= missed_rx;
6672

6673 6674
	ixgbe_update_xoff_received(adapter);

6675
	/* 82598 hardware only has a 32 bit counter in the high register */
6676 6677 6678 6679 6680 6681 6682
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
		hwstats->lxonrxc += IXGBE_READ_REG(hw, IXGBE_LXONRXC);
		hwstats->gorc += IXGBE_READ_REG(hw, IXGBE_GORCH);
		hwstats->gotc += IXGBE_READ_REG(hw, IXGBE_GOTCH);
		hwstats->tor += IXGBE_READ_REG(hw, IXGBE_TORH);
		break;
D
Don Skidmore 已提交
6683
	case ixgbe_mac_X540:
6684 6685
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
6686
	case ixgbe_mac_x550em_a:
6687
		/* OS2BMC stats are X540 and later */
6688 6689 6690 6691 6692
		hwstats->o2bgptc += IXGBE_READ_REG(hw, IXGBE_O2BGPTC);
		hwstats->o2bspc += IXGBE_READ_REG(hw, IXGBE_O2BSPC);
		hwstats->b2ospc += IXGBE_READ_REG(hw, IXGBE_B2OSPC);
		hwstats->b2ogprc += IXGBE_READ_REG(hw, IXGBE_B2OGPRC);
	case ixgbe_mac_82599EB:
6693 6694 6695
		for (i = 0; i < 16; i++)
			adapter->hw_rx_no_dma_resources +=
					     IXGBE_READ_REG(hw, IXGBE_QPRDC(i));
6696
		hwstats->gorc += IXGBE_READ_REG(hw, IXGBE_GORCL);
6697
		IXGBE_READ_REG(hw, IXGBE_GORCH); /* to clear */
6698
		hwstats->gotc += IXGBE_READ_REG(hw, IXGBE_GOTCL);
6699
		IXGBE_READ_REG(hw, IXGBE_GOTCH); /* to clear */
6700
		hwstats->tor += IXGBE_READ_REG(hw, IXGBE_TORL);
6701
		IXGBE_READ_REG(hw, IXGBE_TORH); /* to clear */
6702 6703 6704
		hwstats->lxonrxc += IXGBE_READ_REG(hw, IXGBE_LXONRXCNT);
		hwstats->fdirmatch += IXGBE_READ_REG(hw, IXGBE_FDIRMATCH);
		hwstats->fdirmiss += IXGBE_READ_REG(hw, IXGBE_FDIRMISS);
6705
#ifdef IXGBE_FCOE
6706 6707 6708 6709 6710 6711
		hwstats->fccrc += IXGBE_READ_REG(hw, IXGBE_FCCRC);
		hwstats->fcoerpdc += IXGBE_READ_REG(hw, IXGBE_FCOERPDC);
		hwstats->fcoeprc += IXGBE_READ_REG(hw, IXGBE_FCOEPRC);
		hwstats->fcoeptc += IXGBE_READ_REG(hw, IXGBE_FCOEPTC);
		hwstats->fcoedwrc += IXGBE_READ_REG(hw, IXGBE_FCOEDWRC);
		hwstats->fcoedwtc += IXGBE_READ_REG(hw, IXGBE_FCOEDWTC);
6712
		/* Add up per cpu counters for total ddp aloc fail */
6713 6714 6715 6716 6717
		if (adapter->fcoe.ddp_pool) {
			struct ixgbe_fcoe *fcoe = &adapter->fcoe;
			struct ixgbe_fcoe_ddp_pool *ddp_pool;
			unsigned int cpu;
			u64 noddp = 0, noddp_ext_buff = 0;
6718
			for_each_possible_cpu(cpu) {
6719 6720 6721
				ddp_pool = per_cpu_ptr(fcoe->ddp_pool, cpu);
				noddp += ddp_pool->noddp;
				noddp_ext_buff += ddp_pool->noddp_ext_buff;
6722
			}
6723 6724
			hwstats->fcoe_noddp = noddp;
			hwstats->fcoe_noddp_ext_buff = noddp_ext_buff;
6725
		}
6726
#endif /* IXGBE_FCOE */
6727 6728 6729
		break;
	default:
		break;
6730
	}
6731
	bprc = IXGBE_READ_REG(hw, IXGBE_BPRC);
6732 6733
	hwstats->bprc += bprc;
	hwstats->mprc += IXGBE_READ_REG(hw, IXGBE_MPRC);
6734
	if (hw->mac.type == ixgbe_mac_82598EB)
6735 6736 6737 6738 6739 6740 6741 6742 6743
		hwstats->mprc -= bprc;
	hwstats->roc += IXGBE_READ_REG(hw, IXGBE_ROC);
	hwstats->prc64 += IXGBE_READ_REG(hw, IXGBE_PRC64);
	hwstats->prc127 += IXGBE_READ_REG(hw, IXGBE_PRC127);
	hwstats->prc255 += IXGBE_READ_REG(hw, IXGBE_PRC255);
	hwstats->prc511 += IXGBE_READ_REG(hw, IXGBE_PRC511);
	hwstats->prc1023 += IXGBE_READ_REG(hw, IXGBE_PRC1023);
	hwstats->prc1522 += IXGBE_READ_REG(hw, IXGBE_PRC1522);
	hwstats->rlec += IXGBE_READ_REG(hw, IXGBE_RLEC);
6744
	lxon = IXGBE_READ_REG(hw, IXGBE_LXONTXC);
6745
	hwstats->lxontxc += lxon;
6746
	lxoff = IXGBE_READ_REG(hw, IXGBE_LXOFFTXC);
6747 6748 6749
	hwstats->lxofftxc += lxoff;
	hwstats->gptc += IXGBE_READ_REG(hw, IXGBE_GPTC);
	hwstats->mptc += IXGBE_READ_REG(hw, IXGBE_MPTC);
6750 6751 6752 6753
	/*
	 * 82598 errata - tx of flow control packets is included in tx counters
	 */
	xon_off_tot = lxon + lxoff;
6754 6755 6756 6757 6758 6759 6760 6761 6762 6763 6764 6765 6766 6767 6768
	hwstats->gptc -= xon_off_tot;
	hwstats->mptc -= xon_off_tot;
	hwstats->gotc -= (xon_off_tot * (ETH_ZLEN + ETH_FCS_LEN));
	hwstats->ruc += IXGBE_READ_REG(hw, IXGBE_RUC);
	hwstats->rfc += IXGBE_READ_REG(hw, IXGBE_RFC);
	hwstats->rjc += IXGBE_READ_REG(hw, IXGBE_RJC);
	hwstats->tpr += IXGBE_READ_REG(hw, IXGBE_TPR);
	hwstats->ptc64 += IXGBE_READ_REG(hw, IXGBE_PTC64);
	hwstats->ptc64 -= xon_off_tot;
	hwstats->ptc127 += IXGBE_READ_REG(hw, IXGBE_PTC127);
	hwstats->ptc255 += IXGBE_READ_REG(hw, IXGBE_PTC255);
	hwstats->ptc511 += IXGBE_READ_REG(hw, IXGBE_PTC511);
	hwstats->ptc1023 += IXGBE_READ_REG(hw, IXGBE_PTC1023);
	hwstats->ptc1522 += IXGBE_READ_REG(hw, IXGBE_PTC1522);
	hwstats->bptc += IXGBE_READ_REG(hw, IXGBE_BPTC);
6769 6770

	/* Fill out the OS statistics structure */
6771
	netdev->stats.multicast = hwstats->mprc;
6772 6773

	/* Rx Errors */
6774
	netdev->stats.rx_errors = hwstats->crcerrs + hwstats->rlec;
6775
	netdev->stats.rx_dropped = 0;
6776 6777
	netdev->stats.rx_length_errors = hwstats->rlec;
	netdev->stats.rx_crc_errors = hwstats->crcerrs;
6778
	netdev->stats.rx_missed_errors = total_mpc;
6779 6780 6781
}

/**
6782
 * ixgbe_fdir_reinit_subtask - worker thread to reinit FDIR filter table
6783
 * @adapter: pointer to the device adapter structure
6784
 **/
6785
static void ixgbe_fdir_reinit_subtask(struct ixgbe_adapter *adapter)
6786
{
6787
	struct ixgbe_hw *hw = &adapter->hw;
6788
	int i;
6789

6790 6791 6792 6793
	if (!(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_FDIR_REQUIRES_REINIT;
6794

6795
	/* if interface is down do nothing */
6796
	if (test_bit(__IXGBE_DOWN, &adapter->state))
6797 6798 6799 6800 6801 6802 6803 6804
		return;

	/* do nothing if we are not using signature filters */
	if (!(adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE))
		return;

	adapter->fdir_overflow++;

6805 6806 6807
	if (ixgbe_reinit_fdir_tables_82599(hw) == 0) {
		for (i = 0; i < adapter->num_tx_queues; i++)
			set_bit(__IXGBE_TX_FDIR_INIT_DONE,
6808
				&(adapter->tx_ring[i]->state));
6809 6810
		/* re-enable flow director interrupts */
		IXGBE_WRITE_REG(hw, IXGBE_EIMS, IXGBE_EIMS_FLOW_DIR);
6811 6812 6813 6814 6815 6816 6817 6818
	} else {
		e_err(probe, "failed to finish FDIR re-initialization, "
		      "ignored adding FDIR ATR filters\n");
	}
}

/**
 * ixgbe_check_hang_subtask - check for hung queues and dropped interrupts
6819
 * @adapter: pointer to the device adapter structure
6820 6821
 *
 * This function serves two purposes.  First it strobes the interrupt lines
S
Stephen Hemminger 已提交
6822
 * in order to make certain interrupts are occurring.  Secondly it sets the
6823
 * bits needed to check for TX hangs.  As a result we should immediately
S
Stephen Hemminger 已提交
6824
 * determine if a hang has occurred.
6825 6826
 */
static void ixgbe_check_hang_subtask(struct ixgbe_adapter *adapter)
6827
{
6828
	struct ixgbe_hw *hw = &adapter->hw;
6829 6830
	u64 eics = 0;
	int i;
6831

6832
	/* If we're down, removing or resetting, just bail */
6833
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
6834
	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
6835 6836
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;
6837

6838 6839 6840 6841 6842
	/* Force detection of hung controller */
	if (netif_carrier_ok(adapter->netdev)) {
		for (i = 0; i < adapter->num_tx_queues; i++)
			set_check_for_tx_hang(adapter->tx_ring[i]);
	}
6843

6844 6845 6846 6847 6848 6849 6850 6851
	if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED)) {
		/*
		 * for legacy and MSI interrupts don't set any bits
		 * that are enabled for EIAM, because this operation
		 * would set *both* EIMS and EICS for any bit in EIAM
		 */
		IXGBE_WRITE_REG(hw, IXGBE_EICS,
			(IXGBE_EICS_TCP_TIMER | IXGBE_EICS_OTHER));
6852 6853
	} else {
		/* get one bit for every active tx/rx interrupt vector */
6854
		for (i = 0; i < adapter->num_q_vectors; i++) {
6855
			struct ixgbe_q_vector *qv = adapter->q_vector[i];
6856
			if (qv->rx.ring || qv->tx.ring)
J
Jacob Keller 已提交
6857
				eics |= BIT_ULL(i);
6858
		}
6859
	}
6860

6861
	/* Cause software interrupt to ensure rings are cleaned */
6862
	ixgbe_irq_rearm_queues(adapter, eics);
6863 6864
}

6865
/**
6866
 * ixgbe_watchdog_update_link - update the link status
6867 6868
 * @adapter: pointer to the device adapter structure
 * @link_speed: pointer to a u32 to store the link_speed
6869
 **/
6870
static void ixgbe_watchdog_update_link(struct ixgbe_adapter *adapter)
6871 6872
{
	struct ixgbe_hw *hw = &adapter->hw;
6873 6874
	u32 link_speed = adapter->link_speed;
	bool link_up = adapter->link_up;
6875
	bool pfc_en = adapter->dcb_cfg.pfc_mode_enable;
6876

6877 6878 6879 6880 6881
	if (!(adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE))
		return;

	if (hw->mac.ops.check_link) {
		hw->mac.ops.check_link(hw, &link_speed, &link_up, false);
6882
	} else {
6883 6884 6885
		/* always assume link is up, if no check link function */
		link_speed = IXGBE_LINK_SPEED_10GB_FULL;
		link_up = true;
6886
	}
6887 6888 6889 6890

	if (adapter->ixgbe_ieee_pfc)
		pfc_en |= !!(adapter->ixgbe_ieee_pfc->pfc_en);

6891
	if (link_up && !((adapter->flags & IXGBE_FLAG_DCB_ENABLED) && pfc_en)) {
6892
		hw->mac.ops.fc_enable(hw);
6893 6894
		ixgbe_set_rx_drop_en(adapter);
	}
6895 6896 6897 6898 6899 6900 6901 6902 6903 6904 6905

	if (link_up ||
	    time_after(jiffies, (adapter->link_check_timeout +
				 IXGBE_TRY_LINK_TIMEOUT))) {
		adapter->flags &= ~IXGBE_FLAG_NEED_LINK_UPDATE;
		IXGBE_WRITE_REG(hw, IXGBE_EIMS, IXGBE_EIMC_LSC);
		IXGBE_WRITE_FLUSH(hw);
	}

	adapter->link_up = link_up;
	adapter->link_speed = link_speed;
6906 6907
}

6908 6909 6910 6911 6912 6913 6914 6915 6916 6917 6918 6919 6920 6921 6922 6923 6924
static void ixgbe_update_default_up(struct ixgbe_adapter *adapter)
{
#ifdef CONFIG_IXGBE_DCB
	struct net_device *netdev = adapter->netdev;
	struct dcb_app app = {
			      .selector = IEEE_8021QAZ_APP_SEL_ETHERTYPE,
			      .protocol = 0,
			     };
	u8 up = 0;

	if (adapter->dcbx_cap & DCB_CAP_DCBX_VER_IEEE)
		up = dcb_ieee_getapp_mask(netdev, &app);

	adapter->default_up = (up > 1) ? (ffs(up) - 1) : 0;
#endif
}

D
David Ahern 已提交
6925 6926 6927 6928 6929 6930 6931 6932 6933 6934 6935 6936
static int ixgbe_enable_macvlan(struct net_device *upper, void *data)
{
	if (netif_is_macvlan(upper)) {
		struct macvlan_dev *vlan = netdev_priv(upper);

		if (vlan->fwd_priv)
			netif_tx_wake_all_queues(upper);
	}

	return 0;
}

6937
/**
6938 6939
 * ixgbe_watchdog_link_is_up - update netif_carrier status and
 *                             print link up message
6940
 * @adapter: pointer to the device adapter structure
6941
 **/
6942
static void ixgbe_watchdog_link_is_up(struct ixgbe_adapter *adapter)
6943
{
6944
	struct net_device *netdev = adapter->netdev;
6945
	struct ixgbe_hw *hw = &adapter->hw;
6946
	u32 link_speed = adapter->link_speed;
6947
	const char *speed_str;
6948
	bool flow_rx, flow_tx;
6949

6950 6951
	/* only continue if link was previously down */
	if (netif_carrier_ok(netdev))
6952
		return;
6953

6954
	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
6955

6956 6957 6958 6959 6960 6961 6962 6963 6964
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB: {
		u32 frctl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
		u32 rmcs = IXGBE_READ_REG(hw, IXGBE_RMCS);
		flow_rx = !!(frctl & IXGBE_FCTRL_RFCE);
		flow_tx = !!(rmcs & IXGBE_RMCS_TFCE_802_3X);
	}
		break;
	case ixgbe_mac_X540:
6965 6966
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
6967
	case ixgbe_mac_x550em_a:
6968 6969 6970 6971 6972 6973 6974 6975 6976 6977 6978
	case ixgbe_mac_82599EB: {
		u32 mflcn = IXGBE_READ_REG(hw, IXGBE_MFLCN);
		u32 fccfg = IXGBE_READ_REG(hw, IXGBE_FCCFG);
		flow_rx = !!(mflcn & IXGBE_MFLCN_RFCE);
		flow_tx = !!(fccfg & IXGBE_FCCFG_TFCE_802_3X);
	}
		break;
	default:
		flow_tx = false;
		flow_rx = false;
		break;
6979
	}
6980

6981 6982
	adapter->last_rx_ptp_check = jiffies;

6983
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
6984
		ixgbe_ptp_start_cyclecounter(adapter);
6985

6986 6987 6988 6989 6990 6991 6992 6993 6994 6995 6996 6997 6998
	switch (link_speed) {
	case IXGBE_LINK_SPEED_10GB_FULL:
		speed_str = "10 Gbps";
		break;
	case IXGBE_LINK_SPEED_2_5GB_FULL:
		speed_str = "2.5 Gbps";
		break;
	case IXGBE_LINK_SPEED_1GB_FULL:
		speed_str = "1 Gbps";
		break;
	case IXGBE_LINK_SPEED_100_FULL:
		speed_str = "100 Mbps";
		break;
6999 7000 7001
	case IXGBE_LINK_SPEED_10_FULL:
		speed_str = "10 Mbps";
		break;
7002 7003 7004 7005 7006
	default:
		speed_str = "unknown speed";
		break;
	}
	e_info(drv, "NIC Link is Up %s, Flow Control: %s\n", speed_str,
7007 7008 7009
	       ((flow_rx && flow_tx) ? "RX/TX" :
	       (flow_rx ? "RX" :
	       (flow_tx ? "TX" : "None"))));
7010

7011 7012
	netif_carrier_on(netdev);
	ixgbe_check_vf_rate_limit(adapter);
7013

7014 7015 7016 7017 7018
	/* enable transmits */
	netif_tx_wake_all_queues(adapter->netdev);

	/* enable any upper devices */
	rtnl_lock();
D
David Ahern 已提交
7019 7020
	netdev_walk_all_upper_dev_rcu(adapter->netdev,
				      ixgbe_enable_macvlan, NULL);
7021 7022
	rtnl_unlock();

7023 7024 7025
	/* update the default user priority for VFs */
	ixgbe_update_default_up(adapter);

7026 7027
	/* ping all the active vfs to let them know link has changed */
	ixgbe_ping_all_vfs(adapter);
7028 7029
}

7030
/**
7031 7032
 * ixgbe_watchdog_link_is_down - update netif_carrier status and
 *                               print link down message
7033
 * @adapter: pointer to the adapter structure
7034
 **/
A
Alexander Duyck 已提交
7035
static void ixgbe_watchdog_link_is_down(struct ixgbe_adapter *adapter)
7036
{
7037
	struct net_device *netdev = adapter->netdev;
7038
	struct ixgbe_hw *hw = &adapter->hw;
7039

7040 7041
	adapter->link_up = false;
	adapter->link_speed = 0;
7042

7043 7044 7045
	/* only continue if link was up previously */
	if (!netif_carrier_ok(netdev))
		return;
7046

7047 7048 7049
	/* poll for SFP+ cable when link is down */
	if (ixgbe_is_sfp(hw) && hw->mac.type == ixgbe_mac_82598EB)
		adapter->flags2 |= IXGBE_FLAG2_SEARCH_FOR_SFP;
7050

7051
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
7052
		ixgbe_ptp_start_cyclecounter(adapter);
7053

7054 7055
	e_info(drv, "NIC Link is Down\n");
	netif_carrier_off(netdev);
7056 7057 7058

	/* ping all the active vfs to let them know link has changed */
	ixgbe_ping_all_vfs(adapter);
7059
}
7060

7061 7062 7063 7064 7065 7066 7067 7068 7069 7070 7071 7072 7073 7074 7075 7076 7077 7078 7079 7080 7081 7082 7083 7084 7085
static bool ixgbe_ring_tx_pending(struct ixgbe_adapter *adapter)
{
	int i;

	for (i = 0; i < adapter->num_tx_queues; i++) {
		struct ixgbe_ring *tx_ring = adapter->tx_ring[i];

		if (tx_ring->next_to_use != tx_ring->next_to_clean)
			return true;
	}

	return false;
}

static bool ixgbe_vf_tx_pending(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
	u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);

	int i, j;

	if (!adapter->num_vfs)
		return false;

7086 7087 7088 7089
	/* resetting the PF is only needed for MAC before X550 */
	if (hw->mac.type >= ixgbe_mac_X550)
		return false;

7090 7091 7092 7093 7094 7095 7096 7097 7098 7099 7100 7101 7102 7103 7104
	for (i = 0; i < adapter->num_vfs; i++) {
		for (j = 0; j < q_per_pool; j++) {
			u32 h, t;

			h = IXGBE_READ_REG(hw, IXGBE_PVFTDHN(q_per_pool, i, j));
			t = IXGBE_READ_REG(hw, IXGBE_PVFTDTN(q_per_pool, i, j));

			if (h != t)
				return true;
		}
	}

	return false;
}

7105 7106
/**
 * ixgbe_watchdog_flush_tx - flush queues on link down
7107
 * @adapter: pointer to the device adapter structure
7108 7109 7110 7111
 **/
static void ixgbe_watchdog_flush_tx(struct ixgbe_adapter *adapter)
{
	if (!netif_carrier_ok(adapter->netdev)) {
7112 7113
		if (ixgbe_ring_tx_pending(adapter) ||
		    ixgbe_vf_tx_pending(adapter)) {
7114 7115 7116 7117 7118
			/* We've lost link, so the controller stops DMA,
			 * but we've got queued Tx work that's never going
			 * to get done, so reset controller to flush Tx.
			 * (Do the reset outside of interrupt context).
			 */
7119
			e_warn(drv, "initiating reset to clear Tx work after link loss\n");
7120
			set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
7121
		}
7122 7123 7124
	}
}

7125 7126 7127 7128 7129 7130 7131 7132 7133 7134 7135 7136 7137 7138 7139 7140 7141
#ifdef CONFIG_PCI_IOV
static inline void ixgbe_issue_vf_flr(struct ixgbe_adapter *adapter,
				      struct pci_dev *vfdev)
{
	if (!pci_wait_for_pending_transaction(vfdev))
		e_dev_warn("Issuing VFLR with pending transactions\n");

	e_dev_err("Issuing VFLR for VF %s\n", pci_name(vfdev));
	pcie_capability_set_word(vfdev, PCI_EXP_DEVCTL, PCI_EXP_DEVCTL_BCR_FLR);

	msleep(100);
}

static void ixgbe_check_for_bad_vf(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct pci_dev *pdev = adapter->pdev;
7142
	unsigned int vf;
7143 7144 7145 7146 7147 7148 7149 7150 7151 7152 7153 7154 7155 7156 7157 7158 7159 7160
	u32 gpc;

	if (!(netif_carrier_ok(adapter->netdev)))
		return;

	gpc = IXGBE_READ_REG(hw, IXGBE_TXDGPC);
	if (gpc) /* If incrementing then no need for the check below */
		return;
	/* Check to see if a bad DMA write target from an errant or
	 * malicious VF has caused a PCIe error.  If so then we can
	 * issue a VFLR to the offending VF(s) and then resume without
	 * requesting a full slot reset.
	 */

	if (!pdev)
		return;

	/* check status reg for all VFs owned by this PF */
7161 7162 7163
	for (vf = 0; vf < adapter->num_vfs; ++vf) {
		struct pci_dev *vfdev = adapter->vfinfo[vf].vfdev;
		u16 status_reg;
7164

7165 7166 7167 7168 7169 7170
		if (!vfdev)
			continue;
		pci_read_config_word(vfdev, PCI_STATUS, &status_reg);
		if (status_reg != IXGBE_FAILED_READ_CFG_WORD &&
		    status_reg & PCI_STATUS_REC_MASTER_ABORT)
			ixgbe_issue_vf_flr(adapter, vfdev);
7171 7172 7173
	}
}

7174 7175 7176 7177
static void ixgbe_spoof_check(struct ixgbe_adapter *adapter)
{
	u32 ssvpc;

7178 7179 7180
	/* Do not perform spoof check for 82598 or if not in IOV mode */
	if (adapter->hw.mac.type == ixgbe_mac_82598EB ||
	    adapter->num_vfs == 0)
7181 7182 7183 7184 7185 7186 7187 7188 7189 7190 7191
		return;

	ssvpc = IXGBE_READ_REG(&adapter->hw, IXGBE_SSVPC);

	/*
	 * ssvpc register is cleared on read, if zero then no
	 * spoofed packets in the last interval.
	 */
	if (!ssvpc)
		return;

7192
	e_warn(drv, "%u Spoofed packets detected\n", ssvpc);
7193
}
7194 7195 7196 7197 7198 7199 7200 7201 7202 7203 7204
#else
static void ixgbe_spoof_check(struct ixgbe_adapter __always_unused *adapter)
{
}

static void
ixgbe_check_for_bad_vf(struct ixgbe_adapter __always_unused *adapter)
{
}
#endif /* CONFIG_PCI_IOV */

7205

7206 7207
/**
 * ixgbe_watchdog_subtask - check and bring link up
7208
 * @adapter: pointer to the device adapter structure
7209 7210 7211
 **/
static void ixgbe_watchdog_subtask(struct ixgbe_adapter *adapter)
{
7212
	/* if interface is down, removing or resetting, do nothing */
7213
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
7214
	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
7215
	    test_bit(__IXGBE_RESETTING, &adapter->state))
7216 7217 7218 7219 7220 7221 7222 7223
		return;

	ixgbe_watchdog_update_link(adapter);

	if (adapter->link_up)
		ixgbe_watchdog_link_is_up(adapter);
	else
		ixgbe_watchdog_link_is_down(adapter);
7224

7225
	ixgbe_check_for_bad_vf(adapter);
7226
	ixgbe_spoof_check(adapter);
7227
	ixgbe_update_stats(adapter);
7228 7229

	ixgbe_watchdog_flush_tx(adapter);
7230
}
7231

7232
/**
7233
 * ixgbe_sfp_detection_subtask - poll for SFP+ cable
7234
 * @adapter: the ixgbe adapter structure
7235
 **/
7236
static void ixgbe_sfp_detection_subtask(struct ixgbe_adapter *adapter)
7237 7238
{
	struct ixgbe_hw *hw = &adapter->hw;
7239
	s32 err;
7240

7241 7242 7243 7244
	/* not searching for SFP so there is nothing to do here */
	if (!(adapter->flags2 & IXGBE_FLAG2_SEARCH_FOR_SFP) &&
	    !(adapter->flags2 & IXGBE_FLAG2_SFP_NEEDS_RESET))
		return;
7245

M
Mark Rustad 已提交
7246 7247 7248 7249
	if (adapter->sfp_poll_time &&
	    time_after(adapter->sfp_poll_time, jiffies))
		return; /* If not yet time to poll for SFP */

7250 7251 7252
	/* someone else is in init, wait until next service event */
	if (test_and_set_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
		return;
7253

M
Mark Rustad 已提交
7254 7255
	adapter->sfp_poll_time = jiffies + IXGBE_SFP_POLL_JIFFIES - 1;

7256 7257 7258
	err = hw->phy.ops.identify_sfp(hw);
	if (err == IXGBE_ERR_SFP_NOT_SUPPORTED)
		goto sfp_out;
7259

7260 7261 7262 7263
	if (err == IXGBE_ERR_SFP_NOT_PRESENT) {
		/* If no cable is present, then we need to reset
		 * the next time we find a good cable. */
		adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
7264
	}
7265

7266 7267 7268
	/* exit on error */
	if (err)
		goto sfp_out;
7269

7270 7271 7272
	/* exit if reset not needed */
	if (!(adapter->flags2 & IXGBE_FLAG2_SFP_NEEDS_RESET))
		goto sfp_out;
7273

7274
	adapter->flags2 &= ~IXGBE_FLAG2_SFP_NEEDS_RESET;
7275

7276 7277 7278 7279 7280 7281 7282 7283 7284 7285 7286 7287 7288 7289 7290 7291 7292 7293 7294 7295 7296 7297 7298 7299 7300 7301
	/*
	 * A module may be identified correctly, but the EEPROM may not have
	 * support for that module.  setup_sfp() will fail in that case, so
	 * we should not allow that module to load.
	 */
	if (hw->mac.type == ixgbe_mac_82598EB)
		err = hw->phy.ops.reset(hw);
	else
		err = hw->mac.ops.setup_sfp(hw);

	if (err == IXGBE_ERR_SFP_NOT_SUPPORTED)
		goto sfp_out;

	adapter->flags |= IXGBE_FLAG_NEED_LINK_CONFIG;
	e_info(probe, "detected SFP+: %d\n", hw->phy.sfp_type);

sfp_out:
	clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);

	if ((err == IXGBE_ERR_SFP_NOT_SUPPORTED) &&
	    (adapter->netdev->reg_state == NETREG_REGISTERED)) {
		e_dev_err("failed to initialize because an unsupported "
			  "SFP+ module type was detected.\n");
		e_dev_err("Reload the driver after installing a "
			  "supported module.\n");
		unregister_netdev(adapter->netdev);
7302
	}
7303
}
7304

7305 7306
/**
 * ixgbe_sfp_link_config_subtask - set up link SFP after module install
7307
 * @adapter: the ixgbe adapter structure
7308 7309 7310 7311
 **/
static void ixgbe_sfp_link_config_subtask(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
J
Josh Hay 已提交
7312 7313
	u32 speed;
	bool autoneg = false;
7314 7315 7316 7317 7318 7319 7320 7321 7322 7323

	if (!(adapter->flags & IXGBE_FLAG_NEED_LINK_CONFIG))
		return;

	/* someone else is in init, wait until next service event */
	if (test_and_set_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
		return;

	adapter->flags &= ~IXGBE_FLAG_NEED_LINK_CONFIG;

J
Josh Hay 已提交
7324
	speed = hw->phy.autoneg_advertised;
7325
	if ((!speed) && (hw->mac.ops.get_link_capabilities)) {
J
Josh Hay 已提交
7326
		hw->mac.ops.get_link_capabilities(hw, &speed, &autoneg);
7327 7328 7329 7330 7331 7332 7333 7334

		/* setup the highest link when no autoneg */
		if (!autoneg) {
			if (speed & IXGBE_LINK_SPEED_10GB_FULL)
				speed = IXGBE_LINK_SPEED_10GB_FULL;
		}
	}

7335
	if (hw->mac.ops.setup_link)
J
Josh Hay 已提交
7336
		hw->mac.ops.setup_link(hw, speed, true);
7337 7338 7339 7340 7341 7342 7343 7344 7345 7346 7347 7348 7349 7350 7351

	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
	adapter->link_check_timeout = jiffies;
	clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);
}

/**
 * ixgbe_service_timer - Timer Call-back
 * @data: pointer to adapter cast into an unsigned long
 **/
static void ixgbe_service_timer(unsigned long data)
{
	struct ixgbe_adapter *adapter = (struct ixgbe_adapter *)data;
	unsigned long next_event_offset;

7352 7353 7354 7355 7356
	/* poll faster when waiting for link */
	if (adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE)
		next_event_offset = HZ / 10;
	else
		next_event_offset = HZ * 2;
7357

7358 7359 7360
	/* Reset the timer */
	mod_timer(&adapter->service_timer, next_event_offset + jiffies);

7361
	ixgbe_service_event_schedule(adapter);
7362 7363
}

7364 7365 7366 7367 7368 7369 7370 7371 7372 7373 7374 7375 7376 7377 7378 7379 7380 7381 7382 7383
static void ixgbe_phy_interrupt_subtask(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 status;

	if (!(adapter->flags2 & IXGBE_FLAG2_PHY_INTERRUPT))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_PHY_INTERRUPT;

	if (!hw->phy.ops.handle_lasi)
		return;

	status = hw->phy.ops.handle_lasi(&adapter->hw);
	if (status != IXGBE_ERR_OVERTEMP)
		return;

	e_crit(drv, "%s\n", ixgbe_overheat_msg);
}

7384 7385
static void ixgbe_reset_subtask(struct ixgbe_adapter *adapter)
{
7386
	if (!test_and_clear_bit(__IXGBE_RESET_REQUESTED, &adapter->state))
7387 7388
		return;

7389
	/* If we're already down, removing or resetting, just bail */
7390
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
7391
	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
7392 7393 7394 7395 7396 7397 7398
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;

	ixgbe_dump(adapter);
	netdev_err(adapter->netdev, "Reset adapter\n");
	adapter->tx_timeout_count++;

7399
	rtnl_lock();
7400
	ixgbe_reinit_locked(adapter);
7401
	rtnl_unlock();
7402 7403
}

7404 7405 7406 7407 7408 7409 7410 7411 7412
/**
 * ixgbe_service_task - manages and runs subtasks
 * @work: pointer to work_struct containing our data
 **/
static void ixgbe_service_task(struct work_struct *work)
{
	struct ixgbe_adapter *adapter = container_of(work,
						     struct ixgbe_adapter,
						     service_task);
7413 7414 7415 7416 7417 7418 7419 7420 7421
	if (ixgbe_removed(adapter->hw.hw_addr)) {
		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
			rtnl_lock();
			ixgbe_down(adapter);
			rtnl_unlock();
		}
		ixgbe_service_event_complete(adapter);
		return;
	}
7422
	if (adapter->flags2 & IXGBE_FLAG2_UDP_TUN_REREG_NEEDED) {
7423
		rtnl_lock();
7424
		adapter->flags2 &= ~IXGBE_FLAG2_UDP_TUN_REREG_NEEDED;
7425 7426
		udp_tunnel_get_rx_info(adapter->netdev);
		rtnl_unlock();
7427
	}
7428
	ixgbe_reset_subtask(adapter);
7429
	ixgbe_phy_interrupt_subtask(adapter);
7430 7431
	ixgbe_sfp_detection_subtask(adapter);
	ixgbe_sfp_link_config_subtask(adapter);
7432
	ixgbe_check_overtemp_subtask(adapter);
7433
	ixgbe_watchdog_subtask(adapter);
7434
	ixgbe_fdir_reinit_subtask(adapter);
7435
	ixgbe_check_hang_subtask(adapter);
7436

7437
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state)) {
7438 7439 7440
		ixgbe_ptp_overflow_check(adapter);
		ixgbe_ptp_rx_hang(adapter);
	}
7441 7442

	ixgbe_service_event_complete(adapter);
7443 7444
}

7445 7446
static int ixgbe_tso(struct ixgbe_ring *tx_ring,
		     struct ixgbe_tx_buffer *first,
7447
		     u8 *hdr_len)
7448
{
7449
	u32 vlan_macip_lens, type_tucmd, mss_l4len_idx;
7450
	struct sk_buff *skb = first->skb;
7451 7452 7453 7454 7455 7456 7457 7458 7459 7460
	union {
		struct iphdr *v4;
		struct ipv6hdr *v6;
		unsigned char *hdr;
	} ip;
	union {
		struct tcphdr *tcp;
		unsigned char *hdr;
	} l4;
	u32 paylen, l4_offset;
7461
	int err;
7462

7463 7464 7465
	if (skb->ip_summed != CHECKSUM_PARTIAL)
		return 0;

7466 7467
	if (!skb_is_gso(skb))
		return 0;
7468

7469 7470 7471
	err = skb_cow_head(skb, 0);
	if (err < 0)
		return err;
7472

7473 7474 7475
	ip.hdr = skb_network_header(skb);
	l4.hdr = skb_checksum_start(skb);

7476 7477 7478
	/* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
	type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;

7479 7480
	/* initialize outer IP header fields */
	if (ip.v4->version == 4) {
7481 7482 7483
		unsigned char *csum_start = skb_checksum_start(skb);
		unsigned char *trans_start = ip.hdr + (ip.v4->ihl * 4);

7484 7485 7486
		/* IP header will have to cancel out any data that
		 * is not a part of the outer IP header
		 */
7487 7488 7489
		ip.v4->check = csum_fold(csum_partial(trans_start,
						      csum_start - trans_start,
						      0));
7490
		type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
7491 7492

		ip.v4->tot_len = 0;
7493 7494 7495
		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
				   IXGBE_TX_FLAGS_CSUM |
				   IXGBE_TX_FLAGS_IPV4;
7496 7497
	} else {
		ip.v6->payload_len = 0;
7498 7499
		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
				   IXGBE_TX_FLAGS_CSUM;
7500 7501
	}

7502 7503 7504 7505 7506 7507 7508 7509 7510
	/* determine offset of inner transport header */
	l4_offset = l4.hdr - skb->data;

	/* compute length of segmentation header */
	*hdr_len = (l4.tcp->doff * 4) + l4_offset;

	/* remove payload length from inner checksum */
	paylen = skb->len - l4_offset;
	csum_replace_by_diff(&l4.tcp->check, htonl(paylen));
7511

7512 7513 7514 7515
	/* update gso size and bytecount with header size */
	first->gso_segs = skb_shinfo(skb)->gso_segs;
	first->bytecount += (first->gso_segs - 1) * *hdr_len;

7516
	/* mss_l4len_id: use 0 as index for TSO */
7517
	mss_l4len_idx = (*hdr_len - l4_offset) << IXGBE_ADVTXD_L4LEN_SHIFT;
7518 7519 7520
	mss_l4len_idx |= skb_shinfo(skb)->gso_size << IXGBE_ADVTXD_MSS_SHIFT;

	/* vlan_macip_lens: HEADLEN, MACLEN, VLAN tag */
7521 7522
	vlan_macip_lens = l4.hdr - ip.hdr;
	vlan_macip_lens |= (ip.hdr - skb->data) << IXGBE_ADVTXD_MACLEN_SHIFT;
7523
	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
7524 7525

	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, 0, type_tucmd,
7526
			  mss_l4len_idx);
7527 7528 7529 7530

	return 1;
}

7531 7532 7533 7534 7535 7536 7537 7538 7539
static inline bool ixgbe_ipv6_csum_is_sctp(struct sk_buff *skb)
{
	unsigned int offset = 0;

	ipv6_find_hdr(skb, &offset, IPPROTO_SCTP, NULL, NULL);

	return offset == skb_checksum_start_offset(skb);
}

7540 7541
static void ixgbe_tx_csum(struct ixgbe_ring *tx_ring,
			  struct ixgbe_tx_buffer *first)
7542
{
7543
	struct sk_buff *skb = first->skb;
7544 7545
	u32 vlan_macip_lens = 0;
	u32 type_tucmd = 0;
7546

7547
	if (skb->ip_summed != CHECKSUM_PARTIAL) {
7548 7549 7550
csum_failed:
		if (!(first->tx_flags & (IXGBE_TX_FLAGS_HW_VLAN |
					 IXGBE_TX_FLAGS_CC)))
7551
			return;
7552 7553
		goto no_csum;
	}
7554

7555 7556 7557 7558 7559 7560 7561 7562 7563 7564 7565 7566 7567
	switch (skb->csum_offset) {
	case offsetof(struct tcphdr, check):
		type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;
		/* fall through */
	case offsetof(struct udphdr, check):
		break;
	case offsetof(struct sctphdr, checksum):
		/* validate that this is actually an SCTP request */
		if (((first->protocol == htons(ETH_P_IP)) &&
		     (ip_hdr(skb)->protocol == IPPROTO_SCTP)) ||
		    ((first->protocol == htons(ETH_P_IPV6)) &&
		     ixgbe_ipv6_csum_is_sctp(skb))) {
			type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_SCTP;
7568
			break;
7569
		}
7570 7571 7572 7573
		/* fall through */
	default:
		skb_checksum_help(skb);
		goto csum_failed;
7574 7575
	}

7576 7577 7578 7579
	/* update TX checksum flag */
	first->tx_flags |= IXGBE_TX_FLAGS_CSUM;
	vlan_macip_lens = skb_checksum_start_offset(skb) -
			  skb_network_offset(skb);
7580
no_csum:
7581
	/* vlan_macip_lens: MACLEN, VLAN tag */
7582
	vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
7583
	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
7584

7585
	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, 0, type_tucmd, 0);
7586 7587
}

7588 7589 7590 7591 7592 7593
#define IXGBE_SET_FLAG(_input, _flag, _result) \
	((_flag <= _result) ? \
	 ((u32)(_input & _flag) * (_result / _flag)) : \
	 ((u32)(_input & _flag) / (_flag / _result)))

static u32 ixgbe_tx_cmd_type(struct sk_buff *skb, u32 tx_flags)
7594
{
7595
	/* set type for advanced descriptor with frame checksum insertion */
7596 7597 7598
	u32 cmd_type = IXGBE_ADVTXD_DTYP_DATA |
		       IXGBE_ADVTXD_DCMD_DEXT |
		       IXGBE_ADVTXD_DCMD_IFCS;
7599

7600
	/* set HW vlan bit if vlan is present */
7601 7602
	cmd_type |= IXGBE_SET_FLAG(tx_flags, IXGBE_TX_FLAGS_HW_VLAN,
				   IXGBE_ADVTXD_DCMD_VLE);
7603

7604
	/* set segmentation enable bits for TSO/FSO */
7605 7606 7607 7608 7609 7610
	cmd_type |= IXGBE_SET_FLAG(tx_flags, IXGBE_TX_FLAGS_TSO,
				   IXGBE_ADVTXD_DCMD_TSE);

	/* set timestamp bit if present */
	cmd_type |= IXGBE_SET_FLAG(tx_flags, IXGBE_TX_FLAGS_TSTAMP,
				   IXGBE_ADVTXD_MAC_TSTAMP);
7611

7612
	/* insert frame checksum */
7613
	cmd_type ^= IXGBE_SET_FLAG(skb->no_fcs, 1, IXGBE_ADVTXD_DCMD_IFCS);
7614

7615 7616
	return cmd_type;
}
7617

7618 7619
static void ixgbe_tx_olinfo_status(union ixgbe_adv_tx_desc *tx_desc,
				   u32 tx_flags, unsigned int paylen)
7620
{
7621
	u32 olinfo_status = paylen << IXGBE_ADVTXD_PAYLEN_SHIFT;
7622

7623
	/* enable L4 checksum for TSO and TX checksum offload */
7624 7625 7626
	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
					IXGBE_TX_FLAGS_CSUM,
					IXGBE_ADVTXD_POPTS_TXSM);
7627

7628
	/* enble IPv4 checksum for TSO */
7629 7630 7631
	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
					IXGBE_TX_FLAGS_IPV4,
					IXGBE_ADVTXD_POPTS_IXSM);
7632

7633 7634 7635 7636
	/*
	 * Check Context must be set if Tx switch is enabled, which it
	 * always is for case where virtual functions are running
	 */
7637 7638 7639
	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
					IXGBE_TX_FLAGS_CC,
					IXGBE_ADVTXD_CC);
7640

7641
	tx_desc->read.olinfo_status = cpu_to_le32(olinfo_status);
7642
}
7643

7644 7645 7646 7647 7648 7649 7650 7651 7652 7653 7654 7655 7656 7657 7658 7659 7660 7661 7662 7663 7664 7665 7666 7667 7668 7669 7670 7671 7672 7673
static int __ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
{
	netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);

	/* Herbert's original patch had:
	 *  smp_mb__after_netif_stop_queue();
	 * but since that doesn't exist yet, just open code it.
	 */
	smp_mb();

	/* We need to check again in a case another CPU has just
	 * made room available.
	 */
	if (likely(ixgbe_desc_unused(tx_ring) < size))
		return -EBUSY;

	/* A reprieve! - use start_queue because it doesn't call schedule */
	netif_start_subqueue(tx_ring->netdev, tx_ring->queue_index);
	++tx_ring->tx_stats.restart_queue;
	return 0;
}

static inline int ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
{
	if (likely(ixgbe_desc_unused(tx_ring) >= size))
		return 0;

	return __ixgbe_maybe_stop_tx(tx_ring, size);
}

7674 7675 7676 7677 7678 7679 7680
#define IXGBE_TXD_CMD (IXGBE_TXD_CMD_EOP | \
		       IXGBE_TXD_CMD_RS)

static void ixgbe_tx_map(struct ixgbe_ring *tx_ring,
			 struct ixgbe_tx_buffer *first,
			 const u8 hdr_len)
{
7681
	struct sk_buff *skb = first->skb;
7682
	struct ixgbe_tx_buffer *tx_buffer;
7683
	union ixgbe_adv_tx_desc *tx_desc;
7684 7685 7686
	struct skb_frag_struct *frag;
	dma_addr_t dma;
	unsigned int data_len, size;
7687
	u32 tx_flags = first->tx_flags;
7688
	u32 cmd_type = ixgbe_tx_cmd_type(skb, tx_flags);
7689 7690
	u16 i = tx_ring->next_to_use;

7691 7692
	tx_desc = IXGBE_TX_DESC(tx_ring, i);

7693 7694 7695 7696
	ixgbe_tx_olinfo_status(tx_desc, tx_flags, skb->len - hdr_len);

	size = skb_headlen(skb);
	data_len = skb->data_len;
7697

7698 7699
#ifdef IXGBE_FCOE
	if (tx_flags & IXGBE_TX_FLAGS_FCOE) {
7700
		if (data_len < sizeof(struct fcoe_crc_eof)) {
7701 7702
			size -= sizeof(struct fcoe_crc_eof) - data_len;
			data_len = 0;
7703 7704
		} else {
			data_len -= sizeof(struct fcoe_crc_eof);
7705 7706
		}
	}
7707

7708
#endif
7709
	dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
7710

7711
	tx_buffer = first;
7712

7713 7714 7715 7716 7717 7718 7719 7720 7721
	for (frag = &skb_shinfo(skb)->frags[0];; frag++) {
		if (dma_mapping_error(tx_ring->dev, dma))
			goto dma_error;

		/* record length, and DMA address */
		dma_unmap_len_set(tx_buffer, len, size);
		dma_unmap_addr_set(tx_buffer, dma, dma);

		tx_desc->read.buffer_addr = cpu_to_le64(dma);
7722

7723
		while (unlikely(size > IXGBE_MAX_DATA_PER_TXD)) {
7724
			tx_desc->read.cmd_type_len =
7725
				cpu_to_le32(cmd_type ^ IXGBE_MAX_DATA_PER_TXD);
7726

7727
			i++;
7728
			tx_desc++;
7729
			if (i == tx_ring->count) {
7730
				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
7731 7732
				i = 0;
			}
7733
			tx_desc->read.olinfo_status = 0;
7734 7735 7736 7737 7738

			dma += IXGBE_MAX_DATA_PER_TXD;
			size -= IXGBE_MAX_DATA_PER_TXD;

			tx_desc->read.buffer_addr = cpu_to_le64(dma);
7739
		}
7740

7741 7742
		if (likely(!data_len))
			break;
7743

7744
		tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type ^ size);
7745

7746 7747 7748 7749 7750 7751
		i++;
		tx_desc++;
		if (i == tx_ring->count) {
			tx_desc = IXGBE_TX_DESC(tx_ring, 0);
			i = 0;
		}
7752
		tx_desc->read.olinfo_status = 0;
7753

7754
#ifdef IXGBE_FCOE
E
Eric Dumazet 已提交
7755
		size = min_t(unsigned int, data_len, skb_frag_size(frag));
7756
#else
E
Eric Dumazet 已提交
7757
		size = skb_frag_size(frag);
7758 7759
#endif
		data_len -= size;
7760

7761 7762
		dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
				       DMA_TO_DEVICE);
7763

7764 7765
		tx_buffer = &tx_ring->tx_buffer_info[i];
	}
7766

7767
	/* write last descriptor with RS and EOP bits */
7768 7769
	cmd_type |= size | IXGBE_TXD_CMD;
	tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type);
7770

7771
	netdev_tx_sent_queue(txring_txq(tx_ring), first->bytecount);
7772

7773 7774
	/* set the timestamp */
	first->time_stamp = jiffies;
7775 7776

	/*
7777 7778 7779 7780 7781 7782
	 * Force memory writes to complete before letting h/w know there
	 * are new descriptors to fetch.  (Only applicable for weak-ordered
	 * memory model archs, such as IA-64).
	 *
	 * We also need this memory barrier to make certain all of the
	 * status bits have been updated before next_to_watch is written.
7783 7784 7785
	 */
	wmb();

7786 7787 7788
	/* set next_to_watch value indicating a packet is present */
	first->next_to_watch = tx_desc;

7789 7790 7791 7792 7793 7794
	i++;
	if (i == tx_ring->count)
		i = 0;

	tx_ring->next_to_use = i;

7795 7796 7797
	ixgbe_maybe_stop_tx(tx_ring, DESC_NEEDED);

	if (netif_xmit_stopped(txring_txq(tx_ring)) || !skb->xmit_more) {
7798 7799 7800 7801 7802 7803
		writel(i, tx_ring->tail);

		/* we need this if more than one processor can write to our tail
		 * at a time, it synchronizes IO on IA64/Altix systems
		 */
		mmiowb();
7804
	}
7805

7806 7807
	return;
dma_error:
7808
	dev_err(tx_ring->dev, "TX DMA map failed\n");
7809
	tx_buffer = &tx_ring->tx_buffer_info[i];
7810 7811

	/* clear dma mappings for failed tx_buffer_info map */
7812 7813 7814 7815 7816 7817 7818 7819 7820 7821
	while (tx_buffer != first) {
		if (dma_unmap_len(tx_buffer, len))
			dma_unmap_page(tx_ring->dev,
				       dma_unmap_addr(tx_buffer, dma),
				       dma_unmap_len(tx_buffer, len),
				       DMA_TO_DEVICE);
		dma_unmap_len_set(tx_buffer, len, 0);

		if (i--)
			i += tx_ring->count;
7822
		tx_buffer = &tx_ring->tx_buffer_info[i];
7823 7824
	}

7825 7826 7827 7828 7829 7830 7831 7832 7833 7834
	if (dma_unmap_len(tx_buffer, len))
		dma_unmap_single(tx_ring->dev,
				 dma_unmap_addr(tx_buffer, dma),
				 dma_unmap_len(tx_buffer, len),
				 DMA_TO_DEVICE);
	dma_unmap_len_set(tx_buffer, len, 0);

	dev_kfree_skb_any(first->skb);
	first->skb = NULL;

7835
	tx_ring->next_to_use = i;
7836 7837
}

7838
static void ixgbe_atr(struct ixgbe_ring *ring,
7839
		      struct ixgbe_tx_buffer *first)
7840 7841 7842 7843 7844 7845 7846 7847 7848
{
	struct ixgbe_q_vector *q_vector = ring->q_vector;
	union ixgbe_atr_hash_dword input = { .dword = 0 };
	union ixgbe_atr_hash_dword common = { .dword = 0 };
	union {
		unsigned char *network;
		struct iphdr *ipv4;
		struct ipv6hdr *ipv6;
	} hdr;
7849
	struct tcphdr *th;
7850
	unsigned int hlen;
7851
	struct sk_buff *skb;
7852
	__be16 vlan_id;
7853
	int l4_proto;
7854

7855 7856 7857 7858 7859 7860
	/* if ring doesn't have a interrupt vector, cannot perform ATR */
	if (!q_vector)
		return;

	/* do nothing if sampling is disabled */
	if (!ring->atr_sample_rate)
7861
		return;
7862

7863
	ring->atr_count++;
7864

7865 7866 7867 7868 7869
	/* currently only IPv4/IPv6 with TCP is supported */
	if ((first->protocol != htons(ETH_P_IP)) &&
	    (first->protocol != htons(ETH_P_IPV6)))
		return;

7870
	/* snag network header to get L4 type and address */
7871 7872
	skb = first->skb;
	hdr.network = skb_network_header(skb);
7873 7874
	if (unlikely(hdr.network <= skb->data))
		return;
7875 7876
	if (skb->encapsulation &&
	    first->protocol == htons(ETH_P_IP) &&
7877
	    hdr.ipv4->protocol == IPPROTO_UDP) {
7878
		struct ixgbe_adapter *adapter = q_vector->adapter;
7879

7880 7881 7882 7883
		if (unlikely(skb_tail_pointer(skb) < hdr.network +
			     VXLAN_HEADROOM))
			return;

7884 7885
		/* verify the port is recognized as VXLAN */
		if (adapter->vxlan_port &&
7886
		    udp_hdr(skb)->dest == adapter->vxlan_port)
7887
			hdr.network = skb_inner_network_header(skb);
7888 7889 7890 7891

		if (adapter->geneve_port &&
		    udp_hdr(skb)->dest == adapter->geneve_port)
			hdr.network = skb_inner_network_header(skb);
7892 7893
	}

7894 7895 7896 7897 7898 7899
	/* Make sure we have at least [minimum IPv4 header + TCP]
	 * or [IPv6 header] bytes
	 */
	if (unlikely(skb_tail_pointer(skb) < hdr.network + 40))
		return;

7900 7901 7902
	/* Currently only IPv4/IPv6 with TCP is supported */
	switch (hdr.ipv4->version) {
	case IPVERSION:
7903 7904 7905
		/* access ihl as u8 to avoid unaligned access on ia64 */
		hlen = (hdr.network[0] & 0x0F) << 2;
		l4_proto = hdr.ipv4->protocol;
7906 7907
		break;
	case 6:
7908 7909 7910
		hlen = hdr.network - skb->data;
		l4_proto = ipv6_find_hdr(skb, &hlen, IPPROTO_TCP, NULL, NULL);
		hlen -= hdr.network - skb->data;
7911 7912 7913
		break;
	default:
		return;
7914
	}
7915

7916 7917 7918
	if (l4_proto != IPPROTO_TCP)
		return;

7919 7920 7921 7922
	if (unlikely(skb_tail_pointer(skb) < hdr.network +
		     hlen + sizeof(struct tcphdr)))
		return;

7923 7924 7925 7926
	th = (struct tcphdr *)(hdr.network + hlen);

	/* skip this packet since the socket is closing */
	if (th->fin)
7927 7928 7929 7930 7931 7932 7933 7934 7935
		return;

	/* sample on all syn packets or once every atr sample count */
	if (!th->syn && (ring->atr_count < ring->atr_sample_rate))
		return;

	/* reset sample count */
	ring->atr_count = 0;

7936
	vlan_id = htons(first->tx_flags >> IXGBE_TX_FLAGS_VLAN_SHIFT);
7937 7938 7939 7940 7941 7942 7943 7944 7945 7946 7947 7948 7949 7950

	/*
	 * src and dst are inverted, think how the receiver sees them
	 *
	 * The input is broken into two sections, a non-compressed section
	 * containing vm_pool, vlan_id, and flow_type.  The rest of the data
	 * is XORed together and stored in the compressed dword.
	 */
	input.formatted.vlan_id = vlan_id;

	/*
	 * since src port and flex bytes occupy the same word XOR them together
	 * and write the value to source port portion of compressed dword
	 */
7951
	if (first->tx_flags & (IXGBE_TX_FLAGS_SW_VLAN | IXGBE_TX_FLAGS_HW_VLAN))
7952
		common.port.src ^= th->dest ^ htons(ETH_P_8021Q);
7953
	else
7954
		common.port.src ^= th->dest ^ first->protocol;
7955 7956
	common.port.dst ^= th->source;

7957 7958
	switch (hdr.ipv4->version) {
	case IPVERSION:
7959 7960
		input.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_TCPV4;
		common.ip ^= hdr.ipv4->saddr ^ hdr.ipv4->daddr;
7961 7962
		break;
	case 6:
7963 7964 7965 7966 7967 7968 7969 7970 7971
		input.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_TCPV6;
		common.ip ^= hdr.ipv6->saddr.s6_addr32[0] ^
			     hdr.ipv6->saddr.s6_addr32[1] ^
			     hdr.ipv6->saddr.s6_addr32[2] ^
			     hdr.ipv6->saddr.s6_addr32[3] ^
			     hdr.ipv6->daddr.s6_addr32[0] ^
			     hdr.ipv6->daddr.s6_addr32[1] ^
			     hdr.ipv6->daddr.s6_addr32[2] ^
			     hdr.ipv6->daddr.s6_addr32[3];
7972 7973 7974
		break;
	default:
		break;
7975
	}
7976

7977
	if (hdr.network != skb_network_header(skb))
7978 7979
		input.formatted.flow_type |= IXGBE_ATR_L4TYPE_TUNNEL_MASK;

7980
	/* This assumes the Rx queue and Tx queue are bound to the same CPU */
7981 7982
	ixgbe_fdir_add_signature_filter_82599(&q_vector->adapter->hw,
					      input, common, ring->queue_index);
7983 7984
}

7985
static u16 ixgbe_select_queue(struct net_device *dev, struct sk_buff *skb,
7986
			      void *accel_priv, select_queue_fallback_t fallback)
7987
{
7988 7989
	struct ixgbe_fwd_adapter *fwd_adapter = accel_priv;
#ifdef IXGBE_FCOE
7990 7991 7992
	struct ixgbe_adapter *adapter;
	struct ixgbe_ring_feature *f;
	int txq;
7993 7994 7995 7996 7997 7998
#endif

	if (fwd_adapter)
		return skb->queue_mapping + fwd_adapter->tx_base_queue;

#ifdef IXGBE_FCOE
7999

8000 8001 8002 8003 8004
	/*
	 * only execute the code below if protocol is FCoE
	 * or FIP and we have FCoE enabled on the adapter
	 */
	switch (vlan_get_protocol(skb)) {
8005 8006
	case htons(ETH_P_FCOE):
	case htons(ETH_P_FIP):
8007
		adapter = netdev_priv(dev);
8008

8009 8010 8011
		if (adapter->flags & IXGBE_FLAG_FCOE_ENABLED)
			break;
	default:
8012
		return fallback(dev, skb);
8013
	}
8014

8015
	f = &adapter->ring_feature[RING_F_FCOE];
8016

8017 8018
	txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) :
					   smp_processor_id();
8019

8020 8021
	while (txq >= f->indices)
		txq -= f->indices;
8022

8023
	return txq + f->offset;
8024
#else
8025
	return fallback(dev, skb);
8026
#endif
8027 8028
}

8029
netdev_tx_t ixgbe_xmit_frame_ring(struct sk_buff *skb,
8030 8031
			  struct ixgbe_adapter *adapter,
			  struct ixgbe_ring *tx_ring)
8032
{
8033
	struct ixgbe_tx_buffer *first;
8034
	int tso;
8035
	u32 tx_flags = 0;
8036 8037
	unsigned short f;
	u16 count = TXD_USE_COUNT(skb_headlen(skb));
8038
	__be16 protocol = skb->protocol;
8039
	u8 hdr_len = 0;
8040

8041 8042
	/*
	 * need: 1 descriptor per page * PAGE_SIZE/IXGBE_MAX_DATA_PER_TXD,
8043
	 *       + 1 desc for skb_headlen/IXGBE_MAX_DATA_PER_TXD,
8044 8045 8046 8047 8048 8049
	 *       + 2 desc gap to keep tail from touching head,
	 *       + 1 desc for context descriptor,
	 * otherwise try next time
	 */
	for (f = 0; f < skb_shinfo(skb)->nr_frags; f++)
		count += TXD_USE_COUNT(skb_shinfo(skb)->frags[f].size);
8050

8051 8052 8053 8054 8055
	if (ixgbe_maybe_stop_tx(tx_ring, count + 3)) {
		tx_ring->tx_stats.tx_busy++;
		return NETDEV_TX_BUSY;
	}

8056 8057 8058
	/* record the location of the first descriptor for this packet */
	first = &tx_ring->tx_buffer_info[tx_ring->next_to_use];
	first->skb = skb;
8059 8060
	first->bytecount = skb->len;
	first->gso_segs = 1;
8061

8062
	/* if we have a HW VLAN tag being added default to the HW one */
8063 8064
	if (skb_vlan_tag_present(skb)) {
		tx_flags |= skb_vlan_tag_get(skb) << IXGBE_TX_FLAGS_VLAN_SHIFT;
8065 8066
		tx_flags |= IXGBE_TX_FLAGS_HW_VLAN;
	/* else if it is a SW VLAN check the next protocol and store the tag */
8067
	} else if (protocol == htons(ETH_P_8021Q)) {
8068 8069 8070 8071 8072
		struct vlan_hdr *vhdr, _vhdr;
		vhdr = skb_header_pointer(skb, ETH_HLEN, sizeof(_vhdr), &_vhdr);
		if (!vhdr)
			goto out_drop;

8073 8074
		tx_flags |= ntohs(vhdr->h_vlan_TCI) <<
				  IXGBE_TX_FLAGS_VLAN_SHIFT;
8075 8076
		tx_flags |= IXGBE_TX_FLAGS_SW_VLAN;
	}
8077
	protocol = vlan_get_protocol(skb);
8078

8079 8080 8081 8082
	if (unlikely(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP) &&
	    adapter->ptp_clock &&
	    !test_and_set_bit_lock(__IXGBE_PTP_TX_IN_PROGRESS,
				   &adapter->state)) {
8083 8084
		skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
		tx_flags |= IXGBE_TX_FLAGS_TSTAMP;
8085 8086 8087 8088 8089

		/* schedule check for Tx timestamp */
		adapter->ptp_tx_skb = skb_get(skb);
		adapter->ptp_tx_start = jiffies;
		schedule_work(&adapter->ptp_tx_work);
8090 8091
	}

8092 8093
	skb_tx_timestamp(skb);

8094 8095 8096 8097 8098 8099
#ifdef CONFIG_PCI_IOV
	/*
	 * Use the l2switch_enable flag - would be false if the DMA
	 * Tx switch had been disabled.
	 */
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
8100
		tx_flags |= IXGBE_TX_FLAGS_CC;
8101 8102

#endif
8103
	/* DCB maps skb priorities 0-7 onto 3 bit PCP of VLAN tag. */
8104
	if ((adapter->flags & IXGBE_FLAG_DCB_ENABLED) &&
8105 8106
	    ((tx_flags & (IXGBE_TX_FLAGS_HW_VLAN | IXGBE_TX_FLAGS_SW_VLAN)) ||
	     (skb->priority != TC_PRIO_CONTROL))) {
8107
		tx_flags &= ~IXGBE_TX_FLAGS_VLAN_PRIO_MASK;
8108 8109
		tx_flags |= (skb->priority & 0x7) <<
					IXGBE_TX_FLAGS_VLAN_PRIO_SHIFT;
8110 8111
		if (tx_flags & IXGBE_TX_FLAGS_SW_VLAN) {
			struct vlan_ethhdr *vhdr;
8112 8113

			if (skb_cow_head(skb, 0))
8114 8115 8116 8117 8118 8119
				goto out_drop;
			vhdr = (struct vlan_ethhdr *)skb->data;
			vhdr->h_vlan_TCI = htons(tx_flags >>
						 IXGBE_TX_FLAGS_VLAN_SHIFT);
		} else {
			tx_flags |= IXGBE_TX_FLAGS_HW_VLAN;
8120
		}
8121
	}
8122

8123 8124 8125 8126
	/* record initial flags and protocol */
	first->tx_flags = tx_flags;
	first->protocol = protocol;

8127
#ifdef IXGBE_FCOE
8128
	/* setup tx offload for FCoE */
8129
	if ((protocol == htons(ETH_P_FCOE)) &&
8130
	    (tx_ring->netdev->features & (NETIF_F_FSO | NETIF_F_FCOE_CRC))) {
8131
		tso = ixgbe_fso(tx_ring, first, &hdr_len);
8132 8133
		if (tso < 0)
			goto out_drop;
8134

8135
		goto xmit_fcoe;
8136
	}
8137

8138
#endif /* IXGBE_FCOE */
8139
	tso = ixgbe_tso(tx_ring, first, &hdr_len);
8140
	if (tso < 0)
8141
		goto out_drop;
8142 8143
	else if (!tso)
		ixgbe_tx_csum(tx_ring, first);
8144 8145 8146

	/* add the ATR filter if ATR is on */
	if (test_bit(__IXGBE_TX_FDIR_INIT_DONE, &tx_ring->state))
8147
		ixgbe_atr(tx_ring, first);
8148 8149 8150 8151

#ifdef IXGBE_FCOE
xmit_fcoe:
#endif /* IXGBE_FCOE */
8152
	ixgbe_tx_map(tx_ring, first, hdr_len);
8153

8154
	return NETDEV_TX_OK;
8155 8156

out_drop:
8157 8158 8159
	dev_kfree_skb_any(first->skb);
	first->skb = NULL;

8160
	return NETDEV_TX_OK;
8161 8162
}

8163 8164 8165
static netdev_tx_t __ixgbe_xmit_frame(struct sk_buff *skb,
				      struct net_device *netdev,
				      struct ixgbe_ring *ring)
8166 8167 8168 8169
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_ring *tx_ring;

8170 8171 8172 8173
	/*
	 * The minimum packet size for olinfo paylen is 17 so pad the skb
	 * in order to meet this minimum size requirement.
	 */
8174 8175
	if (skb_put_padto(skb, 17))
		return NETDEV_TX_OK;
8176

8177 8178
	tx_ring = ring ? ring : adapter->tx_ring[skb->queue_mapping];

8179
	return ixgbe_xmit_frame_ring(skb, adapter, tx_ring);
8180 8181
}

8182 8183 8184 8185 8186 8187
static netdev_tx_t ixgbe_xmit_frame(struct sk_buff *skb,
				    struct net_device *netdev)
{
	return __ixgbe_xmit_frame(skb, netdev, NULL);
}

8188 8189 8190 8191 8192 8193 8194 8195 8196 8197
/**
 * ixgbe_set_mac - Change the Ethernet Address of the NIC
 * @netdev: network interface device structure
 * @p: pointer to an address structure
 *
 * Returns 0 on success, negative on failure
 **/
static int ixgbe_set_mac(struct net_device *netdev, void *p)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
8198
	struct ixgbe_hw *hw = &adapter->hw;
8199 8200 8201 8202 8203 8204
	struct sockaddr *addr = p;

	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
8205
	memcpy(hw->mac.addr, addr->sa_data, netdev->addr_len);
8206

8207 8208 8209
	ixgbe_mac_set_default_filter(adapter);

	return 0;
8210 8211
}

8212 8213 8214 8215 8216 8217 8218 8219 8220 8221 8222 8223 8224 8225 8226 8227 8228 8229 8230 8231 8232 8233 8234 8235 8236 8237 8238 8239 8240 8241 8242
static int
ixgbe_mdio_read(struct net_device *netdev, int prtad, int devad, u16 addr)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;
	u16 value;
	int rc;

	if (prtad != hw->phy.mdio.prtad)
		return -EINVAL;
	rc = hw->phy.ops.read_reg(hw, addr, devad, &value);
	if (!rc)
		rc = value;
	return rc;
}

static int ixgbe_mdio_write(struct net_device *netdev, int prtad, int devad,
			    u16 addr, u16 value)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

	if (prtad != hw->phy.mdio.prtad)
		return -EINVAL;
	return hw->phy.ops.write_reg(hw, addr, devad, value);
}

static int ixgbe_ioctl(struct net_device *netdev, struct ifreq *req, int cmd)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

8243 8244
	switch (cmd) {
	case SIOCSHWTSTAMP:
8245 8246 8247
		return ixgbe_ptp_set_ts_config(adapter, req);
	case SIOCGHWTSTAMP:
		return ixgbe_ptp_get_ts_config(adapter, req);
8248 8249 8250
	default:
		return mdio_mii_ioctl(&adapter->hw.phy.mdio, if_mii(req), cmd);
	}
8251 8252
}

8253 8254
/**
 * ixgbe_add_sanmac_netdev - Add the SAN MAC address to the corresponding
8255
 * netdev->dev_addrs
8256 8257 8258 8259 8260 8261 8262 8263
 * @netdev: network interface device structure
 *
 * Returns non-zero on failure
 **/
static int ixgbe_add_sanmac_netdev(struct net_device *dev)
{
	int err = 0;
	struct ixgbe_adapter *adapter = netdev_priv(dev);
8264
	struct ixgbe_hw *hw = &adapter->hw;
8265

8266
	if (is_valid_ether_addr(hw->mac.san_addr)) {
8267
		rtnl_lock();
8268
		err = dev_addr_add(dev, hw->mac.san_addr, NETDEV_HW_ADDR_T_SAN);
8269
		rtnl_unlock();
8270 8271 8272

		/* update SAN MAC vmdq pool selection */
		hw->mac.ops.set_vmdq_san_mac(hw, VMDQ_P(0));
8273 8274 8275 8276 8277 8278
	}
	return err;
}

/**
 * ixgbe_del_sanmac_netdev - Removes the SAN MAC address to the corresponding
8279
 * netdev->dev_addrs
8280 8281 8282 8283 8284 8285 8286 8287 8288 8289 8290 8291 8292 8293 8294 8295 8296 8297
 * @netdev: network interface device structure
 *
 * Returns non-zero on failure
 **/
static int ixgbe_del_sanmac_netdev(struct net_device *dev)
{
	int err = 0;
	struct ixgbe_adapter *adapter = netdev_priv(dev);
	struct ixgbe_mac_info *mac = &adapter->hw.mac;

	if (is_valid_ether_addr(mac->san_addr)) {
		rtnl_lock();
		err = dev_addr_del(dev, mac->san_addr, NETDEV_HW_ADDR_T_SAN);
		rtnl_unlock();
	}
	return err;
}

8298 8299 8300 8301 8302 8303 8304 8305 8306
#ifdef CONFIG_NET_POLL_CONTROLLER
/*
 * Polling 'interrupt' - used by things like netconsole to send skbs
 * without having to re-enable interrupts. It's not called while
 * the interrupt routine is executing.
 */
static void ixgbe_netpoll(struct net_device *netdev)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
8307
	int i;
8308

8309 8310 8311 8312
	/* if interface is down do nothing */
	if (test_bit(__IXGBE_DOWN, &adapter->state))
		return;

8313 8314 8315
	/* loop through and schedule all active queues */
	for (i = 0; i < adapter->num_q_vectors; i++)
		ixgbe_msix_clean_rings(0, adapter->q_vector[i]);
8316 8317
}

A
Alexander Duyck 已提交
8318
#endif
8319 8320 8321

static void ixgbe_get_stats64(struct net_device *netdev,
			      struct rtnl_link_stats64 *stats)
E
Eric Dumazet 已提交
8322 8323 8324 8325
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	int i;

E
Eric Dumazet 已提交
8326
	rcu_read_lock();
E
Eric Dumazet 已提交
8327
	for (i = 0; i < adapter->num_rx_queues; i++) {
E
Eric Dumazet 已提交
8328
		struct ixgbe_ring *ring = ACCESS_ONCE(adapter->rx_ring[i]);
E
Eric Dumazet 已提交
8329 8330 8331
		u64 bytes, packets;
		unsigned int start;

E
Eric Dumazet 已提交
8332 8333
		if (ring) {
			do {
8334
				start = u64_stats_fetch_begin_irq(&ring->syncp);
E
Eric Dumazet 已提交
8335 8336
				packets = ring->stats.packets;
				bytes   = ring->stats.bytes;
8337
			} while (u64_stats_fetch_retry_irq(&ring->syncp, start));
E
Eric Dumazet 已提交
8338 8339 8340
			stats->rx_packets += packets;
			stats->rx_bytes   += bytes;
		}
E
Eric Dumazet 已提交
8341
	}
E
Eric Dumazet 已提交
8342 8343 8344 8345 8346 8347 8348 8349

	for (i = 0; i < adapter->num_tx_queues; i++) {
		struct ixgbe_ring *ring = ACCESS_ONCE(adapter->tx_ring[i]);
		u64 bytes, packets;
		unsigned int start;

		if (ring) {
			do {
8350
				start = u64_stats_fetch_begin_irq(&ring->syncp);
E
Eric Dumazet 已提交
8351 8352
				packets = ring->stats.packets;
				bytes   = ring->stats.bytes;
8353
			} while (u64_stats_fetch_retry_irq(&ring->syncp, start));
E
Eric Dumazet 已提交
8354 8355 8356 8357
			stats->tx_packets += packets;
			stats->tx_bytes   += bytes;
		}
	}
E
Eric Dumazet 已提交
8358
	rcu_read_unlock();
8359

E
Eric Dumazet 已提交
8360 8361 8362 8363 8364 8365 8366 8367
	/* following stats updated by ixgbe_watchdog_task() */
	stats->multicast	= netdev->stats.multicast;
	stats->rx_errors	= netdev->stats.rx_errors;
	stats->rx_length_errors	= netdev->stats.rx_length_errors;
	stats->rx_crc_errors	= netdev->stats.rx_crc_errors;
	stats->rx_missed_errors	= netdev->stats.rx_missed_errors;
}

8368
#ifdef CONFIG_IXGBE_DCB
8369 8370 8371
/**
 * ixgbe_validate_rtr - verify 802.1Qp to Rx packet buffer mapping is valid.
 * @adapter: pointer to ixgbe_adapter
8372 8373 8374 8375 8376 8377 8378 8379 8380 8381 8382 8383 8384 8385 8386 8387 8388 8389 8390 8391 8392 8393 8394 8395 8396 8397 8398 8399 8400 8401 8402 8403 8404 8405
 * @tc: number of traffic classes currently enabled
 *
 * Configure a valid 802.1Qp to Rx packet buffer mapping ie confirm
 * 802.1Q priority maps to a packet buffer that exists.
 */
static void ixgbe_validate_rtr(struct ixgbe_adapter *adapter, u8 tc)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 reg, rsave;
	int i;

	/* 82598 have a static priority to TC mapping that can not
	 * be changed so no validation is needed.
	 */
	if (hw->mac.type == ixgbe_mac_82598EB)
		return;

	reg = IXGBE_READ_REG(hw, IXGBE_RTRUP2TC);
	rsave = reg;

	for (i = 0; i < MAX_TRAFFIC_CLASS; i++) {
		u8 up2tc = reg >> (i * IXGBE_RTRUP2TC_UP_SHIFT);

		/* If up2tc is out of bounds default to zero */
		if (up2tc > tc)
			reg &= ~(0x7 << IXGBE_RTRUP2TC_UP_SHIFT);
	}

	if (reg != rsave)
		IXGBE_WRITE_REG(hw, IXGBE_RTRUP2TC, reg);

	return;
}

8406 8407 8408 8409 8410 8411 8412 8413 8414 8415 8416 8417 8418 8419 8420 8421 8422 8423 8424 8425 8426 8427 8428 8429 8430
/**
 * ixgbe_set_prio_tc_map - Configure netdev prio tc map
 * @adapter: Pointer to adapter struct
 *
 * Populate the netdev user priority to tc map
 */
static void ixgbe_set_prio_tc_map(struct ixgbe_adapter *adapter)
{
	struct net_device *dev = adapter->netdev;
	struct ixgbe_dcb_config *dcb_cfg = &adapter->dcb_cfg;
	struct ieee_ets *ets = adapter->ixgbe_ieee_ets;
	u8 prio;

	for (prio = 0; prio < MAX_USER_PRIORITY; prio++) {
		u8 tc = 0;

		if (adapter->dcbx_cap & DCB_CAP_DCBX_VER_CEE)
			tc = ixgbe_dcb_get_tc_from_up(dcb_cfg, 0, prio);
		else if (ets)
			tc = ets->prio_tc[prio];

		netdev_set_prio_tc_map(dev, prio, tc);
	}
}

8431
#endif /* CONFIG_IXGBE_DCB */
8432 8433
/**
 * ixgbe_setup_tc - configure net_device for multiple traffic classes
8434 8435 8436 8437 8438 8439 8440 8441
 *
 * @netdev: net device to configure
 * @tc: number of traffic classes to enable
 */
int ixgbe_setup_tc(struct net_device *dev, u8 tc)
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
	struct ixgbe_hw *hw = &adapter->hw;
8442
	bool pools;
8443 8444

	/* Hardware supports up to 8 traffic classes */
8445 8446 8447 8448
	if (tc > adapter->dcb_cfg.num_tcs.pg_tcs)
		return -EINVAL;

	if (hw->mac.type == ixgbe_mac_82598EB && tc && tc < MAX_TRAFFIC_CLASS)
8449 8450
		return -EINVAL;

8451 8452 8453 8454
	pools = (find_first_zero_bit(&adapter->fwd_bitmask, 32) > 1);
	if (tc && pools && adapter->num_rx_pools > IXGBE_MAX_DCBMACVLANS)
		return -EBUSY;

8455
	/* Hardware has to reinitialize queues and interrupts to
S
Stephen Hemminger 已提交
8456
	 * match packet buffer alignment. Unfortunately, the
8457 8458 8459 8460
	 * hardware is not flexible enough to do this dynamically.
	 */
	if (netif_running(dev))
		ixgbe_close(dev);
8461 8462 8463
	else
		ixgbe_reset(adapter);

8464 8465
	ixgbe_clear_interrupt_scheme(adapter);

8466
#ifdef CONFIG_IXGBE_DCB
8467
	if (tc) {
8468
		netdev_set_num_tc(dev, tc);
8469 8470
		ixgbe_set_prio_tc_map(adapter);

8471 8472
		adapter->flags |= IXGBE_FLAG_DCB_ENABLED;

8473 8474
		if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
			adapter->last_lfc_mode = adapter->hw.fc.requested_mode;
8475
			adapter->hw.fc.requested_mode = ixgbe_fc_none;
8476
		}
8477
	} else {
8478
		netdev_reset_tc(dev);
8479

8480 8481
		if (adapter->hw.mac.type == ixgbe_mac_82598EB)
			adapter->hw.fc.requested_mode = adapter->last_lfc_mode;
8482 8483 8484 8485 8486 8487 8488

		adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;

		adapter->temp_dcb_cfg.pfc_mode_enable = false;
		adapter->dcb_cfg.pfc_mode_enable = false;
	}

8489
	ixgbe_validate_rtr(adapter, tc);
8490 8491 8492 8493

#endif /* CONFIG_IXGBE_DCB */
	ixgbe_init_interrupt_scheme(adapter);

8494
	if (netif_running(dev))
8495
		return ixgbe_open(dev);
8496 8497 8498

	return 0;
}
E
Eric Dumazet 已提交
8499

8500 8501 8502
static int ixgbe_delete_clsu32(struct ixgbe_adapter *adapter,
			       struct tc_cls_u32_offload *cls)
{
8503
	u32 hdl = cls->knode.handle;
8504
	u32 uhtid = TC_U32_USERHTID(cls->knode.handle);
8505 8506 8507 8508 8509 8510
	u32 loc = cls->knode.handle & 0xfffff;
	int err = 0, i, j;
	struct ixgbe_jump_table *jump = NULL;

	if (loc > IXGBE_MAX_HW_ENTRIES)
		return -EINVAL;
8511

8512 8513 8514
	if ((uhtid != 0x800) && (uhtid >= IXGBE_MAX_LINK_HANDLE))
		return -EINVAL;

8515 8516 8517
	/* Clear this filter in the link data it is associated with */
	if (uhtid != 0x800) {
		jump = adapter->jump_tables[uhtid];
8518 8519 8520 8521 8522
		if (!jump)
			return -EINVAL;
		if (!test_bit(loc - 1, jump->child_loc_map))
			return -EINVAL;
		clear_bit(loc - 1, jump->child_loc_map);
8523 8524 8525 8526 8527 8528 8529 8530 8531 8532 8533 8534 8535 8536 8537 8538 8539 8540 8541 8542 8543 8544 8545 8546 8547 8548 8549
	}

	/* Check if the filter being deleted is a link */
	for (i = 1; i < IXGBE_MAX_LINK_HANDLE; i++) {
		jump = adapter->jump_tables[i];
		if (jump && jump->link_hdl == hdl) {
			/* Delete filters in the hardware in the child hash
			 * table associated with this link
			 */
			for (j = 0; j < IXGBE_MAX_HW_ENTRIES; j++) {
				if (!test_bit(j, jump->child_loc_map))
					continue;
				spin_lock(&adapter->fdir_perfect_lock);
				err = ixgbe_update_ethtool_fdir_entry(adapter,
								      NULL,
								      j + 1);
				spin_unlock(&adapter->fdir_perfect_lock);
				clear_bit(j, jump->child_loc_map);
			}
			/* Remove resources for this link */
			kfree(jump->input);
			kfree(jump->mask);
			kfree(jump);
			adapter->jump_tables[i] = NULL;
			return err;
		}
	}
8550

8551
	spin_lock(&adapter->fdir_perfect_lock);
8552
	err = ixgbe_update_ethtool_fdir_entry(adapter, NULL, loc);
8553 8554 8555 8556
	spin_unlock(&adapter->fdir_perfect_lock);
	return err;
}

8557 8558 8559 8560
static int ixgbe_configure_clsu32_add_hnode(struct ixgbe_adapter *adapter,
					    __be16 protocol,
					    struct tc_cls_u32_offload *cls)
{
8561 8562 8563 8564 8565
	u32 uhtid = TC_U32_USERHTID(cls->hnode.handle);

	if (uhtid >= IXGBE_MAX_LINK_HANDLE)
		return -EINVAL;

8566 8567 8568 8569 8570 8571
	/* This ixgbe devices do not support hash tables at the moment
	 * so abort when given hash tables.
	 */
	if (cls->hnode.divisor > 0)
		return -EINVAL;

8572
	set_bit(uhtid - 1, &adapter->tables);
8573 8574 8575 8576 8577 8578
	return 0;
}

static int ixgbe_configure_clsu32_del_hnode(struct ixgbe_adapter *adapter,
					    struct tc_cls_u32_offload *cls)
{
8579 8580 8581 8582 8583 8584
	u32 uhtid = TC_U32_USERHTID(cls->hnode.handle);

	if (uhtid >= IXGBE_MAX_LINK_HANDLE)
		return -EINVAL;

	clear_bit(uhtid - 1, &adapter->tables);
8585 8586 8587
	return 0;
}

8588
#ifdef CONFIG_NET_CLS_ACT
D
David Ahern 已提交
8589 8590 8591 8592 8593 8594 8595 8596 8597 8598 8599 8600 8601 8602 8603 8604 8605 8606 8607 8608 8609 8610 8611 8612 8613 8614
struct upper_walk_data {
	struct ixgbe_adapter *adapter;
	u64 action;
	int ifindex;
	u8 queue;
};

static int get_macvlan_queue(struct net_device *upper, void *_data)
{
	if (netif_is_macvlan(upper)) {
		struct macvlan_dev *dfwd = netdev_priv(upper);
		struct ixgbe_fwd_adapter *vadapter = dfwd->fwd_priv;
		struct upper_walk_data *data = _data;
		struct ixgbe_adapter *adapter = data->adapter;
		int ifindex = data->ifindex;

		if (vadapter && vadapter->netdev->ifindex == ifindex) {
			data->queue = adapter->rx_ring[vadapter->rx_base_queue]->reg_idx;
			data->action = data->queue;
			return 1;
		}
	}

	return 0;
}

8615 8616 8617 8618
static int handle_redirect_action(struct ixgbe_adapter *adapter, int ifindex,
				  u8 *queue, u64 *action)
{
	unsigned int num_vfs = adapter->num_vfs, vf;
D
David Ahern 已提交
8619
	struct upper_walk_data data;
8620 8621 8622 8623 8624 8625 8626 8627 8628 8629 8630 8631 8632 8633 8634 8635 8636 8637
	struct net_device *upper;

	/* redirect to a SRIOV VF */
	for (vf = 0; vf < num_vfs; ++vf) {
		upper = pci_get_drvdata(adapter->vfinfo[vf].vfdev);
		if (upper->ifindex == ifindex) {
			if (adapter->num_rx_pools > 1)
				*queue = vf * 2;
			else
				*queue = vf * adapter->num_rx_queues_per_pool;

			*action = vf + 1;
			*action <<= ETHTOOL_RX_FLOW_SPEC_RING_VF_OFF;
			return 0;
		}
	}

	/* redirect to a offloaded macvlan netdev */
D
David Ahern 已提交
8638 8639 8640 8641 8642 8643 8644 8645 8646 8647
	data.adapter = adapter;
	data.ifindex = ifindex;
	data.action = 0;
	data.queue = 0;
	if (netdev_walk_all_upper_dev_rcu(adapter->netdev,
					  get_macvlan_queue, &data)) {
		*action = data.action;
		*queue = data.queue;

		return 0;
8648 8649 8650 8651 8652 8653 8654 8655 8656
	}

	return -EINVAL;
}

static int parse_tc_actions(struct ixgbe_adapter *adapter,
			    struct tcf_exts *exts, u64 *action, u8 *queue)
{
	const struct tc_action *a;
8657
	LIST_HEAD(actions);
8658 8659 8660 8661 8662
	int err;

	if (tc_no_actions(exts))
		return -EINVAL;

8663 8664
	tcf_exts_to_list(exts, &actions);
	list_for_each_entry(a, &actions, list) {
8665 8666 8667 8668 8669 8670 8671 8672 8673

		/* Drop action */
		if (is_tcf_gact_shot(a)) {
			*action = IXGBE_FDIR_DROP_QUEUE;
			*queue = IXGBE_FDIR_DROP_QUEUE;
			return 0;
		}

		/* Redirect to a VF or a offloaded macvlan */
8674
		if (is_tcf_mirred_egress_redirect(a)) {
8675 8676 8677 8678 8679 8680 8681 8682 8683 8684 8685 8686 8687 8688 8689 8690 8691 8692 8693
			int ifindex = tcf_mirred_ifindex(a);

			err = handle_redirect_action(adapter, ifindex, queue,
						     action);
			if (err == 0)
				return err;
		}
	}

	return -EINVAL;
}
#else
static int parse_tc_actions(struct ixgbe_adapter *adapter,
			    struct tcf_exts *exts, u64 *action, u8 *queue)
{
	return -EINVAL;
}
#endif /* CONFIG_NET_CLS_ACT */

8694 8695 8696 8697 8698 8699 8700 8701 8702 8703 8704 8705 8706 8707 8708 8709 8710 8711 8712 8713 8714 8715 8716 8717 8718 8719 8720 8721 8722 8723 8724 8725 8726 8727 8728 8729 8730 8731 8732 8733 8734 8735 8736 8737 8738 8739 8740 8741 8742
static int ixgbe_clsu32_build_input(struct ixgbe_fdir_filter *input,
				    union ixgbe_atr_input *mask,
				    struct tc_cls_u32_offload *cls,
				    struct ixgbe_mat_field *field_ptr,
				    struct ixgbe_nexthdr *nexthdr)
{
	int i, j, off;
	__be32 val, m;
	bool found_entry = false, found_jump_field = false;

	for (i = 0; i < cls->knode.sel->nkeys; i++) {
		off = cls->knode.sel->keys[i].off;
		val = cls->knode.sel->keys[i].val;
		m = cls->knode.sel->keys[i].mask;

		for (j = 0; field_ptr[j].val; j++) {
			if (field_ptr[j].off == off) {
				field_ptr[j].val(input, mask, val, m);
				input->filter.formatted.flow_type |=
					field_ptr[j].type;
				found_entry = true;
				break;
			}
		}
		if (nexthdr) {
			if (nexthdr->off == cls->knode.sel->keys[i].off &&
			    nexthdr->val == cls->knode.sel->keys[i].val &&
			    nexthdr->mask == cls->knode.sel->keys[i].mask)
				found_jump_field = true;
			else
				continue;
		}
	}

	if (nexthdr && !found_jump_field)
		return -EINVAL;

	if (!found_entry)
		return 0;

	mask->formatted.flow_type = IXGBE_ATR_L4TYPE_IPV6_MASK |
				    IXGBE_ATR_L4TYPE_MASK;

	if (input->filter.formatted.flow_type == IXGBE_ATR_FLOW_TYPE_IPV4)
		mask->formatted.flow_type &= IXGBE_ATR_L4TYPE_IPV6_MASK;

	return 0;
}

8743 8744 8745 8746 8747 8748 8749
static int ixgbe_configure_clsu32(struct ixgbe_adapter *adapter,
				  __be16 protocol,
				  struct tc_cls_u32_offload *cls)
{
	u32 loc = cls->knode.handle & 0xfffff;
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_mat_field *field_ptr;
8750 8751 8752 8753
	struct ixgbe_fdir_filter *input = NULL;
	union ixgbe_atr_input *mask = NULL;
	struct ixgbe_jump_table *jump = NULL;
	int i, err = -EINVAL;
8754
	u8 queue;
8755
	u32 uhtid, link_uhtid;
8756

8757 8758
	uhtid = TC_U32_USERHTID(cls->knode.handle);
	link_uhtid = TC_U32_USERHTID(cls->knode.link_handle);
8759

8760
	/* At the moment cls_u32 jumps to network layer and skips past
8761 8762 8763
	 * L2 headers. The canonical method to match L2 frames is to use
	 * negative values. However this is error prone at best but really
	 * just broken because there is no way to "know" what sort of hdr
8764
	 * is in front of the network layer. Fix cls_u32 to support L2
8765 8766 8767
	 * headers when needed.
	 */
	if (protocol != htons(ETH_P_IP))
8768
		return err;
8769 8770 8771

	if (loc >= ((1024 << adapter->fdir_pballoc) - 2)) {
		e_err(drv, "Location out of range\n");
8772
		return err;
8773 8774 8775 8776 8777 8778 8779 8780 8781
	}

	/* cls u32 is a graph starting at root node 0x800. The driver tracks
	 * links and also the fields used to advance the parser across each
	 * link (e.g. nexthdr/eat parameters from 'tc'). This way we can map
	 * the u32 graph onto the hardware parse graph denoted in ixgbe_model.h
	 * To add support for new nodes update ixgbe_model.h parse structures
	 * this function _should_ be generic try not to hardcode values here.
	 */
8782
	if (uhtid == 0x800) {
8783
		field_ptr = (adapter->jump_tables[0])->mat;
8784
	} else {
8785
		if (uhtid >= IXGBE_MAX_LINK_HANDLE)
8786 8787 8788 8789
			return err;
		if (!adapter->jump_tables[uhtid])
			return err;
		field_ptr = (adapter->jump_tables[uhtid])->mat;
8790 8791 8792
	}

	if (!field_ptr)
8793
		return err;
8794

8795 8796 8797 8798 8799
	/* At this point we know the field_ptr is valid and need to either
	 * build cls_u32 link or attach filter. Because adding a link to
	 * a handle that does not exist is invalid and the same for adding
	 * rules to handles that don't exist.
	 */
8800

8801 8802
	if (link_uhtid) {
		struct ixgbe_nexthdr *nexthdr = ixgbe_ipv4_jumps;
8803

8804 8805 8806 8807 8808 8809
		if (link_uhtid >= IXGBE_MAX_LINK_HANDLE)
			return err;

		if (!test_bit(link_uhtid - 1, &adapter->tables))
			return err;

8810 8811 8812 8813 8814 8815 8816 8817 8818 8819 8820 8821
		/* Multiple filters as links to the same hash table are not
		 * supported. To add a new filter with the same next header
		 * but different match/jump conditions, create a new hash table
		 * and link to it.
		 */
		if (adapter->jump_tables[link_uhtid] &&
		    (adapter->jump_tables[link_uhtid])->link_hdl) {
			e_err(drv, "Link filter exists for link: %x\n",
			      link_uhtid);
			return err;
		}

8822 8823 8824 8825 8826 8827 8828 8829 8830 8831 8832 8833 8834 8835 8836 8837 8838
		for (i = 0; nexthdr[i].jump; i++) {
			if (nexthdr[i].o != cls->knode.sel->offoff ||
			    nexthdr[i].s != cls->knode.sel->offshift ||
			    nexthdr[i].m != cls->knode.sel->offmask)
				return err;

			jump = kzalloc(sizeof(*jump), GFP_KERNEL);
			if (!jump)
				return -ENOMEM;
			input = kzalloc(sizeof(*input), GFP_KERNEL);
			if (!input) {
				err = -ENOMEM;
				goto free_jump;
			}
			mask = kzalloc(sizeof(*mask), GFP_KERNEL);
			if (!mask) {
				err = -ENOMEM;
8839
				goto free_input;
8840 8841 8842
			}
			jump->input = input;
			jump->mask = mask;
8843 8844
			jump->link_hdl = cls->knode.handle;

8845 8846 8847 8848 8849
			err = ixgbe_clsu32_build_input(input, mask, cls,
						       field_ptr, &nexthdr[i]);
			if (!err) {
				jump->mat = nexthdr[i].jump;
				adapter->jump_tables[link_uhtid] = jump;
8850 8851 8852
				break;
			}
		}
8853
		return 0;
8854 8855
	}

8856 8857 8858 8859 8860 8861
	input = kzalloc(sizeof(*input), GFP_KERNEL);
	if (!input)
		return -ENOMEM;
	mask = kzalloc(sizeof(*mask), GFP_KERNEL);
	if (!mask) {
		err = -ENOMEM;
8862
		goto free_input;
8863
	}
8864

8865 8866 8867 8868 8869 8870 8871
	if ((uhtid != 0x800) && (adapter->jump_tables[uhtid])) {
		if ((adapter->jump_tables[uhtid])->input)
			memcpy(input, (adapter->jump_tables[uhtid])->input,
			       sizeof(*input));
		if ((adapter->jump_tables[uhtid])->mask)
			memcpy(mask, (adapter->jump_tables[uhtid])->mask,
			       sizeof(*mask));
8872 8873 8874 8875 8876 8877 8878 8879 8880 8881 8882 8883 8884 8885

		/* Lookup in all child hash tables if this location is already
		 * filled with a filter
		 */
		for (i = 1; i < IXGBE_MAX_LINK_HANDLE; i++) {
			struct ixgbe_jump_table *link = adapter->jump_tables[i];

			if (link && (test_bit(loc - 1, link->child_loc_map))) {
				e_err(drv, "Filter exists in location: %x\n",
				      loc);
				err = -EINVAL;
				goto err_out;
			}
		}
8886 8887 8888
	}
	err = ixgbe_clsu32_build_input(input, mask, cls, field_ptr, NULL);
	if (err)
8889 8890
		goto err_out;

8891 8892 8893
	err = parse_tc_actions(adapter, cls->knode.exts, &input->action,
			       &queue);
	if (err < 0)
8894 8895 8896 8897 8898 8899 8900
		goto err_out;

	input->sw_idx = loc;

	spin_lock(&adapter->fdir_perfect_lock);

	if (hlist_empty(&adapter->fdir_filter_list)) {
8901 8902
		memcpy(&adapter->fdir_mask, mask, sizeof(*mask));
		err = ixgbe_fdir_set_input_mask_82599(hw, mask);
8903 8904
		if (err)
			goto err_out_w_lock;
8905
	} else if (memcmp(&adapter->fdir_mask, mask, sizeof(*mask))) {
8906 8907 8908 8909
		err = -EINVAL;
		goto err_out_w_lock;
	}

8910
	ixgbe_atr_compute_perfect_hash_82599(&input->filter, mask);
8911 8912 8913 8914 8915 8916
	err = ixgbe_fdir_write_perfect_filter_82599(hw, &input->filter,
						    input->sw_idx, queue);
	if (!err)
		ixgbe_update_ethtool_fdir_entry(adapter, input, input->sw_idx);
	spin_unlock(&adapter->fdir_perfect_lock);

8917 8918
	if ((uhtid != 0x800) && (adapter->jump_tables[uhtid]))
		set_bit(loc - 1, (adapter->jump_tables[uhtid])->child_loc_map);
8919

8920
	kfree(mask);
8921 8922 8923 8924
	return err;
err_out_w_lock:
	spin_unlock(&adapter->fdir_perfect_lock);
err_out:
8925
	kfree(mask);
8926 8927
free_input:
	kfree(input);
8928 8929 8930
free_jump:
	kfree(jump);
	return err;
8931 8932
}

8933 8934
static int __ixgbe_setup_tc(struct net_device *dev, u32 handle, __be16 proto,
			    struct tc_to_netdev *tc)
8935
{
8936 8937 8938 8939 8940 8941 8942 8943 8944 8945 8946
	struct ixgbe_adapter *adapter = netdev_priv(dev);

	if (TC_H_MAJ(handle) == TC_H_MAJ(TC_H_INGRESS) &&
	    tc->type == TC_SETUP_CLSU32) {
		switch (tc->cls_u32->command) {
		case TC_CLSU32_NEW_KNODE:
		case TC_CLSU32_REPLACE_KNODE:
			return ixgbe_configure_clsu32(adapter,
						      proto, tc->cls_u32);
		case TC_CLSU32_DELETE_KNODE:
			return ixgbe_delete_clsu32(adapter, tc->cls_u32);
8947 8948 8949 8950 8951 8952 8953
		case TC_CLSU32_NEW_HNODE:
		case TC_CLSU32_REPLACE_HNODE:
			return ixgbe_configure_clsu32_add_hnode(adapter, proto,
								tc->cls_u32);
		case TC_CLSU32_DELETE_HNODE:
			return ixgbe_configure_clsu32_del_hnode(adapter,
								tc->cls_u32);
8954 8955 8956 8957 8958
		default:
			return -EINVAL;
		}
	}

8959
	if (tc->type != TC_SETUP_MQPRIO)
8960 8961
		return -EINVAL;

8962 8963 8964
	tc->mqprio->hw = TC_MQPRIO_HW_OFFLOAD_TCS;

	return ixgbe_setup_tc(dev, tc->mqprio->num_tc);
8965 8966
}

8967 8968 8969 8970 8971 8972 8973 8974 8975 8976 8977
#ifdef CONFIG_PCI_IOV
void ixgbe_sriov_reinit(struct ixgbe_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;

	rtnl_lock();
	ixgbe_setup_tc(netdev, netdev_get_num_tc(netdev));
	rtnl_unlock();
}

#endif
8978 8979 8980 8981 8982 8983 8984 8985 8986 8987
void ixgbe_do_reset(struct net_device *netdev)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

	if (netif_running(netdev))
		ixgbe_reinit_locked(adapter);
	else
		ixgbe_reset(adapter);
}

8988
static netdev_features_t ixgbe_fix_features(struct net_device *netdev,
8989
					    netdev_features_t features)
8990 8991 8992 8993
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

	/* If Rx checksum is disabled, then RSC/LRO should also be disabled */
8994 8995
	if (!(features & NETIF_F_RXCSUM))
		features &= ~NETIF_F_LRO;
8996

8997 8998 8999
	/* Turn off LRO if not RSC capable */
	if (!(adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE))
		features &= ~NETIF_F_LRO;
9000

9001
	return features;
9002 9003
}

9004
static int ixgbe_set_features(struct net_device *netdev,
9005
			      netdev_features_t features)
9006 9007
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
9008
	netdev_features_t changed = netdev->features ^ features;
9009 9010 9011
	bool need_reset = false;

	/* Make sure RSC matches LRO, reset if change */
9012 9013
	if (!(features & NETIF_F_LRO)) {
		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
9014
			need_reset = true;
9015 9016 9017 9018 9019 9020 9021 9022 9023 9024
		adapter->flags2 &= ~IXGBE_FLAG2_RSC_ENABLED;
	} else if ((adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE) &&
		   !(adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)) {
		if (adapter->rx_itr_setting == 1 ||
		    adapter->rx_itr_setting > IXGBE_MIN_RSC_ITR) {
			adapter->flags2 |= IXGBE_FLAG2_RSC_ENABLED;
			need_reset = true;
		} else if ((changed ^ features) & NETIF_F_LRO) {
			e_info(probe, "rx-usecs set too low, "
			       "disabling RSC\n");
9025 9026 9027 9028
		}
	}

	/*
9029 9030
	 * Check if Flow Director n-tuple support or hw_tc support was
	 * enabled or disabled.  If the state changed, we need to reset.
9031
	 */
9032
	if ((features & NETIF_F_NTUPLE) || (features & NETIF_F_HW_TC)) {
9033
		/* turn off ATR, enable perfect filters and reset */
9034 9035 9036
		if (!(adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE))
			need_reset = true;

9037 9038
		adapter->flags &= ~IXGBE_FLAG_FDIR_HASH_CAPABLE;
		adapter->flags |= IXGBE_FLAG_FDIR_PERFECT_CAPABLE;
9039
	} else {
9040 9041 9042 9043 9044 9045 9046
		/* turn off perfect filters, enable ATR and reset */
		if (adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE)
			need_reset = true;

		adapter->flags &= ~IXGBE_FLAG_FDIR_PERFECT_CAPABLE;

		/* We cannot enable ATR if SR-IOV is enabled */
9047 9048 9049 9050 9051 9052 9053 9054 9055 9056
		if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED ||
		    /* We cannot enable ATR if we have 2 or more tcs */
		    (netdev_get_num_tc(netdev) > 1) ||
		    /* We cannot enable ATR if RSS is disabled */
		    (adapter->ring_feature[RING_F_RSS].limit <= 1) ||
		    /* A sample rate of 0 indicates ATR disabled */
		    (!adapter->atr_sample_rate))
			; /* do nothing not supported */
		else /* otherwise supported and set the flag */
			adapter->flags |= IXGBE_FLAG_FDIR_HASH_CAPABLE;
9057 9058
	}

B
Ben Greear 已提交
9059 9060 9061
	if (changed & NETIF_F_RXALL)
		need_reset = true;

9062
	netdev->features = features;
9063 9064

	if ((adapter->flags & IXGBE_FLAG_VXLAN_OFFLOAD_CAPABLE)) {
9065 9066 9067 9068 9069 9070 9071 9072 9073 9074 9075 9076 9077 9078 9079 9080 9081
		if (features & NETIF_F_RXCSUM) {
			adapter->flags2 |= IXGBE_FLAG2_UDP_TUN_REREG_NEEDED;
		} else {
			u32 port_mask = IXGBE_VXLANCTRL_VXLAN_UDPPORT_MASK;

			ixgbe_clear_udp_tunnel_port(adapter, port_mask);
		}
	}

	if ((adapter->flags & IXGBE_FLAG_GENEVE_OFFLOAD_CAPABLE)) {
		if (features & NETIF_F_RXCSUM) {
			adapter->flags2 |= IXGBE_FLAG2_UDP_TUN_REREG_NEEDED;
		} else {
			u32 port_mask = IXGBE_VXLANCTRL_GENEVE_UDPPORT_MASK;

			ixgbe_clear_udp_tunnel_port(adapter, port_mask);
		}
9082 9083
	}

9084 9085
	if (need_reset)
		ixgbe_do_reset(netdev);
9086 9087 9088
	else if (changed & (NETIF_F_HW_VLAN_CTAG_RX |
			    NETIF_F_HW_VLAN_CTAG_FILTER))
		ixgbe_set_rx_mode(netdev);
9089 9090 9091 9092

	return 0;
}

9093
/**
9094
 * ixgbe_add_udp_tunnel_port - Get notifications about adding UDP tunnel ports
9095
 * @dev: The port's netdev
9096
 * @ti: Tunnel endpoint information
9097
 **/
9098 9099
static void ixgbe_add_udp_tunnel_port(struct net_device *dev,
				      struct udp_tunnel_info *ti)
9100 9101 9102
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
	struct ixgbe_hw *hw = &adapter->hw;
9103
	__be16 port = ti->port;
9104 9105
	u32 port_shift = 0;
	u32 reg;
9106

9107 9108 9109
	if (ti->sa_family != AF_INET)
		return;

9110 9111 9112 9113
	switch (ti->type) {
	case UDP_TUNNEL_TYPE_VXLAN:
		if (!(adapter->flags & IXGBE_FLAG_VXLAN_OFFLOAD_CAPABLE))
			return;
9114

9115 9116 9117 9118 9119 9120 9121 9122 9123 9124 9125 9126 9127 9128 9129 9130 9131 9132 9133 9134 9135 9136 9137 9138 9139 9140 9141
		if (adapter->vxlan_port == port)
			return;

		if (adapter->vxlan_port) {
			netdev_info(dev,
				    "VXLAN port %d set, not adding port %d\n",
				    ntohs(adapter->vxlan_port),
				    ntohs(port));
			return;
		}

		adapter->vxlan_port = port;
		break;
	case UDP_TUNNEL_TYPE_GENEVE:
		if (!(adapter->flags & IXGBE_FLAG_GENEVE_OFFLOAD_CAPABLE))
			return;

		if (adapter->geneve_port == port)
			return;

		if (adapter->geneve_port) {
			netdev_info(dev,
				    "GENEVE port %d set, not adding port %d\n",
				    ntohs(adapter->geneve_port),
				    ntohs(port));
			return;
		}
9142

9143 9144 9145 9146
		port_shift = IXGBE_VXLANCTRL_GENEVE_UDPPORT_SHIFT;
		adapter->geneve_port = port;
		break;
	default:
9147 9148 9149
		return;
	}

9150 9151
	reg = IXGBE_READ_REG(hw, IXGBE_VXLANCTRL) | ntohs(port) << port_shift;
	IXGBE_WRITE_REG(hw, IXGBE_VXLANCTRL, reg);
9152 9153 9154
}

/**
9155
 * ixgbe_del_udp_tunnel_port - Get notifications about removing UDP tunnel ports
9156
 * @dev: The port's netdev
9157
 * @ti: Tunnel endpoint information
9158
 **/
9159 9160
static void ixgbe_del_udp_tunnel_port(struct net_device *dev,
				      struct udp_tunnel_info *ti)
9161 9162
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
9163
	u32 port_mask;
9164

9165 9166
	if (ti->type != UDP_TUNNEL_TYPE_VXLAN &&
	    ti->type != UDP_TUNNEL_TYPE_GENEVE)
9167 9168
		return;

9169
	if (ti->sa_family != AF_INET)
9170 9171
		return;

9172 9173 9174 9175
	switch (ti->type) {
	case UDP_TUNNEL_TYPE_VXLAN:
		if (!(adapter->flags & IXGBE_FLAG_VXLAN_OFFLOAD_CAPABLE))
			return;
9176

9177 9178 9179 9180 9181 9182 9183 9184 9185 9186 9187 9188 9189 9190 9191 9192 9193 9194 9195 9196 9197
		if (adapter->vxlan_port != ti->port) {
			netdev_info(dev, "VXLAN port %d not found\n",
				    ntohs(ti->port));
			return;
		}

		port_mask = IXGBE_VXLANCTRL_VXLAN_UDPPORT_MASK;
		break;
	case UDP_TUNNEL_TYPE_GENEVE:
		if (!(adapter->flags & IXGBE_FLAG_GENEVE_OFFLOAD_CAPABLE))
			return;

		if (adapter->geneve_port != ti->port) {
			netdev_info(dev, "GENEVE port %d not found\n",
				    ntohs(ti->port));
			return;
		}

		port_mask = IXGBE_VXLANCTRL_GENEVE_UDPPORT_MASK;
		break;
	default:
9198 9199 9200
		return;
	}

9201 9202
	ixgbe_clear_udp_tunnel_port(adapter, port_mask);
	adapter->flags2 |= IXGBE_FLAG2_UDP_TUN_REREG_NEEDED;
9203 9204
}

9205
static int ixgbe_ndo_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
J
John Fastabend 已提交
9206
			     struct net_device *dev,
9207
			     const unsigned char *addr, u16 vid,
J
John Fastabend 已提交
9208 9209
			     u16 flags)
{
9210
	/* guarantee we can provide a unique filter for the unicast address */
9211
	if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) {
9212 9213 9214 9215
		struct ixgbe_adapter *adapter = netdev_priv(dev);
		u16 pool = VMDQ_P(0);

		if (netdev_uc_count(dev) >= ixgbe_available_rars(adapter, pool))
9216
			return -ENOMEM;
J
John Fastabend 已提交
9217 9218
	}

9219
	return ndo_dflt_fdb_add(ndm, tb, dev, addr, vid, flags);
J
John Fastabend 已提交
9220 9221
}

9222 9223 9224 9225 9226 9227 9228 9229 9230 9231
/**
 * ixgbe_configure_bridge_mode - set various bridge modes
 * @adapter - the private structure
 * @mode - requested bridge mode
 *
 * Configure some settings require for various bridge modes.
 **/
static int ixgbe_configure_bridge_mode(struct ixgbe_adapter *adapter,
				       __u16 mode)
{
9232 9233 9234 9235
	struct ixgbe_hw *hw = &adapter->hw;
	unsigned int p, num_pools;
	u32 vmdctl;

9236 9237
	switch (mode) {
	case BRIDGE_MODE_VEPA:
9238
		/* disable Tx loopback, rely on switch hairpin mode */
9239
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_PFDTXGSWC, 0);
9240 9241 9242 9243 9244 9245 9246 9247 9248 9249 9250 9251 9252 9253 9254 9255 9256 9257 9258

		/* must enable Rx switching replication to allow multicast
		 * packet reception on all VFs, and to enable source address
		 * pruning.
		 */
		vmdctl = IXGBE_READ_REG(hw, IXGBE_VMD_CTL);
		vmdctl |= IXGBE_VT_CTL_REPLEN;
		IXGBE_WRITE_REG(hw, IXGBE_VMD_CTL, vmdctl);

		/* enable Rx source address pruning. Note, this requires
		 * replication to be enabled or else it does nothing.
		 */
		num_pools = adapter->num_vfs + adapter->num_rx_pools;
		for (p = 0; p < num_pools; p++) {
			if (hw->mac.ops.set_source_address_pruning)
				hw->mac.ops.set_source_address_pruning(hw,
								       true,
								       p);
		}
9259 9260
		break;
	case BRIDGE_MODE_VEB:
9261
		/* enable Tx loopback for internal VF/PF communication */
9262 9263
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_PFDTXGSWC,
				IXGBE_PFDTXGSWC_VT_LBEN);
9264 9265 9266 9267 9268 9269 9270 9271 9272 9273 9274 9275 9276 9277 9278 9279 9280 9281 9282

		/* disable Rx switching replication unless we have SR-IOV
		 * virtual functions
		 */
		vmdctl = IXGBE_READ_REG(hw, IXGBE_VMD_CTL);
		if (!adapter->num_vfs)
			vmdctl &= ~IXGBE_VT_CTL_REPLEN;
		IXGBE_WRITE_REG(hw, IXGBE_VMD_CTL, vmdctl);

		/* disable Rx source address pruning, since we don't expect to
		 * be receiving external loopback of our transmitted frames.
		 */
		num_pools = adapter->num_vfs + adapter->num_rx_pools;
		for (p = 0; p < num_pools; p++) {
			if (hw->mac.ops.set_source_address_pruning)
				hw->mac.ops.set_source_address_pruning(hw,
								       false,
								       p);
		}
9283 9284 9285 9286 9287 9288 9289 9290 9291 9292 9293 9294 9295
		break;
	default:
		return -EINVAL;
	}

	adapter->bridge_mode = mode;

	e_info(drv, "enabling bridge mode: %s\n",
	       mode == BRIDGE_MODE_VEPA ? "VEPA" : "VEB");

	return 0;
}

9296
static int ixgbe_ndo_bridge_setlink(struct net_device *dev,
9297
				    struct nlmsghdr *nlh, u16 flags)
9298 9299 9300 9301 9302 9303 9304 9305 9306
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
	struct nlattr *attr, *br_spec;
	int rem;

	if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
		return -EOPNOTSUPP;

	br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
9307 9308
	if (!br_spec)
		return -EINVAL;
9309 9310

	nla_for_each_nested(attr, br_spec, rem) {
9311
		int status;
9312 9313 9314 9315 9316
		__u16 mode;

		if (nla_type(attr) != IFLA_BRIDGE_MODE)
			continue;

9317 9318 9319
		if (nla_len(attr) < sizeof(mode))
			return -EINVAL;

9320
		mode = nla_get_u16(attr);
9321 9322 9323
		status = ixgbe_configure_bridge_mode(adapter, mode);
		if (status)
			return status;
9324 9325

		break;
9326 9327 9328 9329 9330 9331
	}

	return 0;
}

static int ixgbe_ndo_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq,
9332
				    struct net_device *dev,
9333
				    u32 filter_mask, int nlflags)
9334 9335 9336 9337 9338 9339
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);

	if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
		return 0;

9340
	return ndo_dflt_bridge_getlink(skb, pid, seq, dev,
9341 9342
				       adapter->bridge_mode, 0, 0, nlflags,
				       filter_mask, NULL);
9343 9344
}

9345 9346 9347 9348
static void *ixgbe_fwd_add(struct net_device *pdev, struct net_device *vdev)
{
	struct ixgbe_fwd_adapter *fwd_adapter = NULL;
	struct ixgbe_adapter *adapter = netdev_priv(pdev);
9349
	int used_pools = adapter->num_vfs + adapter->num_rx_pools;
9350
	unsigned int limit;
9351 9352
	int pool, err;

9353 9354 9355 9356 9357 9358 9359
	/* Hardware has a limited number of available pools. Each VF, and the
	 * PF require a pool. Check to ensure we don't attempt to use more
	 * then the available number of pools.
	 */
	if (used_pools >= IXGBE_MAX_VF_FUNCTIONS)
		return ERR_PTR(-EINVAL);

9360 9361 9362 9363 9364 9365 9366
#ifdef CONFIG_RPS
	if (vdev->num_rx_queues != vdev->num_tx_queues) {
		netdev_info(pdev, "%s: Only supports a single queue count for TX and RX\n",
			    vdev->name);
		return ERR_PTR(-EINVAL);
	}
#endif
9367
	/* Check for hardware restriction on number of rx/tx queues */
9368
	if (vdev->num_tx_queues > IXGBE_MAX_L2A_QUEUES ||
9369 9370 9371 9372 9373 9374 9375 9376 9377 9378 9379 9380
	    vdev->num_tx_queues == IXGBE_BAD_L2A_QUEUE) {
		netdev_info(pdev,
			    "%s: Supports RX/TX Queue counts 1,2, and 4\n",
			    pdev->name);
		return ERR_PTR(-EINVAL);
	}

	if (((adapter->flags & IXGBE_FLAG_DCB_ENABLED) &&
	      adapter->num_rx_pools > IXGBE_MAX_DCBMACVLANS - 1) ||
	    (adapter->num_rx_pools > IXGBE_MAX_MACVLANS))
		return ERR_PTR(-EBUSY);

9381
	fwd_adapter = kzalloc(sizeof(*fwd_adapter), GFP_KERNEL);
9382 9383 9384 9385 9386 9387
	if (!fwd_adapter)
		return ERR_PTR(-ENOMEM);

	pool = find_first_zero_bit(&adapter->fwd_bitmask, 32);
	adapter->num_rx_pools++;
	set_bit(pool, &adapter->fwd_bitmask);
9388
	limit = find_last_bit(&adapter->fwd_bitmask, 32);
9389 9390 9391

	/* Enable VMDq flag so device will be set in VM mode */
	adapter->flags |= IXGBE_FLAG_VMDQ_ENABLED | IXGBE_FLAG_SRIOV_ENABLED;
9392
	adapter->ring_feature[RING_F_VMDQ].limit = limit + 1;
9393
	adapter->ring_feature[RING_F_RSS].limit = vdev->num_tx_queues;
9394 9395 9396 9397 9398 9399 9400

	/* Force reinit of ring allocation with VMDQ enabled */
	err = ixgbe_setup_tc(pdev, netdev_get_num_tc(pdev));
	if (err)
		goto fwd_add_err;
	fwd_adapter->pool = pool;
	fwd_adapter->real_adapter = adapter;
9401 9402 9403 9404 9405 9406 9407 9408

	if (netif_running(pdev)) {
		err = ixgbe_fwd_ring_up(vdev, fwd_adapter);
		if (err)
			goto fwd_add_err;
		netif_tx_start_all_queues(vdev);
	}

9409 9410 9411 9412 9413 9414 9415 9416 9417 9418 9419 9420 9421 9422 9423
	return fwd_adapter;
fwd_add_err:
	/* unwind counter and free adapter struct */
	netdev_info(pdev,
		    "%s: dfwd hardware acceleration failed\n", vdev->name);
	clear_bit(pool, &adapter->fwd_bitmask);
	adapter->num_rx_pools--;
	kfree(fwd_adapter);
	return ERR_PTR(err);
}

static void ixgbe_fwd_del(struct net_device *pdev, void *priv)
{
	struct ixgbe_fwd_adapter *fwd_adapter = priv;
	struct ixgbe_adapter *adapter = fwd_adapter->real_adapter;
9424
	unsigned int limit;
9425 9426 9427 9428

	clear_bit(fwd_adapter->pool, &adapter->fwd_bitmask);
	adapter->num_rx_pools--;

9429 9430
	limit = find_last_bit(&adapter->fwd_bitmask, 32);
	adapter->ring_feature[RING_F_VMDQ].limit = limit + 1;
9431 9432 9433 9434 9435 9436 9437 9438 9439 9440
	ixgbe_fwd_ring_down(fwd_adapter->netdev, fwd_adapter);
	ixgbe_setup_tc(pdev, netdev_get_num_tc(pdev));
	netdev_dbg(pdev, "pool %i:%i queues %i:%i VSI bitmask %lx\n",
		   fwd_adapter->pool, adapter->num_rx_pools,
		   fwd_adapter->rx_base_queue,
		   fwd_adapter->rx_base_queue + adapter->num_rx_queues_per_pool,
		   adapter->fwd_bitmask);
	kfree(fwd_adapter);
}

9441 9442 9443
#define IXGBE_MAX_MAC_HDR_LEN		127
#define IXGBE_MAX_NETWORK_HDR_LEN	511

9444 9445 9446 9447
static netdev_features_t
ixgbe_features_check(struct sk_buff *skb, struct net_device *dev,
		     netdev_features_t features)
{
9448 9449 9450 9451 9452 9453 9454 9455 9456 9457 9458 9459 9460 9461 9462 9463 9464 9465 9466 9467 9468 9469 9470
	unsigned int network_hdr_len, mac_hdr_len;

	/* Make certain the headers can be described by a context descriptor */
	mac_hdr_len = skb_network_header(skb) - skb->data;
	if (unlikely(mac_hdr_len > IXGBE_MAX_MAC_HDR_LEN))
		return features & ~(NETIF_F_HW_CSUM |
				    NETIF_F_SCTP_CRC |
				    NETIF_F_HW_VLAN_CTAG_TX |
				    NETIF_F_TSO |
				    NETIF_F_TSO6);

	network_hdr_len = skb_checksum_start(skb) - skb_network_header(skb);
	if (unlikely(network_hdr_len >  IXGBE_MAX_NETWORK_HDR_LEN))
		return features & ~(NETIF_F_HW_CSUM |
				    NETIF_F_SCTP_CRC |
				    NETIF_F_TSO |
				    NETIF_F_TSO6);

	/* We can only support IPV4 TSO in tunnels if we can mangle the
	 * inner IP ID field, so strip TSO if MANGLEID is not supported.
	 */
	if (skb->encapsulation && !(features & NETIF_F_TSO_MANGLEID))
		features &= ~NETIF_F_TSO;
9471 9472 9473 9474

	return features;
}

9475
static const struct net_device_ops ixgbe_netdev_ops = {
9476
	.ndo_open		= ixgbe_open,
9477
	.ndo_stop		= ixgbe_close,
9478
	.ndo_start_xmit		= ixgbe_xmit_frame,
9479
	.ndo_select_queue	= ixgbe_select_queue,
A
Alexander Duyck 已提交
9480
	.ndo_set_rx_mode	= ixgbe_set_rx_mode,
9481 9482 9483 9484
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_set_mac_address	= ixgbe_set_mac,
	.ndo_change_mtu		= ixgbe_change_mtu,
	.ndo_tx_timeout		= ixgbe_tx_timeout,
9485
	.ndo_set_tx_maxrate	= ixgbe_tx_maxrate,
9486 9487
	.ndo_vlan_rx_add_vid	= ixgbe_vlan_rx_add_vid,
	.ndo_vlan_rx_kill_vid	= ixgbe_vlan_rx_kill_vid,
9488
	.ndo_do_ioctl		= ixgbe_ioctl,
9489 9490
	.ndo_set_vf_mac		= ixgbe_ndo_set_vf_mac,
	.ndo_set_vf_vlan	= ixgbe_ndo_set_vf_vlan,
9491
	.ndo_set_vf_rate	= ixgbe_ndo_set_vf_bw,
A
Alexander Duyck 已提交
9492
	.ndo_set_vf_spoofchk	= ixgbe_ndo_set_vf_spoofchk,
9493
	.ndo_set_vf_rss_query_en = ixgbe_ndo_set_vf_rss_query_en,
H
Hiroshi Shimamoto 已提交
9494
	.ndo_set_vf_trust	= ixgbe_ndo_set_vf_trust,
9495
	.ndo_get_vf_config	= ixgbe_ndo_get_vf_config,
E
Eric Dumazet 已提交
9496
	.ndo_get_stats64	= ixgbe_get_stats64,
9497
	.ndo_setup_tc		= __ixgbe_setup_tc,
9498 9499 9500
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= ixgbe_netpoll,
#endif
9501 9502
#ifdef IXGBE_FCOE
	.ndo_fcoe_ddp_setup = ixgbe_fcoe_ddp_get,
9503
	.ndo_fcoe_ddp_target = ixgbe_fcoe_ddp_target,
9504
	.ndo_fcoe_ddp_done = ixgbe_fcoe_ddp_put,
9505 9506
	.ndo_fcoe_enable = ixgbe_fcoe_enable,
	.ndo_fcoe_disable = ixgbe_fcoe_disable,
9507
	.ndo_fcoe_get_wwn = ixgbe_fcoe_get_wwn,
9508
	.ndo_fcoe_get_hbainfo = ixgbe_fcoe_get_hbainfo,
9509
#endif /* IXGBE_FCOE */
9510 9511
	.ndo_set_features = ixgbe_set_features,
	.ndo_fix_features = ixgbe_fix_features,
J
John Fastabend 已提交
9512
	.ndo_fdb_add		= ixgbe_ndo_fdb_add,
9513 9514
	.ndo_bridge_setlink	= ixgbe_ndo_bridge_setlink,
	.ndo_bridge_getlink	= ixgbe_ndo_bridge_getlink,
9515 9516
	.ndo_dfwd_add_station	= ixgbe_fwd_add,
	.ndo_dfwd_del_station	= ixgbe_fwd_del,
9517 9518
	.ndo_udp_tunnel_add	= ixgbe_add_udp_tunnel_port,
	.ndo_udp_tunnel_del	= ixgbe_del_udp_tunnel_port,
9519
	.ndo_features_check	= ixgbe_features_check,
9520 9521
};

9522 9523 9524 9525 9526 9527 9528 9529 9530 9531 9532
/**
 * ixgbe_enumerate_functions - Get the number of ports this device has
 * @adapter: adapter structure
 *
 * This function enumerates the phsyical functions co-located on a single slot,
 * in order to determine how many ports a device has. This is most useful in
 * determining the required GT/s of PCIe bandwidth necessary for optimal
 * performance.
 **/
static inline int ixgbe_enumerate_functions(struct ixgbe_adapter *adapter)
{
9533
	struct pci_dev *entry, *pdev = adapter->pdev;
9534 9535
	int physfns = 0;

9536 9537 9538
	/* Some cards can not use the generic count PCIe functions method,
	 * because they are behind a parent switch, so we hardcode these with
	 * the correct number of functions.
9539
	 */
9540
	if (ixgbe_pcie_from_parent(&adapter->hw))
9541
		physfns = 4;
9542 9543 9544

	list_for_each_entry(entry, &adapter->pdev->bus->devices, bus_list) {
		/* don't count virtual functions */
9545 9546 9547 9548 9549 9550 9551 9552 9553 9554 9555 9556 9557 9558
		if (entry->is_virtfn)
			continue;

		/* When the devices on the bus don't all match our device ID,
		 * we can't reliably determine the correct number of
		 * functions. This can occur if a function has been direct
		 * attached to a virtual machine using VT-d, for example. In
		 * this case, simply return -1 to indicate this.
		 */
		if ((entry->vendor != pdev->vendor) ||
		    (entry->device != pdev->device))
			return -1;

		physfns++;
9559 9560 9561 9562 9563
	}

	return physfns;
}

9564 9565
/**
 * ixgbe_wol_supported - Check whether device supports WoL
9566
 * @adapter: the adapter private structure
9567 9568 9569 9570 9571 9572 9573
 * @device_id: the device ID
 * @subdev_id: the subsystem device ID
 *
 * This function is used by probe and ethtool to determine
 * which devices have WoL support
 *
 **/
9574 9575
bool ixgbe_wol_supported(struct ixgbe_adapter *adapter, u16 device_id,
			 u16 subdevice_id)
9576 9577 9578 9579
{
	struct ixgbe_hw *hw = &adapter->hw;
	u16 wol_cap = adapter->eeprom_cap & IXGBE_DEVICE_CAPS_WOL_MASK;

9580 9581 9582 9583 9584 9585 9586 9587 9588 9589 9590 9591 9592
	/* WOL not supported on 82598 */
	if (hw->mac.type == ixgbe_mac_82598EB)
		return false;

	/* check eeprom to see if WOL is enabled for X540 and newer */
	if (hw->mac.type >= ixgbe_mac_X540) {
		if ((wol_cap == IXGBE_DEVICE_CAPS_WOL_PORT0_1) ||
		    ((wol_cap == IXGBE_DEVICE_CAPS_WOL_PORT0) &&
		     (hw->bus.func == 0)))
			return true;
	}

	/* WOL is determined based on device IDs for 82599 MACs */
9593 9594 9595 9596 9597
	switch (device_id) {
	case IXGBE_DEV_ID_82599_SFP:
		/* Only these subdevices could supports WOL */
		switch (subdevice_id) {
		case IXGBE_SUBDEV_ID_82599_560FLR:
9598 9599 9600
		case IXGBE_SUBDEV_ID_82599_LOM_SNAP6:
		case IXGBE_SUBDEV_ID_82599_SFP_WOL0:
		case IXGBE_SUBDEV_ID_82599_SFP_2OCP:
9601 9602 9603
			/* only support first port */
			if (hw->bus.func != 0)
				break;
9604
		case IXGBE_SUBDEV_ID_82599_SP_560FLR:
9605
		case IXGBE_SUBDEV_ID_82599_SFP:
9606
		case IXGBE_SUBDEV_ID_82599_RNDC:
9607
		case IXGBE_SUBDEV_ID_82599_ECNA_DP:
9608 9609 9610
		case IXGBE_SUBDEV_ID_82599_SFP_1OCP:
		case IXGBE_SUBDEV_ID_82599_SFP_LOM_OEM1:
		case IXGBE_SUBDEV_ID_82599_SFP_LOM_OEM2:
9611
			return true;
9612 9613
		}
		break;
9614
	case IXGBE_DEV_ID_82599EN_SFP:
9615
		/* Only these subdevices support WOL */
9616 9617
		switch (subdevice_id) {
		case IXGBE_SUBDEV_ID_82599EN_SFP_OCP1:
9618
			return true;
9619 9620
		}
		break;
9621 9622 9623
	case IXGBE_DEV_ID_82599_COMBO_BACKPLANE:
		/* All except this subdevice support WOL */
		if (subdevice_id != IXGBE_SUBDEV_ID_82599_KX4_KR_MEZZ)
9624
			return true;
9625 9626
		break;
	case IXGBE_DEV_ID_82599_KX4:
9627 9628
		return  true;
	default:
9629 9630 9631
		break;
	}

9632
	return false;
9633 9634
}

9635 9636 9637 9638 9639 9640 9641 9642 9643 9644 9645
/**
 * ixgbe_probe - Device Initialization Routine
 * @pdev: PCI device information struct
 * @ent: entry in ixgbe_pci_tbl
 *
 * Returns 0 on success, negative on failure
 *
 * ixgbe_probe initializes an adapter identified by a pci_dev structure.
 * The OS initialization, configuring of the adapter private structure,
 * and a hardware reset occur.
 **/
9646
static int ixgbe_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
9647 9648 9649 9650 9651
{
	struct net_device *netdev;
	struct ixgbe_adapter *adapter = NULL;
	struct ixgbe_hw *hw;
	const struct ixgbe_info *ii = ixgbe_info_tbl[ent->driver_data];
9652
	int i, err, pci_using_dac, expected_gts;
9653
	unsigned int indices = MAX_TX_QUEUES;
9654
	u8 part_str[IXGBE_PBANUM_LENGTH];
9655
	bool disable_dev = false;
9656 9657 9658
#ifdef IXGBE_FCOE
	u16 device_caps;
#endif
9659
	u32 eec;
9660

9661 9662 9663 9664 9665 9666 9667 9668 9669
	/* Catch broken hardware that put the wrong VF device ID in
	 * the PCIe SR-IOV capability.
	 */
	if (pdev->is_virtfn) {
		WARN(1, KERN_ERR "%s (%hx:%hx) should not be a VF!\n",
		     pci_name(pdev), pdev->vendor, pdev->device);
		return -EINVAL;
	}

9670
	err = pci_enable_device_mem(pdev);
9671 9672 9673
	if (err)
		return err;

9674
	if (!dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64))) {
9675 9676
		pci_using_dac = 1;
	} else {
9677
		err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
9678
		if (err) {
9679 9680 9681
			dev_err(&pdev->dev,
				"No usable DMA configuration, aborting\n");
			goto err_dma;
9682 9683 9684 9685
		}
		pci_using_dac = 0;
	}

9686
	err = pci_request_mem_regions(pdev, ixgbe_driver_name);
9687
	if (err) {
9688 9689
		dev_err(&pdev->dev,
			"pci_request_selected_regions failed 0x%x\n", err);
9690 9691 9692
		goto err_pci_reg;
	}

9693
	pci_enable_pcie_error_reporting(pdev);
9694

9695
	pci_set_master(pdev);
9696
	pci_save_state(pdev);
9697

9698
	if (ii->mac == ixgbe_mac_82598EB) {
9699
#ifdef CONFIG_IXGBE_DCB
9700 9701 9702 9703
		/* 8 TC w/ 4 queues per TC */
		indices = 4 * MAX_TRAFFIC_CLASS;
#else
		indices = IXGBE_MAX_RSS_INDICES;
9704
#endif
9705
	}
9706

9707
	netdev = alloc_etherdev_mq(sizeof(struct ixgbe_adapter), indices);
9708 9709 9710 9711 9712 9713 9714 9715 9716 9717 9718 9719 9720
	if (!netdev) {
		err = -ENOMEM;
		goto err_alloc_etherdev;
	}

	SET_NETDEV_DEV(netdev, &pdev->dev);

	adapter = netdev_priv(netdev);

	adapter->netdev = netdev;
	adapter->pdev = pdev;
	hw = &adapter->hw;
	hw->back = adapter;
9721
	adapter->msg_enable = netif_msg_init(debug, DEFAULT_MSG_ENABLE);
9722

9723
	hw->hw_addr = ioremap(pci_resource_start(pdev, 0),
9724
			      pci_resource_len(pdev, 0));
9725
	adapter->io_addr = hw->hw_addr;
9726 9727 9728 9729 9730
	if (!hw->hw_addr) {
		err = -EIO;
		goto err_ioremap;
	}

9731
	netdev->netdev_ops = &ixgbe_netdev_ops;
9732 9733
	ixgbe_set_ethtool_ops(netdev);
	netdev->watchdog_timeo = 5 * HZ;
9734
	strlcpy(netdev->name, pci_name(pdev), sizeof(netdev->name));
9735 9736

	/* Setup hw api */
9737
	hw->mac.ops   = *ii->mac_ops;
9738
	hw->mac.type  = ii->mac;
9739
	hw->mvals     = ii->mvals;
9740 9741
	if (ii->link_ops)
		hw->link.ops  = *ii->link_ops;
9742

9743
	/* EEPROM */
9744
	hw->eeprom.ops = *ii->eeprom_ops;
9745
	eec = IXGBE_READ_REG(hw, IXGBE_EEC(hw));
9746 9747 9748 9749
	if (ixgbe_removed(hw->hw_addr)) {
		err = -EIO;
		goto err_ioremap;
	}
9750
	/* If EEPROM is valid (bit 8 = 1), use default otherwise use bit bang */
J
Jacob Keller 已提交
9751
	if (!(eec & BIT(8)))
9752 9753 9754
		hw->eeprom.ops.read = &ixgbe_read_eeprom_bit_bang_generic;

	/* PHY */
9755
	hw->phy.ops = *ii->phy_ops;
D
Donald Skidmore 已提交
9756
	hw->phy.sfp_type = ixgbe_sfp_type_unknown;
9757 9758 9759 9760 9761 9762 9763
	/* ixgbe_identify_phy_generic will set prtad and mmds properly */
	hw->phy.mdio.prtad = MDIO_PRTAD_NONE;
	hw->phy.mdio.mmds = 0;
	hw->phy.mdio.mode_support = MDIO_SUPPORTS_C45 | MDIO_EMULATE_C22;
	hw->phy.mdio.dev = netdev;
	hw->phy.mdio.mdio_read = ixgbe_mdio_read;
	hw->phy.mdio.mdio_write = ixgbe_mdio_write;
D
Donald Skidmore 已提交
9764

9765
	/* setup the private structure */
9766
	err = ixgbe_sw_init(adapter, ii);
9767 9768 9769
	if (err)
		goto err_sw_init;

9770 9771 9772 9773
	/* Make sure the SWFW semaphore is in a valid state */
	if (hw->mac.ops.init_swfw_sync)
		hw->mac.ops.init_swfw_sync(hw);

9774
	/* Make it possible the adapter to be woken up via WOL */
D
Don Skidmore 已提交
9775 9776 9777
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
9778 9779
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
9780
	case ixgbe_mac_x550em_a:
9781
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
D
Don Skidmore 已提交
9782 9783 9784 9785
		break;
	default:
		break;
	}
9786

9787 9788 9789 9790 9791 9792 9793
	/*
	 * If there is a fan on this device and it has failed log the
	 * failure.
	 */
	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE) {
		u32 esdp = IXGBE_READ_REG(hw, IXGBE_ESDP);
		if (esdp & IXGBE_ESDP_SDP1)
9794
			e_crit(probe, "Fan has stopped, replace the adapter\n");
9795 9796
	}

9797 9798 9799
	if (allow_unsupported_sfp)
		hw->allow_unsupported_sfp = allow_unsupported_sfp;

9800
	/* reset_hw fills in the perm_addr as well */
9801
	hw->phy.reset_if_overtemp = true;
9802
	err = hw->mac.ops.reset_hw(hw);
9803
	hw->phy.reset_if_overtemp = false;
9804
	ixgbe_set_eee_capable(adapter);
9805
	if (err == IXGBE_ERR_SFP_NOT_PRESENT) {
9806 9807
		err = 0;
	} else if (err == IXGBE_ERR_SFP_NOT_SUPPORTED) {
D
Don Skidmore 已提交
9808 9809
		e_dev_err("failed to load because an unsupported SFP+ or QSFP module type was detected.\n");
		e_dev_err("Reload the driver after installing a supported module.\n");
9810 9811
		goto err_sw_init;
	} else if (err) {
9812
		e_dev_err("HW Init failed: %d\n", err);
9813 9814 9815
		goto err_sw_init;
	}

9816
#ifdef CONFIG_PCI_IOV
9817 9818 9819 9820 9821
	/* SR-IOV not supported on the 82598 */
	if (adapter->hw.mac.type == ixgbe_mac_82598EB)
		goto skip_sriov;
	/* Mailbox */
	ixgbe_init_mbx_params_pf(hw);
9822
	hw->mbx.ops = ii->mbx_ops;
9823
	pci_sriov_set_totalvfs(pdev, IXGBE_MAX_VFS_DRV_LIMIT);
9824
	ixgbe_enable_sriov(adapter);
9825
skip_sriov:
9826

9827
#endif
9828
	netdev->features = NETIF_F_SG |
9829 9830 9831
			   NETIF_F_TSO |
			   NETIF_F_TSO6 |
			   NETIF_F_RXHASH |
9832
			   NETIF_F_RXCSUM |
9833 9834 9835 9836
			   NETIF_F_HW_CSUM;

#define IXGBE_GSO_PARTIAL_FEATURES (NETIF_F_GSO_GRE | \
				    NETIF_F_GSO_GRE_CSUM | \
9837
				    NETIF_F_GSO_IPXIP4 | \
9838
				    NETIF_F_GSO_IPXIP6 | \
9839 9840 9841 9842 9843 9844
				    NETIF_F_GSO_UDP_TUNNEL | \
				    NETIF_F_GSO_UDP_TUNNEL_CSUM)

	netdev->gso_partial_features = IXGBE_GSO_PARTIAL_FEATURES;
	netdev->features |= NETIF_F_GSO_PARTIAL |
			    IXGBE_GSO_PARTIAL_FEATURES;
9845

9846
	if (hw->mac.type >= ixgbe_mac_82599EB)
9847
		netdev->features |= NETIF_F_SCTP_CRC;
9848 9849

	/* copy netdev features into list of user selectable features */
9850
	netdev->hw_features |= netdev->features |
9851
			       NETIF_F_HW_VLAN_CTAG_FILTER |
9852 9853 9854
			       NETIF_F_HW_VLAN_CTAG_RX |
			       NETIF_F_HW_VLAN_CTAG_TX |
			       NETIF_F_RXALL |
9855 9856 9857 9858
			       NETIF_F_HW_L2FW_DOFFLOAD;

	if (hw->mac.type >= ixgbe_mac_82599EB)
		netdev->hw_features |= NETIF_F_NTUPLE |
9859
				       NETIF_F_HW_TC;
9860

9861 9862 9863
	if (pci_using_dac)
		netdev->features |= NETIF_F_HIGHDMA;

A
Alexander Duyck 已提交
9864 9865 9866 9867
	netdev->vlan_features |= netdev->features | NETIF_F_TSO_MANGLEID;
	netdev->hw_enc_features |= netdev->vlan_features;
	netdev->mpls_features |= NETIF_F_HW_CSUM;

9868 9869 9870 9871
	/* set this bit last since it cannot be part of vlan_features */
	netdev->features |= NETIF_F_HW_VLAN_CTAG_FILTER |
			    NETIF_F_HW_VLAN_CTAG_RX |
			    NETIF_F_HW_VLAN_CTAG_TX;
9872

9873
	netdev->priv_flags |= IFF_UNICAST_FLT;
9874
	netdev->priv_flags |= IFF_SUPP_NOFCS;
9875

9876 9877 9878 9879
	/* MTU range: 68 - 9710 */
	netdev->min_mtu = ETH_MIN_MTU;
	netdev->max_mtu = IXGBE_MAX_JUMBO_FRAME_SIZE - (ETH_HLEN + ETH_FCS_LEN);

J
Jeff Kirsher 已提交
9880
#ifdef CONFIG_IXGBE_DCB
9881
	if (adapter->flags & IXGBE_FLAG_DCB_CAPABLE)
9882
		netdev->dcbnl_ops = &ixgbe_dcbnl_ops;
9883 9884
#endif

9885
#ifdef IXGBE_FCOE
9886
	if (adapter->flags & IXGBE_FLAG_FCOE_CAPABLE) {
9887 9888
		unsigned int fcoe_l;

9889 9890
		if (hw->mac.ops.get_device_caps) {
			hw->mac.ops.get_device_caps(hw, &device_caps);
9891 9892
			if (device_caps & IXGBE_DEVICE_CAPS_FCOE_OFFLOADS)
				adapter->flags &= ~IXGBE_FLAG_FCOE_CAPABLE;
9893
		}
9894

9895 9896 9897

		fcoe_l = min_t(int, IXGBE_FCRETA_SIZE, num_online_cpus());
		adapter->ring_feature[RING_F_FCOE].limit = fcoe_l;
9898

9899 9900 9901
		netdev->features |= NETIF_F_FSO |
				    NETIF_F_FCOE_CRC;

9902 9903 9904
		netdev->vlan_features |= NETIF_F_FSO |
					 NETIF_F_FCOE_CRC |
					 NETIF_F_FCOE_MTU;
9905
	}
9906
#endif /* IXGBE_FCOE */
9907

9908 9909
	if (adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE)
		netdev->hw_features |= NETIF_F_LRO;
9910
	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
A
Alexander Duyck 已提交
9911 9912
		netdev->features |= NETIF_F_LRO;

9913
	/* make sure the EEPROM is good */
9914
	if (hw->eeprom.ops.validate_checksum(hw, NULL) < 0) {
9915
		e_dev_err("The EEPROM Checksum Is Not Valid\n");
9916
		err = -EIO;
9917
		goto err_sw_init;
9918 9919
	}

9920 9921
	eth_platform_get_mac_address(&adapter->pdev->dev,
				     adapter->hw.mac.perm_addr);
9922

9923 9924
	memcpy(netdev->dev_addr, hw->mac.perm_addr, netdev->addr_len);

9925
	if (!is_valid_ether_addr(netdev->dev_addr)) {
9926
		e_dev_err("invalid MAC address\n");
9927
		err = -EIO;
9928
		goto err_sw_init;
9929 9930
	}

9931 9932
	/* Set hw->mac.addr to permanent MAC address */
	ether_addr_copy(hw->mac.addr, hw->mac.perm_addr);
9933
	ixgbe_mac_set_default_filter(adapter);
9934

9935
	setup_timer(&adapter->service_timer, &ixgbe_service_timer,
A
Alexander Duyck 已提交
9936
		    (unsigned long) adapter);
9937

9938 9939 9940 9941
	if (ixgbe_removed(hw->hw_addr)) {
		err = -EIO;
		goto err_sw_init;
	}
9942
	INIT_WORK(&adapter->service_task, ixgbe_service_task);
9943
	set_bit(__IXGBE_SERVICE_INITED, &adapter->state);
9944
	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
9945

9946 9947 9948
	err = ixgbe_init_interrupt_scheme(adapter);
	if (err)
		goto err_sw_init;
9949

9950
	/* WOL not supported for all devices */
E
Emil Tantilov 已提交
9951
	adapter->wol = 0;
9952
	hw->eeprom.ops.read(hw, 0x2c, &adapter->eeprom_cap);
9953
	hw->wol_enabled = ixgbe_wol_supported(adapter, pdev->device,
D
Don Skidmore 已提交
9954
						pdev->subsystem_device);
9955
	if (hw->wol_enabled)
9956
		adapter->wol = IXGBE_WUFC_MAG;
E
Emil Tantilov 已提交
9957

9958 9959
	device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);

9960 9961 9962 9963
	/* save off EEPROM version number */
	hw->eeprom.ops.read(hw, 0x2e, &adapter->eeprom_verh);
	hw->eeprom.ops.read(hw, 0x2d, &adapter->eeprom_verl);

9964
	/* pick up the PCI bus settings for reporting later */
9965
	if (ixgbe_pcie_from_parent(hw))
9966
		ixgbe_get_parent_bus_info(adapter);
9967 9968
	else
		 hw->mac.ops.get_bus_info(hw);
9969

9970 9971 9972 9973 9974 9975 9976 9977 9978 9979 9980 9981
	/* calculate the expected PCIe bandwidth required for optimal
	 * performance. Note that some older parts will never have enough
	 * bandwidth due to being older generation PCIe parts. We clamp these
	 * parts to ensure no warning is displayed if it can't be fixed.
	 */
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
		expected_gts = min(ixgbe_enumerate_functions(adapter) * 10, 16);
		break;
	default:
		expected_gts = ixgbe_enumerate_functions(adapter) * 10;
		break;
9982
	}
9983 9984 9985 9986

	/* don't check link if we failed to enumerate functions */
	if (expected_gts > 0)
		ixgbe_check_minimum_link(adapter, expected_gts);
9987

9988
	err = ixgbe_read_pba_string_generic(hw, part_str, sizeof(part_str));
9989
	if (err)
9990
		strlcpy(part_str, "Unknown", sizeof(part_str));
9991 9992 9993
	if (ixgbe_is_sfp(hw) && hw->phy.sfp_type != ixgbe_sfp_type_not_present)
		e_dev_info("MAC: %d, PHY: %d, SFP+: %d, PBA No: %s\n",
			   hw->mac.type, hw->phy.type, hw->phy.sfp_type,
9994
			   part_str);
9995 9996 9997 9998 9999 10000
	else
		e_dev_info("MAC: %d, PHY: %d, PBA No: %s\n",
			   hw->mac.type, hw->phy.type, part_str);

	e_dev_info("%pM\n", netdev->dev_addr);

10001
	/* reset the hardware with the new settings */
10002 10003 10004
	err = hw->mac.ops.start_hw(hw);
	if (err == IXGBE_ERR_EEPROM_VERSION) {
		/* We are running on a pre-production device, log a warning */
10005 10006 10007 10008 10009 10010
		e_dev_warn("This device is a pre-production adapter/LOM. "
			   "Please be aware there may be issues associated "
			   "with your hardware.  If you are experiencing "
			   "problems please contact your Intel or hardware "
			   "representative who provided you with this "
			   "hardware.\n");
10011
	}
10012 10013 10014 10015 10016
	strcpy(netdev->name, "eth%d");
	err = register_netdev(netdev);
	if (err)
		goto err_register;

10017 10018
	pci_set_drvdata(pdev, adapter);

10019 10020
	/* power down the optics for 82599 SFP+ fiber */
	if (hw->mac.ops.disable_tx_laser)
10021 10022
		hw->mac.ops.disable_tx_laser(hw);

10023 10024 10025
	/* carrier off reporting is important to ethtool even BEFORE open */
	netif_carrier_off(netdev);

10026
#ifdef CONFIG_IXGBE_DCA
10027
	if (dca_add_requester(&pdev->dev) == 0) {
10028 10029 10030 10031
		adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
		ixgbe_setup_dca(adapter);
	}
#endif
10032
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
10033
		e_info(probe, "IOV is enabled with %d VFs\n", adapter->num_vfs);
10034 10035 10036 10037
		for (i = 0; i < adapter->num_vfs; i++)
			ixgbe_vf_configuration(pdev, (i | 0x10000000));
	}

10038 10039 10040
	/* firmware requires driver version to be 0xFFFFFFFF
	 * since os does not support feature
	 */
E
Emil Tantilov 已提交
10041
	if (hw->mac.ops.set_fw_drv_ver)
10042 10043 10044
		hw->mac.ops.set_fw_drv_ver(hw, 0xFF, 0xFF, 0xFF, 0xFF,
					   sizeof(ixgbe_driver_version) - 1,
					   ixgbe_driver_version);
E
Emil Tantilov 已提交
10045

10046 10047
	/* add san mac addr to netdev */
	ixgbe_add_sanmac_netdev(netdev);
10048

10049
	e_dev_info("%s\n", ixgbe_default_device_descr);
10050

10051
#ifdef CONFIG_IXGBE_HWMON
10052 10053
	if (ixgbe_sysfs_init(adapter))
		e_err(probe, "failed to allocate sysfs resources\n");
10054
#endif /* CONFIG_IXGBE_HWMON */
10055

C
Catherine Sullivan 已提交
10056 10057
	ixgbe_dbg_adapter_init(adapter);

10058 10059
	/* setup link for SFP devices with MNG FW, else wait for IXGBE_UP */
	if (ixgbe_mng_enabled(hw) && ixgbe_is_sfp(hw) && hw->mac.ops.setup_link)
10060 10061 10062 10063
		hw->mac.ops.setup_link(hw,
			IXGBE_LINK_SPEED_10GB_FULL | IXGBE_LINK_SPEED_1GB_FULL,
			true);

10064 10065 10066
	return 0;

err_register:
10067
	ixgbe_release_hw_control(adapter);
10068
	ixgbe_clear_interrupt_scheme(adapter);
10069
err_sw_init:
10070
	ixgbe_disable_sriov(adapter);
10071
	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
10072
	iounmap(adapter->io_addr);
10073
	kfree(adapter->jump_tables[0]);
10074
	kfree(adapter->mac_table);
10075
err_ioremap:
10076
	disable_dev = !test_and_set_bit(__IXGBE_DISABLED, &adapter->state);
10077 10078
	free_netdev(netdev);
err_alloc_etherdev:
10079
	pci_release_mem_regions(pdev);
10080 10081
err_pci_reg:
err_dma:
10082
	if (!adapter || disable_dev)
10083
		pci_disable_device(pdev);
10084 10085 10086 10087 10088 10089 10090 10091 10092 10093 10094 10095
	return err;
}

/**
 * ixgbe_remove - Device Removal Routine
 * @pdev: PCI device information struct
 *
 * ixgbe_remove is called by the PCI subsystem to alert the driver
 * that it should release a PCI device.  The could be caused by a
 * Hot-Plug event, or because the driver is going to be removed from
 * memory.
 **/
10096
static void ixgbe_remove(struct pci_dev *pdev)
10097
{
10098
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
10099
	struct net_device *netdev;
10100
	bool disable_dev;
10101
	int i;
10102

10103 10104 10105 10106 10107
	/* if !adapter then we already cleaned up in probe */
	if (!adapter)
		return;

	netdev  = adapter->netdev;
C
Catherine Sullivan 已提交
10108 10109
	ixgbe_dbg_adapter_exit(adapter);

10110
	set_bit(__IXGBE_REMOVING, &adapter->state);
10111
	cancel_work_sync(&adapter->service_task);
10112

10113

10114
#ifdef CONFIG_IXGBE_DCA
10115 10116 10117
	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED) {
		adapter->flags &= ~IXGBE_FLAG_DCA_ENABLED;
		dca_remove_requester(&pdev->dev);
10118 10119
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
				IXGBE_DCA_CTRL_DCA_DISABLE);
10120 10121 10122
	}

#endif
10123
#ifdef CONFIG_IXGBE_HWMON
10124
	ixgbe_sysfs_exit(adapter);
10125
#endif /* CONFIG_IXGBE_HWMON */
10126

10127 10128 10129
	/* remove the added san mac */
	ixgbe_del_sanmac_netdev(netdev);

10130
#ifdef CONFIG_PCI_IOV
10131
	ixgbe_disable_sriov(adapter);
10132
#endif
10133 10134 10135
	if (netdev->reg_state == NETREG_REGISTERED)
		unregister_netdev(netdev);

10136
	ixgbe_clear_interrupt_scheme(adapter);
10137

10138
	ixgbe_release_hw_control(adapter);
10139

10140 10141 10142 10143 10144
#ifdef CONFIG_DCB
	kfree(adapter->ixgbe_ieee_pfc);
	kfree(adapter->ixgbe_ieee_ets);

#endif
10145
	iounmap(adapter->io_addr);
10146
	pci_release_mem_regions(pdev);
10147

10148
	e_dev_info("complete\n");
10149

10150 10151 10152 10153 10154 10155 10156 10157
	for (i = 0; i < IXGBE_MAX_LINK_HANDLE; i++) {
		if (adapter->jump_tables[i]) {
			kfree(adapter->jump_tables[i]->input);
			kfree(adapter->jump_tables[i]->mask);
		}
		kfree(adapter->jump_tables[i]);
	}

10158
	kfree(adapter->mac_table);
10159
	disable_dev = !test_and_set_bit(__IXGBE_DISABLED, &adapter->state);
10160 10161
	free_netdev(netdev);

10162
	pci_disable_pcie_error_reporting(pdev);
10163

10164
	if (disable_dev)
10165
		pci_disable_device(pdev);
10166 10167 10168 10169 10170 10171 10172 10173 10174 10175 10176
}

/**
 * ixgbe_io_error_detected - called when PCI error is detected
 * @pdev: Pointer to PCI device
 * @state: The current pci connection state
 *
 * This function is called after a PCI bus error affecting
 * this device has been detected.
 */
static pci_ers_result_t ixgbe_io_error_detected(struct pci_dev *pdev,
10177
						pci_channel_state_t state)
10178
{
10179 10180
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
10181

10182
#ifdef CONFIG_PCI_IOV
10183
	struct ixgbe_hw *hw = &adapter->hw;
10184 10185 10186 10187 10188 10189 10190 10191 10192 10193
	struct pci_dev *bdev, *vfdev;
	u32 dw0, dw1, dw2, dw3;
	int vf, pos;
	u16 req_id, pf_func;

	if (adapter->hw.mac.type == ixgbe_mac_82598EB ||
	    adapter->num_vfs == 0)
		goto skip_bad_vf_detection;

	bdev = pdev->bus->self;
10194
	while (bdev && (pci_pcie_type(bdev) != PCI_EXP_TYPE_ROOT_PORT))
10195 10196 10197 10198 10199 10200 10201 10202 10203
		bdev = bdev->bus->self;

	if (!bdev)
		goto skip_bad_vf_detection;

	pos = pci_find_ext_capability(bdev, PCI_EXT_CAP_ID_ERR);
	if (!pos)
		goto skip_bad_vf_detection;

10204 10205 10206 10207 10208 10209
	dw0 = ixgbe_read_pci_cfg_dword(hw, pos + PCI_ERR_HEADER_LOG);
	dw1 = ixgbe_read_pci_cfg_dword(hw, pos + PCI_ERR_HEADER_LOG + 4);
	dw2 = ixgbe_read_pci_cfg_dword(hw, pos + PCI_ERR_HEADER_LOG + 8);
	dw3 = ixgbe_read_pci_cfg_dword(hw, pos + PCI_ERR_HEADER_LOG + 12);
	if (ixgbe_removed(hw->hw_addr))
		goto skip_bad_vf_detection;
10210 10211 10212 10213 10214 10215 10216 10217 10218 10219 10220 10221 10222 10223 10224 10225 10226 10227 10228 10229 10230 10231

	req_id = dw1 >> 16;
	/* On the 82599 if bit 7 of the requestor ID is set then it's a VF */
	if (!(req_id & 0x0080))
		goto skip_bad_vf_detection;

	pf_func = req_id & 0x01;
	if ((pf_func & 1) == (pdev->devfn & 1)) {
		unsigned int device_id;

		vf = (req_id & 0x7F) >> 1;
		e_dev_err("VF %d has caused a PCIe error\n", vf);
		e_dev_err("TLP: dw0: %8.8x\tdw1: %8.8x\tdw2: "
				"%8.8x\tdw3: %8.8x\n",
		dw0, dw1, dw2, dw3);
		switch (adapter->hw.mac.type) {
		case ixgbe_mac_82599EB:
			device_id = IXGBE_82599_VF_DEVICE_ID;
			break;
		case ixgbe_mac_X540:
			device_id = IXGBE_X540_VF_DEVICE_ID;
			break;
10232 10233 10234 10235 10236 10237
		case ixgbe_mac_X550:
			device_id = IXGBE_DEV_ID_X550_VF;
			break;
		case ixgbe_mac_X550EM_x:
			device_id = IXGBE_DEV_ID_X550EM_X_VF;
			break;
10238 10239 10240
		case ixgbe_mac_x550em_a:
			device_id = IXGBE_DEV_ID_X550EM_A_VF;
			break;
10241 10242 10243 10244 10245 10246
		default:
			device_id = 0;
			break;
		}

		/* Find the pci device of the offending VF */
J
Jon Mason 已提交
10247
		vfdev = pci_get_device(PCI_VENDOR_ID_INTEL, device_id, NULL);
10248 10249 10250
		while (vfdev) {
			if (vfdev->devfn == (req_id & 0xFF))
				break;
J
Jon Mason 已提交
10251
			vfdev = pci_get_device(PCI_VENDOR_ID_INTEL,
10252 10253 10254 10255 10256 10257 10258 10259
					       device_id, vfdev);
		}
		/*
		 * There's a slim chance the VF could have been hot plugged,
		 * so if it is no longer present we don't need to issue the
		 * VFLR.  Just clean up the AER in that case.
		 */
		if (vfdev) {
10260
			ixgbe_issue_vf_flr(adapter, vfdev);
G
Greg Rose 已提交
10261 10262
			/* Free device reference count */
			pci_dev_put(vfdev);
10263 10264 10265 10266 10267 10268 10269 10270 10271 10272 10273 10274 10275 10276 10277 10278 10279
		}

		pci_cleanup_aer_uncorrect_error_status(pdev);
	}

	/*
	 * Even though the error may have occurred on the other port
	 * we still need to increment the vf error reference count for
	 * both ports because the I/O resume function will be called
	 * for both of them.
	 */
	adapter->vferr_refcount++;

	return PCI_ERS_RESULT_RECOVERED;

skip_bad_vf_detection:
#endif /* CONFIG_PCI_IOV */
10280 10281 10282
	if (!test_bit(__IXGBE_SERVICE_INITED, &adapter->state))
		return PCI_ERS_RESULT_DISCONNECT;

10283
	rtnl_lock();
10284 10285
	netif_device_detach(netdev);

10286 10287
	if (state == pci_channel_io_perm_failure) {
		rtnl_unlock();
10288
		return PCI_ERS_RESULT_DISCONNECT;
10289
	}
10290

10291
	if (netif_running(netdev))
E
Emil Tantilov 已提交
10292
		ixgbe_close_suspend(adapter);
10293 10294 10295 10296

	if (!test_and_set_bit(__IXGBE_DISABLED, &adapter->state))
		pci_disable_device(pdev);
	rtnl_unlock();
10297

10298
	/* Request a slot reset. */
10299 10300 10301 10302 10303 10304 10305 10306 10307 10308 10309
	return PCI_ERS_RESULT_NEED_RESET;
}

/**
 * ixgbe_io_slot_reset - called after the pci bus has been reset.
 * @pdev: Pointer to PCI device
 *
 * Restart the card from scratch, as if from a cold-boot.
 */
static pci_ers_result_t ixgbe_io_slot_reset(struct pci_dev *pdev)
{
10310
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
10311 10312
	pci_ers_result_t result;
	int err;
10313

10314
	if (pci_enable_device_mem(pdev)) {
10315
		e_err(probe, "Cannot re-enable PCI device after reset.\n");
10316 10317
		result = PCI_ERS_RESULT_DISCONNECT;
	} else {
10318
		smp_mb__before_atomic();
10319
		clear_bit(__IXGBE_DISABLED, &adapter->state);
10320
		adapter->hw.hw_addr = adapter->io_addr;
10321 10322
		pci_set_master(pdev);
		pci_restore_state(pdev);
10323
		pci_save_state(pdev);
10324

10325
		pci_wake_from_d3(pdev, false);
10326

10327
		ixgbe_reset(adapter);
10328
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
10329 10330 10331 10332 10333
		result = PCI_ERS_RESULT_RECOVERED;
	}

	err = pci_cleanup_aer_uncorrect_error_status(pdev);
	if (err) {
10334 10335
		e_dev_err("pci_cleanup_aer_uncorrect_error_status "
			  "failed 0x%0x\n", err);
10336 10337
		/* non-fatal, continue */
	}
10338

10339
	return result;
10340 10341 10342 10343 10344 10345 10346 10347 10348 10349 10350
}

/**
 * ixgbe_io_resume - called when traffic can start flowing again.
 * @pdev: Pointer to PCI device
 *
 * This callback is called when the error recovery driver tells us that
 * its OK to resume normal operation.
 */
static void ixgbe_io_resume(struct pci_dev *pdev)
{
10351 10352
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
10353

10354 10355 10356 10357 10358 10359 10360 10361
#ifdef CONFIG_PCI_IOV
	if (adapter->vferr_refcount) {
		e_info(drv, "Resuming after VF err\n");
		adapter->vferr_refcount--;
		return;
	}

#endif
E
Emil Tantilov 已提交
10362
	rtnl_lock();
10363
	if (netif_running(netdev))
E
Emil Tantilov 已提交
10364
		ixgbe_open(netdev);
10365 10366

	netif_device_attach(netdev);
E
Emil Tantilov 已提交
10367
	rtnl_unlock();
10368 10369
}

10370
static const struct pci_error_handlers ixgbe_err_handler = {
10371 10372 10373 10374 10375 10376 10377 10378 10379
	.error_detected = ixgbe_io_error_detected,
	.slot_reset = ixgbe_io_slot_reset,
	.resume = ixgbe_io_resume,
};

static struct pci_driver ixgbe_driver = {
	.name     = ixgbe_driver_name,
	.id_table = ixgbe_pci_tbl,
	.probe    = ixgbe_probe,
10380
	.remove   = ixgbe_remove,
10381 10382 10383 10384 10385
#ifdef CONFIG_PM
	.suspend  = ixgbe_suspend,
	.resume   = ixgbe_resume,
#endif
	.shutdown = ixgbe_shutdown,
10386
	.sriov_configure = ixgbe_pci_sriov_configure,
10387 10388 10389 10390 10391 10392 10393 10394 10395 10396 10397 10398
	.err_handler = &ixgbe_err_handler
};

/**
 * ixgbe_init_module - Driver Registration Routine
 *
 * ixgbe_init_module is the first routine called when the driver is
 * loaded. All it does is register with the PCI subsystem.
 **/
static int __init ixgbe_init_module(void)
{
	int ret;
10399
	pr_info("%s - version %s\n", ixgbe_driver_string, ixgbe_driver_version);
10400
	pr_info("%s\n", ixgbe_copyright);
10401

10402 10403 10404 10405 10406 10407
	ixgbe_wq = create_singlethread_workqueue(ixgbe_driver_name);
	if (!ixgbe_wq) {
		pr_err("%s: Failed to create workqueue\n", ixgbe_driver_name);
		return -ENOMEM;
	}

C
Catherine Sullivan 已提交
10408 10409
	ixgbe_dbg_init();

10410 10411
	ret = pci_register_driver(&ixgbe_driver);
	if (ret) {
10412
		destroy_workqueue(ixgbe_wq);
10413 10414 10415 10416
		ixgbe_dbg_exit();
		return ret;
	}

10417
#ifdef CONFIG_IXGBE_DCA
10418 10419
	dca_register_notify(&dca_notifier);
#endif
10420

10421
	return 0;
10422
}
10423

10424 10425 10426 10427 10428 10429 10430 10431 10432 10433
module_init(ixgbe_init_module);

/**
 * ixgbe_exit_module - Driver Exit Cleanup Routine
 *
 * ixgbe_exit_module is called just before the driver is removed
 * from memory.
 **/
static void __exit ixgbe_exit_module(void)
{
10434
#ifdef CONFIG_IXGBE_DCA
10435 10436
	dca_unregister_notify(&dca_notifier);
#endif
10437
	pci_unregister_driver(&ixgbe_driver);
C
Catherine Sullivan 已提交
10438 10439

	ixgbe_dbg_exit();
10440 10441 10442 10443
	if (ixgbe_wq) {
		destroy_workqueue(ixgbe_wq);
		ixgbe_wq = NULL;
	}
10444
}
10445

10446
#ifdef CONFIG_IXGBE_DCA
10447
static int ixgbe_notify_dca(struct notifier_block *nb, unsigned long event,
10448
			    void *p)
10449 10450 10451 10452
{
	int ret_val;

	ret_val = driver_for_each_device(&ixgbe_driver.driver, NULL, &event,
10453
					 __ixgbe_notify_dca);
10454 10455 10456

	return ret_val ? NOTIFY_BAD : NOTIFY_DONE;
}
10457

10458
#endif /* CONFIG_IXGBE_DCA */
10459

10460 10461 10462
module_exit(ixgbe_exit_module);

/* ixgbe_main.c */