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

  Intel 10 Gigabit PCI Express Linux driver
4
  Copyright(c) 1999 - 2014 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 45
#include <net/checksum.h>
#include <net/ip6_checksum.h>
#include <linux/ethtool.h>
46
#include <linux/if.h>
47
#include <linux/if_vlan.h>
48
#include <linux/if_macvlan.h>
49
#include <linux/if_bridge.h>
50
#include <linux/prefetch.h>
51
#include <scsi/fc/fc_fcoe.h>
52 53 54

#include "ixgbe.h"
#include "ixgbe_common.h"
55
#include "ixgbe_dcb_82599.h"
56
#include "ixgbe_sriov.h"
57 58

char ixgbe_driver_name[] = "ixgbe";
S
Stephen Hemminger 已提交
59
static const char ixgbe_driver_string[] =
60
			      "Intel(R) 10 Gigabit PCI Express Network Driver";
61
#ifdef IXGBE_FCOE
62 63
char ixgbe_default_device_descr[] =
			      "Intel(R) 10 Gigabit Network Connection";
64 65 66 67
#else
static char ixgbe_default_device_descr[] =
			      "Intel(R) 10 Gigabit Network Connection";
#endif
D
Don Skidmore 已提交
68
#define DRV_VERSION "3.19.1-k"
S
Stephen Hemminger 已提交
69
const char ixgbe_driver_version[] = DRV_VERSION;
70
static const char ixgbe_copyright[] =
71
				"Copyright (c) 1999-2014 Intel Corporation.";
72 73

static const struct ixgbe_info *ixgbe_info_tbl[] = {
74
	[board_82598] = &ixgbe_82598_info,
75
	[board_82599] = &ixgbe_82599_info,
76
	[board_X540] = &ixgbe_X540_info,
77 78 79 80 81 82 83 84 85 86
};

/* 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) }
 */
87
static DEFINE_PCI_DEVICE_TABLE(ixgbe_pci_tbl) = {
88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113
	{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 },
114
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_QSFP_SF_QP), board_82599 },
115
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599EN_SFP), board_82599 },
116
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP_SF_QP), board_82599 },
117
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X540T1), board_X540 },
118 119 120 121 122
	/* required last entry */
	{0, }
};
MODULE_DEVICE_TABLE(pci, ixgbe_pci_tbl);

123
#ifdef CONFIG_IXGBE_DCA
124
static int ixgbe_notify_dca(struct notifier_block *, unsigned long event,
125
			    void *p);
126 127 128 129 130 131 132
static struct notifier_block dca_notifier = {
	.notifier_call = ixgbe_notify_dca,
	.next          = NULL,
	.priority      = 0
};
#endif

133 134 135
#ifdef CONFIG_PCI_IOV
static unsigned int max_vfs;
module_param(max_vfs, uint, 0);
136
MODULE_PARM_DESC(max_vfs,
137
		 "Maximum number of virtual functions to allocate per physical function - default is zero and maximum value is 63. (Deprecated)");
138 139
#endif /* CONFIG_PCI_IOV */

140 141 142 143 144
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");

145 146 147 148 149
#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)");

150 151 152 153 154
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);

155 156
static bool ixgbe_check_cfg_remove(struct ixgbe_hw *hw, struct pci_dev *pdev);

157 158 159 160 161 162 163 164 165 166 167 168 169 170
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;

171
	if (!pci_is_pcie(parent_dev))
172 173
		return -1;

174
	pcie_capability_read_word(parent_dev, reg, value);
175 176 177
	if (*value == IXGBE_FAILED_READ_CFG_WORD &&
	    ixgbe_check_cfg_remove(&adapter->hw, parent_dev))
		return -1;
178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203
	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;
}

204 205 206 207 208 209 210 211 212 213 214 215 216
/**
 * 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:
217
	case IXGBE_DEV_ID_82599_QSFP_SF_QP:
218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254
		return true;
	default:
		return false;
	}
}

static void ixgbe_check_minimum_link(struct ixgbe_adapter *adapter,
				     int expected_gts)
{
	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;

	/* determine whether to use the the parent device
	 */
	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:
255
		/* 128b/130b encoding reduces throughput by less than 2% */
256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272
		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%" :
273
		    speed == PCIE_SPEED_8_0GT ? "<2%" :
274 275 276 277 278 279 280 281 282 283
		    "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");
	}
}

284 285 286
static void ixgbe_service_event_schedule(struct ixgbe_adapter *adapter)
{
	if (!test_bit(__IXGBE_DOWN, &adapter->state) &&
287
	    !test_bit(__IXGBE_REMOVING, &adapter->state) &&
288 289 290 291
	    !test_and_set_bit(__IXGBE_SERVICE_SCHED, &adapter->state))
		schedule_work(&adapter->service_task);
}

292 293 294 295 296 297 298 299
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");
300 301
	if (test_bit(__IXGBE_SERVICE_INITED, &adapter->state))
		ixgbe_service_event_schedule(adapter);
302 303
}

304
static void ixgbe_check_remove(struct ixgbe_hw *hw, u32 reg)
305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322
{
	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);
}

323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348
/**
 * 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;
	value = readl(reg_addr + reg);
	if (unlikely(value == IXGBE_FAILED_READ_REG))
		ixgbe_check_remove(hw, reg);
	return value;
}

349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390
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 */

391 392 393 394 395 396 397 398 399
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);
}

400 401 402 403
static void ixgbe_service_event_complete(struct ixgbe_adapter *adapter)
{
	BUG_ON(!test_bit(__IXGBE_SERVICE_SCHED, &adapter->state));

S
Stephen Hemminger 已提交
404
	/* flush memory to make sure state is correct before next watchdog */
405 406 407 408
	smp_mb__before_clear_bit();
	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
}

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 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 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 503 504 505 506 507 508 509 510 511 512 513
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 */
	{}
};


/*
 * ixgbe_regdump - register printout routine
 */
static void ixgbe_regdump(struct ixgbe_hw *hw, struct ixgbe_reg_info *reginfo)
{
	int i = 0, j = 0;
	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:
514
		pr_info("%-15s %08x\n", reginfo->name,
515 516 517 518 519 520
			IXGBE_READ_REG(hw, reginfo->ofs));
		return;
	}

	for (i = 0; i < 8; i++) {
		snprintf(rname, 16, "%s[%d-%d]", reginfo->name, i*8, i*8+7);
521
		pr_err("%-15s", rname);
522
		for (j = 0; j < 8; j++)
523 524
			pr_cont(" %08x", regs[i*8+j]);
		pr_cont("\n");
525 526 527 528 529 530 531 532 533 534 535 536 537 538
	}

}

/*
 * 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;
539
	struct ixgbe_tx_buffer *tx_buffer;
540 541 542 543 544 545 546 547 548 549 550 551 552 553
	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");
554
		pr_info("Device Name     state            "
555
			"trans_start      last_rx\n");
556 557 558 559 560
		pr_info("%-15s %016lX %016lX %016lX\n",
			netdev->name,
			netdev->state,
			netdev->trans_start,
			netdev->last_rx);
561 562 563 564
	}

	/* Print Registers */
	dev_info(&adapter->pdev->dev, "Register Dump\n");
565
	pr_info(" Register Name   Value\n");
566 567 568 569 570 571 572 573 574 575
	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))
		goto exit;

	dev_info(&adapter->pdev->dev, "TX Rings Summary\n");
J
Josh Hay 已提交
576 577 578
	pr_info(" %s     %s              %s        %s\n",
		"Queue [NTU] [NTC] [bi(ntc)->dma  ]",
		"leng", "ntw", "timestamp");
579 580
	for (n = 0; n < adapter->num_tx_queues; n++) {
		tx_ring = adapter->tx_ring[n];
581
		tx_buffer = &tx_ring->tx_buffer_info[tx_ring->next_to_clean];
J
Josh Hay 已提交
582
		pr_info(" %5d %5X %5X %016llX %08X %p %016llX\n",
583
			   n, tx_ring->next_to_use, tx_ring->next_to_clean,
584 585 586 587
			   (u64)dma_unmap_addr(tx_buffer, dma),
			   dma_unmap_len(tx_buffer, len),
			   tx_buffer->next_to_watch,
			   (u64)tx_buffer->time_stamp);
588 589 590 591 592 593 594 595 596 597
	}

	/* 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
	 *
598
	 * 82598 Advanced Transmit Descriptor
599 600 601
	 *   +--------------------------------------------------------------+
	 * 0 |         Buffer Address [63:0]                                |
	 *   +--------------------------------------------------------------+
602
	 * 8 |  PAYLEN  | POPTS  | IDX | STA | DCMD  |DTYP |  RSV |  DTALEN |
603 604
	 *   +--------------------------------------------------------------+
	 *   63       46 45    40 39 36 35 32 31   24 23 20 19              0
605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628
	 *
	 * 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
629 630 631 632
	 */

	for (n = 0; n < adapter->num_tx_queues; n++) {
		tx_ring = adapter->tx_ring[n];
633 634 635
		pr_info("------------------------------------\n");
		pr_info("TX QUEUE INDEX = %d\n", tx_ring->queue_index);
		pr_info("------------------------------------\n");
J
Josh Hay 已提交
636 637 638 639
		pr_info("%s%s    %s              %s        %s          %s\n",
			"T [desc]     [address 63:0  ] ",
			"[PlPOIdStDDt Ln] [bi->dma       ] ",
			"leng", "ntw", "timestamp", "bi->skb");
640 641

		for (i = 0; tx_ring->desc && (i < tx_ring->count); i++) {
642
			tx_desc = IXGBE_TX_DESC(tx_ring, i);
643
			tx_buffer = &tx_ring->tx_buffer_info[i];
644
			u0 = (struct my_u0 *)tx_desc;
J
Josh Hay 已提交
645 646 647 648 649 650
			if (dma_unmap_len(tx_buffer, len) > 0) {
				pr_info("T [0x%03X]    %016llX %016llX %016llX %08X %p %016llX %p",
					i,
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
					(u64)dma_unmap_addr(tx_buffer, dma),
651
					dma_unmap_len(tx_buffer, len),
J
Josh Hay 已提交
652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672
					tx_buffer->next_to_watch,
					(u64)tx_buffer->time_stamp,
					tx_buffer->skb);
				if (i == tx_ring->next_to_use &&
					i == tx_ring->next_to_clean)
					pr_cont(" NTC/U\n");
				else if (i == tx_ring->next_to_use)
					pr_cont(" NTU\n");
				else if (i == tx_ring->next_to_clean)
					pr_cont(" NTC\n");
				else
					pr_cont("\n");

				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);
			}
673 674 675 676 677 678
		}
	}

	/* Print RX Rings Summary */
rx_ring_summary:
	dev_info(&adapter->pdev->dev, "RX Rings Summary\n");
679
	pr_info("Queue [NTU] [NTC]\n");
680 681
	for (n = 0; n < adapter->num_rx_queues; n++) {
		rx_ring = adapter->rx_ring[n];
682 683
		pr_info("%5d %5X %5X\n",
			n, rx_ring->next_to_use, rx_ring->next_to_clean);
684 685 686 687 688 689 690 691
	}

	/* Print RX Rings */
	if (!netif_msg_rx_status(adapter))
		goto exit;

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

692 693 694
	/* Receive Descriptor Formats
	 *
	 * 82598 Advanced Receive Descriptor (Read) Format
695 696 697 698 699 700 701 702
	 *    63                                           1        0
	 *    +-----------------------------------------------------+
	 *  0 |       Packet Buffer Address [63:1]           |A0/NSE|
	 *    +----------------------------------------------+------+
	 *  8 |       Header Buffer Address [63:1]           |  DD  |
	 *    +-----------------------------------------------------+
	 *
	 *
703
	 * 82598 Advanced Receive Descriptor (Write-Back) Format
704 705 706
	 *
	 *   63       48 47    32 31  30      21 20 16 15   4 3     0
	 *   +------------------------------------------------------+
707 708 709
	 * 0 |       RSS Hash /  |SPH| HDR_LEN  | RSV |Packet|  RSS |
	 *   | Packet   | IP     |   |          |     | Type | Type |
	 *   | Checksum | Ident  |   |          |     |      |      |
710 711 712 713
	 *   +------------------------------------------------------+
	 * 8 | VLAN Tag | Length | Extended Error | Extended Status |
	 *   +------------------------------------------------------+
	 *   63       48 47    32 31            20 19               0
714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734
	 *
	 * 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
735
	 */
736

737 738
	for (n = 0; n < adapter->num_rx_queues; n++) {
		rx_ring = adapter->rx_ring[n];
739 740 741
		pr_info("------------------------------------\n");
		pr_info("RX QUEUE INDEX = %d\n", rx_ring->queue_index);
		pr_info("------------------------------------\n");
J
Josh Hay 已提交
742 743 744
		pr_info("%s%s%s",
			"R  [desc]      [ PktBuf     A0] ",
			"[  HeadBuf   DD] [bi->dma       ] [bi->skb       ] ",
745
			"<-- Adv Rx Read format\n");
J
Josh Hay 已提交
746 747 748
		pr_info("%s%s%s",
			"RWB[desc]      [PcsmIpSHl PtRs] ",
			"[vl er S cks ln] ---------------- [bi->skb       ] ",
749 750 751 752
			"<-- Adv Rx Write-Back format\n");

		for (i = 0; i < rx_ring->count; i++) {
			rx_buffer_info = &rx_ring->rx_buffer_info[i];
753
			rx_desc = IXGBE_RX_DESC(rx_ring, i);
754 755 756 757
			u0 = (struct my_u0 *)rx_desc;
			staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
			if (staterr & IXGBE_RXD_STAT_DD) {
				/* Descriptor Done */
758
				pr_info("RWB[0x%03X]     %016llX "
759 760 761 762 763
					"%016llX ---------------- %p", i,
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
					rx_buffer_info->skb);
			} else {
764
				pr_info("R  [0x%03X]     %016llX "
765 766 767 768 769 770
					"%016llX %016llX %p", i,
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
					(u64)rx_buffer_info->dma,
					rx_buffer_info->skb);

771 772
				if (netif_msg_pktdata(adapter) &&
				    rx_buffer_info->dma) {
773 774
					print_hex_dump(KERN_INFO, "",
					   DUMP_PREFIX_ADDRESS, 16, 1,
775 776
					   page_address(rx_buffer_info->page) +
						    rx_buffer_info->page_offset,
777
					   ixgbe_rx_bufsz(rx_ring), true);
778 779 780 781
				}
			}

			if (i == rx_ring->next_to_use)
782
				pr_cont(" NTU\n");
783
			else if (i == rx_ring->next_to_clean)
784
				pr_cont(" NTC\n");
785
			else
786
				pr_cont("\n");
787 788 789 790 791 792 793 794

		}
	}

exit:
	return;
}

795 796 797 798 799 800 801
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,
802
			ctrl_ext & ~IXGBE_CTRL_EXT_DRV_LOAD);
803 804 805 806 807 808 809 810 811
}

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,
812
			ctrl_ext | IXGBE_CTRL_EXT_DRV_LOAD);
813
}
814

815
/**
816 817 818 819 820 821 822 823
 * 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,
824
			   u8 queue, u8 msix_vector)
825 826
{
	u32 ivar, index;
827 828 829 830 831 832 833 834 835 836 837 838 839
	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 已提交
840
	case ixgbe_mac_X540:
841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862
		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;
	}
863 864
}

865
static inline void ixgbe_irq_rearm_queues(struct ixgbe_adapter *adapter,
866
					  u64 qmask)
867 868 869
{
	u32 mask;

870 871
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
872 873
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS, mask);
874 875
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
876
	case ixgbe_mac_X540:
877 878 879 880
		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);
881 882 883
		break;
	default:
		break;
884 885 886
	}
}

887 888
void ixgbe_unmap_and_free_tx_resource(struct ixgbe_ring *ring,
				      struct ixgbe_tx_buffer *tx_buffer)
889
{
890 891 892
	if (tx_buffer->skb) {
		dev_kfree_skb_any(tx_buffer->skb);
		if (dma_unmap_len(tx_buffer, len))
893
			dma_unmap_single(ring->dev,
894 895 896 897 898 899 900 901
					 dma_unmap_addr(tx_buffer, dma),
					 dma_unmap_len(tx_buffer, len),
					 DMA_TO_DEVICE);
	} else if (dma_unmap_len(tx_buffer, len)) {
		dma_unmap_page(ring->dev,
			       dma_unmap_addr(tx_buffer, dma),
			       dma_unmap_len(tx_buffer, len),
			       DMA_TO_DEVICE);
902
	}
903 904 905 906
	tx_buffer->next_to_watch = NULL;
	tx_buffer->skb = NULL;
	dma_unmap_len_set(tx_buffer, len, 0);
	/* tx_buffer must be completely set up in the transmit path */
907 908
}

909
static void ixgbe_update_xoff_rx_lfc(struct ixgbe_adapter *adapter)
910 911 912 913
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_hw_stats *hwstats = &adapter->stats;
	int i;
914
	u32 data;
915

916 917 918
	if ((hw->fc.current_mode != ixgbe_fc_full) &&
	    (hw->fc.current_mode != ixgbe_fc_rx_pause))
		return;
919

920 921 922 923 924 925 926 927
	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;
928

929 930
	/* refill credits (no tx hang) if we received xoff */
	if (!data)
931
		return;
932 933 934 935 936 937 938 939 940 941 942

	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};
943
	u8 tc;
944 945 946 947 948 949 950 951
	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);
952
		return;
953
	}
954 955 956

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

959 960
		switch (hw->mac.type) {
		case ixgbe_mac_82598EB:
961
			pxoffrxc = IXGBE_READ_REG(hw, IXGBE_PXOFFRXC(i));
962
			break;
963
		default:
964
			pxoffrxc = IXGBE_READ_REG(hw, IXGBE_PXOFFRXCNT(i));
965
		}
966 967 968 969
		hwstats->pxoffrxc[i] += pxoffrxc;
		/* Get the TC for given UP */
		tc = netdev_get_prio_tc_map(adapter->netdev, i);
		xoff[tc] += pxoffrxc;
970 971 972 973 974 975
	}

	/* 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];

976
		tc = tx_ring->dcb_tc;
977 978
		if (xoff[tc])
			clear_bit(__IXGBE_HANG_CHECK_ARMED, &tx_ring->state);
979 980 981
	}
}

982
static u64 ixgbe_get_tx_completed(struct ixgbe_ring *ring)
983
{
984
	return ring->stats.packets;
985 986 987 988
}

static u64 ixgbe_get_tx_pending(struct ixgbe_ring *ring)
{
989 990 991 992 993 994 995 996
	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);
997

998 999 1000
	hw = &adapter->hw;
	head = IXGBE_READ_REG(hw, IXGBE_TDH(ring->reg_idx));
	tail = IXGBE_READ_REG(hw, IXGBE_TDT(ring->reg_idx));
1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015

	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);
	bool ret = false;

A
Alexander Duyck 已提交
1016
	clear_check_for_tx_hang(tx_ring);
1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038

	/*
	 * 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.
	 */
	if ((tx_done_old == tx_done) && tx_pending) {
		/* make sure it is true for two checks in a row */
		ret = test_and_set_bit(__IXGBE_HANG_CHECK_ARMED,
				       &tx_ring->state);
	} else {
		/* 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);
1039 1040
	}

1041
	return ret;
1042 1043
}

1044 1045 1046 1047 1048 1049 1050 1051 1052 1053
/**
 * 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)) {
		adapter->flags2 |= IXGBE_FLAG2_RESET_REQUESTED;
1054
		e_warn(drv, "initiating reset due to tx timeout\n");
1055 1056 1057
		ixgbe_service_event_schedule(adapter);
	}
}
1058

1059 1060
/**
 * ixgbe_clean_tx_irq - Reclaim resources after transmit completes
1061
 * @q_vector: structure containing interrupt and ring information
1062
 * @tx_ring: tx ring to clean
1063
 **/
1064
static bool ixgbe_clean_tx_irq(struct ixgbe_q_vector *q_vector,
1065
			       struct ixgbe_ring *tx_ring)
1066
{
1067
	struct ixgbe_adapter *adapter = q_vector->adapter;
1068 1069
	struct ixgbe_tx_buffer *tx_buffer;
	union ixgbe_adv_tx_desc *tx_desc;
1070
	unsigned int total_bytes = 0, total_packets = 0;
1071
	unsigned int budget = q_vector->tx.work_limit;
1072 1073 1074 1075
	unsigned int i = tx_ring->next_to_clean;

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

1077
	tx_buffer = &tx_ring->tx_buffer_info[i];
1078
	tx_desc = IXGBE_TX_DESC(tx_ring, i);
1079
	i -= tx_ring->count;
1080

1081
	do {
1082 1083 1084 1085 1086 1087
		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;

1088
		/* prevent any other reads prior to eop_desc */
1089
		read_barrier_depends();
1090

1091 1092 1093
		/* if DD is not set pending work has not been completed */
		if (!(eop_desc->wb.status & cpu_to_le32(IXGBE_TXD_STAT_DD)))
			break;
1094

1095 1096
		/* clear next_to_watch to prevent false hangs */
		tx_buffer->next_to_watch = NULL;
1097

1098 1099 1100 1101
		/* update the statistics for this packet */
		total_bytes += tx_buffer->bytecount;
		total_packets += tx_buffer->gso_segs;

1102 1103 1104
		/* free the skb */
		dev_kfree_skb_any(tx_buffer->skb);

1105 1106 1107 1108 1109 1110
		/* 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);

1111 1112
		/* clear tx_buffer data */
		tx_buffer->skb = NULL;
1113
		dma_unmap_len_set(tx_buffer, len, 0);
1114

1115 1116
		/* unmap remaining buffers */
		while (tx_desc != eop_desc) {
1117 1118
			tx_buffer++;
			tx_desc++;
1119
			i++;
1120 1121
			if (unlikely(!i)) {
				i -= tx_ring->count;
1122
				tx_buffer = tx_ring->tx_buffer_info;
1123
				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
1124
			}
1125

1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147
			/* 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);
1148

1149 1150 1151 1152 1153
		/* update budget accounting */
		budget--;
	} while (likely(budget));

	i += tx_ring->count;
1154
	tx_ring->next_to_clean = i;
1155
	u64_stats_update_begin(&tx_ring->syncp);
1156
	tx_ring->stats.bytes += total_bytes;
1157
	tx_ring->stats.packets += total_packets;
1158
	u64_stats_update_end(&tx_ring->syncp);
1159 1160
	q_vector->tx.total_bytes += total_bytes;
	q_vector->tx.total_packets += total_packets;
1161

1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175
	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)),
1176 1177
			tx_ring->next_to_use, i,
			tx_ring->tx_buffer_info[i].time_stamp, jiffies);
1178 1179 1180 1181 1182 1183 1184

		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);

1185
		/* schedule immediate reset if we believe we hung */
1186
		ixgbe_tx_timeout_reset(adapter);
1187 1188

		/* the adapter is about to reset, no point in enabling stuff */
1189
		return true;
1190
	}
1191

1192 1193 1194
	netdev_tx_completed_queue(txring_txq(tx_ring),
				  total_packets, total_bytes);

1195
#define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
1196
	if (unlikely(total_packets && netif_carrier_ok(tx_ring->netdev) &&
1197
		     (ixgbe_desc_unused(tx_ring) >= TX_WAKE_THRESHOLD))) {
1198 1199 1200 1201
		/* Make sure that anybody stopping the queue after this
		 * sees the new next_to_clean.
		 */
		smp_mb();
1202 1203 1204 1205 1206
		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);
1207
			++tx_ring->tx_stats.restart_queue;
1208
		}
1209
	}
1210

1211
	return !!budget;
1212 1213
}

1214
#ifdef CONFIG_IXGBE_DCA
1215 1216
static void ixgbe_update_tx_dca(struct ixgbe_adapter *adapter,
				struct ixgbe_ring *tx_ring,
1217
				int cpu)
1218
{
1219
	struct ixgbe_hw *hw = &adapter->hw;
1220 1221
	u32 txctrl = dca3_get_tag(tx_ring->dev, cpu);
	u16 reg_offset;
1222 1223 1224

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
1225
		reg_offset = IXGBE_DCA_TXCTRL(tx_ring->reg_idx);
1226 1227
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
1228
	case ixgbe_mac_X540:
1229 1230
		reg_offset = IXGBE_DCA_TXCTRL_82599(tx_ring->reg_idx);
		txctrl <<= IXGBE_DCA_TXCTRL_CPUID_SHIFT_82599;
1231 1232
		break;
	default:
1233 1234
		/* for unknown hardware do not write register */
		return;
1235
	}
1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246

	/*
	 * 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);
1247 1248
}

1249 1250
static void ixgbe_update_rx_dca(struct ixgbe_adapter *adapter,
				struct ixgbe_ring *rx_ring,
1251
				int cpu)
1252
{
1253
	struct ixgbe_hw *hw = &adapter->hw;
1254 1255 1256
	u32 rxctrl = dca3_get_tag(rx_ring->dev, cpu);
	u8 reg_idx = rx_ring->reg_idx;

1257 1258 1259

	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
1260
	case ixgbe_mac_X540:
1261
		rxctrl <<= IXGBE_DCA_RXCTRL_CPUID_SHIFT_82599;
1262 1263 1264 1265
		break;
	default:
		break;
	}
1266 1267 1268 1269 1270 1271 1272 1273 1274 1275

	/*
	 * 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 |
		  IXGBE_DCA_RXCTRL_DESC_DCA_EN;

	IXGBE_WRITE_REG(hw, IXGBE_DCA_RXCTRL(reg_idx), rxctrl);
1276 1277 1278 1279 1280
}

static void ixgbe_update_dca(struct ixgbe_q_vector *q_vector)
{
	struct ixgbe_adapter *adapter = q_vector->adapter;
1281
	struct ixgbe_ring *ring;
1282 1283
	int cpu = get_cpu();

1284 1285 1286
	if (q_vector->cpu == cpu)
		goto out_no_update;

1287
	ixgbe_for_each_ring(ring, q_vector->tx)
1288
		ixgbe_update_tx_dca(adapter, ring, cpu);
1289

1290
	ixgbe_for_each_ring(ring, q_vector->rx)
1291
		ixgbe_update_rx_dca(adapter, ring, cpu);
1292 1293 1294

	q_vector->cpu = cpu;
out_no_update:
1295 1296 1297 1298 1299 1300 1301 1302 1303 1304
	put_cpu();
}

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

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

1305 1306 1307
	/* always use CB2 mode, difference is masked in the CB driver */
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL, 2);

1308
	for (i = 0; i < adapter->num_q_vectors; i++) {
1309 1310
		adapter->q_vector[i]->cpu = -1;
		ixgbe_update_dca(adapter->q_vector[i]);
1311 1312 1313 1314 1315
	}
}

static int __ixgbe_notify_dca(struct device *dev, void *data)
{
1316
	struct ixgbe_adapter *adapter = dev_get_drvdata(dev);
1317 1318
	unsigned long event = *(unsigned long *)data;

1319
	if (!(adapter->flags & IXGBE_FLAG_DCA_CAPABLE))
1320 1321
		return 0;

1322 1323
	switch (event) {
	case DCA_PROVIDER_ADD:
1324 1325 1326
		/* if we're already enabled, don't do it again */
		if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
			break;
1327
		if (dca_add_requester(dev) == 0) {
1328
			adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341
			ixgbe_setup_dca(adapter);
			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;
			IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL, 1);
		}
		break;
	}

1342
	return 0;
1343
}
E
Emil Tantilov 已提交
1344

1345
#endif /* CONFIG_IXGBE_DCA */
1346 1347
static inline void ixgbe_rx_hash(struct ixgbe_ring *ring,
				 union ixgbe_adv_rx_desc *rx_desc,
E
Emil Tantilov 已提交
1348 1349
				 struct sk_buff *skb)
{
1350
	if (ring->netdev->features & NETIF_F_RXHASH)
T
Tom Herbert 已提交
1351 1352 1353
		skb_set_hash(skb,
			     le32_to_cpu(rx_desc->wb.lower.hi_dword.rss),
			     PKT_HASH_TYPE_L3);
E
Emil Tantilov 已提交
1354 1355
}

1356
#ifdef IXGBE_FCOE
1357 1358
/**
 * ixgbe_rx_is_fcoe - check the rx desc for incoming pkt type
1359
 * @ring: structure containing ring specific data
1360 1361 1362 1363
 * @rx_desc: advanced rx descriptor
 *
 * Returns : true if it is FCoE pkt
 */
1364
static inline bool ixgbe_rx_is_fcoe(struct ixgbe_ring *ring,
1365 1366 1367 1368
				    union ixgbe_adv_rx_desc *rx_desc)
{
	__le16 pkt_info = rx_desc->wb.lower.lo_dword.hs_rss.pkt_info;

1369
	return test_bit(__IXGBE_RX_FCOE, &ring->state) &&
1370 1371 1372 1373 1374
	       ((pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_ETQF_MASK)) ==
		(cpu_to_le16(IXGBE_ETQF_FILTER_FCOE <<
			     IXGBE_RXDADV_PKTTYPE_ETQF_SHIFT)));
}

1375
#endif /* IXGBE_FCOE */
1376 1377
/**
 * ixgbe_rx_checksum - indicate in skb if hw indicated a good cksum
1378 1379
 * @ring: structure containing ring specific data
 * @rx_desc: current Rx descriptor being processed
1380 1381
 * @skb: skb currently being received and modified
 **/
1382
static inline void ixgbe_rx_checksum(struct ixgbe_ring *ring,
1383
				     union ixgbe_adv_rx_desc *rx_desc,
1384
				     struct sk_buff *skb)
1385
{
1386
	skb_checksum_none_assert(skb);
1387

1388
	/* Rx csum disabled */
1389
	if (!(ring->netdev->features & NETIF_F_RXCSUM))
1390
		return;
1391 1392

	/* if IP and error */
1393 1394
	if (ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_IPCS) &&
	    ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_IPE)) {
1395
		ring->rx_stats.csum_err++;
1396 1397
		return;
	}
1398

1399
	if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_L4CS))
1400 1401
		return;

1402
	if (ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_TCPE)) {
1403
		__le16 pkt_info = rx_desc->wb.lower.lo_dword.hs_rss.pkt_info;
1404 1405 1406 1407 1408

		/*
		 * 82599 errata, UDP frames with a 0 checksum can be marked as
		 * checksum errors.
		 */
1409 1410
		if ((pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_UDP)) &&
		    test_bit(__IXGBE_RX_CSUM_UDP_ZERO_ERR, &ring->state))
1411 1412
			return;

1413
		ring->rx_stats.csum_err++;
1414 1415 1416
		return;
	}

1417
	/* It must be a TCP or UDP packet with a valid checksum */
1418
	skb->ip_summed = CHECKSUM_UNNECESSARY;
1419 1420
}

1421
static inline void ixgbe_release_rx_desc(struct ixgbe_ring *rx_ring, u32 val)
1422
{
1423
	rx_ring->next_to_use = val;
1424 1425 1426

	/* update next to alloc since we have filled the ring */
	rx_ring->next_to_alloc = val;
1427 1428 1429 1430 1431 1432 1433
	/*
	 * 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();
1434
	ixgbe_write_tail(rx_ring, val);
1435 1436
}

1437 1438 1439 1440
static bool ixgbe_alloc_mapped_page(struct ixgbe_ring *rx_ring,
				    struct ixgbe_rx_buffer *bi)
{
	struct page *page = bi->page;
1441
	dma_addr_t dma = bi->dma;
1442

1443 1444
	/* since we are recycling buffers we should seldom need to alloc */
	if (likely(dma))
1445 1446
		return true;

1447 1448
	/* alloc new page for storage */
	if (likely(!page)) {
1449 1450
		page = __skb_alloc_pages(GFP_ATOMIC | __GFP_COLD | __GFP_COMP,
					 bi->skb, ixgbe_rx_pg_order(rx_ring));
1451 1452 1453 1454
		if (unlikely(!page)) {
			rx_ring->rx_stats.alloc_rx_page_failed++;
			return false;
		}
1455
		bi->page = page;
1456 1457
	}

1458 1459 1460 1461 1462 1463 1464 1465 1466
	/* map page for use */
	dma = dma_map_page(rx_ring->dev, page, 0,
			   ixgbe_rx_pg_size(rx_ring), DMA_FROM_DEVICE);

	/*
	 * 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)) {
1467
		__free_pages(page, ixgbe_rx_pg_order(rx_ring));
1468
		bi->page = NULL;
1469 1470 1471 1472 1473

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

1474
	bi->dma = dma;
1475
	bi->page_offset = 0;
1476

1477 1478 1479
	return true;
}

1480
/**
1481
 * ixgbe_alloc_rx_buffers - Replace used receive buffers
1482 1483
 * @rx_ring: ring to place buffers on
 * @cleaned_count: number of buffers to replace
1484
 **/
1485
void ixgbe_alloc_rx_buffers(struct ixgbe_ring *rx_ring, u16 cleaned_count)
1486 1487
{
	union ixgbe_adv_rx_desc *rx_desc;
1488
	struct ixgbe_rx_buffer *bi;
1489
	u16 i = rx_ring->next_to_use;
1490

1491 1492
	/* nothing to do */
	if (!cleaned_count)
1493 1494
		return;

1495
	rx_desc = IXGBE_RX_DESC(rx_ring, i);
1496 1497
	bi = &rx_ring->rx_buffer_info[i];
	i -= rx_ring->count;
1498

1499 1500
	do {
		if (!ixgbe_alloc_mapped_page(rx_ring, bi))
1501
			break;
1502

1503 1504 1505 1506 1507
		/*
		 * 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);
1508

1509 1510
		rx_desc++;
		bi++;
1511
		i++;
1512
		if (unlikely(!i)) {
1513
			rx_desc = IXGBE_RX_DESC(rx_ring, 0);
1514 1515 1516 1517 1518 1519
			bi = rx_ring->rx_buffer_info;
			i -= rx_ring->count;
		}

		/* clear the hdr_addr for the next_to_use descriptor */
		rx_desc->read.hdr_addr = 0;
1520 1521 1522

		cleaned_count--;
	} while (cleaned_count);
1523

1524 1525
	i += rx_ring->count;

1526
	if (rx_ring->next_to_use != i)
1527
		ixgbe_release_rx_desc(rx_ring, i);
1528 1529
}

1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550
/**
 * ixgbe_get_headlen - determine size of header for RSC/LRO/GRO/FCOE
 * @data: pointer to the start of the headers
 * @max_len: total length of section to find headers in
 *
 * This function is meant to determine the length of headers that will
 * be recognized by hardware for LRO, GRO, and RSC offloads.  The main
 * motivation of doing this is to only perform one pull for IPv4 TCP
 * packets so that we can do basic things like calculating the gso_size
 * based on the average data per packet.
 **/
static unsigned int ixgbe_get_headlen(unsigned char *data,
				      unsigned int max_len)
{
	union {
		unsigned char *network;
		/* l2 headers */
		struct ethhdr *eth;
		struct vlan_hdr *vlan;
		/* l3 headers */
		struct iphdr *ipv4;
1551
		struct ipv6hdr *ipv6;
1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568
	} hdr;
	__be16 protocol;
	u8 nexthdr = 0;	/* default to not TCP */
	u8 hlen;

	/* this should never happen, but better safe than sorry */
	if (max_len < ETH_HLEN)
		return max_len;

	/* initialize network frame pointer */
	hdr.network = data;

	/* set first protocol and move network header forward */
	protocol = hdr.eth->h_proto;
	hdr.network += ETH_HLEN;

	/* handle any vlan tag if present */
1569
	if (protocol == htons(ETH_P_8021Q)) {
1570 1571 1572 1573 1574 1575 1576 1577
		if ((hdr.network - data) > (max_len - VLAN_HLEN))
			return max_len;

		protocol = hdr.vlan->h_vlan_encapsulated_proto;
		hdr.network += VLAN_HLEN;
	}

	/* handle L3 protocols */
1578
	if (protocol == htons(ETH_P_IP)) {
1579 1580 1581 1582 1583 1584 1585 1586 1587 1588
		if ((hdr.network - data) > (max_len - sizeof(struct iphdr)))
			return max_len;

		/* access ihl as a u8 to avoid unaligned access on ia64 */
		hlen = (hdr.network[0] & 0x0F) << 2;

		/* verify hlen meets minimum size requirements */
		if (hlen < sizeof(struct iphdr))
			return hdr.network - data;

1589
		/* record next protocol if header is present */
1590
		if (!(hdr.ipv4->frag_off & htons(IP_OFFSET)))
1591
			nexthdr = hdr.ipv4->protocol;
1592
	} else if (protocol == htons(ETH_P_IPV6)) {
1593 1594 1595 1596 1597
		if ((hdr.network - data) > (max_len - sizeof(struct ipv6hdr)))
			return max_len;

		/* record next protocol */
		nexthdr = hdr.ipv6->nexthdr;
1598
		hlen = sizeof(struct ipv6hdr);
1599
#ifdef IXGBE_FCOE
1600
	} else if (protocol == htons(ETH_P_FCOE)) {
1601 1602
		if ((hdr.network - data) > (max_len - FCOE_HEADER_LEN))
			return max_len;
1603
		hlen = FCOE_HEADER_LEN;
1604 1605 1606 1607 1608
#endif
	} else {
		return hdr.network - data;
	}

1609 1610 1611
	/* relocate pointer to start of L4 header */
	hdr.network += hlen;

1612
	/* finally sort out TCP/UDP */
1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624
	if (nexthdr == IPPROTO_TCP) {
		if ((hdr.network - data) > (max_len - sizeof(struct tcphdr)))
			return max_len;

		/* access doff as a u8 to avoid unaligned access on ia64 */
		hlen = (hdr.network[12] & 0xF0) >> 2;

		/* verify hlen meets minimum size requirements */
		if (hlen < sizeof(struct tcphdr))
			return hdr.network - data;

		hdr.network += hlen;
1625 1626 1627 1628 1629
	} else if (nexthdr == IPPROTO_UDP) {
		if ((hdr.network - data) > (max_len - sizeof(struct udphdr)))
			return max_len;

		hdr.network += sizeof(struct udphdr);
1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646
	}

	/*
	 * If everything has gone correctly hdr.network should be the
	 * data section of the packet and will be the end of the header.
	 * If not then it probably represents the end of the last recognized
	 * header.
	 */
	if ((hdr.network - data) < max_len)
		return hdr.network - data;
	else
		return max_len;
}

static void ixgbe_set_rsc_gso_size(struct ixgbe_ring *ring,
				   struct sk_buff *skb)
{
1647
	u16 hdr_len = skb_headlen(skb);
1648 1649 1650 1651

	/* 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);
1652
	skb_shinfo(skb)->gso_type = SKB_GSO_TCPV4;
1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670
}

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;
}

1671 1672 1673 1674 1675
/**
 * 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 已提交
1676
 *
1677 1678 1679
 * 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 已提交
1680
 **/
1681 1682 1683
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 已提交
1684
{
1685 1686
	struct net_device *dev = rx_ring->netdev;

1687 1688 1689
	ixgbe_update_rsc_stats(rx_ring, skb);

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

1691 1692
	ixgbe_rx_checksum(rx_ring, rx_desc, skb);

1693 1694
	if (unlikely(ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_STAT_TS)))
		ixgbe_ptp_rx_hwtstamp(rx_ring->q_vector->adapter, skb);
1695

1696
	if ((dev->features & NETIF_F_HW_VLAN_CTAG_RX) &&
1697
	    ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_VP)) {
1698
		u16 vid = le16_to_cpu(rx_desc->wb.upper.vlan);
1699
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vid);
A
Alexander Duyck 已提交
1700 1701
	}

1702
	skb_record_rx_queue(skb, rx_ring->queue_index);
1703

1704
	skb->protocol = eth_type_trans(skb, dev);
A
Alexander Duyck 已提交
1705 1706
}

1707 1708
static void ixgbe_rx_skb(struct ixgbe_q_vector *q_vector,
			 struct sk_buff *skb)
1709
{
1710 1711
	struct ixgbe_adapter *adapter = q_vector->adapter;

1712
	if (ixgbe_qv_busy_polling(q_vector))
1713 1714
		netif_receive_skb(skb);
	else if (!(adapter->flags & IXGBE_FLAG_IN_NETPOLL))
1715 1716 1717
		napi_gro_receive(&q_vector->napi, skb);
	else
		netif_rx(skb);
1718
}
1719

1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742
/**
 * 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));

1743 1744 1745 1746 1747 1748 1749 1750 1751 1752
	/* 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;
1753

1754 1755 1756 1757 1758
			/* 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;
		}
1759 1760
	}

1761 1762 1763 1764
	/* 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;

1765 1766 1767 1768 1769 1770 1771
	/* 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;
}

1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801
/**
 * 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.
	 */
1802
	pull_len = ixgbe_get_headlen(va, IXGBE_RX_HDR_SIZE);
1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813

	/* 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;
}

1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843
/**
 * 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)) {
		dma_unmap_page(rx_ring->dev, IXGBE_CB(skb)->dma,
			       ixgbe_rx_pg_size(rx_ring), DMA_FROM_DEVICE);
		IXGBE_CB(skb)->page_released = false;
	} 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,
					      ixgbe_rx_bufsz(rx_ring),
					      DMA_FROM_DEVICE);
	}
	IXGBE_CB(skb)->dma = 0;
}

1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875
/**
 * 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;
	}

1876
	/* place header in linear portion of buffer */
1877 1878
	if (skb_is_nonlinear(skb))
		ixgbe_pull_tail(rx_ring, skb);
1879

1880 1881 1882 1883 1884 1885
#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
1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902
	/* if skb_pad returns an error the skb was freed */
	if (unlikely(skb->len < 60)) {
		int pad_len = 60 - skb->len;

		if (skb_pad(skb, pad_len))
			return true;
		__skb_put(skb, pad_len);
	}

	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
 *
1903
 * Synchronizes page for reuse by the adapter
1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919
 **/
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;

	/* transfer page from old buffer to new buffer */
	new_buff->page = old_buff->page;
	new_buff->dma = old_buff->dma;
1920
	new_buff->page_offset = old_buff->page_offset;
1921 1922 1923

	/* sync the buffer for use by the device */
	dma_sync_single_range_for_device(rx_ring->dev, new_buff->dma,
1924 1925
					 new_buff->page_offset,
					 ixgbe_rx_bufsz(rx_ring),
1926 1927 1928 1929 1930 1931 1932 1933 1934 1935
					 DMA_FROM_DEVICE);
}

/**
 * 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
 *
1936 1937 1938 1939 1940 1941 1942
 * 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.
1943
 **/
1944
static bool ixgbe_add_rx_frag(struct ixgbe_ring *rx_ring,
1945
			      struct ixgbe_rx_buffer *rx_buffer,
1946 1947
			      union ixgbe_adv_rx_desc *rx_desc,
			      struct sk_buff *skb)
1948
{
1949 1950
	struct page *page = rx_buffer->page;
	unsigned int size = le16_to_cpu(rx_desc->wb.upper.length);
1951
#if (PAGE_SIZE < 8192)
1952
	unsigned int truesize = ixgbe_rx_bufsz(rx_ring);
1953 1954 1955 1956 1957
#else
	unsigned int truesize = ALIGN(size, L1_CACHE_BYTES);
	unsigned int last_offset = ixgbe_rx_pg_size(rx_ring) -
				   ixgbe_rx_bufsz(rx_ring);
#endif
1958

1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972
	if ((size <= IXGBE_RX_HDR_SIZE) && !skb_is_nonlinear(skb)) {
		unsigned char *va = page_address(page) + rx_buffer->page_offset;

		memcpy(__skb_put(skb, size), va, ALIGN(size, sizeof(long)));

		/* we can reuse buffer as-is, just make sure it is local */
		if (likely(page_to_nid(page) == numa_node_id()))
			return true;

		/* this page cannot be reused so discard it */
		put_page(page);
		return false;
	}

1973 1974 1975
	skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, page,
			rx_buffer->page_offset, size, truesize);

1976 1977 1978 1979 1980 1981 1982
	/* avoid re-using remote pages */
	if (unlikely(page_to_nid(page) != numa_node_id()))
		return false;

#if (PAGE_SIZE < 8192)
	/* if we are only owner of page we can reuse it */
	if (unlikely(page_count(page) != 1))
1983 1984 1985 1986 1987
		return false;

	/* flip page offset to other buffer */
	rx_buffer->page_offset ^= truesize;

1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000
	/*
	 * since we are the only owner of the page and we need to
	 * increment it, just set the value to 2 in order to avoid
	 * an unecessary locked operation
	 */
	atomic_set(&page->_count, 2);
#else
	/* move offset up to the next cache line */
	rx_buffer->page_offset += truesize;

	if (rx_buffer->page_offset > last_offset)
		return false;

2001 2002
	/* bump ref count on page before it is given to the stack */
	get_page(page);
2003
#endif
2004 2005

	return true;
2006 2007
}

2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088
static struct sk_buff *ixgbe_fetch_rx_buffer(struct ixgbe_ring *rx_ring,
					     union ixgbe_adv_rx_desc *rx_desc)
{
	struct ixgbe_rx_buffer *rx_buffer;
	struct sk_buff *skb;
	struct page *page;

	rx_buffer = &rx_ring->rx_buffer_info[rx_ring->next_to_clean];
	page = rx_buffer->page;
	prefetchw(page);

	skb = rx_buffer->skb;

	if (likely(!skb)) {
		void *page_addr = page_address(page) +
				  rx_buffer->page_offset;

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

		/* allocate a skb to store the frags */
		skb = netdev_alloc_skb_ip_align(rx_ring->netdev,
						IXGBE_RX_HDR_SIZE);
		if (unlikely(!skb)) {
			rx_ring->rx_stats.alloc_rx_buff_failed++;
			return NULL;
		}

		/*
		 * we will be copying header into skb->data in
		 * pskb_may_pull so it is in our interest to prefetch
		 * it now to avoid a possible cache miss
		 */
		prefetchw(skb->data);

		/*
		 * 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 (likely(ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP)))
			goto dma_sync;

		IXGBE_CB(skb)->dma = rx_buffer->dma;
	} else {
		if (ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP))
			ixgbe_dma_sync_frag(rx_ring, skb);

dma_sync:
		/* 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,
					      ixgbe_rx_bufsz(rx_ring),
					      DMA_FROM_DEVICE);
	}

	/* pull page into skb */
	if (ixgbe_add_rx_frag(rx_ring, rx_buffer, rx_desc, skb)) {
		/* hand second half of page back to the ring */
		ixgbe_reuse_rx_page(rx_ring, rx_buffer);
	} else 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(rx_ring->dev, rx_buffer->dma,
			       ixgbe_rx_pg_size(rx_ring),
			       DMA_FROM_DEVICE);
	}

	/* clear contents of buffer_info */
	rx_buffer->skb = NULL;
	rx_buffer->dma = 0;
	rx_buffer->page = NULL;

	return skb;
2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101
}

/**
 * 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.
 *
2102
 * Returns amount of work completed
2103
 **/
2104
static int ixgbe_clean_rx_irq(struct ixgbe_q_vector *q_vector,
2105
			       struct ixgbe_ring *rx_ring,
2106
			       const int budget)
2107
{
2108
	unsigned int total_rx_bytes = 0, total_rx_packets = 0;
B
Ben Greear 已提交
2109
#ifdef IXGBE_FCOE
2110
	struct ixgbe_adapter *adapter = q_vector->adapter;
2111 2112
	int ddp_bytes;
	unsigned int mss = 0;
2113
#endif /* IXGBE_FCOE */
2114
	u16 cleaned_count = ixgbe_desc_unused(rx_ring);
2115

2116
	while (likely(total_rx_packets < budget)) {
2117 2118 2119 2120 2121 2122 2123 2124 2125
		union ixgbe_adv_rx_desc *rx_desc;
		struct sk_buff *skb;

		/* 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;
		}

2126
		rx_desc = IXGBE_RX_DESC(rx_ring, rx_ring->next_to_clean);
2127 2128 2129

		if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_DD))
			break;
2130

2131 2132 2133 2134 2135 2136
		/*
		 * This memory barrier is needed to keep us from reading
		 * any other fields out of the rx_desc until we know the
		 * RXD_STAT_DD bit is set
		 */
		rmb();
2137

2138 2139
		/* retrieve a buffer from the ring */
		skb = ixgbe_fetch_rx_buffer(rx_ring, rx_desc);
2140

2141 2142 2143
		/* exit if we failed to retrieve a buffer */
		if (!skb)
			break;
2144 2145

		cleaned_count++;
A
Alexander Duyck 已提交
2146

2147 2148 2149
		/* place incomplete frames back on ring for completion */
		if (ixgbe_is_non_eop(rx_ring, rx_desc, skb))
			continue;
2150

2151 2152 2153
		/* verify the packet layout is correct */
		if (ixgbe_cleanup_headers(rx_ring, rx_desc, skb))
			continue;
2154

2155 2156 2157
		/* probably a little skewed due to removing CRC */
		total_rx_bytes += skb->len;

2158 2159 2160
		/* populate checksum, timestamp, VLAN, and protocol */
		ixgbe_process_skb_fields(rx_ring, rx_desc, skb);

2161 2162
#ifdef IXGBE_FCOE
		/* if ddp, not passing to ULD unless for FCP_RSP or error */
2163
		if (ixgbe_rx_is_fcoe(rx_ring, rx_desc)) {
2164
			ddp_bytes = ixgbe_fcoe_ddp(adapter, rx_desc, skb);
2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178
			/* 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);
			}
2179 2180
			if (!ddp_bytes) {
				dev_kfree_skb_any(skb);
2181
				continue;
2182
			}
2183
		}
2184

2185
#endif /* IXGBE_FCOE */
2186
		skb_mark_napi_id(skb, &q_vector->napi);
2187
		ixgbe_rx_skb(q_vector, skb);
2188

2189
		/* update budget accounting */
2190
		total_rx_packets++;
2191
	}
2192

2193 2194 2195 2196
	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);
2197 2198
	q_vector->rx.total_packets += total_rx_packets;
	q_vector->rx.total_bytes += total_rx_bytes;
2199

2200 2201 2202
	if (cleaned_count)
		ixgbe_alloc_rx_buffers(rx_ring, cleaned_count);

2203
	return total_rx_packets;
2204 2205
}

2206
#ifdef CONFIG_NET_RX_BUSY_POLL
2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223
/* must be called with local_bh_disable()d */
static int ixgbe_low_latency_recv(struct napi_struct *napi)
{
	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;
	int found = 0;

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

	if (!ixgbe_qv_lock_poll(q_vector))
		return LL_FLUSH_BUSY;

	ixgbe_for_each_ring(ring, q_vector->rx) {
		found = ixgbe_clean_rx_irq(q_vector, ring, 4);
2224
#ifdef BP_EXTENDED_STATS
2225 2226 2227 2228 2229
		if (found)
			ring->stats.cleaned += found;
		else
			ring->stats.misses++;
#endif
2230 2231 2232 2233 2234 2235 2236 2237
		if (found)
			break;
	}

	ixgbe_qv_unlock_poll(q_vector);

	return found;
}
2238
#endif	/* CONFIG_NET_RX_BUSY_POLL */
2239

2240 2241 2242 2243 2244 2245 2246 2247 2248
/**
 * 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)
{
2249
	struct ixgbe_q_vector *q_vector;
2250
	int v_idx;
2251
	u32 mask;
2252

2253 2254 2255 2256 2257 2258
	/* Populate MSIX to EITR Select */
	if (adapter->num_vfs > 32) {
		u32 eitrsel = (1 << (adapter->num_vfs - 32)) - 1;
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITRSEL, eitrsel);
	}

2259 2260
	/*
	 * Populate the IVAR table and set the ITR values to the
2261 2262
	 * corresponding register.
	 */
2263
	for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
2264
		struct ixgbe_ring *ring;
2265
		q_vector = adapter->q_vector[v_idx];
2266

2267
		ixgbe_for_each_ring(ring, q_vector->rx)
2268 2269
			ixgbe_set_ivar(adapter, 0, ring->reg_idx, v_idx);

2270
		ixgbe_for_each_ring(ring, q_vector->tx)
2271 2272
			ixgbe_set_ivar(adapter, 1, ring->reg_idx, v_idx);

2273
		ixgbe_write_eitr(q_vector);
2274 2275
	}

2276 2277
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
2278
		ixgbe_set_ivar(adapter, -1, IXGBE_IVAR_OTHER_CAUSES_INDEX,
2279
			       v_idx);
2280 2281
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2282
	case ixgbe_mac_X540:
2283
		ixgbe_set_ivar(adapter, -1, 1, v_idx);
2284 2285 2286 2287
		break;
	default:
		break;
	}
2288 2289
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITR(v_idx), 1950);

2290
	/* set up to autoclear timer, and the vectors */
2291
	mask = IXGBE_EIMS_ENABLE_MASK;
2292 2293 2294 2295
	mask &= ~(IXGBE_EIMS_OTHER |
		  IXGBE_EIMS_MAILBOX |
		  IXGBE_EIMS_LSC);

2296
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIAC, mask);
2297 2298
}

2299 2300 2301 2302 2303 2304 2305 2306 2307
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
2308 2309
 * @q_vector: structure containing interrupt and ring information
 * @ring_container: structure containing ring performance data
2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320
 *
 *      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)
 **/
2321 2322
static void ixgbe_update_itr(struct ixgbe_q_vector *q_vector,
			     struct ixgbe_ring_container *ring_container)
2323
{
2324 2325 2326
	int bytes = ring_container->total_bytes;
	int packets = ring_container->total_packets;
	u32 timepassed_us;
2327
	u64 bytes_perint;
2328
	u8 itr_setting = ring_container->itr;
2329 2330

	if (packets == 0)
2331
		return;
2332 2333

	/* simple throttlerate management
2334 2335 2336
	 *   0-10MB/s   lowest (100000 ints/s)
	 *  10-20MB/s   low    (20000 ints/s)
	 *  20-1249MB/s bulk   (8000 ints/s)
2337 2338
	 */
	/* what was last interrupt timeslice? */
2339
	timepassed_us = q_vector->itr >> 2;
2340 2341 2342
	if (timepassed_us == 0)
		return;

2343 2344 2345 2346
	bytes_perint = bytes / timepassed_us; /* bytes/usec */

	switch (itr_setting) {
	case lowest_latency:
2347
		if (bytes_perint > 10)
2348
			itr_setting = low_latency;
2349 2350
		break;
	case low_latency:
2351
		if (bytes_perint > 20)
2352
			itr_setting = bulk_latency;
2353
		else if (bytes_perint <= 10)
2354
			itr_setting = lowest_latency;
2355 2356
		break;
	case bulk_latency:
2357
		if (bytes_perint <= 20)
2358
			itr_setting = low_latency;
2359 2360 2361
		break;
	}

2362 2363 2364 2365 2366 2367
	/* 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;
2368 2369
}

2370 2371
/**
 * ixgbe_write_eitr - write EITR register in hardware specific way
2372
 * @q_vector: structure containing interrupt and ring information
2373 2374 2375 2376 2377
 *
 * 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.
 */
2378
void ixgbe_write_eitr(struct ixgbe_q_vector *q_vector)
2379
{
2380
	struct ixgbe_adapter *adapter = q_vector->adapter;
2381
	struct ixgbe_hw *hw = &adapter->hw;
2382
	int v_idx = q_vector->v_idx;
2383
	u32 itr_reg = q_vector->itr & IXGBE_MAX_EITR;
2384

2385 2386
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
2387 2388
		/* must write high and low 16 bits to reset counter */
		itr_reg |= (itr_reg << 16);
2389 2390
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2391
	case ixgbe_mac_X540:
2392 2393 2394 2395 2396
		/*
		 * set the WDIS bit to not clear the timer bits and cause an
		 * immediate assertion of the interrupt
		 */
		itr_reg |= IXGBE_EITR_CNT_WDIS;
2397 2398 2399
		break;
	default:
		break;
2400 2401 2402 2403
	}
	IXGBE_WRITE_REG(hw, IXGBE_EITR(v_idx), itr_reg);
}

2404
static void ixgbe_set_itr(struct ixgbe_q_vector *q_vector)
2405
{
2406
	u32 new_itr = q_vector->itr;
2407
	u8 current_itr;
2408

2409 2410
	ixgbe_update_itr(q_vector, &q_vector->tx);
	ixgbe_update_itr(q_vector, &q_vector->rx);
2411

2412
	current_itr = max(q_vector->rx.itr, q_vector->tx.itr);
2413 2414 2415 2416

	switch (current_itr) {
	/* counts and packets in update_itr are dependent on these numbers */
	case lowest_latency:
2417
		new_itr = IXGBE_100K_ITR;
2418 2419
		break;
	case low_latency:
2420
		new_itr = IXGBE_20K_ITR;
2421 2422
		break;
	case bulk_latency:
2423
		new_itr = IXGBE_8K_ITR;
2424
		break;
2425 2426
	default:
		break;
2427 2428
	}

2429
	if (new_itr != q_vector->itr) {
2430
		/* do an exponential smoothing */
2431 2432
		new_itr = (10 * new_itr * q_vector->itr) /
			  ((9 * new_itr) + q_vector->itr);
2433

2434
		/* save the algorithm value here */
2435
		q_vector->itr = new_itr;
2436 2437

		ixgbe_write_eitr(q_vector);
2438 2439 2440
	}
}

2441
/**
2442
 * ixgbe_check_overtemp_subtask - check for over temperature
2443
 * @adapter: pointer to adapter
2444
 **/
2445
static void ixgbe_check_overtemp_subtask(struct ixgbe_adapter *adapter)
2446 2447 2448 2449
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 eicr = adapter->interrupt_event;

2450
	if (test_bit(__IXGBE_DOWN, &adapter->state))
2451 2452
		return;

2453 2454 2455 2456 2457 2458
	if (!(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE) &&
	    !(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_EVENT))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_TEMP_SENSOR_EVENT;

2459
	switch (hw->device_id) {
2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472
	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
		 */
		if (!(eicr & IXGBE_EICR_GPI_SDP0) &&
		    !(eicr & IXGBE_EICR_LSC))
			return;

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

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

2478 2479 2480 2481 2482 2483 2484 2485 2486
			if (link_up)
				return;
		}

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

		break;
2487 2488
	default:
		if (!(eicr & IXGBE_EICR_GPI_SDP0))
2489
			return;
2490
		break;
2491
	}
2492 2493 2494 2495
	e_crit(drv,
	       "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\n");
2496 2497

	adapter->interrupt_event = 0;
2498 2499
}

2500 2501 2502 2503 2504 2505
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) &&
	    (eicr & IXGBE_EICR_GPI_SDP1)) {
2506
		e_crit(probe, "Fan has stopped, replace the adapter\n");
2507 2508 2509 2510
		/* write to clear the interrupt */
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1);
	}
}
2511

2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536 2537 2538 2539 2540 2541 2542 2543 2544
static void ixgbe_check_overtemp_event(struct ixgbe_adapter *adapter, u32 eicr)
{
	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
		 */
		if (((eicr & IXGBE_EICR_GPI_SDP0) || (eicr & IXGBE_EICR_LSC)) &&
		    (!test_bit(__IXGBE_DOWN, &adapter->state))) {
			adapter->interrupt_event = eicr;
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_EVENT;
			ixgbe_service_event_schedule(adapter);
			return;
		}
		return;
	case ixgbe_mac_X540:
		if (!(eicr & IXGBE_EICR_TS))
			return;
		break;
	default:
		return;
	}

	e_crit(drv,
	       "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\n");
}

2545 2546 2547 2548
static void ixgbe_check_sfp_event(struct ixgbe_adapter *adapter, u32 eicr)
{
	struct ixgbe_hw *hw = &adapter->hw;

2549 2550 2551
	if (eicr & IXGBE_EICR_GPI_SDP2) {
		/* Clear the interrupt */
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP2);
2552 2553 2554 2555
		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
			adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
			ixgbe_service_event_schedule(adapter);
		}
2556 2557
	}

2558 2559 2560
	if (eicr & IXGBE_EICR_GPI_SDP1) {
		/* Clear the interrupt */
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1);
2561 2562 2563 2564
		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
			adapter->flags |= IXGBE_FLAG_NEED_LINK_CONFIG;
			ixgbe_service_event_schedule(adapter);
		}
2565 2566 2567
	}
}

2568 2569 2570 2571 2572 2573 2574 2575 2576
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);
2577
		IXGBE_WRITE_FLUSH(hw);
2578
		ixgbe_service_event_schedule(adapter);
2579 2580 2581
	}
}

2582 2583 2584 2585
static inline void ixgbe_irq_enable_queues(struct ixgbe_adapter *adapter,
					   u64 qmask)
{
	u32 mask;
2586
	struct ixgbe_hw *hw = &adapter->hw;
2587

2588 2589
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
2590
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
2591 2592 2593
		IXGBE_WRITE_REG(hw, IXGBE_EIMS, mask);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2594
	case ixgbe_mac_X540:
2595
		mask = (qmask & 0xFFFFFFFF);
2596 2597
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(0), mask);
2598
		mask = (qmask >> 32);
2599 2600 2601 2602 2603
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(1), mask);
		break;
	default:
		break;
2604 2605 2606 2607 2608
	}
	/* skip the flush */
}

static inline void ixgbe_irq_disable_queues(struct ixgbe_adapter *adapter,
2609
					    u64 qmask)
2610 2611
{
	u32 mask;
2612
	struct ixgbe_hw *hw = &adapter->hw;
2613

2614 2615
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
2616
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
2617 2618 2619
		IXGBE_WRITE_REG(hw, IXGBE_EIMC, mask);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2620
	case ixgbe_mac_X540:
2621
		mask = (qmask & 0xFFFFFFFF);
2622 2623
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMC_EX(0), mask);
2624
		mask = (qmask >> 32);
2625 2626 2627 2628 2629
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMC_EX(1), mask);
		break;
	default:
		break;
2630 2631 2632 2633
	}
	/* skip the flush */
}

2634
/**
2635 2636
 * ixgbe_irq_enable - Enable default interrupt generation settings
 * @adapter: board private structure
2637
 **/
2638 2639
static inline void ixgbe_irq_enable(struct ixgbe_adapter *adapter, bool queues,
				    bool flush)
2640
{
2641
	u32 mask = (IXGBE_EIMS_ENABLE_MASK & ~IXGBE_EIMS_RTX_QUEUE);
2642

2643 2644 2645
	/* don't reenable LSC while waiting for link */
	if (adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE)
		mask &= ~IXGBE_EIMS_LSC;
2646

2647
	if (adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE)
2648 2649 2650 2651 2652 2653 2654 2655 2656 2657
		switch (adapter->hw.mac.type) {
		case ixgbe_mac_82599EB:
			mask |= IXGBE_EIMS_GPI_SDP0;
			break;
		case ixgbe_mac_X540:
			mask |= IXGBE_EIMS_TS;
			break;
		default:
			break;
		}
2658 2659 2660 2661 2662 2663
	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE)
		mask |= IXGBE_EIMS_GPI_SDP1;
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
		mask |= IXGBE_EIMS_GPI_SDP1;
		mask |= IXGBE_EIMS_GPI_SDP2;
2664 2665
	case ixgbe_mac_X540:
		mask |= IXGBE_EIMS_ECC;
2666 2667 2668 2669
		mask |= IXGBE_EIMS_MAILBOX;
		break;
	default:
		break;
2670
	}
J
Jacob Keller 已提交
2671 2672 2673 2674

	if (adapter->hw.mac.type == ixgbe_mac_X540)
		mask |= IXGBE_EIMS_TIMESYNC;

2675 2676 2677
	if ((adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) &&
	    !(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
		mask |= IXGBE_EIMS_FLOW_DIR;
2678

2679 2680 2681 2682 2683
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMS, mask);
	if (queues)
		ixgbe_irq_enable_queues(adapter, ~0);
	if (flush)
		IXGBE_WRITE_FLUSH(&adapter->hw);
2684 2685
}

2686
static irqreturn_t ixgbe_msix_other(int irq, void *data)
2687
{
2688
	struct ixgbe_adapter *adapter = data;
2689
	struct ixgbe_hw *hw = &adapter->hw;
2690
	u32 eicr;
2691

2692 2693 2694 2695 2696 2697 2698
	/*
	 * 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);
2699 2700 2701 2702 2703 2704 2705 2706 2707 2708

	/* The lower 16bits of the EICR register are for the queue interrupts
	 * which should be masked here in order to not accidently clear them if
	 * 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;

2709
	IXGBE_WRITE_REG(hw, IXGBE_EICR, eicr);
2710

2711 2712
	if (eicr & IXGBE_EICR_LSC)
		ixgbe_check_lsc(adapter);
2713

2714 2715
	if (eicr & IXGBE_EICR_MAILBOX)
		ixgbe_msg_task(adapter);
2716

2717 2718
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2719
	case ixgbe_mac_X540:
2720 2721 2722 2723 2724 2725
		if (eicr & IXGBE_EICR_ECC) {
			e_info(link, "Received ECC Err, initiating reset\n");
			adapter->flags2 |= IXGBE_FLAG2_RESET_REQUESTED;
			ixgbe_service_event_schedule(adapter);
			IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_ECC);
		}
2726 2727
		/* Handle Flow Director Full threshold interrupt */
		if (eicr & IXGBE_EICR_FLOW_DIR) {
2728
			int reinit_count = 0;
2729 2730
			int i;
			for (i = 0; i < adapter->num_tx_queues; i++) {
2731
				struct ixgbe_ring *ring = adapter->tx_ring[i];
A
Alexander Duyck 已提交
2732
				if (test_and_clear_bit(__IXGBE_TX_FDIR_INIT_DONE,
2733 2734 2735 2736 2737 2738 2739 2740
						       &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);
2741 2742
			}
		}
2743
		ixgbe_check_sfp_event(adapter, eicr);
2744
		ixgbe_check_overtemp_event(adapter, eicr);
2745 2746 2747
		break;
	default:
		break;
2748
	}
2749

2750
	ixgbe_check_fan_failure(adapter, eicr);
J
Jacob Keller 已提交
2751 2752 2753

	if (unlikely(eicr & IXGBE_EICR_TIMESYNC))
		ixgbe_ptp_check_pps_event(adapter, eicr);
2754

2755
	/* re-enable the original interrupt state, no lsc, no queues */
2756
	if (!test_bit(__IXGBE_DOWN, &adapter->state))
2757
		ixgbe_irq_enable(adapter, false, false);
2758

2759
	return IRQ_HANDLED;
2760
}
2761

2762
static irqreturn_t ixgbe_msix_clean_rings(int irq, void *data)
2763
{
2764
	struct ixgbe_q_vector *q_vector = data;
2765

2766
	/* EIAM disabled interrupts (on this vector) for us */
2767

2768 2769
	if (q_vector->rx.ring || q_vector->tx.ring)
		napi_schedule(&q_vector->napi);
2770

2771
	return IRQ_HANDLED;
2772 2773
}

2774 2775 2776 2777 2778 2779 2780
/**
 * 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
 **/
2781
int ixgbe_poll(struct napi_struct *napi, int budget)
2782 2783 2784 2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797
{
	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;
	int per_ring_budget;
	bool clean_complete = true;

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

	ixgbe_for_each_ring(ring, q_vector->tx)
		clean_complete &= !!ixgbe_clean_tx_irq(q_vector, ring);

2798 2799 2800
	if (!ixgbe_qv_lock_napi(q_vector))
		return budget;

2801 2802 2803 2804 2805 2806 2807 2808
	/* 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;

	ixgbe_for_each_ring(ring, q_vector->rx)
2809 2810
		clean_complete &= (ixgbe_clean_rx_irq(q_vector, ring,
				   per_ring_budget) < per_ring_budget);
2811

2812
	ixgbe_qv_unlock_napi(q_vector);
2813 2814 2815 2816 2817 2818 2819 2820 2821 2822 2823 2824 2825 2826
	/* If all work not completed, return budget and keep polling */
	if (!clean_complete)
		return budget;

	/* all work done, exit the polling mode */
	napi_complete(napi);
	if (adapter->rx_itr_setting & 1)
		ixgbe_set_itr(q_vector);
	if (!test_bit(__IXGBE_DOWN, &adapter->state))
		ixgbe_irq_enable_queues(adapter, ((u64)1 << q_vector->v_idx));

	return 0;
}

2827 2828 2829 2830 2831 2832 2833 2834 2835 2836
/**
 * 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;
2837
	int vector, err;
2838
	int ri = 0, ti = 0;
2839

2840
	for (vector = 0; vector < adapter->num_q_vectors; vector++) {
2841
		struct ixgbe_q_vector *q_vector = adapter->q_vector[vector];
2842
		struct msix_entry *entry = &adapter->msix_entries[vector];
R
Robert Olsson 已提交
2843

2844
		if (q_vector->tx.ring && q_vector->rx.ring) {
2845
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2846 2847 2848
				 "%s-%s-%d", netdev->name, "TxRx", ri++);
			ti++;
		} else if (q_vector->rx.ring) {
2849
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2850 2851
				 "%s-%s-%d", netdev->name, "rx", ri++);
		} else if (q_vector->tx.ring) {
2852
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2853
				 "%s-%s-%d", netdev->name, "tx", ti++);
2854 2855 2856
		} else {
			/* skip this unused q_vector */
			continue;
2857
		}
2858 2859
		err = request_irq(entry->vector, &ixgbe_msix_clean_rings, 0,
				  q_vector->name, q_vector);
2860
		if (err) {
2861
			e_err(probe, "request_irq failed for MSIX interrupt "
2862
			      "Error: %d\n", err);
2863
			goto free_queue_irqs;
2864
		}
2865 2866 2867 2868
		/* 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,
2869
					      &q_vector->affinity_mask);
2870
		}
2871 2872
	}

2873
	err = request_irq(adapter->msix_entries[vector].vector,
2874
			  ixgbe_msix_other, 0, netdev->name, adapter);
2875
	if (err) {
2876
		e_err(probe, "request_irq for msix_other failed: %d\n", err);
2877
		goto free_queue_irqs;
2878 2879 2880 2881
	}

	return 0;

2882
free_queue_irqs:
2883 2884 2885 2886 2887 2888 2889
	while (vector) {
		vector--;
		irq_set_affinity_hint(adapter->msix_entries[vector].vector,
				      NULL);
		free_irq(adapter->msix_entries[vector].vector,
			 adapter->q_vector[vector]);
	}
2890 2891
	adapter->flags &= ~IXGBE_FLAG_MSIX_ENABLED;
	pci_disable_msix(adapter->pdev);
2892 2893 2894 2895 2896 2897
	kfree(adapter->msix_entries);
	adapter->msix_entries = NULL;
	return err;
}

/**
2898
 * ixgbe_intr - legacy mode Interrupt Handler
2899 2900 2901 2902 2903
 * @irq: interrupt number
 * @data: pointer to a network interface device structure
 **/
static irqreturn_t ixgbe_intr(int irq, void *data)
{
2904
	struct ixgbe_adapter *adapter = data;
2905
	struct ixgbe_hw *hw = &adapter->hw;
2906
	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
2907 2908
	u32 eicr;

2909
	/*
2910
	 * Workaround for silicon errata #26 on 82598.  Mask the interrupt
2911 2912 2913 2914
	 * before the read of EICR.
	 */
	IXGBE_WRITE_REG(hw, IXGBE_EIMC, IXGBE_IRQ_CLEAR_MASK);

2915
	/* for NAPI, using EIAM to auto-mask tx/rx interrupt bits on read
S
Stephen Hemminger 已提交
2916
	 * therefore no explicit interrupt disable is necessary */
2917
	eicr = IXGBE_READ_REG(hw, IXGBE_EICR);
2918
	if (!eicr) {
2919 2920
		/*
		 * shared interrupt alert!
2921
		 * make sure interrupts are enabled because the read will
2922 2923 2924 2925 2926 2927
		 * 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);
2928
		return IRQ_NONE;	/* Not our interrupt */
2929
	}
2930

2931 2932
	if (eicr & IXGBE_EICR_LSC)
		ixgbe_check_lsc(adapter);
2933

2934 2935
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
2936
		ixgbe_check_sfp_event(adapter, eicr);
2937 2938
		/* Fall through */
	case ixgbe_mac_X540:
2939 2940 2941 2942 2943 2944
		if (eicr & IXGBE_EICR_ECC) {
			e_info(link, "Received ECC Err, initiating reset\n");
			adapter->flags2 |= IXGBE_FLAG2_RESET_REQUESTED;
			ixgbe_service_event_schedule(adapter);
			IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_ECC);
		}
2945
		ixgbe_check_overtemp_event(adapter, eicr);
2946 2947 2948 2949
		break;
	default:
		break;
	}
2950

2951
	ixgbe_check_fan_failure(adapter, eicr);
J
Jacob Keller 已提交
2952 2953
	if (unlikely(eicr & IXGBE_EICR_TIMESYNC))
		ixgbe_ptp_check_pps_event(adapter, eicr);
2954

2955 2956
	/* would disable interrupts here but EIAM disabled it */
	napi_schedule(&q_vector->napi);
2957

2958 2959 2960 2961 2962 2963 2964
	/*
	 * 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);

2965 2966 2967 2968 2969 2970 2971 2972 2973 2974
	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.
 **/
2975
static int ixgbe_request_irq(struct ixgbe_adapter *adapter)
2976 2977
{
	struct net_device *netdev = adapter->netdev;
2978
	int err;
2979

2980
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
2981
		err = ixgbe_request_msix_irqs(adapter);
2982
	else if (adapter->flags & IXGBE_FLAG_MSI_ENABLED)
2983
		err = request_irq(adapter->pdev->irq, ixgbe_intr, 0,
2984
				  netdev->name, adapter);
2985
	else
2986
		err = request_irq(adapter->pdev->irq, ixgbe_intr, IRQF_SHARED,
2987
				  netdev->name, adapter);
2988

2989
	if (err)
2990
		e_err(probe, "request_irq failed, Error %d\n", err);
2991 2992 2993 2994 2995 2996

	return err;
}

static void ixgbe_free_irq(struct ixgbe_adapter *adapter)
{
2997
	int vector;
2998

2999 3000 3001 3002
	if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED)) {
		free_irq(adapter->pdev->irq, adapter);
		return;
	}
3003

3004 3005 3006
	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];
3007

3008 3009 3010
		/* free only the irqs that were actually requested */
		if (!q_vector->rx.ring && !q_vector->tx.ring)
			continue;
3011

3012 3013 3014 3015
		/* clear the affinity_mask in the IRQ descriptor */
		irq_set_affinity_hint(entry->vector, NULL);

		free_irq(entry->vector, q_vector);
3016
	}
3017 3018

	free_irq(adapter->msix_entries[vector++].vector, adapter);
3019 3020
}

3021 3022 3023 3024 3025 3026
/**
 * ixgbe_irq_disable - Mask off interrupt generation on the NIC
 * @adapter: board private structure
 **/
static inline void ixgbe_irq_disable(struct ixgbe_adapter *adapter)
{
3027 3028
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
3029
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, ~0);
3030 3031
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3032
	case ixgbe_mac_X540:
3033 3034
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFF0000);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(0), ~0);
3035
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(1), ~0);
3036 3037 3038
		break;
	default:
		break;
3039 3040 3041
	}
	IXGBE_WRITE_FLUSH(&adapter->hw);
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
3042 3043 3044 3045 3046 3047
		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);
3048 3049 3050 3051 3052
	} else {
		synchronize_irq(adapter->pdev->irq);
	}
}

3053 3054 3055 3056 3057 3058
/**
 * ixgbe_configure_msi_and_legacy - Initialize PIN (INTA...) and MSI interrupts
 *
 **/
static void ixgbe_configure_msi_and_legacy(struct ixgbe_adapter *adapter)
{
3059
	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
3060

3061
	ixgbe_write_eitr(q_vector);
3062

3063 3064
	ixgbe_set_ivar(adapter, 0, 0, 0);
	ixgbe_set_ivar(adapter, 1, 0, 0);
3065

3066
	e_info(hw, "Legacy interrupt IVAR setup done\n");
3067 3068
}

3069 3070 3071 3072 3073 3074 3075
/**
 * 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.
 **/
3076 3077
void ixgbe_configure_tx_ring(struct ixgbe_adapter *adapter,
			     struct ixgbe_ring *ring)
3078 3079 3080
{
	struct ixgbe_hw *hw = &adapter->hw;
	u64 tdba = ring->dma;
3081
	int wait_loop = 10;
3082
	u32 txdctl = IXGBE_TXDCTL_ENABLE;
3083
	u8 reg_idx = ring->reg_idx;
3084

3085
	/* disable queue to avoid issues while updating state */
3086
	IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), 0);
3087 3088
	IXGBE_WRITE_FLUSH(hw);

3089
	IXGBE_WRITE_REG(hw, IXGBE_TDBAL(reg_idx),
3090
			(tdba & DMA_BIT_MASK(32)));
3091 3092 3093 3094 3095
	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);
3096
	ring->tail = adapter->io_addr + IXGBE_TDT(reg_idx);
3097

3098 3099
	/*
	 * set WTHRESH to encourage burst writeback, it should not be set
E
Emil Tantilov 已提交
3100 3101 3102
	 * 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
3103 3104 3105 3106 3107
	 *
	 * 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 已提交
3108 3109 3110
#if IS_ENABLED(CONFIG_BQL)
	if (!ring->q_vector || (ring->q_vector->itr < IXGBE_100K_ITR))
#else
3111
	if (!ring->q_vector || (ring->q_vector->itr < 8))
E
Emil Tantilov 已提交
3112
#endif
3113 3114 3115 3116
		txdctl |= (1 << 16);	/* WTHRESH = 1 */
	else
		txdctl |= (8 << 16);	/* WTHRESH = 8 */

3117 3118 3119 3120
	/*
	 * Setting PTHRESH to 32 both improves performance
	 * and avoids a TX hang with DFP enabled
	 */
3121 3122
	txdctl |= (1 << 8) |	/* HTHRESH = 1 */
		   32;		/* PTHRESH = 32 */
3123 3124

	/* reinitialize flowdirector state */
3125
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
3126 3127 3128 3129 3130 3131
		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;
	}
3132

3133 3134 3135 3136 3137
	/* 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)
3138
			netif_set_xps_queue(ring->netdev,
3139 3140 3141 3142
					    &q_vector->affinity_mask,
					    ring->queue_index);
	}

3143 3144
	clear_bit(__IXGBE_HANG_CHECK_ARMED, &ring->state);

3145 3146 3147 3148 3149 3150 3151 3152 3153 3154
	/* 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 {
3155
		usleep_range(1000, 2000);
3156 3157 3158 3159
		txdctl = IXGBE_READ_REG(hw, IXGBE_TXDCTL(reg_idx));
	} while (--wait_loop && !(txdctl & IXGBE_TXDCTL_ENABLE));
	if (!wait_loop)
		e_err(drv, "Could not enable Tx Queue %d\n", reg_idx);
3160 3161
}

3162 3163 3164
static void ixgbe_setup_mtqc(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3165
	u32 rttdcs, mtqc;
3166
	u8 tcs = netdev_get_num_tc(adapter->netdev);
3167 3168 3169 3170 3171 3172 3173 3174 3175 3176

	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 */
3177 3178 3179 3180 3181 3182 3183 3184 3185 3186 3187 3188 3189 3190 3191
	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;
		else if (adapter->ring_feature[RING_F_RSS].indices == 4)
			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;
3192
		else
3193 3194
			mtqc = IXGBE_MTQC_64Q_1PB;
	}
3195

3196
	IXGBE_WRITE_REG(hw, IXGBE_MTQC, mtqc);
3197

3198 3199 3200 3201 3202
	/* 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);
3203 3204 3205 3206 3207 3208 3209
	}

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

3210
/**
3211
 * ixgbe_configure_tx - Configure 8259x Transmit Unit after Reset
3212 3213 3214 3215 3216 3217
 * @adapter: board private structure
 *
 * Configure the Tx unit of the MAC after a reset.
 **/
static void ixgbe_configure_tx(struct ixgbe_adapter *adapter)
{
3218 3219
	struct ixgbe_hw *hw = &adapter->hw;
	u32 dmatxctl;
3220
	u32 i;
3221

3222 3223 3224 3225 3226 3227 3228 3229 3230
	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);
	}

3231
	/* Setup the HW Tx Head and Tail descriptor pointers */
3232 3233
	for (i = 0; i < adapter->num_tx_queues; i++)
		ixgbe_configure_tx_ring(adapter, adapter->tx_ring[i]);
3234 3235
}

3236 3237 3238 3239 3240 3241 3242 3243 3244 3245 3246 3247 3248 3249 3250 3251 3252 3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282 3283 3284 3285 3286 3287 3288 3289 3290
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]);
	}
}

3291
#define IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT 2
3292

3293
static void ixgbe_configure_srrctl(struct ixgbe_adapter *adapter,
3294
				   struct ixgbe_ring *rx_ring)
3295
{
3296
	struct ixgbe_hw *hw = &adapter->hw;
3297
	u32 srrctl;
3298
	u8 reg_idx = rx_ring->reg_idx;
3299

3300 3301
	if (hw->mac.type == ixgbe_mac_82598EB) {
		u16 mask = adapter->ring_feature[RING_F_RSS].mask;
3302

3303 3304 3305 3306 3307 3308
		/*
		 * if VMDq is not active we must program one srrctl register
		 * per RSS queue since we have enabled RDRXCTL.MVMEN
		 */
		reg_idx &= mask;
	}
3309

3310 3311
	/* configure header buffer length, needed for RSC */
	srrctl = IXGBE_RX_HDR_SIZE << IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT;
3312

3313
	/* configure the packet buffer length */
3314
	srrctl |= ixgbe_rx_bufsz(rx_ring) >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
3315 3316

	/* configure descriptor type */
3317
	srrctl |= IXGBE_SRRCTL_DESCTYPE_ADV_ONEBUF;
3318

3319
	IXGBE_WRITE_REG(hw, IXGBE_SRRCTL(reg_idx), srrctl);
3320
}
3321

3322
static void ixgbe_setup_mrqc(struct ixgbe_adapter *adapter)
3323
{
3324 3325
	struct ixgbe_hw *hw = &adapter->hw;
	static const u32 seed[10] = { 0xE291D73D, 0x1805EC6C, 0x2A94B30D,
3326 3327
			  0xA54F2BEC, 0xEA49AF7C, 0xE214AD3D, 0xB855AABE,
			  0x6A3E67EA, 0x14364D17, 0x3BED200D};
3328 3329 3330
	u32 mrqc = 0, reta = 0;
	u32 rxcsum;
	int i, j;
3331 3332 3333 3334 3335 3336 3337 3338 3339
	u16 rss_i = adapter->ring_feature[RING_F_RSS].indices;

	/*
	 * Program table for at least 2 queues w/ SR-IOV so that VFs can
	 * 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.
	 */
	if ((adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) && (rss_i < 2))
		rss_i = 2;
3340

3341 3342 3343 3344 3345 3346
	/* Fill out hash function seeds */
	for (i = 0; i < 10; i++)
		IXGBE_WRITE_REG(hw, IXGBE_RSSRK(i), seed[i]);

	/* Fill out redirection table */
	for (i = 0, j = 0; i < 128; i++, j++) {
3347
		if (j == rss_i)
3348 3349 3350 3351 3352 3353 3354
			j = 0;
		/* reta = 4-byte sliding window of
		 * 0x00..(indices-1)(indices-1)00..etc. */
		reta = (reta << 8) | (j * 0x11);
		if ((i & 3) == 3)
			IXGBE_WRITE_REG(hw, IXGBE_RETA(i >> 2), reta);
	}
3355

3356 3357 3358 3359 3360
	/* 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);

3361
	if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
3362
		if (adapter->ring_feature[RING_F_RSS].mask)
3363
			mrqc = IXGBE_MRQC_RSSEN;
3364
	} else {
3365 3366 3367 3368 3369 3370 3371 3372 3373
		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 */
			else if (adapter->ring_feature[RING_F_RSS].indices == 4)
				mrqc = IXGBE_MRQC_VMDQRSS32EN;
3374
			else
3375 3376 3377
				mrqc = IXGBE_MRQC_VMDQRSS64EN;
		} else {
			if (tcs > 4)
3378
				mrqc = IXGBE_MRQC_RTRSS8TCEN;
3379 3380 3381 3382
			else if (tcs > 1)
				mrqc = IXGBE_MRQC_RTRSS4TCEN;
			else
				mrqc = IXGBE_MRQC_RSSEN;
3383
		}
3384 3385
	}

3386
	/* Perform hash on these packet types */
3387 3388 3389 3390
	mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4 |
		IXGBE_MRQC_RSS_FIELD_IPV4_TCP |
		IXGBE_MRQC_RSS_FIELD_IPV6 |
		IXGBE_MRQC_RSS_FIELD_IPV6_TCP;
3391

3392 3393 3394 3395 3396
	if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV4_UDP)
		mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4_UDP;
	if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV6_UDP)
		mrqc |= IXGBE_MRQC_RSS_FIELD_IPV6_UDP;

3397
	IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
3398 3399
}

3400 3401 3402 3403 3404
/**
 * ixgbe_configure_rscctl - enable RSC for the indicated ring
 * @adapter:    address of board private structure
 * @index:      index of ring to set
 **/
3405
static void ixgbe_configure_rscctl(struct ixgbe_adapter *adapter,
3406
				   struct ixgbe_ring *ring)
3407 3408 3409
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 rscctrl;
3410
	u8 reg_idx = ring->reg_idx;
3411

A
Alexander Duyck 已提交
3412
	if (!ring_is_rsc_enabled(ring))
3413
		return;
3414

3415
	rscctrl = IXGBE_READ_REG(hw, IXGBE_RSCCTL(reg_idx));
3416 3417 3418 3419
	rscctrl |= IXGBE_RSCCTL_RSCEN;
	/*
	 * we must limit the number of descriptors so that the
	 * total size of max desc * buf_len is not greater
3420
	 * than 65536
3421
	 */
3422
	rscctrl |= IXGBE_RSCCTL_MAXDESC_16;
3423
	IXGBE_WRITE_REG(hw, IXGBE_RSCCTL(reg_idx), rscctrl);
3424 3425
}

3426 3427 3428 3429 3430 3431 3432
#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;
3433
	u8 reg_idx = ring->reg_idx;
3434

3435 3436
	if (ixgbe_removed(hw->hw_addr))
		return;
3437 3438 3439 3440 3441 3442
	/* 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 {
3443
		usleep_range(1000, 2000);
3444 3445 3446 3447 3448 3449 3450 3451 3452
		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);
	}
}

3453 3454 3455 3456 3457 3458 3459 3460
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;

3461 3462
	if (ixgbe_removed(hw->hw_addr))
		return;
3463 3464 3465 3466 3467 3468 3469 3470 3471 3472 3473 3474 3475 3476 3477 3478 3479 3480 3481 3482 3483 3484
	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);
	}
}

3485 3486
void ixgbe_configure_rx_ring(struct ixgbe_adapter *adapter,
			     struct ixgbe_ring *ring)
3487 3488 3489
{
	struct ixgbe_hw *hw = &adapter->hw;
	u64 rdba = ring->dma;
3490
	u32 rxdctl;
3491
	u8 reg_idx = ring->reg_idx;
3492

3493 3494
	/* disable queue to avoid issues while updating state */
	rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
3495
	ixgbe_disable_rx_queue(adapter, ring);
3496

3497 3498 3499 3500 3501 3502
	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));
	IXGBE_WRITE_REG(hw, IXGBE_RDH(reg_idx), 0);
	IXGBE_WRITE_REG(hw, IXGBE_RDT(reg_idx), 0);
3503
	ring->tail = adapter->io_addr + IXGBE_RDT(reg_idx);
3504 3505 3506 3507 3508 3509 3510 3511 3512 3513 3514 3515 3516 3517 3518 3519 3520 3521 3522 3523 3524

	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;
	}

	/* enable receive descriptor ring */
	rxdctl |= IXGBE_RXDCTL_ENABLE;
	IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(reg_idx), rxdctl);

	ixgbe_rx_desc_queue_enable(adapter, ring);
3525
	ixgbe_alloc_rx_buffers(ring, ixgbe_desc_unused(ring));
3526 3527
}

3528 3529 3530
static void ixgbe_setup_psrtype(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3531
	int rss_i = adapter->ring_feature[RING_F_RSS].indices;
3532
	u16 pool;
3533 3534 3535

	/* PSRTYPE must be initialized in non 82598 adapters */
	u32 psrtype = IXGBE_PSRTYPE_TCPHDR |
3536 3537
		      IXGBE_PSRTYPE_UDPHDR |
		      IXGBE_PSRTYPE_IPV4HDR |
3538
		      IXGBE_PSRTYPE_L2HDR |
3539
		      IXGBE_PSRTYPE_IPV6HDR;
3540 3541 3542 3543

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

3544 3545 3546 3547
	if (rss_i > 3)
		psrtype |= 2 << 29;
	else if (rss_i > 1)
		psrtype |= 1 << 29;
3548

3549 3550
	for_each_set_bit(pool, &adapter->fwd_bitmask, 32)
		IXGBE_WRITE_REG(hw, IXGBE_PSRTYPE(VMDQ_P(pool)), psrtype);
3551 3552
}

3553 3554 3555 3556
static void ixgbe_configure_virtualization(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 reg_offset, vf_shift;
3557
	u32 gcr_ext, vmdctl;
3558
	int i;
3559 3560 3561 3562 3563

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

	vmdctl = IXGBE_READ_REG(hw, IXGBE_VT_CTL);
3564 3565
	vmdctl |= IXGBE_VMD_CTL_VMDQ_EN;
	vmdctl &= ~IXGBE_VT_CTL_POOL_MASK;
3566
	vmdctl |= VMDQ_P(0) << IXGBE_VT_CTL_POOL_SHIFT;
3567 3568
	vmdctl |= IXGBE_VT_CTL_REPLEN;
	IXGBE_WRITE_REG(hw, IXGBE_VT_CTL, vmdctl);
3569

3570 3571
	vf_shift = VMDQ_P(0) % 32;
	reg_offset = (VMDQ_P(0) >= 32) ? 1 : 0;
3572 3573

	/* Enable only the PF's pool for Tx/Rx */
3574 3575 3576 3577
	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), (~0) << vf_shift);
	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset ^ 1), reg_offset - 1);
	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), (~0) << vf_shift);
	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset ^ 1), reg_offset - 1);
3578 3579
	if (adapter->flags2 & IXGBE_FLAG2_BRIDGE_MODE_VEB)
		IXGBE_WRITE_REG(hw, IXGBE_PFDTXGSWC, IXGBE_PFDTXGSWC_VT_LBEN);
3580 3581

	/* Map PF MAC address in RAR Entry 0 to first pool following VFs */
3582
	hw->mac.ops.set_vmdq(hw, 0, VMDQ_P(0));
3583 3584 3585 3586 3587

	/*
	 * Set up VF register offsets for selected VT Mode,
	 * i.e. 32 or 64 VFs for SR-IOV
	 */
3588 3589 3590 3591 3592 3593 3594 3595 3596 3597 3598 3599
	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;
	}

3600 3601
	IXGBE_WRITE_REG(hw, IXGBE_GCR_EXT, gcr_ext);

3602

3603
	/* Enable MAC Anti-Spoofing */
3604
	hw->mac.ops.set_mac_anti_spoofing(hw, (adapter->num_vfs != 0),
3605
					  adapter->num_vfs);
3606 3607 3608 3609 3610
	/* For VFs that have spoof checking turned off */
	for (i = 0; i < adapter->num_vfs; i++) {
		if (!adapter->vfinfo[i].spoofchk_enabled)
			ixgbe_ndo_set_vf_spoofchk(adapter->netdev, i, false);
	}
3611 3612
}

3613
static void ixgbe_set_rx_buffer_len(struct ixgbe_adapter *adapter)
3614 3615 3616 3617
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct net_device *netdev = adapter->netdev;
	int max_frame = netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
3618 3619 3620
	struct ixgbe_ring *rx_ring;
	int i;
	u32 mhadd, hlreg0;
3621

3622
#ifdef IXGBE_FCOE
3623 3624 3625 3626
	/* 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;
3627

3628
#endif /* IXGBE_FCOE */
3629 3630 3631 3632 3633

	/* 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);

3634 3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645
	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);
3646

3647 3648 3649 3650
	/*
	 * Setup the HW Rx Head and Tail Descriptor Pointers and
	 * the Base and Length of the Rx Descriptor Ring
	 */
3651
	for (i = 0; i < adapter->num_rx_queues; i++) {
3652
		rx_ring = adapter->rx_ring[i];
A
Alexander Duyck 已提交
3653 3654
		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
			set_ring_rsc_enabled(rx_ring);
3655
		else
A
Alexander Duyck 已提交
3656
			clear_ring_rsc_enabled(rx_ring);
3657 3658 3659
	}
}

3660 3661 3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672 3673 3674 3675 3676 3677 3678 3679
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;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3680
	case ixgbe_mac_X540:
3681 3682 3683 3684 3685 3686 3687 3688 3689 3690 3691 3692 3693 3694 3695 3696
		/* 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);
}

3697 3698 3699 3700 3701 3702 3703 3704 3705 3706
/**
 * 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;
3707
	u32 rxctrl, rfctl;
3708 3709 3710 3711 3712 3713

	/* disable receives while setting up the descriptors */
	rxctrl = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
	IXGBE_WRITE_REG(hw, IXGBE_RXCTRL, rxctrl & ~IXGBE_RXCTRL_RXEN);

	ixgbe_setup_psrtype(adapter);
3714
	ixgbe_setup_rdrxctl(adapter);
3715

3716 3717 3718 3719 3720 3721 3722
	/* 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;
	IXGBE_WRITE_REG(hw, IXGBE_RFCTL, rfctl);

3723
	/* Program registers for the distribution of queues */
3724 3725
	ixgbe_setup_mrqc(adapter);

3726 3727 3728 3729 3730 3731 3732
	/* 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
	 */
3733 3734
	for (i = 0; i < adapter->num_rx_queues; i++)
		ixgbe_configure_rx_ring(adapter, adapter->rx_ring[i]);
3735

3736 3737 3738 3739 3740 3741 3742
	/* 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);
3743 3744
}

3745 3746
static int ixgbe_vlan_rx_add_vid(struct net_device *netdev,
				 __be16 proto, u16 vid)
3747 3748 3749 3750 3751
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

	/* add VID to filter table */
3752
	hw->mac.ops.set_vfta(&adapter->hw, vid, VMDQ_P(0), true);
3753
	set_bit(vid, adapter->active_vlans);
3754 3755

	return 0;
3756 3757
}

3758 3759
static int ixgbe_vlan_rx_kill_vid(struct net_device *netdev,
				  __be16 proto, u16 vid)
3760 3761 3762 3763 3764
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

	/* remove VID from filter table */
3765
	hw->mac.ops.set_vfta(&adapter->hw, vid, VMDQ_P(0), false);
3766
	clear_bit(vid, adapter->active_vlans);
3767 3768

	return 0;
3769 3770
}

3771 3772 3773 3774 3775 3776 3777 3778
/**
 * 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;
3779 3780 3781 3782
	int i, j;

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
3783 3784
		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
		vlnctrl &= ~IXGBE_VLNCTRL_VME;
3785 3786 3787
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3788
	case ixgbe_mac_X540:
3789
		for (i = 0; i < adapter->num_rx_queues; i++) {
3790 3791 3792 3793 3794
			struct ixgbe_ring *ring = adapter->rx_ring[i];

			if (ring->l2_accel_priv)
				continue;
			j = ring->reg_idx;
3795 3796 3797 3798 3799 3800 3801 3802 3803 3804 3805
			vlnctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(j));
			vlnctrl &= ~IXGBE_RXDCTL_VME;
			IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(j), vlnctrl);
		}
		break;
	default:
		break;
	}
}

/**
3806
 * ixgbe_vlan_strip_enable - helper to enable hw vlan stripping
3807 3808
 * @adapter: driver data
 */
3809
static void ixgbe_vlan_strip_enable(struct ixgbe_adapter *adapter)
3810 3811
{
	struct ixgbe_hw *hw = &adapter->hw;
3812
	u32 vlnctrl;
3813 3814 3815 3816
	int i, j;

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
3817 3818
		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
		vlnctrl |= IXGBE_VLNCTRL_VME;
3819 3820 3821
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3822
	case ixgbe_mac_X540:
3823
		for (i = 0; i < adapter->num_rx_queues; i++) {
3824 3825 3826 3827 3828
			struct ixgbe_ring *ring = adapter->rx_ring[i];

			if (ring->l2_accel_priv)
				continue;
			j = ring->reg_idx;
3829 3830 3831 3832 3833 3834 3835 3836 3837 3838
			vlnctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(j));
			vlnctrl |= IXGBE_RXDCTL_VME;
			IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(j), vlnctrl);
		}
		break;
	default:
		break;
	}
}

3839 3840
static void ixgbe_restore_vlan(struct ixgbe_adapter *adapter)
{
3841
	u16 vid;
3842

3843
	ixgbe_vlan_rx_add_vid(adapter->netdev, htons(ETH_P_8021Q), 0);
3844 3845

	for_each_set_bit(vid, adapter->active_vlans, VLAN_N_VID)
3846
		ixgbe_vlan_rx_add_vid(adapter->netdev, htons(ETH_P_8021Q), vid);
3847 3848
}

3849 3850 3851 3852 3853 3854 3855 3856 3857 3858 3859 3860 3861 3862 3863 3864 3865 3866 3867 3868 3869 3870 3871
/**
 * 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
3872
	ixgbe_restore_vf_multicasts(adapter);
3873 3874 3875 3876 3877
#endif

	return netdev_mc_count(netdev);
}

3878 3879 3880 3881 3882 3883 3884 3885 3886 3887 3888 3889 3890 3891 3892 3893 3894 3895 3896 3897 3898 3899 3900 3901 3902 3903 3904 3905 3906 3907 3908 3909 3910 3911 3912 3913 3914 3915 3916 3917 3918 3919 3920 3921 3922 3923 3924 3925 3926 3927 3928 3929 3930 3931 3932 3933 3934 3935 3936 3937 3938 3939 3940 3941 3942 3943 3944 3945 3946 3947 3948 3949 3950 3951 3952 3953 3954 3955 3956 3957 3958 3959 3960 3961 3962 3963 3964 3965 3966 3967 3968 3969 3970 3971 3972 3973 3974 3975 3976 3977 3978 3979 3980 3981 3982 3983 3984 3985 3986 3987 3988 3989 3990 3991 3992 3993 3994 3995 3996 3997 3998 3999 4000
#ifdef CONFIG_PCI_IOV
void ixgbe_full_sync_mac_table(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int i;
	for (i = 0; i < hw->mac.num_rar_entries; i++) {
		if (adapter->mac_table[i].state & IXGBE_MAC_STATE_IN_USE)
			hw->mac.ops.set_rar(hw, i, adapter->mac_table[i].addr,
					    adapter->mac_table[i].queue,
					    IXGBE_RAH_AV);
		else
			hw->mac.ops.clear_rar(hw, i);

		adapter->mac_table[i].state &= ~(IXGBE_MAC_STATE_MODIFIED);
	}
}
#endif

static void ixgbe_sync_mac_table(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int i;
	for (i = 0; i < hw->mac.num_rar_entries; i++) {
		if (adapter->mac_table[i].state & IXGBE_MAC_STATE_MODIFIED) {
			if (adapter->mac_table[i].state &
			    IXGBE_MAC_STATE_IN_USE)
				hw->mac.ops.set_rar(hw, i,
						adapter->mac_table[i].addr,
						adapter->mac_table[i].queue,
						IXGBE_RAH_AV);
			else
				hw->mac.ops.clear_rar(hw, i);

			adapter->mac_table[i].state &=
						~(IXGBE_MAC_STATE_MODIFIED);
		}
	}
}

static void ixgbe_flush_sw_mac_table(struct ixgbe_adapter *adapter)
{
	int i;
	struct ixgbe_hw *hw = &adapter->hw;

	for (i = 0; i < hw->mac.num_rar_entries; i++) {
		adapter->mac_table[i].state |= IXGBE_MAC_STATE_MODIFIED;
		adapter->mac_table[i].state &= ~IXGBE_MAC_STATE_IN_USE;
		memset(adapter->mac_table[i].addr, 0, ETH_ALEN);
		adapter->mac_table[i].queue = 0;
	}
	ixgbe_sync_mac_table(adapter);
}

static int ixgbe_available_rars(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int i, count = 0;

	for (i = 0; i < hw->mac.num_rar_entries; i++) {
		if (adapter->mac_table[i].state == 0)
			count++;
	}
	return count;
}

/* this function destroys the first RAR entry */
static void ixgbe_mac_set_default_filter(struct ixgbe_adapter *adapter,
					 u8 *addr)
{
	struct ixgbe_hw *hw = &adapter->hw;

	memcpy(&adapter->mac_table[0].addr, addr, ETH_ALEN);
	adapter->mac_table[0].queue = VMDQ_P(0);
	adapter->mac_table[0].state = (IXGBE_MAC_STATE_DEFAULT |
				       IXGBE_MAC_STATE_IN_USE);
	hw->mac.ops.set_rar(hw, 0, adapter->mac_table[0].addr,
			    adapter->mac_table[0].queue,
			    IXGBE_RAH_AV);
}

int ixgbe_add_mac_filter(struct ixgbe_adapter *adapter, u8 *addr, u16 queue)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int i;

	if (is_zero_ether_addr(addr))
		return -EINVAL;

	for (i = 0; i < hw->mac.num_rar_entries; i++) {
		if (adapter->mac_table[i].state & IXGBE_MAC_STATE_IN_USE)
			continue;
		adapter->mac_table[i].state |= (IXGBE_MAC_STATE_MODIFIED |
						IXGBE_MAC_STATE_IN_USE);
		ether_addr_copy(adapter->mac_table[i].addr, addr);
		adapter->mac_table[i].queue = queue;
		ixgbe_sync_mac_table(adapter);
		return i;
	}
	return -ENOMEM;
}

int ixgbe_del_mac_filter(struct ixgbe_adapter *adapter, u8 *addr, u16 queue)
{
	/* search table for addr, if found, set to 0 and sync */
	int i;
	struct ixgbe_hw *hw = &adapter->hw;

	if (is_zero_ether_addr(addr))
		return -EINVAL;

	for (i = 0; i < hw->mac.num_rar_entries; i++) {
		if (ether_addr_equal(addr, adapter->mac_table[i].addr) &&
		    adapter->mac_table[i].queue == queue) {
			adapter->mac_table[i].state |= IXGBE_MAC_STATE_MODIFIED;
			adapter->mac_table[i].state &= ~IXGBE_MAC_STATE_IN_USE;
			memset(adapter->mac_table[i].addr, 0, ETH_ALEN);
			adapter->mac_table[i].queue = 0;
			ixgbe_sync_mac_table(adapter);
			return 0;
		}
	}
	return -ENOMEM;
}
4001 4002 4003 4004 4005 4006 4007 4008 4009
/**
 * 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
 **/
4010
static int ixgbe_write_uc_addr_list(struct net_device *netdev, int vfn)
4011 4012 4013 4014 4015
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	int count = 0;

	/* return ENOMEM indicating insufficient memory for addresses */
4016
	if (netdev_uc_count(netdev) > ixgbe_available_rars(adapter))
4017 4018
		return -ENOMEM;

4019
	if (!netdev_uc_empty(netdev)) {
4020 4021
		struct netdev_hw_addr *ha;
		netdev_for_each_uc_addr(ha, netdev) {
4022 4023
			ixgbe_del_mac_filter(adapter, ha->addr, vfn);
			ixgbe_add_mac_filter(adapter, ha->addr, vfn);
4024 4025 4026 4027 4028 4029
			count++;
		}
	}
	return count;
}

4030
/**
4031
 * ixgbe_set_rx_mode - Unicast, Multicast and Promiscuous mode set
4032 4033
 * @netdev: network interface device structure
 *
4034 4035 4036 4037
 * 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.
4038
 **/
4039
void ixgbe_set_rx_mode(struct net_device *netdev)
4040 4041 4042
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;
4043
	u32 fctrl, vmolr = IXGBE_VMOLR_BAM | IXGBE_VMOLR_AUPE;
4044
	u32 vlnctrl;
4045
	int count;
4046 4047 4048

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

4051
	/* set all bits that we expect to always be set */
B
Ben Greear 已提交
4052
	fctrl &= ~IXGBE_FCTRL_SBP; /* disable store-bad-packets */
4053 4054 4055 4056
	fctrl |= IXGBE_FCTRL_BAM;
	fctrl |= IXGBE_FCTRL_DPF; /* discard pause frames when FC enabled */
	fctrl |= IXGBE_FCTRL_PMCF;

4057 4058
	/* clear the bits we are changing the status of */
	fctrl &= ~(IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);
4059
	vlnctrl &= ~(IXGBE_VLNCTRL_VFE | IXGBE_VLNCTRL_CFIEN);
4060
	if (netdev->flags & IFF_PROMISC) {
4061
		hw->addr_ctrl.user_set_promisc = true;
4062
		fctrl |= (IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);
4063
		vmolr |= IXGBE_VMOLR_MPE;
4064 4065 4066 4067 4068 4069
		/* Only disable hardware filter vlans in promiscuous mode
		 * if SR-IOV and VMDQ are disabled - otherwise ensure
		 * that hardware VLAN filters remain enabled.
		 */
		if (!(adapter->flags & (IXGBE_FLAG_VMDQ_ENABLED |
					IXGBE_FLAG_SRIOV_ENABLED)))
4070
			vlnctrl |= (IXGBE_VLNCTRL_VFE | IXGBE_VLNCTRL_CFIEN);
4071
	} else {
4072 4073
		if (netdev->flags & IFF_ALLMULTI) {
			fctrl |= IXGBE_FCTRL_MPE;
4074
			vmolr |= IXGBE_VMOLR_MPE;
4075
		}
4076
		vlnctrl |= IXGBE_VLNCTRL_VFE;
4077
		hw->addr_ctrl.user_set_promisc = false;
4078 4079 4080 4081 4082 4083 4084
	}

	/*
	 * Write addresses to available RAR registers, if there is not
	 * sufficient space to store all the addresses then enable
	 * unicast promiscuous mode
	 */
4085
	count = ixgbe_write_uc_addr_list(netdev, VMDQ_P(0));
4086 4087 4088
	if (count < 0) {
		fctrl |= IXGBE_FCTRL_UPE;
		vmolr |= IXGBE_VMOLR_ROPE;
4089 4090
	}

4091 4092 4093 4094
	/* 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
	 */
4095 4096 4097 4098 4099 4100 4101
	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;
	}
4102 4103 4104

	if (hw->mac.type != ixgbe_mac_82598EB) {
		vmolr |= IXGBE_READ_REG(hw, IXGBE_VMOLR(VMDQ_P(0))) &
4105 4106
			 ~(IXGBE_VMOLR_MPE | IXGBE_VMOLR_ROMPE |
			   IXGBE_VMOLR_ROPE);
4107
		IXGBE_WRITE_REG(hw, IXGBE_VMOLR(VMDQ_P(0)), vmolr);
4108 4109
	}

B
Ben Greear 已提交
4110 4111 4112 4113 4114 4115 4116 4117 4118 4119 4120 4121
	/* This is useful for sniffing bad packets. */
	if (adapter->netdev->features & NETIF_F_RXALL) {
		/* 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 */
	}

4122
	IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
4123
	IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
4124

4125
	if (netdev->features & NETIF_F_HW_VLAN_CTAG_RX)
4126 4127 4128
		ixgbe_vlan_strip_enable(adapter);
	else
		ixgbe_vlan_strip_disable(adapter);
4129 4130
}

4131 4132 4133 4134
static void ixgbe_napi_enable_all(struct ixgbe_adapter *adapter)
{
	int q_idx;

4135 4136
	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++) {
		ixgbe_qv_init_lock(adapter->q_vector[q_idx]);
4137
		napi_enable(&adapter->q_vector[q_idx]->napi);
4138
	}
4139 4140 4141 4142 4143 4144
}

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

4145
	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++) {
4146
		napi_disable(&adapter->q_vector[q_idx]->napi);
4147
		while (!ixgbe_qv_disable(adapter->q_vector[q_idx])) {
4148
			pr_info("QV %d locked\n", q_idx);
4149
			usleep_range(1000, 20000);
4150 4151
		}
	}
4152 4153
}

J
Jeff Kirsher 已提交
4154
#ifdef CONFIG_IXGBE_DCB
4155
/**
4156 4157 4158 4159 4160 4161 4162 4163 4164 4165
 * 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;
4166
	int max_frame = adapter->netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
4167

4168 4169 4170 4171 4172 4173 4174 4175 4176
	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);

4177
#ifdef IXGBE_FCOE
4178 4179
	if (adapter->netdev->features & NETIF_F_FCOE_MTU)
		max_frame = max(max_frame, IXGBE_FCOE_JUMBO_FRAME_SIZE);
4180
#endif
4181 4182 4183

	/* reconfigure the hardware */
	if (adapter->dcbx_cap & DCB_CAP_DCBX_VER_CEE) {
4184 4185 4186 4187 4188
		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);
4189 4190 4191 4192 4193 4194 4195
	} 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);
4196
	}
4197 4198 4199

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

4203 4204 4205 4206
		while (rss_i) {
			msb++;
			rss_i >>= 1;
		}
4207

4208 4209
		/* write msb to all 8 TCs in one write */
		IXGBE_WRITE_REG(hw, IXGBE_RQTC, msb * 0x11111111);
4210
	}
4211
}
4212 4213 4214 4215 4216
#endif

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

4217
/**
4218 4219 4220
 * ixgbe_hpbthresh - calculate high water mark for flow control
 *
 * @adapter: board private structure to calculate for
4221
 * @pb: packet buffer to calculate
4222 4223 4224 4225 4226 4227 4228 4229 4230 4231 4232 4233 4234
 */
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 */
4235 4236 4237 4238
	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;
4239
#endif
4240

4241 4242 4243 4244 4245 4246 4247 4248 4249 4250 4251 4252 4253 4254 4255 4256 4257 4258 4259 4260 4261 4262 4263 4264 4265 4266 4267 4268 4269 4270 4271 4272 4273 4274
	/* Calculate delay value for device */
	switch (hw->mac.type) {
	case ixgbe_mac_X540:
		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;
}

4275
/**
4276 4277 4278
 * ixgbe_lpbthresh - calculate low water mark for for flow control
 *
 * @adapter: board private structure to calculate for
4279
 * @pb: packet buffer to calculate
4280
 */
4281
static int ixgbe_lpbthresh(struct ixgbe_adapter *adapter, int pb)
4282 4283 4284 4285 4286 4287 4288 4289 4290
{
	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;

4291 4292 4293 4294 4295 4296 4297 4298
#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

4299 4300 4301 4302 4303 4304 4305 4306 4307 4308 4309 4310 4311 4312 4313 4314 4315 4316 4317 4318 4319 4320 4321 4322 4323 4324 4325 4326
	/* Calculate delay value for device */
	switch (hw->mac.type) {
	case ixgbe_mac_X540:
		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);
4327
		hw->fc.low_water[i] = ixgbe_lpbthresh(adapter, i);
4328 4329

		/* Low water marks must not be larger than high water marks */
4330 4331
		if (hw->fc.low_water[i] > hw->fc.high_water[i])
			hw->fc.low_water[i] = 0;
4332
	}
4333 4334 4335

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

4338 4339 4340
static void ixgbe_configure_pb(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
4341 4342
	int hdrm;
	u8 tc = netdev_get_num_tc(adapter->netdev);
4343 4344 4345

	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE ||
	    adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE)
4346 4347 4348
		hdrm = 32 << adapter->fdir_pballoc;
	else
		hdrm = 0;
4349

4350
	hw->mac.ops.set_rxpba(hw, tc, hdrm, PBA_STRATEGY_EQUAL);
4351
	ixgbe_pbthresh_setup(adapter);
4352 4353
}

4354 4355 4356
static void ixgbe_fdir_filter_restore(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
4357
	struct hlist_node *node2;
4358 4359 4360 4361 4362 4363 4364
	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);

4365
	hlist_for_each_entry_safe(filter, node2,
4366 4367
				  &adapter->fdir_filter_list, fdir_node) {
		ixgbe_fdir_write_perfect_filter_82599(hw,
4368 4369 4370 4371 4372
				&filter->filter,
				filter->sw_idx,
				(filter->action == IXGBE_FDIR_DROP_QUEUE) ?
				IXGBE_FDIR_DROP_QUEUE :
				adapter->rx_ring[filter->action]->reg_idx);
4373 4374 4375 4376 4377
	}

	spin_unlock(&adapter->fdir_perfect_lock);
}

4378 4379 4380 4381 4382 4383 4384 4385 4386 4387 4388 4389 4390 4391 4392 4393 4394 4395 4396
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);
	}
4397
	ixgbe_write_uc_addr_list(adapter->netdev, pool);
4398 4399 4400 4401 4402 4403
	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;
4404
	int rss_i = adapter->num_rx_queues_per_pool;
4405 4406 4407 4408 4409 4410 4411 4412 4413 4414 4415 4416 4417 4418 4419 4420 4421 4422 4423 4424 4425 4426 4427 4428 4429 4430 4431 4432 4433 4434 4435 4436 4437 4438 4439 4440 4441 4442 4443 4444 4445 4446 4447 4448 4449 4450 4451 4452 4453 4454 4455 4456 4457 4458 4459 4460 4461 4462 4463 4464 4465 4466 4467 4468 4469 4470 4471 4472 4473 4474 4475 4476 4477 4478 4479 4480 4481 4482 4483 4484 4485 4486 4487 4488 4489 4490
	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)
		psrtype |= 2 << 29;
	else if (rss_i > 1)
		psrtype |= 1 << 29;

	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)
{
	struct device *dev = rx_ring->dev;
	unsigned long size;
	u16 i;

	/* ring already cleared, nothing to do */
	if (!rx_ring->rx_buffer_info)
		return;

	/* Free all the Rx ring sk_buffs */
	for (i = 0; i < rx_ring->count; i++) {
		struct ixgbe_rx_buffer *rx_buffer;

		rx_buffer = &rx_ring->rx_buffer_info[i];
		if (rx_buffer->skb) {
			struct sk_buff *skb = rx_buffer->skb;
			if (IXGBE_CB(skb)->page_released) {
				dma_unmap_page(dev,
					       IXGBE_CB(skb)->dma,
					       ixgbe_rx_bufsz(rx_ring),
					       DMA_FROM_DEVICE);
				IXGBE_CB(skb)->page_released = false;
			}
			dev_kfree_skb(skb);
		}
		rx_buffer->skb = NULL;
		if (rx_buffer->dma)
			dma_unmap_page(dev, rx_buffer->dma,
				       ixgbe_rx_pg_size(rx_ring),
				       DMA_FROM_DEVICE);
		rx_buffer->dma = 0;
		if (rx_buffer->page)
			__free_pages(rx_buffer->page,
				     ixgbe_rx_pg_order(rx_ring));
		rx_buffer->page = NULL;
	}

	size = sizeof(struct ixgbe_rx_buffer) * rx_ring->count;
	memset(rx_ring->rx_buffer_info, 0, size);

	/* Zero out the descriptor ring */
	memset(rx_ring->desc, 0, rx_ring->size);

	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);
	ixgbe_irq_disable_queues(adapter, ((u64)1 << index));
	ixgbe_clean_rx_ring(rx_ring);
	rx_ring->l2_accel_priv = NULL;
}

4491 4492
static int ixgbe_fwd_ring_down(struct net_device *vdev,
			       struct ixgbe_fwd_adapter *accel)
4493 4494 4495 4496 4497 4498 4499 4500 4501 4502 4503 4504 4505 4506 4507 4508 4509 4510 4511 4512 4513 4514 4515 4516 4517 4518 4519 4520 4521 4522 4523 4524 4525 4526 4527 4528 4529 4530 4531 4532 4533 4534 4535 4536 4537 4538 4539 4540 4541 4542 4543 4544 4545 4546 4547 4548 4549 4550 4551 4552 4553 4554 4555 4556 4557 4558 4559 4560 4561 4562 4563 4564 4565 4566 4567 4568 4569 4570 4571 4572 4573 4574 4575 4576 4577 4578 4579 4580 4581 4582 4583 4584 4585 4586 4587 4588 4589
{
	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;
}

static void ixgbe_configure_dfwd(struct ixgbe_adapter *adapter)
{
	struct net_device *upper;
	struct list_head *iter;
	int err;

	netdev_for_each_all_upper_dev_rcu(adapter->netdev, upper, iter) {
		if (netif_is_macvlan(upper)) {
			struct macvlan_dev *dfwd = netdev_priv(upper);
			struct ixgbe_fwd_adapter *vadapter = dfwd->fwd_priv;

			if (dfwd->fwd_priv) {
				err = ixgbe_fwd_ring_up(upper, vadapter);
				if (err)
					continue;
			}
		}
	}
}

4590 4591
static void ixgbe_configure(struct ixgbe_adapter *adapter)
{
4592 4593
	struct ixgbe_hw *hw = &adapter->hw;

4594
	ixgbe_configure_pb(adapter);
J
Jeff Kirsher 已提交
4595
#ifdef CONFIG_IXGBE_DCB
4596
	ixgbe_configure_dcb(adapter);
4597
#endif
4598 4599 4600 4601 4602
	/*
	 * We must restore virtualization before VLANs or else
	 * the VLVF registers will not be populated
	 */
	ixgbe_configure_virtualization(adapter);
4603

4604
	ixgbe_set_rx_mode(adapter->netdev);
4605 4606
	ixgbe_restore_vlan(adapter);

4607 4608 4609 4610 4611 4612 4613 4614 4615
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
		hw->mac.ops.disable_rx_buff(hw);
		break;
	default:
		break;
	}

4616
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
4617 4618
		ixgbe_init_fdir_signature_82599(&adapter->hw,
						adapter->fdir_pballoc);
4619 4620 4621 4622
	} else if (adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE) {
		ixgbe_init_fdir_perfect_82599(&adapter->hw,
					      adapter->fdir_pballoc);
		ixgbe_fdir_filter_restore(adapter);
4623
	}
4624

4625 4626 4627 4628 4629 4630 4631 4632 4633
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
		hw->mac.ops.enable_rx_buff(hw);
		break;
	default:
		break;
	}

4634 4635 4636 4637 4638
#ifdef IXGBE_FCOE
	/* configure FCoE L2 filters, redirection table, and Rx control */
	ixgbe_configure_fcoe(adapter);

#endif /* IXGBE_FCOE */
4639 4640
	ixgbe_configure_tx(adapter);
	ixgbe_configure_rx(adapter);
4641
	ixgbe_configure_dfwd(adapter);
4642 4643
}

4644 4645 4646 4647 4648 4649 4650
static inline bool ixgbe_is_sfp(struct ixgbe_hw *hw)
{
	switch (hw->phy.type) {
	case ixgbe_phy_sfp_avago:
	case ixgbe_phy_sfp_ftl:
	case ixgbe_phy_sfp_intel:
	case ixgbe_phy_sfp_unknown:
4651 4652 4653 4654
	case ixgbe_phy_sfp_passive_tyco:
	case ixgbe_phy_sfp_passive_unknown:
	case ixgbe_phy_sfp_active_unknown:
	case ixgbe_phy_sfp_ftl_active:
4655 4656 4657 4658
	case ixgbe_phy_qsfp_passive_unknown:
	case ixgbe_phy_qsfp_active_unknown:
	case ixgbe_phy_qsfp_intel:
	case ixgbe_phy_qsfp_unknown:
4659
		return true;
4660 4661 4662
	case ixgbe_phy_nl:
		if (hw->mac.type == ixgbe_mac_82598EB)
			return true;
4663 4664 4665 4666 4667
	default:
		return false;
	}
}

4668
/**
4669 4670 4671 4672 4673
 * ixgbe_sfp_link_config - set up SFP+ link
 * @adapter: pointer to private adapter struct
 **/
static void ixgbe_sfp_link_config(struct ixgbe_adapter *adapter)
{
4674
	/*
S
Stephen Hemminger 已提交
4675
	 * We are assuming the worst case scenario here, and that
4676 4677 4678 4679 4680 4681
	 * 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;
4682

4683
	adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
4684 4685 4686 4687
}

/**
 * ixgbe_non_sfp_link_config - set up non-SFP+ link
4688 4689 4690 4691
 * @hw: pointer to private hardware struct
 *
 * Returns 0 on success, negative on failure
 **/
4692
static int ixgbe_non_sfp_link_config(struct ixgbe_hw *hw)
4693
{
J
Josh Hay 已提交
4694 4695
	u32 speed;
	bool autoneg, link_up = false;
4696 4697 4698
	u32 ret = IXGBE_ERR_LINK_SETUP;

	if (hw->mac.ops.check_link)
J
Josh Hay 已提交
4699
		ret = hw->mac.ops.check_link(hw, &speed, &link_up, false);
4700 4701 4702 4703

	if (ret)
		goto link_cfg_out;

J
Josh Hay 已提交
4704 4705 4706 4707
	speed = hw->phy.autoneg_advertised;
	if ((!speed) && (hw->mac.ops.get_link_capabilities))
		ret = hw->mac.ops.get_link_capabilities(hw, &speed,
							&autoneg);
4708 4709 4710
	if (ret)
		goto link_cfg_out;

4711
	if (hw->mac.ops.setup_link)
J
Josh Hay 已提交
4712
		ret = hw->mac.ops.setup_link(hw, speed, link_up);
4713 4714 4715 4716
link_cfg_out:
	return ret;
}

4717
static void ixgbe_setup_gpie(struct ixgbe_adapter *adapter)
4718 4719
{
	struct ixgbe_hw *hw = &adapter->hw;
4720
	u32 gpie = 0;
4721

4722
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
4723 4724 4725
		gpie = IXGBE_GPIE_MSIX_MODE | IXGBE_GPIE_PBA_SUPPORT |
		       IXGBE_GPIE_OCD;
		gpie |= IXGBE_GPIE_EIAME;
4726 4727 4728 4729 4730 4731 4732 4733 4734
		/*
		 * 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 已提交
4735 4736
		case ixgbe_mac_X540:
		default:
4737 4738 4739 4740 4741
			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(0), 0xFFFFFFFF);
			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(1), 0xFFFFFFFF);
			break;
		}
	} else {
4742 4743 4744 4745
		/* 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);
	}
4746

4747 4748 4749 4750 4751
	/* 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;
4752 4753 4754 4755 4756 4757 4758 4759 4760 4761 4762 4763

		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;
		}
4764 4765
	}

4766
	/* Enable Thermal over heat sensor interrupt */
4767 4768 4769 4770 4771 4772 4773 4774 4775 4776 4777 4778
	if (adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE) {
		switch (adapter->hw.mac.type) {
		case ixgbe_mac_82599EB:
			gpie |= IXGBE_SDP0_GPIEN;
			break;
		case ixgbe_mac_X540:
			gpie |= IXGBE_EIMS_TS;
			break;
		default:
			break;
		}
	}
4779

4780 4781
	/* Enable fan failure interrupt */
	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE)
4782 4783
		gpie |= IXGBE_SDP1_GPIEN;

4784
	if (hw->mac.type == ixgbe_mac_82599EB) {
4785 4786
		gpie |= IXGBE_SDP1_GPIEN;
		gpie |= IXGBE_SDP2_GPIEN;
4787
	}
4788 4789 4790 4791

	IXGBE_WRITE_REG(hw, IXGBE_GPIE, gpie);
}

4792
static void ixgbe_up_complete(struct ixgbe_adapter *adapter)
4793 4794 4795 4796 4797 4798 4799
{
	struct ixgbe_hw *hw = &adapter->hw;
	int err;
	u32 ctrl_ext;

	ixgbe_get_hw_control(adapter);
	ixgbe_setup_gpie(adapter);
4800

4801 4802 4803 4804 4805
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
		ixgbe_configure_msix(adapter);
	else
		ixgbe_configure_msi_and_legacy(adapter);

4806 4807
	/* enable the optics for 82599 SFP+ fiber */
	if (hw->mac.ops.enable_tx_laser)
4808 4809
		hw->mac.ops.enable_tx_laser(hw);

4810
	smp_mb__before_clear_bit();
4811
	clear_bit(__IXGBE_DOWN, &adapter->state);
4812 4813
	ixgbe_napi_enable_all(adapter);

4814 4815 4816 4817 4818 4819 4820 4821
	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);
	}

4822 4823
	/* clear any pending interrupts, may auto mask */
	IXGBE_READ_REG(hw, IXGBE_EICR);
4824
	ixgbe_irq_enable(adapter, true, true);
4825

4826 4827 4828 4829 4830 4831 4832
	/*
	 * 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)
4833
			e_crit(drv, "Fan has stopped, replace the adapter\n");
4834 4835
	}

4836 4837
	/* bring the link up in the watchdog, this could race with our first
	 * link up interrupt but shouldn't be a problem */
4838 4839
	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
	adapter->link_check_timeout = jiffies;
4840
	mod_timer(&adapter->service_timer, jiffies);
4841 4842 4843 4844 4845

	/* 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);
4846 4847
}

4848 4849 4850
void ixgbe_reinit_locked(struct ixgbe_adapter *adapter)
{
	WARN_ON(in_interrupt());
4851 4852 4853
	/* put off any impending NetWatchDogTimeout */
	adapter->netdev->trans_start = jiffies;

4854
	while (test_and_set_bit(__IXGBE_RESETTING, &adapter->state))
4855
		usleep_range(1000, 2000);
4856
	ixgbe_down(adapter);
4857 4858 4859 4860 4861 4862 4863 4864
	/*
	 * 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);
4865 4866 4867 4868
	ixgbe_up(adapter);
	clear_bit(__IXGBE_RESETTING, &adapter->state);
}

4869
void ixgbe_up(struct ixgbe_adapter *adapter)
4870 4871 4872 4873
{
	/* hardware has been reset, we need to reload some things */
	ixgbe_configure(adapter);

4874
	ixgbe_up_complete(adapter);
4875 4876 4877 4878
}

void ixgbe_reset(struct ixgbe_adapter *adapter)
{
4879
	struct ixgbe_hw *hw = &adapter->hw;
4880
	struct net_device *netdev = adapter->netdev;
4881
	int err;
4882
	u8 old_addr[ETH_ALEN];
4883

4884 4885
	if (ixgbe_removed(hw->hw_addr))
		return;
4886 4887 4888 4889 4890 4891 4892 4893 4894
	/* 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;

4895
	err = hw->mac.ops.init_hw(hw);
4896 4897 4898
	switch (err) {
	case 0:
	case IXGBE_ERR_SFP_NOT_PRESENT:
4899
	case IXGBE_ERR_SFP_NOT_SUPPORTED:
4900 4901
		break;
	case IXGBE_ERR_MASTER_REQUESTS_PENDING:
4902
		e_dev_err("master disable timed out\n");
4903
		break;
4904 4905
	case IXGBE_ERR_EEPROM_VERSION:
		/* We are running on a pre-production device, log a warning */
4906
		e_dev_warn("This device is a pre-production adapter/LOM. "
S
Stephen Hemminger 已提交
4907
			   "Please be aware there may be issues associated with "
4908 4909 4910 4911
			   "your hardware.  If you are experiencing problems "
			   "please contact your Intel or hardware "
			   "representative who provided you with this "
			   "hardware.\n");
4912
		break;
4913
	default:
4914
		e_dev_err("Hardware Error: %d\n", err);
4915
	}
4916

4917
	clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);
4918 4919 4920 4921
	/* do not flush user set addresses */
	memcpy(old_addr, &adapter->mac_table[0].addr, netdev->addr_len);
	ixgbe_flush_sw_mac_table(adapter);
	ixgbe_mac_set_default_filter(adapter, old_addr);
4922 4923 4924 4925

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

4927
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
4928
		ixgbe_ptp_reset(adapter);
4929 4930 4931 4932 4933 4934
}

/**
 * ixgbe_clean_tx_ring - Free Tx Buffers
 * @tx_ring: ring to be cleaned
 **/
4935
static void ixgbe_clean_tx_ring(struct ixgbe_ring *tx_ring)
4936 4937 4938
{
	struct ixgbe_tx_buffer *tx_buffer_info;
	unsigned long size;
4939
	u16 i;
4940

4941 4942 4943
	/* ring already cleared, nothing to do */
	if (!tx_ring->tx_buffer_info)
		return;
4944

4945
	/* Free all the Tx ring sk_buffs */
4946 4947
	for (i = 0; i < tx_ring->count; i++) {
		tx_buffer_info = &tx_ring->tx_buffer_info[i];
4948
		ixgbe_unmap_and_free_tx_resource(tx_ring, tx_buffer_info);
4949 4950
	}

4951 4952
	netdev_tx_reset_queue(txring_txq(tx_ring));

4953 4954 4955 4956 4957 4958 4959 4960 4961 4962 4963
	size = sizeof(struct ixgbe_tx_buffer) * tx_ring->count;
	memset(tx_ring->tx_buffer_info, 0, size);

	/* Zero out the descriptor ring */
	memset(tx_ring->desc, 0, tx_ring->size);

	tx_ring->next_to_use = 0;
	tx_ring->next_to_clean = 0;
}

/**
4964
 * ixgbe_clean_all_rx_rings - Free Rx Buffers for all queues
4965 4966
 * @adapter: board private structure
 **/
4967
static void ixgbe_clean_all_rx_rings(struct ixgbe_adapter *adapter)
4968 4969 4970
{
	int i;

4971
	for (i = 0; i < adapter->num_rx_queues; i++)
4972
		ixgbe_clean_rx_ring(adapter->rx_ring[i]);
4973 4974 4975
}

/**
4976
 * ixgbe_clean_all_tx_rings - Free Tx Buffers for all queues
4977 4978
 * @adapter: board private structure
 **/
4979
static void ixgbe_clean_all_tx_rings(struct ixgbe_adapter *adapter)
4980 4981 4982
{
	int i;

4983
	for (i = 0; i < adapter->num_tx_queues; i++)
4984
		ixgbe_clean_tx_ring(adapter->tx_ring[i]);
4985 4986
}

4987 4988
static void ixgbe_fdir_filter_exit(struct ixgbe_adapter *adapter)
{
4989
	struct hlist_node *node2;
4990 4991 4992 4993
	struct ixgbe_fdir_filter *filter;

	spin_lock(&adapter->fdir_perfect_lock);

4994
	hlist_for_each_entry_safe(filter, node2,
4995 4996 4997 4998 4999 5000 5001 5002 5003
				  &adapter->fdir_filter_list, fdir_node) {
		hlist_del(&filter->fdir_node);
		kfree(filter);
	}
	adapter->fdir_filter_count = 0;

	spin_unlock(&adapter->fdir_perfect_lock);
}

5004 5005 5006
void ixgbe_down(struct ixgbe_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
5007
	struct ixgbe_hw *hw = &adapter->hw;
5008 5009
	struct net_device *upper;
	struct list_head *iter;
5010
	u32 rxctrl;
5011
	int i;
5012 5013

	/* signal that we are down to the interrupt handler */
5014 5015
	if (test_and_set_bit(__IXGBE_DOWN, &adapter->state))
		return; /* do nothing if already down */
5016 5017

	/* disable receives */
5018 5019
	rxctrl = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
	IXGBE_WRITE_REG(hw, IXGBE_RXCTRL, rxctrl & ~IXGBE_RXCTRL_RXEN);
5020

5021 5022 5023 5024 5025
	/* 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]);

5026
	usleep_range(10000, 20000);
5027

5028 5029
	netif_tx_stop_all_queues(netdev);

5030
	/* call carrier off first to avoid false dev_watchdog timeouts */
5031 5032 5033
	netif_carrier_off(netdev);
	netif_tx_disable(netdev);

5034 5035 5036 5037 5038 5039 5040 5041 5042 5043 5044 5045 5046
	/* disable any upper devices */
	netdev_for_each_all_upper_dev_rcu(adapter->netdev, upper, iter) {
		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);
			}
		}
	}

5047 5048 5049 5050
	ixgbe_irq_disable(adapter);

	ixgbe_napi_disable_all(adapter);

5051 5052
	adapter->flags2 &= ~(IXGBE_FLAG2_FDIR_REQUIRES_REINIT |
			     IXGBE_FLAG2_RESET_REQUESTED);
5053 5054 5055 5056
	adapter->flags &= ~IXGBE_FLAG_NEED_LINK_UPDATE;

	del_timer_sync(&adapter->service_timer);

5057
	if (adapter->num_vfs) {
5058 5059
		/* Clear EITR Select mapping */
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITRSEL, 0);
5060 5061 5062

		/* Mark all the VFs as inactive */
		for (i = 0 ; i < adapter->num_vfs; i++)
5063
			adapter->vfinfo[i].clear_to_send = false;
5064 5065 5066 5067 5068 5069

		/* 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);
5070 5071
	}

5072 5073
	/* disable transmits in the hardware now that interrupts are off */
	for (i = 0; i < adapter->num_tx_queues; i++) {
5074
		u8 reg_idx = adapter->tx_ring[i]->reg_idx;
5075
		IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), IXGBE_TXDCTL_SWFLSH);
5076
	}
5077 5078

	/* Disable the Tx DMA engine on 82599 and X540 */
5079 5080
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
5081
	case ixgbe_mac_X540:
5082
		IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL,
5083 5084
				(IXGBE_READ_REG(hw, IXGBE_DMATXCTL) &
				 ~IXGBE_DMATXCTL_TE));
5085 5086 5087 5088
		break;
	default:
		break;
	}
5089

5090 5091
	if (!pci_channel_offline(adapter->pdev))
		ixgbe_reset(adapter);
5092

5093 5094
	/* power down the optics for 82599 SFP+ fiber */
	if (hw->mac.ops.disable_tx_laser)
5095 5096
		hw->mac.ops.disable_tx_laser(hw);

5097 5098 5099
	ixgbe_clean_all_tx_rings(adapter);
	ixgbe_clean_all_rx_rings(adapter);

5100
#ifdef CONFIG_IXGBE_DCA
5101
	/* since we reset the hardware DCA settings were cleared */
5102
	ixgbe_setup_dca(adapter);
5103
#endif
5104 5105 5106 5107 5108 5109 5110 5111 5112 5113 5114
}

/**
 * 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 */
5115
	ixgbe_tx_timeout_reset(adapter);
5116 5117 5118 5119 5120 5121 5122 5123 5124 5125
}

/**
 * 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).
 **/
5126
static int ixgbe_sw_init(struct ixgbe_adapter *adapter)
5127 5128 5129
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct pci_dev *pdev = adapter->pdev;
5130
	unsigned int rss, fdir;
5131
	u32 fwsm;
J
Jeff Kirsher 已提交
5132
#ifdef CONFIG_IXGBE_DCB
5133 5134 5135
	int j;
	struct tc_configuration *tc;
#endif
5136

5137 5138 5139 5140 5141 5142 5143 5144
	/* 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;

5145
	/* Set common capability flags and settings */
5146
	rss = min_t(int, IXGBE_MAX_RSS_INDICES, num_online_cpus());
5147
	adapter->ring_feature[RING_F_RSS].limit = rss;
5148 5149 5150 5151
	adapter->flags2 |= IXGBE_FLAG2_RSC_CAPABLE;
	adapter->flags2 |= IXGBE_FLAG2_RSC_ENABLED;
	adapter->max_q_vectors = MAX_Q_VECTORS_82599;
	adapter->atr_sample_rate = 20;
5152 5153
	fdir = min_t(int, IXGBE_MAX_FDIR_INDICES, num_online_cpus());
	adapter->ring_feature[RING_F_FDIR].limit = fdir;
5154 5155 5156 5157 5158 5159 5160 5161 5162 5163 5164 5165 5166
	adapter->fdir_pballoc = IXGBE_FDIR_PBALLOC_64K;
#ifdef CONFIG_IXGBE_DCA
	adapter->flags |= IXGBE_FLAG_DCA_CAPABLE;
#endif
#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 */

5167 5168 5169 5170
	adapter->mac_table = kzalloc(sizeof(struct ixgbe_mac_addr) *
				     hw->mac.num_rar_entries,
				     GFP_ATOMIC);

5171
	/* Set MAC specific capability flags and exceptions */
5172 5173
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
5174 5175 5176
		adapter->flags2 &= ~IXGBE_FLAG2_RSC_CAPABLE;
		adapter->flags2 &= ~IXGBE_FLAG2_RSC_ENABLED;

5177 5178
		if (hw->device_id == IXGBE_DEV_ID_82598AT)
			adapter->flags |= IXGBE_FLAG_FAN_FAIL_CAPABLE;
5179

5180
		adapter->max_q_vectors = MAX_Q_VECTORS_82598;
5181 5182 5183 5184 5185 5186 5187 5188 5189 5190 5191 5192 5193 5194
		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;
5195
		break;
D
Don Skidmore 已提交
5196
	case ixgbe_mac_X540:
5197 5198 5199
		fwsm = IXGBE_READ_REG(hw, IXGBE_FWSM);
		if (fwsm & IXGBE_FWSM_TS_ENABLED)
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
5200 5201 5202
		break;
	default:
		break;
A
Alexander Duyck 已提交
5203
	}
5204

5205 5206 5207 5208 5209
#ifdef IXGBE_FCOE
	/* FCoE support exists, always init the FCoE lock */
	spin_lock_init(&adapter->fcoe.lock);

#endif
5210 5211 5212
	/* n-tuple support exists, always init our spinlock */
	spin_lock_init(&adapter->fdir_perfect_lock);

J
Jeff Kirsher 已提交
5213
#ifdef CONFIG_IXGBE_DCB
5214 5215 5216 5217 5218 5219 5220 5221 5222 5223 5224
	switch (hw->mac.type) {
	case ixgbe_mac_X540:
		adapter->dcb_cfg.num_tcs.pg_tcs = X540_TRAFFIC_CLASS;
		adapter->dcb_cfg.num_tcs.pfc_tcs = X540_TRAFFIC_CLASS;
		break;
	default:
		adapter->dcb_cfg.num_tcs.pg_tcs = MAX_TRAFFIC_CLASS;
		adapter->dcb_cfg.num_tcs.pfc_tcs = MAX_TRAFFIC_CLASS;
		break;
	}

5225 5226 5227 5228 5229 5230 5231 5232 5233
	/* 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;
	}
5234 5235 5236 5237 5238 5239

	/* 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;

5240 5241
	adapter->dcb_cfg.bw_percentage[DCB_TX_CONFIG][0] = 100;
	adapter->dcb_cfg.bw_percentage[DCB_RX_CONFIG][0] = 100;
5242
	adapter->dcb_cfg.pfc_mode_enable = false;
5243
	adapter->dcb_set_bitmap = 0x00;
5244
	adapter->dcbx_cap = DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_CEE;
5245 5246
	memcpy(&adapter->temp_dcb_cfg, &adapter->dcb_cfg,
	       sizeof(adapter->temp_dcb_cfg));
5247 5248

#endif
5249 5250

	/* default flow control settings */
5251
	hw->fc.requested_mode = ixgbe_fc_full;
D
Don Skidmore 已提交
5252
	hw->fc.current_mode = ixgbe_fc_full;	/* init for ethtool output */
5253
	ixgbe_pbthresh_setup(adapter);
5254 5255
	hw->fc.pause_time = IXGBE_DEFAULT_FCPAUSE;
	hw->fc.send_xon = true;
5256
	hw->fc.disable_fc_autoneg = ixgbe_device_supports_autoneg_fc(hw);
5257

5258
#ifdef CONFIG_PCI_IOV
5259 5260 5261
	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");

5262
	/* assign number of SR-IOV VFs */
5263
	if (hw->mac.type != ixgbe_mac_82598EB) {
5264
		if (max_vfs > IXGBE_MAX_VFS_DRV_LIMIT) {
5265 5266 5267 5268 5269 5270 5271
			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 */
5272

5273
	/* enable itr by default in dynamic mode */
5274 5275
	adapter->rx_itr_setting = 1;
	adapter->tx_itr_setting = 1;
5276 5277 5278 5279 5280

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

5281
	/* set default work limits */
5282
	adapter->tx_work_limit = IXGBE_DEFAULT_TX_WORK;
5283

5284
	/* initialize eeprom parameters */
5285
	if (ixgbe_init_eeprom_params_generic(hw)) {
5286
		e_dev_err("EEPROM initialization failed\n");
5287 5288 5289
		return -EIO;
	}

5290 5291
	/* PF holds first pool slot */
	set_bit(0, &adapter->fwd_bitmask);
5292 5293 5294 5295 5296 5297 5298
	set_bit(__IXGBE_DOWN, &adapter->state);

	return 0;
}

/**
 * ixgbe_setup_tx_resources - allocate Tx resources (Descriptors)
5299
 * @tx_ring:    tx descriptor ring (for a specific queue) to setup
5300 5301 5302
 *
 * Return 0 on success, negative on failure
 **/
5303
int ixgbe_setup_tx_resources(struct ixgbe_ring *tx_ring)
5304
{
5305
	struct device *dev = tx_ring->dev;
5306 5307
	int orig_node = dev_to_node(dev);
	int numa_node = -1;
5308 5309
	int size;

5310
	size = sizeof(struct ixgbe_tx_buffer) * tx_ring->count;
5311 5312 5313 5314 5315

	if (tx_ring->q_vector)
		numa_node = tx_ring->q_vector->numa_node;

	tx_ring->tx_buffer_info = vzalloc_node(size, numa_node);
5316
	if (!tx_ring->tx_buffer_info)
E
Eric Dumazet 已提交
5317
		tx_ring->tx_buffer_info = vzalloc(size);
5318 5319
	if (!tx_ring->tx_buffer_info)
		goto err;
5320

5321 5322
	u64_stats_init(&tx_ring->syncp);

5323
	/* round up to nearest 4K */
5324
	tx_ring->size = tx_ring->count * sizeof(union ixgbe_adv_tx_desc);
5325
	tx_ring->size = ALIGN(tx_ring->size, 4096);
5326

5327 5328 5329 5330 5331 5332 5333 5334 5335
	set_dev_node(dev, numa_node);
	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);
5336 5337
	if (!tx_ring->desc)
		goto err;
5338

5339 5340
	tx_ring->next_to_use = 0;
	tx_ring->next_to_clean = 0;
5341
	return 0;
5342 5343 5344 5345

err:
	vfree(tx_ring->tx_buffer_info);
	tx_ring->tx_buffer_info = NULL;
5346
	dev_err(dev, "Unable to allocate memory for the Tx descriptor ring\n");
5347
	return -ENOMEM;
5348 5349
}

5350 5351 5352 5353 5354 5355 5356 5357 5358 5359 5360 5361 5362 5363 5364
/**
 * 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++) {
5365
		err = ixgbe_setup_tx_resources(adapter->tx_ring[i]);
5366 5367
		if (!err)
			continue;
5368

5369
		e_err(probe, "Allocation for Tx Queue %u failed\n", i);
5370
		goto err_setup_tx;
5371 5372
	}

5373 5374 5375 5376 5377
	return 0;
err_setup_tx:
	/* rewind the index freeing the rings as we go */
	while (i--)
		ixgbe_free_tx_resources(adapter->tx_ring[i]);
5378 5379 5380
	return err;
}

5381 5382
/**
 * ixgbe_setup_rx_resources - allocate Rx resources (Descriptors)
5383
 * @rx_ring:    rx descriptor ring (for a specific queue) to setup
5384 5385 5386
 *
 * Returns 0 on success, negative on failure
 **/
5387
int ixgbe_setup_rx_resources(struct ixgbe_ring *rx_ring)
5388
{
5389
	struct device *dev = rx_ring->dev;
5390 5391
	int orig_node = dev_to_node(dev);
	int numa_node = -1;
5392
	int size;
5393

5394
	size = sizeof(struct ixgbe_rx_buffer) * rx_ring->count;
5395 5396 5397 5398 5399

	if (rx_ring->q_vector)
		numa_node = rx_ring->q_vector->numa_node;

	rx_ring->rx_buffer_info = vzalloc_node(size, numa_node);
5400
	if (!rx_ring->rx_buffer_info)
E
Eric Dumazet 已提交
5401
		rx_ring->rx_buffer_info = vzalloc(size);
5402 5403
	if (!rx_ring->rx_buffer_info)
		goto err;
5404

5405 5406
	u64_stats_init(&rx_ring->syncp);

5407
	/* Round up to nearest 4K */
5408 5409
	rx_ring->size = rx_ring->count * sizeof(union ixgbe_adv_rx_desc);
	rx_ring->size = ALIGN(rx_ring->size, 4096);
5410

5411 5412 5413 5414 5415 5416 5417 5418 5419
	set_dev_node(dev, numa_node);
	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);
5420 5421
	if (!rx_ring->desc)
		goto err;
5422

5423 5424
	rx_ring->next_to_clean = 0;
	rx_ring->next_to_use = 0;
5425 5426

	return 0;
5427 5428 5429 5430
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");
5431
	return -ENOMEM;
5432 5433
}

5434 5435 5436 5437 5438 5439 5440 5441 5442 5443 5444 5445 5446 5447 5448
/**
 * 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++) {
5449
		err = ixgbe_setup_rx_resources(adapter->rx_ring[i]);
5450 5451
		if (!err)
			continue;
5452

5453
		e_err(probe, "Allocation for Rx Queue %u failed\n", i);
5454
		goto err_setup_rx;
5455 5456
	}

5457 5458 5459 5460 5461
#ifdef IXGBE_FCOE
	err = ixgbe_setup_fcoe_ddp_resources(adapter);
	if (!err)
#endif
		return 0;
5462 5463 5464 5465
err_setup_rx:
	/* rewind the index freeing the rings as we go */
	while (i--)
		ixgbe_free_rx_resources(adapter->rx_ring[i]);
5466 5467 5468
	return err;
}

5469 5470 5471 5472 5473 5474
/**
 * ixgbe_free_tx_resources - Free Tx Resources per Queue
 * @tx_ring: Tx descriptor ring for a specific queue
 *
 * Free all transmit software resources
 **/
5475
void ixgbe_free_tx_resources(struct ixgbe_ring *tx_ring)
5476
{
5477
	ixgbe_clean_tx_ring(tx_ring);
5478 5479 5480 5481

	vfree(tx_ring->tx_buffer_info);
	tx_ring->tx_buffer_info = NULL;

5482 5483 5484 5485 5486 5487
	/* 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);
5488 5489 5490 5491 5492 5493 5494 5495 5496 5497 5498 5499 5500 5501 5502

	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++)
5503
		if (adapter->tx_ring[i]->desc)
5504
			ixgbe_free_tx_resources(adapter->tx_ring[i]);
5505 5506 5507
}

/**
5508
 * ixgbe_free_rx_resources - Free Rx Resources
5509 5510 5511 5512
 * @rx_ring: ring to clean the resources from
 *
 * Free all receive software resources
 **/
5513
void ixgbe_free_rx_resources(struct ixgbe_ring *rx_ring)
5514
{
5515
	ixgbe_clean_rx_ring(rx_ring);
5516 5517 5518 5519

	vfree(rx_ring->rx_buffer_info);
	rx_ring->rx_buffer_info = NULL;

5520 5521 5522 5523 5524 5525
	/* 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);
5526 5527 5528 5529 5530 5531 5532 5533 5534 5535 5536 5537 5538 5539

	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;

5540 5541 5542 5543
#ifdef IXGBE_FCOE
	ixgbe_free_fcoe_ddp_resources(adapter);

#endif
5544
	for (i = 0; i < adapter->num_rx_queues; i++)
5545
		if (adapter->rx_ring[i]->desc)
5546
			ixgbe_free_rx_resources(adapter->rx_ring[i]);
5547 5548 5549 5550 5551 5552 5553 5554 5555 5556 5557 5558 5559 5560
}

/**
 * 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);
	int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN;

5561
	/* MTU < 68 is an error and causes problems on some kernels */
5562 5563 5564 5565
	if ((new_mtu < 68) || (max_frame > IXGBE_MAX_JUMBO_FRAME_SIZE))
		return -EINVAL;

	/*
5566 5567 5568
	 * 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.
5569 5570 5571
	 */
	if ((adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) &&
	    (adapter->hw.mac.type == ixgbe_mac_82599EB) &&
A
Alexander Duyck 已提交
5572
	    (max_frame > (ETH_FRAME_LEN + ETH_FCS_LEN)))
5573
		e_warn(probe, "Setting MTU > 1500 will disable legacy VFs\n");
5574

5575
	e_info(probe, "changing MTU from %d to %d\n", netdev->mtu, new_mtu);
5576

5577
	/* must set new MTU before calling down or up */
5578 5579
	netdev->mtu = new_mtu;

5580 5581
	if (netif_running(netdev))
		ixgbe_reinit_locked(adapter);
5582 5583 5584 5585 5586 5587 5588 5589 5590 5591 5592 5593 5594 5595 5596 5597 5598 5599 5600

	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.
 **/
static int ixgbe_open(struct net_device *netdev)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
5601
	int err, queues;
5602 5603 5604 5605

	/* disallow open during test */
	if (test_bit(__IXGBE_TESTING, &adapter->state))
		return -EBUSY;
5606

5607 5608
	netif_carrier_off(netdev);

5609 5610 5611 5612 5613 5614 5615 5616 5617 5618 5619 5620
	/* 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);

5621
	err = ixgbe_request_irq(adapter);
5622 5623 5624
	if (err)
		goto err_req_irq;

5625
	/* Notify the stack of the actual queue counts. */
5626 5627 5628 5629 5630 5631
	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);
5632 5633 5634
	if (err)
		goto err_set_queues;

5635 5636 5637 5638 5639 5640
	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);
5641 5642 5643
	if (err)
		goto err_set_queues;

5644 5645
	ixgbe_ptp_init(adapter);

5646
	ixgbe_up_complete(adapter);
5647 5648 5649

	return 0;

5650 5651
err_set_queues:
	ixgbe_free_irq(adapter);
5652
err_req_irq:
5653
	ixgbe_free_all_rx_resources(adapter);
5654
err_setup_rx:
5655
	ixgbe_free_all_tx_resources(adapter);
5656
err_setup_tx:
5657 5658 5659 5660 5661 5662 5663 5664 5665 5666 5667 5668 5669 5670 5671 5672 5673 5674 5675 5676
	ixgbe_reset(adapter);

	return err;
}

/**
 * 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.
 **/
static int ixgbe_close(struct net_device *netdev)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

5677 5678
	ixgbe_ptp_stop(adapter);

5679 5680 5681
	ixgbe_down(adapter);
	ixgbe_free_irq(adapter);

5682 5683
	ixgbe_fdir_filter_exit(adapter);

5684 5685 5686
	ixgbe_free_all_tx_resources(adapter);
	ixgbe_free_all_rx_resources(adapter);

5687
	ixgbe_release_hw_control(adapter);
5688 5689 5690 5691

	return 0;
}

5692 5693 5694
#ifdef CONFIG_PM
static int ixgbe_resume(struct pci_dev *pdev)
{
5695 5696
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
5697 5698
	u32 err;

5699
	adapter->hw.hw_addr = adapter->io_addr;
5700 5701
	pci_set_power_state(pdev, PCI_D0);
	pci_restore_state(pdev);
5702 5703 5704 5705 5706
	/*
	 * pci_restore_state clears dev->state_saved so call
	 * pci_save_state to restore it.
	 */
	pci_save_state(pdev);
5707 5708

	err = pci_enable_device_mem(pdev);
5709
	if (err) {
5710
		e_dev_err("Cannot enable PCI device from suspend\n");
5711 5712
		return err;
	}
5713 5714
	smp_mb__before_clear_bit();
	clear_bit(__IXGBE_DISABLED, &adapter->state);
5715 5716
	pci_set_master(pdev);

5717
	pci_wake_from_d3(pdev, false);
5718 5719 5720

	ixgbe_reset(adapter);

5721 5722
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);

5723 5724 5725
	rtnl_lock();
	err = ixgbe_init_interrupt_scheme(adapter);
	if (!err && netif_running(netdev))
5726
		err = ixgbe_open(netdev);
5727 5728 5729 5730 5731

	rtnl_unlock();

	if (err)
		return err;
5732 5733 5734 5735 5736 5737

	netif_device_attach(netdev);

	return 0;
}
#endif /* CONFIG_PM */
5738 5739

static int __ixgbe_shutdown(struct pci_dev *pdev, bool *enable_wake)
5740
{
5741 5742
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
5743 5744 5745
	struct ixgbe_hw *hw = &adapter->hw;
	u32 ctrl, fctrl;
	u32 wufc = adapter->wol;
5746 5747 5748 5749 5750 5751
#ifdef CONFIG_PM
	int retval = 0;
#endif

	netif_device_detach(netdev);

5752
	rtnl_lock();
5753 5754 5755 5756 5757 5758
	if (netif_running(netdev)) {
		ixgbe_down(adapter);
		ixgbe_free_irq(adapter);
		ixgbe_free_all_tx_resources(adapter);
		ixgbe_free_all_rx_resources(adapter);
	}
5759
	rtnl_unlock();
5760

5761 5762
	ixgbe_clear_interrupt_scheme(adapter);

5763 5764 5765 5766
#ifdef CONFIG_PM
	retval = pci_save_state(pdev);
	if (retval)
		return retval;
5767

5768
#endif
5769 5770 5771
	if (hw->mac.ops.stop_link_on_d3)
		hw->mac.ops.stop_link_on_d3(hw);

5772 5773
	if (wufc) {
		ixgbe_set_rx_mode(netdev);
5774

5775 5776
		/* enable the optics for 82599 SFP+ fiber as we can WoL */
		if (hw->mac.ops.enable_tx_laser)
D
Don Skidmore 已提交
5777 5778
			hw->mac.ops.enable_tx_laser(hw);

5779 5780 5781 5782 5783 5784 5785 5786 5787 5788 5789 5790 5791 5792 5793 5794 5795
		/* 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);
	}

5796 5797
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
5798
		pci_wake_from_d3(pdev, false);
5799 5800
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
5801
	case ixgbe_mac_X540:
5802 5803 5804 5805 5806
		pci_wake_from_d3(pdev, !!wufc);
		break;
	default:
		break;
	}
5807

5808 5809
	*enable_wake = !!wufc;

5810 5811
	ixgbe_release_hw_control(adapter);

5812 5813
	if (!test_and_set_bit(__IXGBE_DISABLED, &adapter->state))
		pci_disable_device(pdev);
5814

5815 5816 5817 5818 5819 5820 5821 5822 5823 5824 5825 5826 5827 5828 5829 5830 5831 5832 5833
	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);
	}
5834 5835 5836

	return 0;
}
5837
#endif /* CONFIG_PM */
5838 5839 5840

static void ixgbe_shutdown(struct pci_dev *pdev)
{
5841 5842 5843 5844 5845 5846 5847 5848
	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);
	}
5849 5850
}

5851 5852 5853 5854 5855 5856
/**
 * ixgbe_update_stats - Update the board statistics counters.
 * @adapter: board private structure
 **/
void ixgbe_update_stats(struct ixgbe_adapter *adapter)
{
5857
	struct net_device *netdev = adapter->netdev;
5858
	struct ixgbe_hw *hw = &adapter->hw;
5859
	struct ixgbe_hw_stats *hwstats = &adapter->stats;
5860 5861
	u64 total_mpc = 0;
	u32 i, missed_rx = 0, mpc, bprc, lxon, lxoff, xon_off_tot;
5862 5863
	u64 non_eop_descs = 0, restart_queue = 0, tx_busy = 0;
	u64 alloc_rx_page_failed = 0, alloc_rx_buff_failed = 0;
5864
	u64 bytes = 0, packets = 0, hw_csum_rx_error = 0;
5865

5866 5867 5868 5869
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;

5870
	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED) {
A
Alexander Duyck 已提交
5871
		u64 rsc_count = 0;
5872 5873
		u64 rsc_flush = 0;
		for (i = 0; i < adapter->num_rx_queues; i++) {
5874 5875
			rsc_count += adapter->rx_ring[i]->rx_stats.rsc_count;
			rsc_flush += adapter->rx_ring[i]->rx_stats.rsc_flush;
5876 5877 5878
		}
		adapter->rsc_total_count = rsc_count;
		adapter->rsc_total_flush = rsc_flush;
5879 5880
	}

5881 5882 5883 5884 5885
	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;
5886
		hw_csum_rx_error += rx_ring->rx_stats.csum_err;
5887 5888 5889 5890 5891 5892
		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;
5893
	adapter->hw_csum_rx_error = hw_csum_rx_error;
5894 5895 5896 5897 5898
	netdev->stats.rx_bytes = bytes;
	netdev->stats.rx_packets = packets;

	bytes = 0;
	packets = 0;
J
Jesse Brandeburg 已提交
5899
	/* gather some stats to the adapter struct that are per queue */
5900 5901 5902 5903 5904 5905 5906
	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;
	}
5907
	adapter->restart_queue = restart_queue;
5908 5909 5910
	adapter->tx_busy = tx_busy;
	netdev->stats.tx_bytes = bytes;
	netdev->stats.tx_packets = packets;
J
Jesse Brandeburg 已提交
5911

5912
	hwstats->crcerrs += IXGBE_READ_REG(hw, IXGBE_CRCERRS);
5913 5914

	/* 8 register reads */
5915 5916 5917 5918
	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;
5919 5920
		hwstats->mpc[i] += mpc;
		total_mpc += hwstats->mpc[i];
5921 5922
		hwstats->pxontxc[i] += IXGBE_READ_REG(hw, IXGBE_PXONTXC(i));
		hwstats->pxofftxc[i] += IXGBE_READ_REG(hw, IXGBE_PXOFFTXC(i));
5923 5924
		switch (hw->mac.type) {
		case ixgbe_mac_82598EB:
5925 5926 5927
			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));
5928 5929
			hwstats->pxonrxc[i] +=
				IXGBE_READ_REG(hw, IXGBE_PXONRXC(i));
5930 5931
			break;
		case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
5932
		case ixgbe_mac_X540:
5933 5934 5935 5936 5937
			hwstats->pxonrxc[i] +=
				IXGBE_READ_REG(hw, IXGBE_PXONRXCNT(i));
			break;
		default:
			break;
5938
		}
5939
	}
5940 5941 5942 5943 5944 5945 5946 5947 5948 5949 5950 5951 5952 5953

	/*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) ||
		    (hw->mac.type == ixgbe_mac_X540)) {
			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 */
		}
	}

5954
	hwstats->gprc += IXGBE_READ_REG(hw, IXGBE_GPRC);
5955
	/* work around hardware counting issue */
5956
	hwstats->gprc -= missed_rx;
5957

5958 5959
	ixgbe_update_xoff_received(adapter);

5960
	/* 82598 hardware only has a 32 bit counter in the high register */
5961 5962 5963 5964 5965 5966 5967
	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 已提交
5968
	case ixgbe_mac_X540:
5969 5970 5971 5972 5973 5974
		/* OS2BMC stats are X540 only*/
		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:
5975 5976 5977
		for (i = 0; i < 16; i++)
			adapter->hw_rx_no_dma_resources +=
					     IXGBE_READ_REG(hw, IXGBE_QPRDC(i));
5978
		hwstats->gorc += IXGBE_READ_REG(hw, IXGBE_GORCL);
5979
		IXGBE_READ_REG(hw, IXGBE_GORCH); /* to clear */
5980
		hwstats->gotc += IXGBE_READ_REG(hw, IXGBE_GOTCL);
5981
		IXGBE_READ_REG(hw, IXGBE_GOTCH); /* to clear */
5982
		hwstats->tor += IXGBE_READ_REG(hw, IXGBE_TORL);
5983
		IXGBE_READ_REG(hw, IXGBE_TORH); /* to clear */
5984 5985 5986
		hwstats->lxonrxc += IXGBE_READ_REG(hw, IXGBE_LXONRXCNT);
		hwstats->fdirmatch += IXGBE_READ_REG(hw, IXGBE_FDIRMATCH);
		hwstats->fdirmiss += IXGBE_READ_REG(hw, IXGBE_FDIRMISS);
5987
#ifdef IXGBE_FCOE
5988 5989 5990 5991 5992 5993
		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);
5994
		/* Add up per cpu counters for total ddp aloc fail */
5995 5996 5997 5998 5999
		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;
6000
			for_each_possible_cpu(cpu) {
6001 6002 6003
				ddp_pool = per_cpu_ptr(fcoe->ddp_pool, cpu);
				noddp += ddp_pool->noddp;
				noddp_ext_buff += ddp_pool->noddp_ext_buff;
6004
			}
6005 6006
			hwstats->fcoe_noddp = noddp;
			hwstats->fcoe_noddp_ext_buff = noddp_ext_buff;
6007
		}
6008
#endif /* IXGBE_FCOE */
6009 6010 6011
		break;
	default:
		break;
6012
	}
6013
	bprc = IXGBE_READ_REG(hw, IXGBE_BPRC);
6014 6015
	hwstats->bprc += bprc;
	hwstats->mprc += IXGBE_READ_REG(hw, IXGBE_MPRC);
6016
	if (hw->mac.type == ixgbe_mac_82598EB)
6017 6018 6019 6020 6021 6022 6023 6024 6025
		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);
6026
	lxon = IXGBE_READ_REG(hw, IXGBE_LXONTXC);
6027
	hwstats->lxontxc += lxon;
6028
	lxoff = IXGBE_READ_REG(hw, IXGBE_LXOFFTXC);
6029 6030 6031
	hwstats->lxofftxc += lxoff;
	hwstats->gptc += IXGBE_READ_REG(hw, IXGBE_GPTC);
	hwstats->mptc += IXGBE_READ_REG(hw, IXGBE_MPTC);
6032 6033 6034 6035
	/*
	 * 82598 errata - tx of flow control packets is included in tx counters
	 */
	xon_off_tot = lxon + lxoff;
6036 6037 6038 6039 6040 6041 6042 6043 6044 6045 6046 6047 6048 6049 6050
	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);
6051 6052

	/* Fill out the OS statistics structure */
6053
	netdev->stats.multicast = hwstats->mprc;
6054 6055

	/* Rx Errors */
6056
	netdev->stats.rx_errors = hwstats->crcerrs + hwstats->rlec;
6057
	netdev->stats.rx_dropped = 0;
6058 6059
	netdev->stats.rx_length_errors = hwstats->rlec;
	netdev->stats.rx_crc_errors = hwstats->crcerrs;
6060
	netdev->stats.rx_missed_errors = total_mpc;
6061 6062 6063
}

/**
6064
 * ixgbe_fdir_reinit_subtask - worker thread to reinit FDIR filter table
6065
 * @adapter: pointer to the device adapter structure
6066
 **/
6067
static void ixgbe_fdir_reinit_subtask(struct ixgbe_adapter *adapter)
6068
{
6069
	struct ixgbe_hw *hw = &adapter->hw;
6070
	int i;
6071

6072 6073 6074 6075
	if (!(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_FDIR_REQUIRES_REINIT;
6076

6077
	/* if interface is down do nothing */
6078
	if (test_bit(__IXGBE_DOWN, &adapter->state))
6079 6080 6081 6082 6083 6084 6085 6086
		return;

	/* do nothing if we are not using signature filters */
	if (!(adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE))
		return;

	adapter->fdir_overflow++;

6087 6088 6089
	if (ixgbe_reinit_fdir_tables_82599(hw) == 0) {
		for (i = 0; i < adapter->num_tx_queues; i++)
			set_bit(__IXGBE_TX_FDIR_INIT_DONE,
6090
				&(adapter->tx_ring[i]->state));
6091 6092
		/* re-enable flow director interrupts */
		IXGBE_WRITE_REG(hw, IXGBE_EIMS, IXGBE_EIMS_FLOW_DIR);
6093 6094 6095 6096 6097 6098 6099 6100
	} 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
6101
 * @adapter: pointer to the device adapter structure
6102 6103
 *
 * This function serves two purposes.  First it strobes the interrupt lines
S
Stephen Hemminger 已提交
6104
 * in order to make certain interrupts are occurring.  Secondly it sets the
6105
 * bits needed to check for TX hangs.  As a result we should immediately
S
Stephen Hemminger 已提交
6106
 * determine if a hang has occurred.
6107 6108
 */
static void ixgbe_check_hang_subtask(struct ixgbe_adapter *adapter)
6109
{
6110
	struct ixgbe_hw *hw = &adapter->hw;
6111 6112
	u64 eics = 0;
	int i;
6113

6114
	/* If we're down, removing or resetting, just bail */
6115
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
6116
	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
6117 6118
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;
6119

6120 6121 6122 6123 6124
	/* 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]);
	}
6125

6126 6127 6128 6129 6130 6131 6132 6133
	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));
6134 6135
	} else {
		/* get one bit for every active tx/rx interrupt vector */
6136
		for (i = 0; i < adapter->num_q_vectors; i++) {
6137
			struct ixgbe_q_vector *qv = adapter->q_vector[i];
6138
			if (qv->rx.ring || qv->tx.ring)
6139 6140
				eics |= ((u64)1 << i);
		}
6141
	}
6142

6143
	/* Cause software interrupt to ensure rings are cleaned */
6144 6145
	ixgbe_irq_rearm_queues(adapter, eics);

6146 6147
}

6148
/**
6149
 * ixgbe_watchdog_update_link - update the link status
6150 6151
 * @adapter: pointer to the device adapter structure
 * @link_speed: pointer to a u32 to store the link_speed
6152
 **/
6153
static void ixgbe_watchdog_update_link(struct ixgbe_adapter *adapter)
6154 6155
{
	struct ixgbe_hw *hw = &adapter->hw;
6156 6157
	u32 link_speed = adapter->link_speed;
	bool link_up = adapter->link_up;
6158
	bool pfc_en = adapter->dcb_cfg.pfc_mode_enable;
6159

6160 6161 6162 6163 6164
	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);
6165
	} else {
6166 6167 6168
		/* always assume link is up, if no check link function */
		link_speed = IXGBE_LINK_SPEED_10GB_FULL;
		link_up = true;
6169
	}
6170 6171 6172 6173

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

6174
	if (link_up && !((adapter->flags & IXGBE_FLAG_DCB_ENABLED) && pfc_en)) {
6175
		hw->mac.ops.fc_enable(hw);
6176 6177
		ixgbe_set_rx_drop_en(adapter);
	}
6178 6179 6180 6181 6182 6183 6184 6185 6186 6187 6188

	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;
6189 6190
}

6191 6192 6193 6194 6195 6196 6197 6198 6199 6200 6201 6202 6203 6204 6205 6206 6207
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
}

6208
/**
6209 6210
 * ixgbe_watchdog_link_is_up - update netif_carrier status and
 *                             print link up message
6211
 * @adapter: pointer to the device adapter structure
6212
 **/
6213
static void ixgbe_watchdog_link_is_up(struct ixgbe_adapter *adapter)
6214
{
6215
	struct net_device *netdev = adapter->netdev;
6216
	struct ixgbe_hw *hw = &adapter->hw;
6217 6218
	struct net_device *upper;
	struct list_head *iter;
6219 6220
	u32 link_speed = adapter->link_speed;
	bool flow_rx, flow_tx;
6221

6222 6223
	/* only continue if link was previously down */
	if (netif_carrier_ok(netdev))
6224
		return;
6225

6226
	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
6227

6228 6229 6230 6231 6232 6233 6234 6235 6236 6237 6238 6239 6240 6241 6242 6243 6244 6245 6246 6247
	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:
	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;
6248
	}
6249

6250 6251
	adapter->last_rx_ptp_check = jiffies;

6252
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
6253
		ixgbe_ptp_start_cyclecounter(adapter);
6254

6255 6256 6257 6258 6259 6260 6261 6262 6263 6264 6265
	e_info(drv, "NIC Link is Up %s, Flow Control: %s\n",
	       (link_speed == IXGBE_LINK_SPEED_10GB_FULL ?
	       "10 Gbps" :
	       (link_speed == IXGBE_LINK_SPEED_1GB_FULL ?
	       "1 Gbps" :
	       (link_speed == IXGBE_LINK_SPEED_100_FULL ?
	       "100 Mbps" :
	       "unknown speed"))),
	       ((flow_rx && flow_tx) ? "RX/TX" :
	       (flow_rx ? "RX" :
	       (flow_tx ? "TX" : "None"))));
6266

6267 6268
	netif_carrier_on(netdev);
	ixgbe_check_vf_rate_limit(adapter);
6269

6270 6271 6272 6273 6274 6275 6276 6277 6278 6279 6280 6281 6282 6283 6284
	/* enable transmits */
	netif_tx_wake_all_queues(adapter->netdev);

	/* enable any upper devices */
	rtnl_lock();
	netdev_for_each_all_upper_dev_rcu(adapter->netdev, upper, iter) {
		if (netif_is_macvlan(upper)) {
			struct macvlan_dev *vlan = netdev_priv(upper);

			if (vlan->fwd_priv)
				netif_tx_wake_all_queues(upper);
		}
	}
	rtnl_unlock();

6285 6286 6287
	/* update the default user priority for VFs */
	ixgbe_update_default_up(adapter);

6288 6289
	/* ping all the active vfs to let them know link has changed */
	ixgbe_ping_all_vfs(adapter);
6290 6291
}

6292
/**
6293 6294
 * ixgbe_watchdog_link_is_down - update netif_carrier status and
 *                               print link down message
6295
 * @adapter: pointer to the adapter structure
6296
 **/
A
Alexander Duyck 已提交
6297
static void ixgbe_watchdog_link_is_down(struct ixgbe_adapter *adapter)
6298
{
6299
	struct net_device *netdev = adapter->netdev;
6300
	struct ixgbe_hw *hw = &adapter->hw;
6301

6302 6303
	adapter->link_up = false;
	adapter->link_speed = 0;
6304

6305 6306 6307
	/* only continue if link was up previously */
	if (!netif_carrier_ok(netdev))
		return;
6308

6309 6310 6311
	/* 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;
6312

6313
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
6314
		ixgbe_ptp_start_cyclecounter(adapter);
6315

6316 6317
	e_info(drv, "NIC Link is Down\n");
	netif_carrier_off(netdev);
6318 6319 6320

	/* ping all the active vfs to let them know link has changed */
	ixgbe_ping_all_vfs(adapter);
6321
}
6322

6323 6324
/**
 * ixgbe_watchdog_flush_tx - flush queues on link down
6325
 * @adapter: pointer to the device adapter structure
6326 6327 6328
 **/
static void ixgbe_watchdog_flush_tx(struct ixgbe_adapter *adapter)
{
6329
	int i;
6330
	int some_tx_pending = 0;
6331

6332
	if (!netif_carrier_ok(adapter->netdev)) {
6333
		for (i = 0; i < adapter->num_tx_queues; i++) {
6334
			struct ixgbe_ring *tx_ring = adapter->tx_ring[i];
6335 6336 6337 6338 6339 6340 6341 6342 6343 6344 6345 6346
			if (tx_ring->next_to_use != tx_ring->next_to_clean) {
				some_tx_pending = 1;
				break;
			}
		}

		if (some_tx_pending) {
			/* 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).
			 */
6347
			e_warn(drv, "initiating reset to clear Tx work after link loss\n");
6348
			adapter->flags2 |= IXGBE_FLAG2_RESET_REQUESTED;
6349
		}
6350 6351 6352
	}
}

6353 6354 6355 6356
static void ixgbe_spoof_check(struct ixgbe_adapter *adapter)
{
	u32 ssvpc;

6357 6358 6359
	/* 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)
6360 6361 6362 6363 6364 6365 6366 6367 6368 6369 6370
		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;

6371
	e_warn(drv, "%u Spoofed packets detected\n", ssvpc);
6372 6373
}

6374 6375
/**
 * ixgbe_watchdog_subtask - check and bring link up
6376
 * @adapter: pointer to the device adapter structure
6377 6378 6379
 **/
static void ixgbe_watchdog_subtask(struct ixgbe_adapter *adapter)
{
6380
	/* if interface is down, removing or resetting, do nothing */
6381
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
6382
	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
6383
	    test_bit(__IXGBE_RESETTING, &adapter->state))
6384 6385 6386 6387 6388 6389 6390 6391
		return;

	ixgbe_watchdog_update_link(adapter);

	if (adapter->link_up)
		ixgbe_watchdog_link_is_up(adapter);
	else
		ixgbe_watchdog_link_is_down(adapter);
6392

6393
	ixgbe_spoof_check(adapter);
6394
	ixgbe_update_stats(adapter);
6395 6396

	ixgbe_watchdog_flush_tx(adapter);
6397
}
6398

6399
/**
6400
 * ixgbe_sfp_detection_subtask - poll for SFP+ cable
6401
 * @adapter: the ixgbe adapter structure
6402
 **/
6403
static void ixgbe_sfp_detection_subtask(struct ixgbe_adapter *adapter)
6404 6405
{
	struct ixgbe_hw *hw = &adapter->hw;
6406
	s32 err;
6407

6408 6409 6410 6411
	/* 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;
6412

6413 6414 6415
	/* someone else is in init, wait until next service event */
	if (test_and_set_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
		return;
6416

6417 6418 6419
	err = hw->phy.ops.identify_sfp(hw);
	if (err == IXGBE_ERR_SFP_NOT_SUPPORTED)
		goto sfp_out;
6420

6421 6422 6423 6424
	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;
6425
	}
6426

6427 6428 6429
	/* exit on error */
	if (err)
		goto sfp_out;
6430

6431 6432 6433
	/* exit if reset not needed */
	if (!(adapter->flags2 & IXGBE_FLAG2_SFP_NEEDS_RESET))
		goto sfp_out;
6434

6435
	adapter->flags2 &= ~IXGBE_FLAG2_SFP_NEEDS_RESET;
6436

6437 6438 6439 6440 6441 6442 6443 6444 6445 6446 6447 6448 6449 6450 6451 6452 6453 6454 6455 6456 6457 6458 6459 6460 6461 6462
	/*
	 * 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);
6463
	}
6464
}
6465

6466 6467
/**
 * ixgbe_sfp_link_config_subtask - set up link SFP after module install
6468
 * @adapter: the ixgbe adapter structure
6469 6470 6471 6472
 **/
static void ixgbe_sfp_link_config_subtask(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
J
Josh Hay 已提交
6473 6474
	u32 speed;
	bool autoneg = false;
6475 6476 6477 6478 6479 6480 6481 6482 6483 6484

	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 已提交
6485
	speed = hw->phy.autoneg_advertised;
6486
	if ((!speed) && (hw->mac.ops.get_link_capabilities)) {
J
Josh Hay 已提交
6487
		hw->mac.ops.get_link_capabilities(hw, &speed, &autoneg);
6488 6489 6490 6491 6492 6493 6494 6495

		/* setup the highest link when no autoneg */
		if (!autoneg) {
			if (speed & IXGBE_LINK_SPEED_10GB_FULL)
				speed = IXGBE_LINK_SPEED_10GB_FULL;
		}
	}

6496
	if (hw->mac.ops.setup_link)
J
Josh Hay 已提交
6497
		hw->mac.ops.setup_link(hw, speed, true);
6498 6499 6500 6501 6502 6503

	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
	adapter->link_check_timeout = jiffies;
	clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);
}

6504 6505 6506 6507 6508 6509 6510 6511 6512 6513 6514 6515 6516 6517 6518 6519 6520 6521 6522 6523 6524 6525 6526 6527 6528 6529 6530 6531 6532 6533 6534 6535 6536 6537 6538 6539 6540 6541 6542 6543 6544 6545 6546 6547 6548
#ifdef CONFIG_PCI_IOV
static void ixgbe_check_for_bad_vf(struct ixgbe_adapter *adapter)
{
	int vf;
	struct ixgbe_hw *hw = &adapter->hw;
	struct net_device *netdev = adapter->netdev;
	u32 gpc;
	u32 ciaa, ciad;

	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.
	 */

	for (vf = 0; vf < adapter->num_vfs; vf++) {
		ciaa = (vf << 16) | 0x80000000;
		/* 32 bit read so align, we really want status at offset 6 */
		ciaa |= PCI_COMMAND;
		IXGBE_WRITE_REG(hw, IXGBE_CIAA_82599, ciaa);
		ciad = IXGBE_READ_REG(hw, IXGBE_CIAD_82599);
		ciaa &= 0x7FFFFFFF;
		/* disable debug mode asap after reading data */
		IXGBE_WRITE_REG(hw, IXGBE_CIAA_82599, ciaa);
		/* Get the upper 16 bits which will be the PCI status reg */
		ciad >>= 16;
		if (ciad & PCI_STATUS_REC_MASTER_ABORT) {
			netdev_err(netdev, "VF %d Hung DMA\n", vf);
			/* Issue VFLR */
			ciaa = (vf << 16) | 0x80000000;
			ciaa |= 0xA8;
			IXGBE_WRITE_REG(hw, IXGBE_CIAA_82599, ciaa);
			ciad = 0x00008000;  /* VFLR */
			IXGBE_WRITE_REG(hw, IXGBE_CIAD_82599, ciad);
			ciaa &= 0x7FFFFFFF;
			IXGBE_WRITE_REG(hw, IXGBE_CIAA_82599, ciaa);
		}
	}
}

#endif
6549 6550 6551 6552 6553 6554 6555 6556
/**
 * 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;
6557
	bool ready = true;
6558

6559 6560 6561 6562 6563
	/* 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;
6564

6565
#ifdef CONFIG_PCI_IOV
6566 6567 6568 6569 6570
	/*
	 * don't bother with SR-IOV VF DMA hang check if there are
	 * no VFs or the link is down
	 */
	if (!adapter->num_vfs ||
6571
	    (adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE))
6572 6573 6574 6575 6576 6577 6578
		goto normal_timer_service;

	/* If we have VFs allocated then we must check for DMA hangs */
	ixgbe_check_for_bad_vf(adapter);
	next_event_offset = HZ / 50;
	adapter->timer_event_accumulator++;

6579
	if (adapter->timer_event_accumulator >= 100)
6580
		adapter->timer_event_accumulator = 0;
6581
	else
6582
		ready = false;
6583

6584
normal_timer_service:
6585
#endif
6586 6587 6588
	/* Reset the timer */
	mod_timer(&adapter->service_timer, next_event_offset + jiffies);

6589 6590
	if (ready)
		ixgbe_service_event_schedule(adapter);
6591 6592
}

6593 6594 6595 6596 6597 6598 6599
static void ixgbe_reset_subtask(struct ixgbe_adapter *adapter)
{
	if (!(adapter->flags2 & IXGBE_FLAG2_RESET_REQUESTED))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_RESET_REQUESTED;

6600
	/* If we're already down, removing or resetting, just bail */
6601
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
6602
	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
6603 6604 6605 6606 6607 6608 6609
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;

	ixgbe_dump(adapter);
	netdev_err(adapter->netdev, "Reset adapter\n");
	adapter->tx_timeout_count++;

6610
	rtnl_lock();
6611
	ixgbe_reinit_locked(adapter);
6612
	rtnl_unlock();
6613 6614
}

6615 6616 6617 6618 6619 6620 6621 6622 6623
/**
 * 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);
6624 6625 6626 6627 6628 6629 6630 6631 6632
	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;
	}
6633
	ixgbe_reset_subtask(adapter);
6634 6635
	ixgbe_sfp_detection_subtask(adapter);
	ixgbe_sfp_link_config_subtask(adapter);
6636
	ixgbe_check_overtemp_subtask(adapter);
6637
	ixgbe_watchdog_subtask(adapter);
6638
	ixgbe_fdir_reinit_subtask(adapter);
6639
	ixgbe_check_hang_subtask(adapter);
6640

6641
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state)) {
6642 6643 6644
		ixgbe_ptp_overflow_check(adapter);
		ixgbe_ptp_rx_hang(adapter);
	}
6645 6646

	ixgbe_service_event_complete(adapter);
6647 6648
}

6649 6650
static int ixgbe_tso(struct ixgbe_ring *tx_ring,
		     struct ixgbe_tx_buffer *first,
6651
		     u8 *hdr_len)
6652
{
6653
	struct sk_buff *skb = first->skb;
6654 6655
	u32 vlan_macip_lens, type_tucmd;
	u32 mss_l4len_idx, l4len;
6656
	int err;
6657

6658 6659 6660
	if (skb->ip_summed != CHECKSUM_PARTIAL)
		return 0;

6661 6662
	if (!skb_is_gso(skb))
		return 0;
6663

6664 6665 6666
	err = skb_cow_head(skb, 0);
	if (err < 0)
		return err;
6667

6668 6669 6670
	/* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
	type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;

6671
	if (first->protocol == htons(ETH_P_IP)) {
6672 6673 6674 6675 6676 6677 6678 6679
		struct iphdr *iph = ip_hdr(skb);
		iph->tot_len = 0;
		iph->check = 0;
		tcp_hdr(skb)->check = ~csum_tcpudp_magic(iph->saddr,
							 iph->daddr, 0,
							 IPPROTO_TCP,
							 0);
		type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
6680 6681 6682
		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
				   IXGBE_TX_FLAGS_CSUM |
				   IXGBE_TX_FLAGS_IPV4;
6683 6684 6685 6686 6687 6688
	} else if (skb_is_gso_v6(skb)) {
		ipv6_hdr(skb)->payload_len = 0;
		tcp_hdr(skb)->check =
		    ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr,
				     &ipv6_hdr(skb)->daddr,
				     0, IPPROTO_TCP, 0);
6689 6690
		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
				   IXGBE_TX_FLAGS_CSUM;
6691 6692
	}

6693
	/* compute header lengths */
6694 6695 6696
	l4len = tcp_hdrlen(skb);
	*hdr_len = skb_transport_offset(skb) + l4len;

6697 6698 6699 6700
	/* update gso size and bytecount with header size */
	first->gso_segs = skb_shinfo(skb)->gso_segs;
	first->bytecount += (first->gso_segs - 1) * *hdr_len;

6701
	/* mss_l4len_id: use 0 as index for TSO */
6702 6703 6704 6705 6706 6707
	mss_l4len_idx = l4len << IXGBE_ADVTXD_L4LEN_SHIFT;
	mss_l4len_idx |= skb_shinfo(skb)->gso_size << IXGBE_ADVTXD_MSS_SHIFT;

	/* vlan_macip_lens: HEADLEN, MACLEN, VLAN tag */
	vlan_macip_lens = skb_network_header_len(skb);
	vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
6708
	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
6709 6710

	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, 0, type_tucmd,
6711
			  mss_l4len_idx);
6712 6713 6714 6715

	return 1;
}

6716 6717
static void ixgbe_tx_csum(struct ixgbe_ring *tx_ring,
			  struct ixgbe_tx_buffer *first)
6718
{
6719
	struct sk_buff *skb = first->skb;
6720 6721 6722
	u32 vlan_macip_lens = 0;
	u32 mss_l4len_idx = 0;
	u32 type_tucmd = 0;
6723

6724
	if (skb->ip_summed != CHECKSUM_PARTIAL) {
6725 6726 6727
		if (!(first->tx_flags & IXGBE_TX_FLAGS_HW_VLAN) &&
		    !(first->tx_flags & IXGBE_TX_FLAGS_CC))
			return;
6728 6729
	} else {
		u8 l4_hdr = 0;
6730
		switch (first->protocol) {
6731
		case htons(ETH_P_IP):
6732 6733 6734
			vlan_macip_lens |= skb_network_header_len(skb);
			type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
			l4_hdr = ip_hdr(skb)->protocol;
6735
			break;
6736
		case htons(ETH_P_IPV6):
6737 6738 6739 6740 6741 6742 6743
			vlan_macip_lens |= skb_network_header_len(skb);
			l4_hdr = ipv6_hdr(skb)->nexthdr;
			break;
		default:
			if (unlikely(net_ratelimit())) {
				dev_warn(tx_ring->dev,
				 "partial checksum but proto=%x!\n",
6744
				 first->protocol);
6745
			}
6746 6747
			break;
		}
6748 6749

		switch (l4_hdr) {
6750
		case IPPROTO_TCP:
6751 6752 6753
			type_tucmd |= IXGBE_ADVTXD_TUCMD_L4T_TCP;
			mss_l4len_idx = tcp_hdrlen(skb) <<
					IXGBE_ADVTXD_L4LEN_SHIFT;
6754 6755
			break;
		case IPPROTO_SCTP:
6756 6757 6758 6759 6760 6761 6762 6763 6764 6765 6766 6767
			type_tucmd |= IXGBE_ADVTXD_TUCMD_L4T_SCTP;
			mss_l4len_idx = sizeof(struct sctphdr) <<
					IXGBE_ADVTXD_L4LEN_SHIFT;
			break;
		case IPPROTO_UDP:
			mss_l4len_idx = sizeof(struct udphdr) <<
					IXGBE_ADVTXD_L4LEN_SHIFT;
			break;
		default:
			if (unlikely(net_ratelimit())) {
				dev_warn(tx_ring->dev,
				 "partial checksum but l4 proto=%x!\n",
6768
				 l4_hdr);
6769
			}
6770 6771
			break;
		}
6772 6773 6774

		/* update TX checksum flag */
		first->tx_flags |= IXGBE_TX_FLAGS_CSUM;
6775 6776
	}

6777
	/* vlan_macip_lens: MACLEN, VLAN tag */
6778
	vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
6779
	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
6780

6781 6782
	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, 0,
			  type_tucmd, mss_l4len_idx);
6783 6784
}

6785 6786 6787 6788 6789 6790
#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)
6791
{
6792
	/* set type for advanced descriptor with frame checksum insertion */
6793 6794 6795
	u32 cmd_type = IXGBE_ADVTXD_DTYP_DATA |
		       IXGBE_ADVTXD_DCMD_DEXT |
		       IXGBE_ADVTXD_DCMD_IFCS;
6796

6797
	/* set HW vlan bit if vlan is present */
6798 6799
	cmd_type |= IXGBE_SET_FLAG(tx_flags, IXGBE_TX_FLAGS_HW_VLAN,
				   IXGBE_ADVTXD_DCMD_VLE);
6800

6801
	/* set segmentation enable bits for TSO/FSO */
6802 6803 6804 6805 6806 6807
	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);
6808

6809
	/* insert frame checksum */
6810
	cmd_type ^= IXGBE_SET_FLAG(skb->no_fcs, 1, IXGBE_ADVTXD_DCMD_IFCS);
6811

6812 6813
	return cmd_type;
}
6814

6815 6816
static void ixgbe_tx_olinfo_status(union ixgbe_adv_tx_desc *tx_desc,
				   u32 tx_flags, unsigned int paylen)
6817
{
6818
	u32 olinfo_status = paylen << IXGBE_ADVTXD_PAYLEN_SHIFT;
6819

6820
	/* enable L4 checksum for TSO and TX checksum offload */
6821 6822 6823
	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
					IXGBE_TX_FLAGS_CSUM,
					IXGBE_ADVTXD_POPTS_TXSM);
6824

6825
	/* enble IPv4 checksum for TSO */
6826 6827 6828
	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
					IXGBE_TX_FLAGS_IPV4,
					IXGBE_ADVTXD_POPTS_IXSM);
6829

6830 6831 6832 6833
	/*
	 * Check Context must be set if Tx switch is enabled, which it
	 * always is for case where virtual functions are running
	 */
6834 6835 6836
	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
					IXGBE_TX_FLAGS_CC,
					IXGBE_ADVTXD_CC);
6837

6838
	tx_desc->read.olinfo_status = cpu_to_le32(olinfo_status);
6839
}
6840

6841 6842 6843 6844 6845 6846 6847
#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)
{
6848
	struct sk_buff *skb = first->skb;
6849
	struct ixgbe_tx_buffer *tx_buffer;
6850
	union ixgbe_adv_tx_desc *tx_desc;
6851 6852 6853
	struct skb_frag_struct *frag;
	dma_addr_t dma;
	unsigned int data_len, size;
6854
	u32 tx_flags = first->tx_flags;
6855
	u32 cmd_type = ixgbe_tx_cmd_type(skb, tx_flags);
6856 6857
	u16 i = tx_ring->next_to_use;

6858 6859
	tx_desc = IXGBE_TX_DESC(tx_ring, i);

6860 6861 6862 6863
	ixgbe_tx_olinfo_status(tx_desc, tx_flags, skb->len - hdr_len);

	size = skb_headlen(skb);
	data_len = skb->data_len;
6864

6865 6866
#ifdef IXGBE_FCOE
	if (tx_flags & IXGBE_TX_FLAGS_FCOE) {
6867
		if (data_len < sizeof(struct fcoe_crc_eof)) {
6868 6869
			size -= sizeof(struct fcoe_crc_eof) - data_len;
			data_len = 0;
6870 6871
		} else {
			data_len -= sizeof(struct fcoe_crc_eof);
6872 6873
		}
	}
6874

6875
#endif
6876
	dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
6877

6878
	tx_buffer = first;
6879

6880 6881 6882 6883 6884 6885 6886 6887 6888
	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);
6889

6890
		while (unlikely(size > IXGBE_MAX_DATA_PER_TXD)) {
6891
			tx_desc->read.cmd_type_len =
6892
				cpu_to_le32(cmd_type ^ IXGBE_MAX_DATA_PER_TXD);
6893

6894
			i++;
6895
			tx_desc++;
6896
			if (i == tx_ring->count) {
6897
				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
6898 6899
				i = 0;
			}
6900
			tx_desc->read.olinfo_status = 0;
6901 6902 6903 6904 6905

			dma += IXGBE_MAX_DATA_PER_TXD;
			size -= IXGBE_MAX_DATA_PER_TXD;

			tx_desc->read.buffer_addr = cpu_to_le64(dma);
6906
		}
6907

6908 6909
		if (likely(!data_len))
			break;
6910

6911
		tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type ^ size);
6912

6913 6914 6915 6916 6917 6918
		i++;
		tx_desc++;
		if (i == tx_ring->count) {
			tx_desc = IXGBE_TX_DESC(tx_ring, 0);
			i = 0;
		}
6919
		tx_desc->read.olinfo_status = 0;
6920

6921
#ifdef IXGBE_FCOE
E
Eric Dumazet 已提交
6922
		size = min_t(unsigned int, data_len, skb_frag_size(frag));
6923
#else
E
Eric Dumazet 已提交
6924
		size = skb_frag_size(frag);
6925 6926
#endif
		data_len -= size;
6927

6928 6929
		dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
				       DMA_TO_DEVICE);
6930

6931 6932
		tx_buffer = &tx_ring->tx_buffer_info[i];
	}
6933

6934
	/* write last descriptor with RS and EOP bits */
6935 6936
	cmd_type |= size | IXGBE_TXD_CMD;
	tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type);
6937

6938
	netdev_tx_sent_queue(txring_txq(tx_ring), first->bytecount);
6939

6940 6941
	/* set the timestamp */
	first->time_stamp = jiffies;
6942 6943

	/*
6944 6945 6946 6947 6948 6949
	 * 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.
6950 6951 6952
	 */
	wmb();

6953 6954 6955
	/* set next_to_watch value indicating a packet is present */
	first->next_to_watch = tx_desc;

6956 6957 6958 6959 6960 6961
	i++;
	if (i == tx_ring->count)
		i = 0;

	tx_ring->next_to_use = i;

6962
	/* notify HW of packet */
6963
	ixgbe_write_tail(tx_ring, i);
6964 6965 6966

	return;
dma_error:
6967
	dev_err(tx_ring->dev, "TX DMA map failed\n");
6968 6969 6970

	/* clear dma mappings for failed tx_buffer_info map */
	for (;;) {
6971 6972 6973
		tx_buffer = &tx_ring->tx_buffer_info[i];
		ixgbe_unmap_and_free_tx_resource(tx_ring, tx_buffer);
		if (tx_buffer == first)
6974 6975 6976 6977 6978 6979 6980
			break;
		if (i == 0)
			i = tx_ring->count;
		i--;
	}

	tx_ring->next_to_use = i;
6981 6982
}

6983
static void ixgbe_atr(struct ixgbe_ring *ring,
6984
		      struct ixgbe_tx_buffer *first)
6985 6986 6987 6988 6989 6990 6991 6992 6993
{
	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;
6994
	struct tcphdr *th;
6995
	__be16 vlan_id;
6996

6997 6998 6999 7000 7001 7002
	/* 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)
7003
		return;
7004

7005
	ring->atr_count++;
7006

7007
	/* snag network header to get L4 type and address */
7008
	hdr.network = skb_network_header(first->skb);
7009 7010

	/* Currently only IPv4/IPv6 with TCP is supported */
7011
	if ((first->protocol != htons(ETH_P_IPV6) ||
7012
	     hdr.ipv6->nexthdr != IPPROTO_TCP) &&
7013
	    (first->protocol != htons(ETH_P_IP) ||
7014 7015
	     hdr.ipv4->protocol != IPPROTO_TCP))
		return;
7016

7017
	th = tcp_hdr(first->skb);
7018

7019 7020
	/* skip this packet since it is invalid or the socket is closing */
	if (!th || th->fin)
7021 7022 7023 7024 7025 7026 7027 7028 7029
		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;

7030
	vlan_id = htons(first->tx_flags >> IXGBE_TX_FLAGS_VLAN_SHIFT);
7031 7032 7033 7034 7035 7036 7037 7038 7039 7040 7041 7042 7043 7044

	/*
	 * 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
	 */
7045
	if (first->tx_flags & (IXGBE_TX_FLAGS_SW_VLAN | IXGBE_TX_FLAGS_HW_VLAN))
7046
		common.port.src ^= th->dest ^ htons(ETH_P_8021Q);
7047
	else
7048
		common.port.src ^= th->dest ^ first->protocol;
7049 7050
	common.port.dst ^= th->source;

7051
	if (first->protocol == htons(ETH_P_IP)) {
7052 7053 7054 7055 7056 7057 7058 7059 7060 7061 7062 7063 7064
		input.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_TCPV4;
		common.ip ^= hdr.ipv4->saddr ^ hdr.ipv4->daddr;
	} else {
		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];
	}
7065 7066

	/* This assumes the Rx queue and Tx queue are bound to the same CPU */
7067 7068
	ixgbe_fdir_add_signature_filter_82599(&q_vector->adapter->hw,
					      input, common, ring->queue_index);
7069 7070
}

7071
static int __ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
7072
{
7073
	netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);
7074 7075 7076 7077 7078 7079 7080
	/* 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. */
7081
	if (likely(ixgbe_desc_unused(tx_ring) < size))
7082 7083 7084
		return -EBUSY;

	/* A reprieve! - use start_queue because it doesn't call schedule */
7085
	netif_start_subqueue(tx_ring->netdev, tx_ring->queue_index);
7086
	++tx_ring->tx_stats.restart_queue;
7087 7088 7089
	return 0;
}

7090
static inline int ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
7091
{
7092
	if (likely(ixgbe_desc_unused(tx_ring) >= size))
7093
		return 0;
7094
	return __ixgbe_maybe_stop_tx(tx_ring, size);
7095 7096
}

7097
static u16 ixgbe_select_queue(struct net_device *dev, struct sk_buff *skb,
7098
			      void *accel_priv, select_queue_fallback_t fallback)
7099
{
7100 7101
	struct ixgbe_fwd_adapter *fwd_adapter = accel_priv;
#ifdef IXGBE_FCOE
7102 7103 7104
	struct ixgbe_adapter *adapter;
	struct ixgbe_ring_feature *f;
	int txq;
7105 7106 7107 7108 7109 7110
#endif

	if (fwd_adapter)
		return skb->queue_mapping + fwd_adapter->tx_base_queue;

#ifdef IXGBE_FCOE
7111

7112 7113 7114 7115 7116
	/*
	 * only execute the code below if protocol is FCoE
	 * or FIP and we have FCoE enabled on the adapter
	 */
	switch (vlan_get_protocol(skb)) {
7117 7118
	case htons(ETH_P_FCOE):
	case htons(ETH_P_FIP):
7119
		adapter = netdev_priv(dev);
7120

7121 7122 7123
		if (adapter->flags & IXGBE_FLAG_FCOE_ENABLED)
			break;
	default:
7124
		return fallback(dev, skb);
7125
	}
7126

7127
	f = &adapter->ring_feature[RING_F_FCOE];
7128

7129 7130
	txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) :
					   smp_processor_id();
7131

7132 7133
	while (txq >= f->indices)
		txq -= f->indices;
7134

7135
	return txq + f->offset;
7136
#else
7137
	return fallback(dev, skb);
7138
#endif
7139 7140
}

7141
netdev_tx_t ixgbe_xmit_frame_ring(struct sk_buff *skb,
7142 7143
			  struct ixgbe_adapter *adapter,
			  struct ixgbe_ring *tx_ring)
7144
{
7145
	struct ixgbe_tx_buffer *first;
7146
	int tso;
7147
	u32 tx_flags = 0;
7148 7149
	unsigned short f;
	u16 count = TXD_USE_COUNT(skb_headlen(skb));
7150
	__be16 protocol = skb->protocol;
7151
	u8 hdr_len = 0;
7152

7153 7154
	/*
	 * need: 1 descriptor per page * PAGE_SIZE/IXGBE_MAX_DATA_PER_TXD,
7155
	 *       + 1 desc for skb_headlen/IXGBE_MAX_DATA_PER_TXD,
7156 7157 7158 7159 7160 7161
	 *       + 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);
7162

7163 7164 7165 7166 7167
	if (ixgbe_maybe_stop_tx(tx_ring, count + 3)) {
		tx_ring->tx_stats.tx_busy++;
		return NETDEV_TX_BUSY;
	}

7168 7169 7170
	/* record the location of the first descriptor for this packet */
	first = &tx_ring->tx_buffer_info[tx_ring->next_to_use];
	first->skb = skb;
7171 7172
	first->bytecount = skb->len;
	first->gso_segs = 1;
7173

7174
	/* if we have a HW VLAN tag being added default to the HW one */
7175
	if (vlan_tx_tag_present(skb)) {
7176 7177 7178
		tx_flags |= vlan_tx_tag_get(skb) << IXGBE_TX_FLAGS_VLAN_SHIFT;
		tx_flags |= IXGBE_TX_FLAGS_HW_VLAN;
	/* else if it is a SW VLAN check the next protocol and store the tag */
7179
	} else if (protocol == htons(ETH_P_8021Q)) {
7180 7181 7182 7183 7184 7185
		struct vlan_hdr *vhdr, _vhdr;
		vhdr = skb_header_pointer(skb, ETH_HLEN, sizeof(_vhdr), &_vhdr);
		if (!vhdr)
			goto out_drop;

		protocol = vhdr->h_vlan_encapsulated_proto;
7186 7187
		tx_flags |= ntohs(vhdr->h_vlan_TCI) <<
				  IXGBE_TX_FLAGS_VLAN_SHIFT;
7188 7189 7190
		tx_flags |= IXGBE_TX_FLAGS_SW_VLAN;
	}

7191 7192 7193
	if (unlikely(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP &&
		     !test_and_set_bit_lock(__IXGBE_PTP_TX_IN_PROGRESS,
					    &adapter->state))) {
7194 7195
		skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
		tx_flags |= IXGBE_TX_FLAGS_TSTAMP;
7196 7197 7198 7199 7200

		/* schedule check for Tx timestamp */
		adapter->ptp_tx_skb = skb_get(skb);
		adapter->ptp_tx_start = jiffies;
		schedule_work(&adapter->ptp_tx_work);
7201 7202
	}

7203 7204
	skb_tx_timestamp(skb);

7205 7206 7207 7208 7209 7210
#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)
7211
		tx_flags |= IXGBE_TX_FLAGS_CC;
7212 7213

#endif
7214
	/* DCB maps skb priorities 0-7 onto 3 bit PCP of VLAN tag. */
7215
	if ((adapter->flags & IXGBE_FLAG_DCB_ENABLED) &&
7216 7217
	    ((tx_flags & (IXGBE_TX_FLAGS_HW_VLAN | IXGBE_TX_FLAGS_SW_VLAN)) ||
	     (skb->priority != TC_PRIO_CONTROL))) {
7218
		tx_flags &= ~IXGBE_TX_FLAGS_VLAN_PRIO_MASK;
7219 7220
		tx_flags |= (skb->priority & 0x7) <<
					IXGBE_TX_FLAGS_VLAN_PRIO_SHIFT;
7221 7222
		if (tx_flags & IXGBE_TX_FLAGS_SW_VLAN) {
			struct vlan_ethhdr *vhdr;
7223 7224

			if (skb_cow_head(skb, 0))
7225 7226 7227 7228 7229 7230
				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;
7231
		}
7232
	}
7233

7234 7235 7236 7237
	/* record initial flags and protocol */
	first->tx_flags = tx_flags;
	first->protocol = protocol;

7238
#ifdef IXGBE_FCOE
7239
	/* setup tx offload for FCoE */
7240
	if ((protocol == htons(ETH_P_FCOE)) &&
7241
	    (tx_ring->netdev->features & (NETIF_F_FSO | NETIF_F_FCOE_CRC))) {
7242
		tso = ixgbe_fso(tx_ring, first, &hdr_len);
7243 7244
		if (tso < 0)
			goto out_drop;
7245

7246
		goto xmit_fcoe;
7247
	}
7248

7249
#endif /* IXGBE_FCOE */
7250
	tso = ixgbe_tso(tx_ring, first, &hdr_len);
7251
	if (tso < 0)
7252
		goto out_drop;
7253 7254
	else if (!tso)
		ixgbe_tx_csum(tx_ring, first);
7255 7256 7257

	/* add the ATR filter if ATR is on */
	if (test_bit(__IXGBE_TX_FDIR_INIT_DONE, &tx_ring->state))
7258
		ixgbe_atr(tx_ring, first);
7259 7260 7261 7262

#ifdef IXGBE_FCOE
xmit_fcoe:
#endif /* IXGBE_FCOE */
7263
	ixgbe_tx_map(tx_ring, first, hdr_len);
7264 7265

	ixgbe_maybe_stop_tx(tx_ring, DESC_NEEDED);
7266 7267

	return NETDEV_TX_OK;
7268 7269

out_drop:
7270 7271 7272
	dev_kfree_skb_any(first->skb);
	first->skb = NULL;

7273
	return NETDEV_TX_OK;
7274 7275
}

7276 7277 7278
static netdev_tx_t __ixgbe_xmit_frame(struct sk_buff *skb,
				      struct net_device *netdev,
				      struct ixgbe_ring *ring)
7279 7280 7281 7282
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_ring *tx_ring;

7283 7284 7285 7286
	/*
	 * The minimum packet size for olinfo paylen is 17 so pad the skb
	 * in order to meet this minimum size requirement.
	 */
7287 7288
	if (unlikely(skb->len < 17)) {
		if (skb_pad(skb, 17 - skb->len))
7289 7290
			return NETDEV_TX_OK;
		skb->len = 17;
7291
		skb_set_tail_pointer(skb, 17);
7292 7293
	}

7294 7295
	tx_ring = ring ? ring : adapter->tx_ring[skb->queue_mapping];

7296
	return ixgbe_xmit_frame_ring(skb, adapter, tx_ring);
7297 7298
}

7299 7300 7301 7302 7303 7304
static netdev_tx_t ixgbe_xmit_frame(struct sk_buff *skb,
				    struct net_device *netdev)
{
	return __ixgbe_xmit_frame(skb, netdev, NULL);
}

7305 7306 7307 7308 7309 7310 7311 7312 7313 7314
/**
 * 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);
7315
	struct ixgbe_hw *hw = &adapter->hw;
7316
	struct sockaddr *addr = p;
7317
	int ret;
7318 7319 7320 7321

	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

7322
	ixgbe_del_mac_filter(adapter, hw->mac.addr, VMDQ_P(0));
7323
	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
7324
	memcpy(hw->mac.addr, addr->sa_data, netdev->addr_len);
7325

7326 7327
	ret = ixgbe_add_mac_filter(adapter, hw->mac.addr, VMDQ_P(0));
	return ret > 0 ? 0 : ret;
7328 7329
}

7330 7331 7332 7333 7334 7335 7336 7337 7338 7339 7340 7341 7342 7343 7344 7345 7346 7347 7348 7349 7350 7351 7352 7353 7354 7355 7356 7357 7358 7359 7360
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);

7361 7362
	switch (cmd) {
	case SIOCSHWTSTAMP:
7363 7364 7365
		return ixgbe_ptp_set_ts_config(adapter, req);
	case SIOCGHWTSTAMP:
		return ixgbe_ptp_get_ts_config(adapter, req);
7366 7367 7368
	default:
		return mdio_mii_ioctl(&adapter->hw.phy.mdio, if_mii(req), cmd);
	}
7369 7370
}

7371 7372
/**
 * ixgbe_add_sanmac_netdev - Add the SAN MAC address to the corresponding
7373
 * netdev->dev_addrs
7374 7375 7376 7377 7378 7379 7380 7381
 * @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);
7382
	struct ixgbe_hw *hw = &adapter->hw;
7383

7384
	if (is_valid_ether_addr(hw->mac.san_addr)) {
7385
		rtnl_lock();
7386
		err = dev_addr_add(dev, hw->mac.san_addr, NETDEV_HW_ADDR_T_SAN);
7387
		rtnl_unlock();
7388 7389 7390

		/* update SAN MAC vmdq pool selection */
		hw->mac.ops.set_vmdq_san_mac(hw, VMDQ_P(0));
7391 7392 7393 7394 7395 7396
	}
	return err;
}

/**
 * ixgbe_del_sanmac_netdev - Removes the SAN MAC address to the corresponding
7397
 * netdev->dev_addrs
7398 7399 7400 7401 7402 7403 7404 7405 7406 7407 7408 7409 7410 7411 7412 7413 7414 7415
 * @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;
}

7416 7417 7418 7419 7420 7421 7422 7423 7424
#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);
7425
	int i;
7426

7427 7428 7429 7430
	/* if interface is down do nothing */
	if (test_bit(__IXGBE_DOWN, &adapter->state))
		return;

7431
	adapter->flags |= IXGBE_FLAG_IN_NETPOLL;
7432
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
7433 7434
		for (i = 0; i < adapter->num_q_vectors; i++)
			ixgbe_msix_clean_rings(0, adapter->q_vector[i]);
7435 7436 7437
	} else {
		ixgbe_intr(adapter->pdev->irq, netdev);
	}
7438 7439 7440
	adapter->flags &= ~IXGBE_FLAG_IN_NETPOLL;
}

A
Alexander Duyck 已提交
7441
#endif
E
Eric Dumazet 已提交
7442 7443 7444 7445 7446 7447
static struct rtnl_link_stats64 *ixgbe_get_stats64(struct net_device *netdev,
						   struct rtnl_link_stats64 *stats)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	int i;

E
Eric Dumazet 已提交
7448
	rcu_read_lock();
E
Eric Dumazet 已提交
7449
	for (i = 0; i < adapter->num_rx_queues; i++) {
E
Eric Dumazet 已提交
7450
		struct ixgbe_ring *ring = ACCESS_ONCE(adapter->rx_ring[i]);
E
Eric Dumazet 已提交
7451 7452 7453
		u64 bytes, packets;
		unsigned int start;

E
Eric Dumazet 已提交
7454 7455
		if (ring) {
			do {
7456
				start = u64_stats_fetch_begin_irq(&ring->syncp);
E
Eric Dumazet 已提交
7457 7458
				packets = ring->stats.packets;
				bytes   = ring->stats.bytes;
7459
			} while (u64_stats_fetch_retry_irq(&ring->syncp, start));
E
Eric Dumazet 已提交
7460 7461 7462
			stats->rx_packets += packets;
			stats->rx_bytes   += bytes;
		}
E
Eric Dumazet 已提交
7463
	}
E
Eric Dumazet 已提交
7464 7465 7466 7467 7468 7469 7470 7471

	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 {
7472
				start = u64_stats_fetch_begin_irq(&ring->syncp);
E
Eric Dumazet 已提交
7473 7474
				packets = ring->stats.packets;
				bytes   = ring->stats.bytes;
7475
			} while (u64_stats_fetch_retry_irq(&ring->syncp, start));
E
Eric Dumazet 已提交
7476 7477 7478 7479
			stats->tx_packets += packets;
			stats->tx_bytes   += bytes;
		}
	}
E
Eric Dumazet 已提交
7480
	rcu_read_unlock();
E
Eric Dumazet 已提交
7481 7482 7483 7484 7485 7486 7487 7488 7489
	/* 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;
	return stats;
}

7490
#ifdef CONFIG_IXGBE_DCB
7491 7492 7493
/**
 * ixgbe_validate_rtr - verify 802.1Qp to Rx packet buffer mapping is valid.
 * @adapter: pointer to ixgbe_adapter
7494 7495 7496 7497 7498 7499 7500 7501 7502 7503 7504 7505 7506 7507 7508 7509 7510 7511 7512 7513 7514 7515 7516 7517 7518 7519 7520 7521 7522 7523 7524 7525 7526 7527
 * @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;
}

7528 7529 7530 7531 7532 7533 7534 7535 7536 7537 7538 7539 7540 7541 7542 7543 7544 7545 7546 7547 7548 7549 7550 7551 7552
/**
 * 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);
	}
}

7553
#endif /* CONFIG_IXGBE_DCB */
7554 7555
/**
 * ixgbe_setup_tc - configure net_device for multiple traffic classes
7556 7557 7558 7559 7560 7561 7562 7563
 *
 * @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;
7564
	bool pools;
7565 7566

	/* Hardware supports up to 8 traffic classes */
7567
	if (tc > adapter->dcb_cfg.num_tcs.pg_tcs ||
A
Alexander Duyck 已提交
7568 7569
	    (hw->mac.type == ixgbe_mac_82598EB &&
	     tc < MAX_TRAFFIC_CLASS))
7570 7571
		return -EINVAL;

7572 7573 7574 7575
	pools = (find_first_zero_bit(&adapter->fwd_bitmask, 32) > 1);
	if (tc && pools && adapter->num_rx_pools > IXGBE_MAX_DCBMACVLANS)
		return -EBUSY;

7576
	/* Hardware has to reinitialize queues and interrupts to
S
Stephen Hemminger 已提交
7577
	 * match packet buffer alignment. Unfortunately, the
7578 7579 7580 7581 7582 7583
	 * hardware is not flexible enough to do this dynamically.
	 */
	if (netif_running(dev))
		ixgbe_close(dev);
	ixgbe_clear_interrupt_scheme(adapter);

7584
#ifdef CONFIG_IXGBE_DCB
7585
	if (tc) {
7586
		netdev_set_num_tc(dev, tc);
7587 7588
		ixgbe_set_prio_tc_map(adapter);

7589 7590
		adapter->flags |= IXGBE_FLAG_DCB_ENABLED;

7591 7592
		if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
			adapter->last_lfc_mode = adapter->hw.fc.requested_mode;
7593
			adapter->hw.fc.requested_mode = ixgbe_fc_none;
7594
		}
7595
	} else {
7596
		netdev_reset_tc(dev);
7597

7598 7599
		if (adapter->hw.mac.type == ixgbe_mac_82598EB)
			adapter->hw.fc.requested_mode = adapter->last_lfc_mode;
7600 7601 7602 7603 7604 7605 7606

		adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;

		adapter->temp_dcb_cfg.pfc_mode_enable = false;
		adapter->dcb_cfg.pfc_mode_enable = false;
	}

7607
	ixgbe_validate_rtr(adapter, tc);
7608 7609 7610 7611

#endif /* CONFIG_IXGBE_DCB */
	ixgbe_init_interrupt_scheme(adapter);

7612
	if (netif_running(dev))
7613
		return ixgbe_open(dev);
7614 7615 7616

	return 0;
}
E
Eric Dumazet 已提交
7617

7618 7619 7620 7621 7622 7623 7624 7625 7626 7627 7628
#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
7629 7630 7631 7632 7633 7634 7635 7636 7637 7638
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);
}

7639
static netdev_features_t ixgbe_fix_features(struct net_device *netdev,
7640
					    netdev_features_t features)
7641 7642 7643 7644
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

	/* If Rx checksum is disabled, then RSC/LRO should also be disabled */
7645 7646
	if (!(features & NETIF_F_RXCSUM))
		features &= ~NETIF_F_LRO;
7647

7648 7649 7650
	/* Turn off LRO if not RSC capable */
	if (!(adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE))
		features &= ~NETIF_F_LRO;
7651

7652
	return features;
7653 7654
}

7655
static int ixgbe_set_features(struct net_device *netdev,
7656
			      netdev_features_t features)
7657 7658
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
7659
	netdev_features_t changed = netdev->features ^ features;
7660 7661 7662
	bool need_reset = false;

	/* Make sure RSC matches LRO, reset if change */
7663 7664
	if (!(features & NETIF_F_LRO)) {
		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
7665
			need_reset = true;
7666 7667 7668 7669 7670 7671 7672 7673 7674 7675
		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");
7676 7677 7678 7679 7680 7681 7682
		}
	}

	/*
	 * Check if Flow Director n-tuple support was enabled or disabled.  If
	 * the state changed, we need to reset.
	 */
7683 7684
	switch (features & NETIF_F_NTUPLE) {
	case NETIF_F_NTUPLE:
7685
		/* turn off ATR, enable perfect filters and reset */
7686 7687 7688
		if (!(adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE))
			need_reset = true;

7689 7690
		adapter->flags &= ~IXGBE_FLAG_FDIR_HASH_CAPABLE;
		adapter->flags |= IXGBE_FLAG_FDIR_PERFECT_CAPABLE;
7691 7692 7693 7694 7695 7696 7697 7698 7699 7700 7701 7702 7703 7704 7705 7706 7707 7708 7709 7710 7711 7712 7713 7714 7715 7716
		break;
	default:
		/* 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 */
		if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
			break;

		/* We cannot enable ATR if we have 2 or more traffic classes */
		if (netdev_get_num_tc(netdev) > 1)
			break;

		/* We cannot enable ATR if RSS is disabled */
		if (adapter->ring_feature[RING_F_RSS].limit <= 1)
			break;

		/* A sample rate of 0 indicates ATR disabled */
		if (!adapter->atr_sample_rate)
			break;

		adapter->flags |= IXGBE_FLAG_FDIR_HASH_CAPABLE;
		break;
7717 7718
	}

7719
	if (features & NETIF_F_HW_VLAN_CTAG_RX)
7720 7721 7722 7723
		ixgbe_vlan_strip_enable(adapter);
	else
		ixgbe_vlan_strip_disable(adapter);

B
Ben Greear 已提交
7724 7725 7726
	if (changed & NETIF_F_RXALL)
		need_reset = true;

7727
	netdev->features = features;
7728 7729 7730 7731 7732 7733
	if (need_reset)
		ixgbe_do_reset(netdev);

	return 0;
}

7734
static int ixgbe_ndo_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
J
John Fastabend 已提交
7735
			     struct net_device *dev,
7736
			     const unsigned char *addr,
J
John Fastabend 已提交
7737 7738 7739
			     u16 flags)
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
7740 7741 7742
	int err;

	if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
7743
		return ndo_dflt_fdb_add(ndm, tb, dev, addr, flags);
J
John Fastabend 已提交
7744

7745 7746 7747 7748
	/* Hardware does not support aging addresses so if a
	 * ndm_state is given only allow permanent addresses
	 */
	if (ndm->ndm_state && !(ndm->ndm_state & NUD_PERMANENT)) {
J
John Fastabend 已提交
7749 7750 7751 7752 7753
		pr_info("%s: FDB only supports static addresses\n",
			ixgbe_driver_name);
		return -EINVAL;
	}

7754
	if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) {
7755 7756 7757
		u32 rar_uc_entries = IXGBE_MAX_PF_MACVLANS;

		if (netdev_uc_count(dev) < rar_uc_entries)
J
John Fastabend 已提交
7758 7759
			err = dev_uc_add_excl(dev, addr);
		else
7760 7761 7762 7763 7764
			err = -ENOMEM;
	} else if (is_multicast_ether_addr(addr)) {
		err = dev_mc_add_excl(dev, addr);
	} else {
		err = -EINVAL;
J
John Fastabend 已提交
7765 7766 7767 7768 7769 7770 7771 7772 7773
	}

	/* Only return duplicate errors if NLM_F_EXCL is set */
	if (err == -EEXIST && !(flags & NLM_F_EXCL))
		err = 0;

	return err;
}

7774 7775 7776 7777 7778 7779 7780 7781 7782 7783 7784 7785 7786 7787 7788 7789 7790 7791 7792 7793
static int ixgbe_ndo_bridge_setlink(struct net_device *dev,
				    struct nlmsghdr *nlh)
{
	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);

	nla_for_each_nested(attr, br_spec, rem) {
		__u16 mode;
		u32 reg = 0;

		if (nla_type(attr) != IFLA_BRIDGE_MODE)
			continue;

		mode = nla_get_u16(attr);
7794
		if (mode == BRIDGE_MODE_VEPA) {
7795
			reg = 0;
7796 7797
			adapter->flags2 &= ~IXGBE_FLAG2_BRIDGE_MODE_VEB;
		} else if (mode == BRIDGE_MODE_VEB) {
7798
			reg = IXGBE_PFDTXGSWC_VT_LBEN;
7799 7800
			adapter->flags2 |= IXGBE_FLAG2_BRIDGE_MODE_VEB;
		} else
7801 7802 7803 7804 7805 7806 7807 7808 7809 7810 7811 7812
			return -EINVAL;

		IXGBE_WRITE_REG(&adapter->hw, IXGBE_PFDTXGSWC, reg);

		e_info(drv, "enabling bridge mode: %s\n",
			mode == BRIDGE_MODE_VEPA ? "VEPA" : "VEB");
	}

	return 0;
}

static int ixgbe_ndo_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq,
7813 7814
				    struct net_device *dev,
				    u32 filter_mask)
7815 7816 7817 7818 7819 7820 7821
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
	u16 mode;

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

7822
	if (adapter->flags2 & IXGBE_FLAG2_BRIDGE_MODE_VEB)
7823 7824 7825 7826 7827 7828 7829
		mode = BRIDGE_MODE_VEB;
	else
		mode = BRIDGE_MODE_VEPA;

	return ndo_dflt_bridge_getlink(skb, pid, seq, dev, mode);
}

7830 7831 7832 7833
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);
7834
	unsigned int limit;
7835 7836
	int pool, err;

7837 7838 7839 7840 7841 7842 7843
#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
7844
	/* Check for hardware restriction on number of rx/tx queues */
7845
	if (vdev->num_tx_queues > IXGBE_MAX_L2A_QUEUES ||
7846 7847 7848 7849 7850 7851 7852 7853 7854 7855 7856 7857 7858 7859 7860 7861 7862 7863 7864
	    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);

	fwd_adapter = kcalloc(1, sizeof(struct ixgbe_fwd_adapter), GFP_KERNEL);
	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);
7865
	limit = find_last_bit(&adapter->fwd_bitmask, 32);
7866 7867 7868

	/* Enable VMDq flag so device will be set in VM mode */
	adapter->flags |= IXGBE_FLAG_VMDQ_ENABLED | IXGBE_FLAG_SRIOV_ENABLED;
7869
	adapter->ring_feature[RING_F_VMDQ].limit = limit + 1;
7870
	adapter->ring_feature[RING_F_RSS].limit = vdev->num_tx_queues;
7871 7872 7873 7874 7875 7876 7877 7878 7879 7880 7881 7882 7883 7884 7885 7886 7887 7888 7889 7890 7891 7892 7893 7894 7895 7896

	/* 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;
	err = ixgbe_fwd_ring_up(vdev, fwd_adapter);
	if (err)
		goto fwd_add_err;
	netif_tx_start_all_queues(vdev);
	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;
7897
	unsigned int limit;
7898 7899 7900 7901

	clear_bit(fwd_adapter->pool, &adapter->fwd_bitmask);
	adapter->num_rx_pools--;

7902 7903
	limit = find_last_bit(&adapter->fwd_bitmask, 32);
	adapter->ring_feature[RING_F_VMDQ].limit = limit + 1;
7904 7905 7906 7907 7908 7909 7910 7911 7912 7913
	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);
}

7914
static const struct net_device_ops ixgbe_netdev_ops = {
7915
	.ndo_open		= ixgbe_open,
7916
	.ndo_stop		= ixgbe_close,
7917
	.ndo_start_xmit		= ixgbe_xmit_frame,
7918
	.ndo_select_queue	= ixgbe_select_queue,
A
Alexander Duyck 已提交
7919
	.ndo_set_rx_mode	= ixgbe_set_rx_mode,
7920 7921 7922 7923 7924 7925
	.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,
	.ndo_vlan_rx_add_vid	= ixgbe_vlan_rx_add_vid,
	.ndo_vlan_rx_kill_vid	= ixgbe_vlan_rx_kill_vid,
7926
	.ndo_do_ioctl		= ixgbe_ioctl,
7927 7928
	.ndo_set_vf_mac		= ixgbe_ndo_set_vf_mac,
	.ndo_set_vf_vlan	= ixgbe_ndo_set_vf_vlan,
7929
	.ndo_set_vf_rate	= ixgbe_ndo_set_vf_bw,
A
Alexander Duyck 已提交
7930
	.ndo_set_vf_spoofchk	= ixgbe_ndo_set_vf_spoofchk,
7931
	.ndo_get_vf_config	= ixgbe_ndo_get_vf_config,
E
Eric Dumazet 已提交
7932
	.ndo_get_stats64	= ixgbe_get_stats64,
7933
#ifdef CONFIG_IXGBE_DCB
J
John Fastabend 已提交
7934
	.ndo_setup_tc		= ixgbe_setup_tc,
7935
#endif
7936 7937 7938
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= ixgbe_netpoll,
#endif
7939
#ifdef CONFIG_NET_RX_BUSY_POLL
7940
	.ndo_busy_poll		= ixgbe_low_latency_recv,
7941
#endif
7942 7943
#ifdef IXGBE_FCOE
	.ndo_fcoe_ddp_setup = ixgbe_fcoe_ddp_get,
7944
	.ndo_fcoe_ddp_target = ixgbe_fcoe_ddp_target,
7945
	.ndo_fcoe_ddp_done = ixgbe_fcoe_ddp_put,
7946 7947
	.ndo_fcoe_enable = ixgbe_fcoe_enable,
	.ndo_fcoe_disable = ixgbe_fcoe_disable,
7948
	.ndo_fcoe_get_wwn = ixgbe_fcoe_get_wwn,
7949
	.ndo_fcoe_get_hbainfo = ixgbe_fcoe_get_hbainfo,
7950
#endif /* IXGBE_FCOE */
7951 7952
	.ndo_set_features = ixgbe_set_features,
	.ndo_fix_features = ixgbe_fix_features,
J
John Fastabend 已提交
7953
	.ndo_fdb_add		= ixgbe_ndo_fdb_add,
7954 7955
	.ndo_bridge_setlink	= ixgbe_ndo_bridge_setlink,
	.ndo_bridge_getlink	= ixgbe_ndo_bridge_getlink,
7956 7957
	.ndo_dfwd_add_station	= ixgbe_fwd_add,
	.ndo_dfwd_del_station	= ixgbe_fwd_del,
7958 7959
};

7960 7961 7962 7963 7964 7965 7966 7967 7968 7969 7970 7971 7972 7973
/**
 * 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)
{
	struct list_head *entry;
	int physfns = 0;

7974 7975 7976
	/* 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.
7977
	 */
7978
	if (ixgbe_pcie_from_parent(&adapter->hw)) {
7979
		physfns = 4;
7980
	} else {
7981 7982 7983 7984 7985 7986 7987 7988 7989 7990 7991 7992
		list_for_each(entry, &adapter->pdev->bus_list) {
			struct pci_dev *pdev =
				list_entry(entry, struct pci_dev, bus_list);
			/* don't count virtual functions */
			if (!pdev->is_virtfn)
				physfns++;
		}
	}

	return physfns;
}

7993 7994 7995 7996 7997 7998 7999 8000 8001 8002 8003 8004 8005 8006 8007 8008 8009 8010 8011 8012 8013
/**
 * ixgbe_wol_supported - Check whether device supports WoL
 * @hw: hw specific details
 * @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
 *
 **/
int ixgbe_wol_supported(struct ixgbe_adapter *adapter, u16 device_id,
			u16 subdevice_id)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u16 wol_cap = adapter->eeprom_cap & IXGBE_DEVICE_CAPS_WOL_MASK;
	int is_wol_supported = 0;

	switch (device_id) {
	case IXGBE_DEV_ID_82599_SFP:
		/* Only these subdevices could supports WOL */
		switch (subdevice_id) {
8014
		case IXGBE_SUBDEV_ID_82599_SFP_WOL0:
8015 8016 8017 8018
		case IXGBE_SUBDEV_ID_82599_560FLR:
			/* only support first port */
			if (hw->bus.func != 0)
				break;
8019
		case IXGBE_SUBDEV_ID_82599_SP_560FLR:
8020
		case IXGBE_SUBDEV_ID_82599_SFP:
8021
		case IXGBE_SUBDEV_ID_82599_RNDC:
8022
		case IXGBE_SUBDEV_ID_82599_ECNA_DP:
8023
		case IXGBE_SUBDEV_ID_82599_LOM_SFP:
8024 8025 8026 8027
			is_wol_supported = 1;
			break;
		}
		break;
8028 8029 8030 8031 8032 8033 8034 8035
	case IXGBE_DEV_ID_82599EN_SFP:
		/* Only this subdevice supports WOL */
		switch (subdevice_id) {
		case IXGBE_SUBDEV_ID_82599EN_SFP_OCP1:
			is_wol_supported = 1;
			break;
		}
		break;
8036 8037 8038 8039 8040 8041 8042 8043 8044
	case IXGBE_DEV_ID_82599_COMBO_BACKPLANE:
		/* All except this subdevice support WOL */
		if (subdevice_id != IXGBE_SUBDEV_ID_82599_KX4_KR_MEZZ)
			is_wol_supported = 1;
		break;
	case IXGBE_DEV_ID_82599_KX4:
		is_wol_supported = 1;
		break;
	case IXGBE_DEV_ID_X540T:
8045
	case IXGBE_DEV_ID_X540T1:
8046 8047 8048 8049 8050 8051 8052 8053 8054 8055 8056 8057
		/* check eeprom to see if enabled wol */
		if ((wol_cap == IXGBE_DEVICE_CAPS_WOL_PORT0_1) ||
		    ((wol_cap == IXGBE_DEVICE_CAPS_WOL_PORT0) &&
		     (hw->bus.func == 0))) {
			is_wol_supported = 1;
		}
		break;
	}

	return is_wol_supported;
}

8058 8059 8060 8061 8062 8063 8064 8065 8066 8067 8068
/**
 * 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.
 **/
8069
static int ixgbe_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
8070 8071 8072 8073 8074 8075
{
	struct net_device *netdev;
	struct ixgbe_adapter *adapter = NULL;
	struct ixgbe_hw *hw;
	const struct ixgbe_info *ii = ixgbe_info_tbl[ent->driver_data];
	static int cards_found;
8076
	int i, err, pci_using_dac, expected_gts;
8077
	unsigned int indices = MAX_TX_QUEUES;
8078
	u8 part_str[IXGBE_PBANUM_LENGTH];
8079 8080 8081
#ifdef IXGBE_FCOE
	u16 device_caps;
#endif
8082
	u32 eec;
8083

8084 8085 8086 8087 8088 8089 8090 8091 8092
	/* 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;
	}

8093
	err = pci_enable_device_mem(pdev);
8094 8095 8096
	if (err)
		return err;

8097
	if (!dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64))) {
8098 8099
		pci_using_dac = 1;
	} else {
8100
		err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
8101
		if (err) {
8102 8103 8104
			dev_err(&pdev->dev,
				"No usable DMA configuration, aborting\n");
			goto err_dma;
8105 8106 8107 8108
		}
		pci_using_dac = 0;
	}

8109
	err = pci_request_selected_regions(pdev, pci_select_bars(pdev,
8110
					   IORESOURCE_MEM), ixgbe_driver_name);
8111
	if (err) {
8112 8113
		dev_err(&pdev->dev,
			"pci_request_selected_regions failed 0x%x\n", err);
8114 8115 8116
		goto err_pci_reg;
	}

8117
	pci_enable_pcie_error_reporting(pdev);
8118

8119
	pci_set_master(pdev);
8120
	pci_save_state(pdev);
8121

8122
	if (ii->mac == ixgbe_mac_82598EB) {
8123
#ifdef CONFIG_IXGBE_DCB
8124 8125 8126 8127
		/* 8 TC w/ 4 queues per TC */
		indices = 4 * MAX_TRAFFIC_CLASS;
#else
		indices = IXGBE_MAX_RSS_INDICES;
8128
#endif
8129
	}
8130

8131
	netdev = alloc_etherdev_mq(sizeof(struct ixgbe_adapter), indices);
8132 8133 8134 8135 8136 8137 8138 8139
	if (!netdev) {
		err = -ENOMEM;
		goto err_alloc_etherdev;
	}

	SET_NETDEV_DEV(netdev, &pdev->dev);

	adapter = netdev_priv(netdev);
8140
	pci_set_drvdata(pdev, adapter);
8141 8142 8143 8144 8145

	adapter->netdev = netdev;
	adapter->pdev = pdev;
	hw = &adapter->hw;
	hw->back = adapter;
8146
	adapter->msg_enable = netif_msg_init(debug, DEFAULT_MSG_ENABLE);
8147

8148
	hw->hw_addr = ioremap(pci_resource_start(pdev, 0),
8149
			      pci_resource_len(pdev, 0));
8150
	adapter->io_addr = hw->hw_addr;
8151 8152 8153 8154 8155
	if (!hw->hw_addr) {
		err = -EIO;
		goto err_ioremap;
	}

8156
	netdev->netdev_ops = &ixgbe_netdev_ops;
8157 8158
	ixgbe_set_ethtool_ops(netdev);
	netdev->watchdog_timeo = 5 * HZ;
8159
	strncpy(netdev->name, pci_name(pdev), sizeof(netdev->name) - 1);
8160 8161 8162 8163 8164

	adapter->bd_number = cards_found;

	/* Setup hw api */
	memcpy(&hw->mac.ops, ii->mac_ops, sizeof(hw->mac.ops));
8165
	hw->mac.type  = ii->mac;
8166

8167 8168 8169
	/* EEPROM */
	memcpy(&hw->eeprom.ops, ii->eeprom_ops, sizeof(hw->eeprom.ops));
	eec = IXGBE_READ_REG(hw, IXGBE_EEC);
8170 8171 8172 8173
	if (ixgbe_removed(hw->hw_addr)) {
		err = -EIO;
		goto err_ioremap;
	}
8174 8175 8176 8177 8178 8179
	/* If EEPROM is valid (bit 8 = 1), use default otherwise use bit bang */
	if (!(eec & (1 << 8)))
		hw->eeprom.ops.read = &ixgbe_read_eeprom_bit_bang_generic;

	/* PHY */
	memcpy(&hw->phy.ops, ii->phy_ops, sizeof(hw->phy.ops));
D
Donald Skidmore 已提交
8180
	hw->phy.sfp_type = ixgbe_sfp_type_unknown;
8181 8182 8183 8184 8185 8186 8187
	/* 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 已提交
8188

8189
	ii->get_invariants(hw);
8190 8191 8192 8193 8194 8195

	/* setup the private structure */
	err = ixgbe_sw_init(adapter);
	if (err)
		goto err_sw_init;

8196
	/* Make it possible the adapter to be woken up via WOL */
D
Don Skidmore 已提交
8197 8198 8199
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
8200
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
D
Don Skidmore 已提交
8201 8202 8203 8204
		break;
	default:
		break;
	}
8205

8206 8207 8208 8209 8210 8211 8212
	/*
	 * 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)
8213
			e_crit(probe, "Fan has stopped, replace the adapter\n");
8214 8215
	}

8216 8217 8218
	if (allow_unsupported_sfp)
		hw->allow_unsupported_sfp = allow_unsupported_sfp;

8219
	/* reset_hw fills in the perm_addr as well */
8220
	hw->phy.reset_if_overtemp = true;
8221
	err = hw->mac.ops.reset_hw(hw);
8222
	hw->phy.reset_if_overtemp = false;
8223 8224 8225 8226
	if (err == IXGBE_ERR_SFP_NOT_PRESENT &&
	    hw->mac.type == ixgbe_mac_82598EB) {
		err = 0;
	} else if (err == IXGBE_ERR_SFP_NOT_SUPPORTED) {
D
Don Skidmore 已提交
8227 8228
		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");
8229 8230
		goto err_sw_init;
	} else if (err) {
8231
		e_dev_err("HW Init failed: %d\n", err);
8232 8233 8234
		goto err_sw_init;
	}

8235
#ifdef CONFIG_PCI_IOV
8236 8237 8238 8239 8240 8241
	/* 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);
	memcpy(&hw->mbx.ops, ii->mbx_ops, sizeof(hw->mbx.ops));
8242
	pci_sriov_set_totalvfs(pdev, IXGBE_MAX_VFS_DRV_LIMIT);
8243
	ixgbe_enable_sriov(adapter);
8244
skip_sriov:
8245

8246
#endif
8247
	netdev->features = NETIF_F_SG |
8248
			   NETIF_F_IP_CSUM |
8249
			   NETIF_F_IPV6_CSUM |
8250 8251 8252
			   NETIF_F_HW_VLAN_CTAG_TX |
			   NETIF_F_HW_VLAN_CTAG_RX |
			   NETIF_F_HW_VLAN_CTAG_FILTER |
8253 8254 8255
			   NETIF_F_TSO |
			   NETIF_F_TSO6 |
			   NETIF_F_RXHASH |
8256
			   NETIF_F_RXCSUM;
8257

8258
	netdev->hw_features = netdev->features | NETIF_F_HW_L2FW_DOFFLOAD;
8259

8260 8261 8262
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
8263
		netdev->features |= NETIF_F_SCTP_CSUM;
8264 8265
		netdev->hw_features |= NETIF_F_SCTP_CSUM |
				       NETIF_F_NTUPLE;
8266 8267 8268 8269
		break;
	default:
		break;
	}
8270

B
Ben Greear 已提交
8271 8272
	netdev->hw_features |= NETIF_F_RXALL;

8273 8274
	netdev->vlan_features |= NETIF_F_TSO;
	netdev->vlan_features |= NETIF_F_TSO6;
8275
	netdev->vlan_features |= NETIF_F_IP_CSUM;
8276
	netdev->vlan_features |= NETIF_F_IPV6_CSUM;
8277 8278
	netdev->vlan_features |= NETIF_F_SG;

8279
	netdev->priv_flags |= IFF_UNICAST_FLT;
8280
	netdev->priv_flags |= IFF_SUPP_NOFCS;
8281

J
Jeff Kirsher 已提交
8282
#ifdef CONFIG_IXGBE_DCB
8283 8284 8285
	netdev->dcbnl_ops = &dcbnl_ops;
#endif

8286
#ifdef IXGBE_FCOE
8287
	if (adapter->flags & IXGBE_FLAG_FCOE_CAPABLE) {
8288 8289
		unsigned int fcoe_l;

8290 8291
		if (hw->mac.ops.get_device_caps) {
			hw->mac.ops.get_device_caps(hw, &device_caps);
8292 8293
			if (device_caps & IXGBE_DEVICE_CAPS_FCOE_OFFLOADS)
				adapter->flags &= ~IXGBE_FLAG_FCOE_CAPABLE;
8294
		}
8295

8296 8297 8298

		fcoe_l = min_t(int, IXGBE_FCRETA_SIZE, num_online_cpus());
		adapter->ring_feature[RING_F_FCOE].limit = fcoe_l;
8299

8300 8301 8302
		netdev->features |= NETIF_F_FSO |
				    NETIF_F_FCOE_CRC;

8303 8304 8305
		netdev->vlan_features |= NETIF_F_FSO |
					 NETIF_F_FCOE_CRC |
					 NETIF_F_FCOE_MTU;
8306
	}
8307
#endif /* IXGBE_FCOE */
8308
	if (pci_using_dac) {
8309
		netdev->features |= NETIF_F_HIGHDMA;
8310 8311
		netdev->vlan_features |= NETIF_F_HIGHDMA;
	}
8312

8313 8314
	if (adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE)
		netdev->hw_features |= NETIF_F_LRO;
8315
	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
A
Alexander Duyck 已提交
8316 8317
		netdev->features |= NETIF_F_LRO;

8318
	/* make sure the EEPROM is good */
8319
	if (hw->eeprom.ops.validate_checksum(hw, NULL) < 0) {
8320
		e_dev_err("The EEPROM Checksum Is Not Valid\n");
8321
		err = -EIO;
8322
		goto err_sw_init;
8323 8324 8325 8326
	}

	memcpy(netdev->dev_addr, hw->mac.perm_addr, netdev->addr_len);

8327
	if (!is_valid_ether_addr(netdev->dev_addr)) {
8328
		e_dev_err("invalid MAC address\n");
8329
		err = -EIO;
8330
		goto err_sw_init;
8331 8332
	}

8333 8334
	ixgbe_mac_set_default_filter(adapter, hw->mac.perm_addr);

8335
	setup_timer(&adapter->service_timer, &ixgbe_service_timer,
A
Alexander Duyck 已提交
8336
		    (unsigned long) adapter);
8337

8338 8339 8340 8341
	if (ixgbe_removed(hw->hw_addr)) {
		err = -EIO;
		goto err_sw_init;
	}
8342
	INIT_WORK(&adapter->service_task, ixgbe_service_task);
8343
	set_bit(__IXGBE_SERVICE_INITED, &adapter->state);
8344
	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
8345

8346 8347 8348
	err = ixgbe_init_interrupt_scheme(adapter);
	if (err)
		goto err_sw_init;
8349

8350
	/* WOL not supported for all devices */
E
Emil Tantilov 已提交
8351
	adapter->wol = 0;
8352
	hw->eeprom.ops.read(hw, 0x2c, &adapter->eeprom_cap);
8353
	hw->wol_enabled = ixgbe_wol_supported(adapter, pdev->device,
D
Don Skidmore 已提交
8354
						pdev->subsystem_device);
8355
	if (hw->wol_enabled)
8356
		adapter->wol = IXGBE_WUFC_MAG;
E
Emil Tantilov 已提交
8357

8358 8359
	device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);

8360 8361 8362 8363
	/* save off EEPROM version number */
	hw->eeprom.ops.read(hw, 0x2e, &adapter->eeprom_verh);
	hw->eeprom.ops.read(hw, 0x2d, &adapter->eeprom_verl);

8364 8365
	/* pick up the PCI bus settings for reporting later */
	hw->mac.ops.get_bus_info(hw);
8366
	if (ixgbe_pcie_from_parent(hw))
8367
		ixgbe_get_parent_bus_info(adapter);
8368

8369 8370 8371 8372 8373 8374 8375 8376 8377 8378 8379 8380
	/* 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;
8381
	}
8382
	ixgbe_check_minimum_link(adapter, expected_gts);
8383

8384 8385 8386 8387 8388 8389
	err = ixgbe_read_pba_string_generic(hw, part_str, IXGBE_PBANUM_LENGTH);
	if (err)
		strncpy(part_str, "Unknown", IXGBE_PBANUM_LENGTH);
	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,
8390
			   part_str);
8391 8392 8393 8394 8395 8396
	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);

8397
	/* reset the hardware with the new settings */
8398 8399 8400
	err = hw->mac.ops.start_hw(hw);
	if (err == IXGBE_ERR_EEPROM_VERSION) {
		/* We are running on a pre-production device, log a warning */
8401 8402 8403 8404 8405 8406
		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");
8407
	}
8408 8409 8410 8411 8412
	strcpy(netdev->name, "eth%d");
	err = register_netdev(netdev);
	if (err)
		goto err_register;

8413 8414
	/* power down the optics for 82599 SFP+ fiber */
	if (hw->mac.ops.disable_tx_laser)
8415 8416
		hw->mac.ops.disable_tx_laser(hw);

8417 8418 8419
	/* carrier off reporting is important to ethtool even BEFORE open */
	netif_carrier_off(netdev);

8420
#ifdef CONFIG_IXGBE_DCA
8421
	if (dca_add_requester(&pdev->dev) == 0) {
8422 8423 8424 8425
		adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
		ixgbe_setup_dca(adapter);
	}
#endif
8426
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
8427
		e_info(probe, "IOV is enabled with %d VFs\n", adapter->num_vfs);
8428 8429 8430 8431
		for (i = 0; i < adapter->num_vfs; i++)
			ixgbe_vf_configuration(pdev, (i | 0x10000000));
	}

8432 8433 8434
	/* firmware requires driver version to be 0xFFFFFFFF
	 * since os does not support feature
	 */
E
Emil Tantilov 已提交
8435
	if (hw->mac.ops.set_fw_drv_ver)
8436 8437
		hw->mac.ops.set_fw_drv_ver(hw, 0xFF, 0xFF, 0xFF,
					   0xFF);
E
Emil Tantilov 已提交
8438

8439 8440
	/* add san mac addr to netdev */
	ixgbe_add_sanmac_netdev(netdev);
8441

8442
	e_dev_info("%s\n", ixgbe_default_device_descr);
8443
	cards_found++;
8444

8445
#ifdef CONFIG_IXGBE_HWMON
8446 8447
	if (ixgbe_sysfs_init(adapter))
		e_err(probe, "failed to allocate sysfs resources\n");
8448
#endif /* CONFIG_IXGBE_HWMON */
8449

C
Catherine Sullivan 已提交
8450 8451
	ixgbe_dbg_adapter_init(adapter);

8452 8453
	/* 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)
8454 8455 8456 8457
		hw->mac.ops.setup_link(hw,
			IXGBE_LINK_SPEED_10GB_FULL | IXGBE_LINK_SPEED_1GB_FULL,
			true);

8458 8459 8460
	return 0;

err_register:
8461
	ixgbe_release_hw_control(adapter);
8462
	ixgbe_clear_interrupt_scheme(adapter);
8463
err_sw_init:
8464
	ixgbe_disable_sriov(adapter);
8465
	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
8466
	iounmap(adapter->io_addr);
8467
	kfree(adapter->mac_table);
8468 8469 8470
err_ioremap:
	free_netdev(netdev);
err_alloc_etherdev:
8471 8472
	pci_release_selected_regions(pdev,
				     pci_select_bars(pdev, IORESOURCE_MEM));
8473 8474
err_pci_reg:
err_dma:
8475 8476
	if (!test_and_set_bit(__IXGBE_DISABLED, &adapter->state))
		pci_disable_device(pdev);
8477 8478 8479 8480 8481 8482 8483 8484 8485 8486 8487 8488
	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.
 **/
8489
static void ixgbe_remove(struct pci_dev *pdev)
8490
{
8491 8492
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
8493

C
Catherine Sullivan 已提交
8494 8495
	ixgbe_dbg_adapter_exit(adapter);

8496
	set_bit(__IXGBE_REMOVING, &adapter->state);
8497
	cancel_work_sync(&adapter->service_task);
8498

8499

8500
#ifdef CONFIG_IXGBE_DCA
8501 8502 8503 8504 8505 8506 8507
	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED) {
		adapter->flags &= ~IXGBE_FLAG_DCA_ENABLED;
		dca_remove_requester(&pdev->dev);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL, 1);
	}

#endif
8508
#ifdef CONFIG_IXGBE_HWMON
8509
	ixgbe_sysfs_exit(adapter);
8510
#endif /* CONFIG_IXGBE_HWMON */
8511

8512 8513 8514
	/* remove the added san mac */
	ixgbe_del_sanmac_netdev(netdev);

D
Donald Skidmore 已提交
8515 8516
	if (netdev->reg_state == NETREG_REGISTERED)
		unregister_netdev(netdev);
8517

8518 8519 8520 8521 8522 8523 8524 8525
#ifdef CONFIG_PCI_IOV
	/*
	 * Only disable SR-IOV on unload if the user specified the now
	 * deprecated max_vfs module parameter.
	 */
	if (max_vfs)
		ixgbe_disable_sriov(adapter);
#endif
8526
	ixgbe_clear_interrupt_scheme(adapter);
8527

8528
	ixgbe_release_hw_control(adapter);
8529

8530 8531 8532 8533 8534
#ifdef CONFIG_DCB
	kfree(adapter->ixgbe_ieee_pfc);
	kfree(adapter->ixgbe_ieee_ets);

#endif
8535
	iounmap(adapter->io_addr);
8536
	pci_release_selected_regions(pdev, pci_select_bars(pdev,
8537
				     IORESOURCE_MEM));
8538

8539
	e_dev_info("complete\n");
8540

8541
	kfree(adapter->mac_table);
8542 8543
	free_netdev(netdev);

8544
	pci_disable_pcie_error_reporting(pdev);
8545

8546 8547
	if (!test_and_set_bit(__IXGBE_DISABLED, &adapter->state))
		pci_disable_device(pdev);
8548 8549 8550 8551 8552 8553 8554 8555 8556 8557 8558
}

/**
 * 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,
8559
						pci_channel_state_t state)
8560
{
8561 8562
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
8563

8564
#ifdef CONFIG_PCI_IOV
8565
	struct ixgbe_hw *hw = &adapter->hw;
8566 8567 8568 8569 8570 8571 8572 8573 8574 8575
	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;
8576
	while (bdev && (pci_pcie_type(bdev) != PCI_EXP_TYPE_ROOT_PORT))
8577 8578 8579 8580 8581 8582 8583 8584 8585
		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;

8586 8587 8588 8589 8590 8591
	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;
8592 8593 8594 8595 8596 8597 8598 8599 8600 8601 8602 8603 8604 8605 8606 8607 8608 8609 8610 8611 8612 8613 8614 8615 8616 8617 8618 8619

	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;
		default:
			device_id = 0;
			break;
		}

		/* Find the pci device of the offending VF */
J
Jon Mason 已提交
8620
		vfdev = pci_get_device(PCI_VENDOR_ID_INTEL, device_id, NULL);
8621 8622 8623
		while (vfdev) {
			if (vfdev->devfn == (req_id & 0xFF))
				break;
J
Jon Mason 已提交
8624
			vfdev = pci_get_device(PCI_VENDOR_ID_INTEL,
8625 8626 8627 8628 8629 8630 8631 8632 8633 8634
					       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) {
			e_dev_err("Issuing VFLR to VF %d\n", vf);
			pci_write_config_dword(vfdev, 0xA8, 0x00008000);
G
Greg Rose 已提交
8635 8636
			/* Free device reference count */
			pci_dev_put(vfdev);
8637 8638 8639 8640 8641 8642 8643 8644 8645 8646 8647 8648 8649 8650 8651 8652 8653
		}

		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 */
8654 8655 8656
	if (!test_bit(__IXGBE_SERVICE_INITED, &adapter->state))
		return PCI_ERS_RESULT_DISCONNECT;

8657
	rtnl_lock();
8658 8659
	netif_device_detach(netdev);

8660 8661
	if (state == pci_channel_io_perm_failure) {
		rtnl_unlock();
8662
		return PCI_ERS_RESULT_DISCONNECT;
8663
	}
8664

8665 8666
	if (netif_running(netdev))
		ixgbe_down(adapter);
8667 8668 8669 8670

	if (!test_and_set_bit(__IXGBE_DISABLED, &adapter->state))
		pci_disable_device(pdev);
	rtnl_unlock();
8671

8672
	/* Request a slot reset. */
8673 8674 8675 8676 8677 8678 8679 8680 8681 8682 8683
	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)
{
8684
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
8685 8686
	pci_ers_result_t result;
	int err;
8687

8688
	if (pci_enable_device_mem(pdev)) {
8689
		e_err(probe, "Cannot re-enable PCI device after reset.\n");
8690 8691
		result = PCI_ERS_RESULT_DISCONNECT;
	} else {
8692 8693
		smp_mb__before_clear_bit();
		clear_bit(__IXGBE_DISABLED, &adapter->state);
8694
		adapter->hw.hw_addr = adapter->io_addr;
8695 8696
		pci_set_master(pdev);
		pci_restore_state(pdev);
8697
		pci_save_state(pdev);
8698

8699
		pci_wake_from_d3(pdev, false);
8700

8701
		ixgbe_reset(adapter);
8702
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
8703 8704 8705 8706 8707
		result = PCI_ERS_RESULT_RECOVERED;
	}

	err = pci_cleanup_aer_uncorrect_error_status(pdev);
	if (err) {
8708 8709
		e_dev_err("pci_cleanup_aer_uncorrect_error_status "
			  "failed 0x%0x\n", err);
8710 8711
		/* non-fatal, continue */
	}
8712

8713
	return result;
8714 8715 8716 8717 8718 8719 8720 8721 8722 8723 8724
}

/**
 * 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)
{
8725 8726
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
8727

8728 8729 8730 8731 8732 8733 8734 8735
#ifdef CONFIG_PCI_IOV
	if (adapter->vferr_refcount) {
		e_info(drv, "Resuming after VF err\n");
		adapter->vferr_refcount--;
		return;
	}

#endif
8736 8737
	if (netif_running(netdev))
		ixgbe_up(adapter);
8738 8739 8740 8741

	netif_device_attach(netdev);
}

8742
static const struct pci_error_handlers ixgbe_err_handler = {
8743 8744 8745 8746 8747 8748 8749 8750 8751
	.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,
8752
	.remove   = ixgbe_remove,
8753 8754 8755 8756 8757
#ifdef CONFIG_PM
	.suspend  = ixgbe_suspend,
	.resume   = ixgbe_resume,
#endif
	.shutdown = ixgbe_shutdown,
8758
	.sriov_configure = ixgbe_pci_sriov_configure,
8759 8760 8761 8762 8763 8764 8765 8766 8767 8768 8769 8770
	.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;
8771
	pr_info("%s - version %s\n", ixgbe_driver_string, ixgbe_driver_version);
8772
	pr_info("%s\n", ixgbe_copyright);
8773

C
Catherine Sullivan 已提交
8774 8775
	ixgbe_dbg_init();

8776 8777 8778 8779 8780 8781
	ret = pci_register_driver(&ixgbe_driver);
	if (ret) {
		ixgbe_dbg_exit();
		return ret;
	}

8782
#ifdef CONFIG_IXGBE_DCA
8783 8784
	dca_register_notify(&dca_notifier);
#endif
8785

8786
	return 0;
8787
}
8788

8789 8790 8791 8792 8793 8794 8795 8796 8797 8798
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)
{
8799
#ifdef CONFIG_IXGBE_DCA
8800 8801
	dca_unregister_notify(&dca_notifier);
#endif
8802
	pci_unregister_driver(&ixgbe_driver);
C
Catherine Sullivan 已提交
8803 8804 8805

	ixgbe_dbg_exit();

E
Eric Dumazet 已提交
8806
	rcu_barrier(); /* Wait for completion of call_rcu()'s */
8807
}
8808

8809
#ifdef CONFIG_IXGBE_DCA
8810
static int ixgbe_notify_dca(struct notifier_block *nb, unsigned long event,
8811
			    void *p)
8812 8813 8814 8815
{
	int ret_val;

	ret_val = driver_for_each_device(&ixgbe_driver.driver, NULL, &event,
8816
					 __ixgbe_notify_dca);
8817 8818 8819

	return ret_val ? NOTIFY_BAD : NOTIFY_DONE;
}
8820

8821
#endif /* CONFIG_IXGBE_DCA */
8822

8823 8824 8825
module_exit(ixgbe_exit_module);

/* ixgbe_main.c */