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

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

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

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

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

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

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

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

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

#include "ixgbe.h"
#include "ixgbe_common.h"
65
#include "ixgbe_dcb_82599.h"
66
#include "ixgbe_sriov.h"
67
#include "ixgbe_model.h"
68 69

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

84 85
static const char ixgbe_overheat_msg[] = "Network adapter has been stopped because it has over heated. Restart the computer. If the problem persists, power off the system and replace the adapter";

86
static const struct ixgbe_info *ixgbe_info_tbl[] = {
87 88 89 90 91
	[board_82598]		= &ixgbe_82598_info,
	[board_82599]		= &ixgbe_82599_info,
	[board_X540]		= &ixgbe_X540_info,
	[board_X550]		= &ixgbe_X550_info,
	[board_X550EM_x]	= &ixgbe_X550EM_x_info,
92
	[board_x550em_x_fw]	= &ixgbe_x550em_x_fw_info,
93
	[board_x550em_a]	= &ixgbe_x550em_a_info,
94
	[board_x550em_a_fw]	= &ixgbe_x550em_a_fw_info,
95 96 97 98 99 100 101 102 103 104
};

/* 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) }
 */
105
static const struct pci_device_id ixgbe_pci_tbl[] = {
106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131
	{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 },
132
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_QSFP_SF_QP), board_82599 },
133
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599EN_SFP), board_82599 },
134
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_SFP_SF_QP), board_82599 },
135
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X540T1), board_X540 },
136
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550T), board_X550},
137
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550T1), board_X550},
138
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_KX4), board_X550EM_x},
139
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_XFI), board_X550EM_x},
140
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_KR), board_X550EM_x},
141
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_10G_T), board_X550EM_x},
142
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_SFP), board_X550EM_x},
143
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_1G_T), board_x550em_x_fw},
144 145
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_KR), board_x550em_a },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_KR_L), board_x550em_a },
146
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SFP_N), board_x550em_a },
147 148
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SGMII), board_x550em_a },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SGMII_L), board_x550em_a },
149
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_10G_T), board_x550em_a},
150
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_SFP), board_x550em_a },
151 152
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_1G_T), board_x550em_a_fw },
	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_1G_T_L), board_x550em_a_fw },
153 154 155 156 157
	/* required last entry */
	{0, }
};
MODULE_DEVICE_TABLE(pci, ixgbe_pci_tbl);

158
#ifdef CONFIG_IXGBE_DCA
159
static int ixgbe_notify_dca(struct notifier_block *, unsigned long event,
160
			    void *p);
161 162 163 164 165 166 167
static struct notifier_block dca_notifier = {
	.notifier_call = ixgbe_notify_dca,
	.next          = NULL,
	.priority      = 0
};
#endif

168 169 170
#ifdef CONFIG_PCI_IOV
static unsigned int max_vfs;
module_param(max_vfs, uint, 0);
171
MODULE_PARM_DESC(max_vfs,
172
		 "Maximum number of virtual functions to allocate per physical function - default is zero and maximum value is 63. (Deprecated)");
173 174
#endif /* CONFIG_PCI_IOV */

175 176 177 178 179
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");

180 181 182 183 184
#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)");

185 186 187 188 189
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);

190 191
static struct workqueue_struct *ixgbe_wq;

192
static bool ixgbe_check_cfg_remove(struct ixgbe_hw *hw, struct pci_dev *pdev);
193
static void ixgbe_watchdog_link_is_down(struct ixgbe_adapter *);
194

195 196 197 198 199 200 201 202 203 204 205 206 207 208
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;

209
	if (!pci_is_pcie(parent_dev))
210 211
		return -1;

212
	pcie_capability_read_word(parent_dev, reg, value);
213 214 215
	if (*value == IXGBE_FAILED_READ_CFG_WORD &&
	    ixgbe_check_cfg_remove(&adapter->hw, parent_dev))
		return -1;
216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241
	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;
}

242 243 244 245 246 247 248 249 250 251 252 253 254
/**
 * 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:
255
	case IXGBE_DEV_ID_82599_QSFP_SF_QP:
256 257 258 259 260 261 262 263 264
		return true;
	default:
		return false;
	}
}

static void ixgbe_check_minimum_link(struct ixgbe_adapter *adapter,
				     int expected_gts)
{
265
	struct ixgbe_hw *hw = &adapter->hw;
266 267 268 269 270
	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;

271 272 273 274 275 276 277
	/* Some devices are not connected over PCIe and thus do not negotiate
	 * speed. These devices do not have valid bus info, and thus any report
	 * we generate may not be correct.
	 */
	if (hw->bus.type == ixgbe_bus_type_internal)
		return;

278
	/* determine whether to use the parent device */
279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299
	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:
300
		/* 128b/130b encoding reduces throughput by less than 2% */
301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317
		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%" :
318
		    speed == PCIE_SPEED_8_0GT ? "<2%" :
319 320 321 322 323 324 325 326 327 328
		    "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");
	}
}

329 330 331
static void ixgbe_service_event_schedule(struct ixgbe_adapter *adapter)
{
	if (!test_bit(__IXGBE_DOWN, &adapter->state) &&
332
	    !test_bit(__IXGBE_REMOVING, &adapter->state) &&
333
	    !test_and_set_bit(__IXGBE_SERVICE_SCHED, &adapter->state))
334
		queue_work(ixgbe_wq, &adapter->service_task);
335 336
}

337 338 339 340 341 342 343 344
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");
345 346
	if (test_bit(__IXGBE_SERVICE_INITED, &adapter->state))
		ixgbe_service_event_schedule(adapter);
347 348
}

349
static void ixgbe_check_remove(struct ixgbe_hw *hw, u32 reg)
350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367
{
	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);
}

368 369 370 371 372 373 374 375 376 377 378 379 380 381 382
/**
 * 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)
{
383
	u8 __iomem *reg_addr = READ_ONCE(hw->hw_addr);
384 385 386 387
	u32 value;

	if (ixgbe_removed(reg_addr))
		return IXGBE_FAILED_READ_REG;
388
	if (unlikely(hw->phy.nw_mng_if_sel &
389
		     IXGBE_NW_MNG_IF_SEL_SGMII_ENABLE)) {
390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408
		struct ixgbe_adapter *adapter;
		int i;

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

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

writes_completed:
409 410 411 412 413 414
	value = readl(reg_addr + reg);
	if (unlikely(value == IXGBE_FAILED_READ_REG))
		ixgbe_check_remove(hw, reg);
	return value;
}

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

457 458 459 460 461 462 463 464 465
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);
}

466 467 468 469
static void ixgbe_service_event_complete(struct ixgbe_adapter *adapter)
{
	BUG_ON(!test_bit(__IXGBE_SERVICE_SCHED, &adapter->state));

S
Stephen Hemminger 已提交
470
	/* flush memory to make sure state is correct before next watchdog */
471
	smp_mb__before_atomic();
472 473 474
	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
}

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
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 */
509
	{ .name = NULL }
510 511 512 513 514 515 516 517
};


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

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

J
Joe Perches 已提交
585 586 587 588 589 590 591
	i = 0;
	while (i < 64) {
		int j;
		char buf[9 * 8 + 1];
		char *p = buf;

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

}

599 600 601 602 603 604 605 606 607 608 609 610 611
static void ixgbe_print_buffer(struct ixgbe_ring *ring, int n)
{
	struct ixgbe_tx_buffer *tx_buffer;

	tx_buffer = &ring->tx_buffer_info[ring->next_to_clean];
	pr_info(" %5d %5X %5X %016llX %08X %p %016llX\n",
		n, ring->next_to_use, ring->next_to_clean,
		(u64)dma_unmap_addr(tx_buffer, dma),
		dma_unmap_len(tx_buffer, len),
		tx_buffer->next_to_watch,
		(u64)tx_buffer->time_stamp);
}

612 613 614 615 616 617 618 619 620
/*
 * 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;
621
	struct ixgbe_ring *ring;
622
	struct ixgbe_tx_buffer *tx_buffer;
623 624 625 626 627 628 629 630 631 632 633 634 635
	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;
	int i = 0;

	if (!netif_msg_hw(adapter))
		return;

	/* Print netdevice Info */
	if (netdev) {
		dev_info(&adapter->pdev->dev, "Net device Info\n");
636
		pr_info("Device Name     state            "
637 638
			"trans_start\n");
		pr_info("%-15s %016lX %016lX\n",
639 640
			netdev->name,
			netdev->state,
641
			dev_trans_start(netdev));
642 643 644 645
	}

	/* Print Registers */
	dev_info(&adapter->pdev->dev, "Register Dump\n");
646
	pr_info(" Register Name   Value\n");
647 648 649 650 651 652 653
	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))
654
		return;
655 656

	dev_info(&adapter->pdev->dev, "TX Rings Summary\n");
J
Josh Hay 已提交
657 658 659
	pr_info(" %s     %s              %s        %s\n",
		"Queue [NTU] [NTC] [bi(ntc)->dma  ]",
		"leng", "ntw", "timestamp");
660
	for (n = 0; n < adapter->num_tx_queues; n++) {
661 662 663 664 665 666 667
		ring = adapter->tx_ring[n];
		ixgbe_print_buffer(ring, n);
	}

	for (n = 0; n < adapter->num_xdp_queues; n++) {
		ring = adapter->xdp_ring[n];
		ixgbe_print_buffer(ring, n);
668 669 670 671 672 673 674 675 676 677
	}

	/* 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
	 *
678
	 * 82598 Advanced Transmit Descriptor
679 680 681
	 *   +--------------------------------------------------------------+
	 * 0 |         Buffer Address [63:0]                                |
	 *   +--------------------------------------------------------------+
682
	 * 8 |  PAYLEN  | POPTS  | IDX | STA | DCMD  |DTYP |  RSV |  DTALEN |
683 684
	 *   +--------------------------------------------------------------+
	 *   63       46 45    40 39 36 35 32 31   24 23 20 19              0
685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708
	 *
	 * 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
709 710 711
	 */

	for (n = 0; n < adapter->num_tx_queues; n++) {
712
		ring = adapter->tx_ring[n];
713
		pr_info("------------------------------------\n");
714
		pr_info("TX QUEUE INDEX = %d\n", ring->queue_index);
715
		pr_info("------------------------------------\n");
J
Josh Hay 已提交
716 717 718 719
		pr_info("%s%s    %s              %s        %s          %s\n",
			"T [desc]     [address 63:0  ] ",
			"[PlPOIdStDDt Ln] [bi->dma       ] ",
			"leng", "ntw", "timestamp", "bi->skb");
720

721 722 723
		for (i = 0; ring->desc && (i < ring->count); i++) {
			tx_desc = IXGBE_TX_DESC(ring, i);
			tx_buffer = &ring->tx_buffer_info[i];
724
			u0 = (struct my_u0 *)tx_desc;
J
Josh Hay 已提交
725
			if (dma_unmap_len(tx_buffer, len) > 0) {
J
Joe Perches 已提交
726 727
				const char *ring_desc;

728 729
				if (i == ring->next_to_use &&
				    i == ring->next_to_clean)
J
Joe Perches 已提交
730
					ring_desc = " NTC/U";
731
				else if (i == ring->next_to_use)
J
Joe Perches 已提交
732
					ring_desc = " NTU";
733
				else if (i == ring->next_to_clean)
J
Joe Perches 已提交
734 735 736 737
					ring_desc = " NTC";
				else
					ring_desc = "";
				pr_info("T [0x%03X]    %016llX %016llX %016llX %08X %p %016llX %p%s",
J
Josh Hay 已提交
738 739 740 741
					i,
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
					(u64)dma_unmap_addr(tx_buffer, dma),
742
					dma_unmap_len(tx_buffer, len),
J
Josh Hay 已提交
743 744
					tx_buffer->next_to_watch,
					(u64)tx_buffer->time_stamp,
J
Joe Perches 已提交
745 746
					tx_buffer->skb,
					ring_desc);
J
Josh Hay 已提交
747 748 749 750 751 752 753 754 755

				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);
			}
756 757 758 759 760 761
		}
	}

	/* Print RX Rings Summary */
rx_ring_summary:
	dev_info(&adapter->pdev->dev, "RX Rings Summary\n");
762
	pr_info("Queue [NTU] [NTC]\n");
763 764
	for (n = 0; n < adapter->num_rx_queues; n++) {
		rx_ring = adapter->rx_ring[n];
765 766
		pr_info("%5d %5X %5X\n",
			n, rx_ring->next_to_use, rx_ring->next_to_clean);
767 768 769 770
	}

	/* Print RX Rings */
	if (!netif_msg_rx_status(adapter))
771
		return;
772 773 774

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

775 776 777
	/* Receive Descriptor Formats
	 *
	 * 82598 Advanced Receive Descriptor (Read) Format
778 779 780 781 782 783 784 785
	 *    63                                           1        0
	 *    +-----------------------------------------------------+
	 *  0 |       Packet Buffer Address [63:1]           |A0/NSE|
	 *    +----------------------------------------------+------+
	 *  8 |       Header Buffer Address [63:1]           |  DD  |
	 *    +-----------------------------------------------------+
	 *
	 *
786
	 * 82598 Advanced Receive Descriptor (Write-Back) Format
787 788 789
	 *
	 *   63       48 47    32 31  30      21 20 16 15   4 3     0
	 *   +------------------------------------------------------+
790 791 792
	 * 0 |       RSS Hash /  |SPH| HDR_LEN  | RSV |Packet|  RSS |
	 *   | Packet   | IP     |   |          |     | Type | Type |
	 *   | Checksum | Ident  |   |          |     |      |      |
793 794 795 796
	 *   +------------------------------------------------------+
	 * 8 | VLAN Tag | Length | Extended Error | Extended Status |
	 *   +------------------------------------------------------+
	 *   63       48 47    32 31            20 19               0
797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817
	 *
	 * 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
818
	 */
819

820 821
	for (n = 0; n < adapter->num_rx_queues; n++) {
		rx_ring = adapter->rx_ring[n];
822 823 824
		pr_info("------------------------------------\n");
		pr_info("RX QUEUE INDEX = %d\n", rx_ring->queue_index);
		pr_info("------------------------------------\n");
J
Joe Perches 已提交
825
		pr_info("%s%s%s\n",
J
Josh Hay 已提交
826 827
			"R  [desc]      [ PktBuf     A0] ",
			"[  HeadBuf   DD] [bi->dma       ] [bi->skb       ] ",
J
Joe Perches 已提交
828 829
			"<-- Adv Rx Read format");
		pr_info("%s%s%s\n",
J
Josh Hay 已提交
830 831
			"RWB[desc]      [PcsmIpSHl PtRs] ",
			"[vl er S cks ln] ---------------- [bi->skb       ] ",
J
Joe Perches 已提交
832
			"<-- Adv Rx Write-Back format");
833 834

		for (i = 0; i < rx_ring->count; i++) {
J
Joe Perches 已提交
835 836 837 838 839 840 841 842 843
			const char *ring_desc;

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

844
			rx_buffer_info = &rx_ring->rx_buffer_info[i];
845
			rx_desc = IXGBE_RX_DESC(rx_ring, i);
846
			u0 = (struct my_u0 *)rx_desc;
847
			if (rx_desc->wb.upper.length) {
848
				/* Descriptor Done */
J
Joe Perches 已提交
849 850
				pr_info("RWB[0x%03X]     %016llX %016llX ---------------- %p%s\n",
					i,
851 852
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
J
Joe Perches 已提交
853 854
					rx_buffer_info->skb,
					ring_desc);
855
			} else {
J
Joe Perches 已提交
856 857
				pr_info("R  [0x%03X]     %016llX %016llX %016llX %p%s\n",
					i,
858 859 860
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
					(u64)rx_buffer_info->dma,
J
Joe Perches 已提交
861 862
					rx_buffer_info->skb,
					ring_desc);
863

864 865
				if (netif_msg_pktdata(adapter) &&
				    rx_buffer_info->dma) {
866 867
					print_hex_dump(KERN_INFO, "",
					   DUMP_PREFIX_ADDRESS, 16, 1,
868 869
					   page_address(rx_buffer_info->page) +
						    rx_buffer_info->page_offset,
870
					   ixgbe_rx_bufsz(rx_ring), true);
871 872 873 874 875 876
				}
			}
		}
	}
}

877 878 879 880 881 882 883
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,
884
			ctrl_ext & ~IXGBE_CTRL_EXT_DRV_LOAD);
885 886 887 888 889 890 891 892 893
}

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,
894
			ctrl_ext | IXGBE_CTRL_EXT_DRV_LOAD);
895
}
896

897
/**
898 899 900 901 902 903 904 905
 * 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,
906
			   u8 queue, u8 msix_vector)
907 908
{
	u32 ivar, index;
909 910 911 912 913 914 915 916 917 918 919 920 921
	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 已提交
922
	case ixgbe_mac_X540:
923 924
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
925
	case ixgbe_mac_x550em_a:
926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947
		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;
	}
948 949
}

950
static inline void ixgbe_irq_rearm_queues(struct ixgbe_adapter *adapter,
951
					  u64 qmask)
952 953 954
{
	u32 mask;

955 956
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
957 958
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS, mask);
959 960
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
961
	case ixgbe_mac_X540:
962 963
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
964
	case ixgbe_mac_x550em_a:
965 966 967 968
		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);
969 970 971
		break;
	default:
		break;
972 973 974
	}
}

975
static void ixgbe_update_xoff_rx_lfc(struct ixgbe_adapter *adapter)
976 977 978 979
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_hw_stats *hwstats = &adapter->stats;
	int i;
980
	u32 data;
981

982 983 984
	if ((hw->fc.current_mode != ixgbe_fc_full) &&
	    (hw->fc.current_mode != ixgbe_fc_rx_pause))
		return;
985

986 987 988 989 990 991 992 993
	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;
994

995 996
	/* refill credits (no tx hang) if we received xoff */
	if (!data)
997
		return;
998 999 1000 1001

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

	for (i = 0; i < adapter->num_xdp_queues; i++)
		clear_bit(__IXGBE_HANG_CHECK_ARMED,
			  &adapter->xdp_ring[i]->state);
1006 1007 1008 1009 1010 1011 1012
}

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};
1013
	u8 tc;
1014 1015 1016 1017 1018 1019 1020 1021
	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);
1022
		return;
1023
	}
1024 1025 1026

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

1029 1030
		switch (hw->mac.type) {
		case ixgbe_mac_82598EB:
1031
			pxoffrxc = IXGBE_READ_REG(hw, IXGBE_PXOFFRXC(i));
1032
			break;
1033
		default:
1034
			pxoffrxc = IXGBE_READ_REG(hw, IXGBE_PXOFFRXCNT(i));
1035
		}
1036 1037 1038 1039
		hwstats->pxoffrxc[i] += pxoffrxc;
		/* Get the TC for given UP */
		tc = netdev_get_prio_tc_map(adapter->netdev, i);
		xoff[tc] += pxoffrxc;
1040 1041 1042 1043 1044 1045
	}

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

1046
		tc = tx_ring->dcb_tc;
1047 1048
		if (xoff[tc])
			clear_bit(__IXGBE_HANG_CHECK_ARMED, &tx_ring->state);
1049
	}
1050 1051 1052 1053 1054 1055 1056 1057

	for (i = 0; i < adapter->num_xdp_queues; i++) {
		struct ixgbe_ring *xdp_ring = adapter->xdp_ring[i];

		tc = xdp_ring->dcb_tc;
		if (xoff[tc])
			clear_bit(__IXGBE_HANG_CHECK_ARMED, &xdp_ring->state);
	}
1058 1059
}

1060
static u64 ixgbe_get_tx_completed(struct ixgbe_ring *ring)
1061
{
1062
	return ring->stats.packets;
1063 1064 1065 1066
}

static u64 ixgbe_get_tx_pending(struct ixgbe_ring *ring)
{
1067 1068 1069 1070 1071 1072 1073 1074
	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);
1075

1076 1077 1078
	hw = &adapter->hw;
	head = IXGBE_READ_REG(hw, IXGBE_TDH(ring->reg_idx));
	tail = IXGBE_READ_REG(hw, IXGBE_TDT(ring->reg_idx));
1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092

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

	return 0;
}

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

A
Alexander Duyck 已提交
1093
	clear_check_for_tx_hang(tx_ring);
1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106

	/*
	 * 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.
	 */
1107
	if (tx_done_old == tx_done && tx_pending)
1108
		/* make sure it is true for two checks in a row */
1109 1110 1111 1112 1113 1114
		return test_and_set_bit(__IXGBE_HANG_CHECK_ARMED,
					&tx_ring->state);
	/* update completed stats and continue */
	tx_ring->tx_stats.tx_done_old = tx_done;
	/* reset the countdown */
	clear_bit(__IXGBE_HANG_CHECK_ARMED, &tx_ring->state);
1115

1116
	return false;
1117 1118
}

1119 1120 1121 1122 1123 1124 1125 1126 1127
/**
 * 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)) {
1128
		set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
1129
		e_warn(drv, "initiating reset due to tx timeout\n");
1130 1131 1132
		ixgbe_service_event_schedule(adapter);
	}
}
1133

1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163
/**
 * ixgbe_tx_maxrate - callback to set the maximum per-queue bitrate
 **/
static int ixgbe_tx_maxrate(struct net_device *netdev,
			    int queue_index, u32 maxrate)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;
	u32 bcnrc_val = ixgbe_link_mbps(adapter);

	if (!maxrate)
		return 0;

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

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

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

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

	return 0;
}

1164 1165
/**
 * ixgbe_clean_tx_irq - Reclaim resources after transmit completes
1166
 * @q_vector: structure containing interrupt and ring information
1167
 * @tx_ring: tx ring to clean
1168
 * @napi_budget: Used to determine if we are in netpoll
1169
 **/
1170
static bool ixgbe_clean_tx_irq(struct ixgbe_q_vector *q_vector,
1171
			       struct ixgbe_ring *tx_ring, int napi_budget)
1172
{
1173
	struct ixgbe_adapter *adapter = q_vector->adapter;
1174 1175
	struct ixgbe_tx_buffer *tx_buffer;
	union ixgbe_adv_tx_desc *tx_desc;
1176
	unsigned int total_bytes = 0, total_packets = 0;
1177
	unsigned int budget = q_vector->tx.work_limit;
1178 1179 1180 1181
	unsigned int i = tx_ring->next_to_clean;

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

1183
	tx_buffer = &tx_ring->tx_buffer_info[i];
1184
	tx_desc = IXGBE_TX_DESC(tx_ring, i);
1185
	i -= tx_ring->count;
1186

1187
	do {
1188 1189 1190 1191 1192 1193
		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;

1194
		/* prevent any other reads prior to eop_desc */
1195
		smp_rmb();
1196

1197 1198 1199
		/* if DD is not set pending work has not been completed */
		if (!(eop_desc->wb.status & cpu_to_le32(IXGBE_TXD_STAT_DD)))
			break;
1200

1201 1202
		/* clear next_to_watch to prevent false hangs */
		tx_buffer->next_to_watch = NULL;
1203

1204 1205 1206 1207
		/* update the statistics for this packet */
		total_bytes += tx_buffer->bytecount;
		total_packets += tx_buffer->gso_segs;

1208
		/* free the skb */
1209 1210 1211 1212
		if (ring_is_xdp(tx_ring))
			page_frag_free(tx_buffer->data);
		else
			napi_consume_skb(tx_buffer->skb, napi_budget);
1213

1214 1215 1216 1217 1218 1219
		/* 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);

1220
		/* clear tx_buffer data */
1221
		dma_unmap_len_set(tx_buffer, len, 0);
1222

1223 1224
		/* unmap remaining buffers */
		while (tx_desc != eop_desc) {
1225 1226
			tx_buffer++;
			tx_desc++;
1227
			i++;
1228 1229
			if (unlikely(!i)) {
				i -= tx_ring->count;
1230
				tx_buffer = tx_ring->tx_buffer_info;
1231
				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
1232
			}
1233

1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255
			/* 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);
1256

1257 1258 1259 1260 1261
		/* update budget accounting */
		budget--;
	} while (likely(budget));

	i += tx_ring->count;
1262
	tx_ring->next_to_clean = i;
1263
	u64_stats_update_begin(&tx_ring->syncp);
1264
	tx_ring->stats.bytes += total_bytes;
1265
	tx_ring->stats.packets += total_packets;
1266
	u64_stats_update_end(&tx_ring->syncp);
1267 1268
	q_vector->tx.total_bytes += total_bytes;
	q_vector->tx.total_packets += total_packets;
1269

1270 1271 1272
	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;
1273
		e_err(drv, "Detected Tx Unit Hang %s\n"
1274 1275 1276 1277 1278 1279 1280
			"  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",
1281
			ring_is_xdp(tx_ring) ? "(XDP)" : "",
1282 1283 1284
			tx_ring->queue_index,
			IXGBE_READ_REG(hw, IXGBE_TDH(tx_ring->reg_idx)),
			IXGBE_READ_REG(hw, IXGBE_TDT(tx_ring->reg_idx)),
1285 1286
			tx_ring->next_to_use, i,
			tx_ring->tx_buffer_info[i].time_stamp, jiffies);
1287

1288 1289 1290
		if (!ring_is_xdp(tx_ring))
			netif_stop_subqueue(tx_ring->netdev,
					    tx_ring->queue_index);
1291 1292 1293 1294 1295

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

1296
		/* schedule immediate reset if we believe we hung */
1297
		ixgbe_tx_timeout_reset(adapter);
1298 1299

		/* the adapter is about to reset, no point in enabling stuff */
1300
		return true;
1301
	}
1302

1303 1304 1305
	if (ring_is_xdp(tx_ring))
		return !!budget;

1306 1307 1308
	netdev_tx_completed_queue(txring_txq(tx_ring),
				  total_packets, total_bytes);

1309
#define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
1310
	if (unlikely(total_packets && netif_carrier_ok(tx_ring->netdev) &&
1311
		     (ixgbe_desc_unused(tx_ring) >= TX_WAKE_THRESHOLD))) {
1312 1313 1314 1315
		/* Make sure that anybody stopping the queue after this
		 * sees the new next_to_clean.
		 */
		smp_mb();
1316 1317 1318 1319 1320
		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);
1321
			++tx_ring->tx_stats.restart_queue;
1322
		}
1323
	}
1324

1325
	return !!budget;
1326 1327
}

1328
#ifdef CONFIG_IXGBE_DCA
1329 1330
static void ixgbe_update_tx_dca(struct ixgbe_adapter *adapter,
				struct ixgbe_ring *tx_ring,
1331
				int cpu)
1332
{
1333
	struct ixgbe_hw *hw = &adapter->hw;
1334
	u32 txctrl = 0;
1335
	u16 reg_offset;
1336

1337 1338 1339
	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
		txctrl = dca3_get_tag(tx_ring->dev, cpu);

1340 1341
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
1342
		reg_offset = IXGBE_DCA_TXCTRL(tx_ring->reg_idx);
1343 1344
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
1345
	case ixgbe_mac_X540:
1346 1347
		reg_offset = IXGBE_DCA_TXCTRL_82599(tx_ring->reg_idx);
		txctrl <<= IXGBE_DCA_TXCTRL_CPUID_SHIFT_82599;
1348 1349
		break;
	default:
1350 1351
		/* for unknown hardware do not write register */
		return;
1352
	}
1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363

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

1366 1367
static void ixgbe_update_rx_dca(struct ixgbe_adapter *adapter,
				struct ixgbe_ring *rx_ring,
1368
				int cpu)
1369
{
1370
	struct ixgbe_hw *hw = &adapter->hw;
1371
	u32 rxctrl = 0;
1372 1373
	u8 reg_idx = rx_ring->reg_idx;

1374 1375
	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
		rxctrl = dca3_get_tag(rx_ring->dev, cpu);
1376 1377 1378

	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
1379
	case ixgbe_mac_X540:
1380
		rxctrl <<= IXGBE_DCA_RXCTRL_CPUID_SHIFT_82599;
1381 1382 1383 1384
		break;
	default:
		break;
	}
1385 1386 1387 1388 1389 1390 1391

	/*
	 * 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 |
1392
		  IXGBE_DCA_RXCTRL_DATA_DCA_EN |
1393 1394 1395
		  IXGBE_DCA_RXCTRL_DESC_DCA_EN;

	IXGBE_WRITE_REG(hw, IXGBE_DCA_RXCTRL(reg_idx), rxctrl);
1396 1397 1398 1399 1400
}

static void ixgbe_update_dca(struct ixgbe_q_vector *q_vector)
{
	struct ixgbe_adapter *adapter = q_vector->adapter;
1401
	struct ixgbe_ring *ring;
1402 1403
	int cpu = get_cpu();

1404 1405 1406
	if (q_vector->cpu == cpu)
		goto out_no_update;

1407
	ixgbe_for_each_ring(ring, q_vector->tx)
1408
		ixgbe_update_tx_dca(adapter, ring, cpu);
1409

1410
	ixgbe_for_each_ring(ring, q_vector->rx)
1411
		ixgbe_update_rx_dca(adapter, ring, cpu);
1412 1413 1414

	q_vector->cpu = cpu;
out_no_update:
1415 1416 1417 1418 1419 1420 1421
	put_cpu();
}

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

1422
	/* always use CB2 mode, difference is masked in the CB driver */
1423 1424 1425 1426 1427 1428
	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
				IXGBE_DCA_CTRL_DCA_MODE_CB2);
	else
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
				IXGBE_DCA_CTRL_DCA_DISABLE);
1429

1430
	for (i = 0; i < adapter->num_q_vectors; i++) {
1431 1432
		adapter->q_vector[i]->cpu = -1;
		ixgbe_update_dca(adapter->q_vector[i]);
1433 1434 1435 1436 1437
	}
}

static int __ixgbe_notify_dca(struct device *dev, void *data)
{
1438
	struct ixgbe_adapter *adapter = dev_get_drvdata(dev);
1439 1440
	unsigned long event = *(unsigned long *)data;

1441
	if (!(adapter->flags & IXGBE_FLAG_DCA_CAPABLE))
1442 1443
		return 0;

1444 1445
	switch (event) {
	case DCA_PROVIDER_ADD:
1446 1447 1448
		/* if we're already enabled, don't do it again */
		if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
			break;
1449
		if (dca_add_requester(dev) == 0) {
1450
			adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
1451 1452
			IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
					IXGBE_DCA_CTRL_DCA_MODE_CB2);
1453 1454
			break;
		}
1455
		/* fall through - DCA is disabled. */
1456 1457 1458 1459
	case DCA_PROVIDER_REMOVE:
		if (adapter->flags & IXGBE_FLAG_DCA_ENABLED) {
			dca_remove_requester(dev);
			adapter->flags &= ~IXGBE_FLAG_DCA_ENABLED;
1460 1461
			IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
					IXGBE_DCA_CTRL_DCA_DISABLE);
1462 1463 1464 1465
		}
		break;
	}

1466
	return 0;
1467
}
E
Emil Tantilov 已提交
1468

1469
#endif /* CONFIG_IXGBE_DCA */
1470 1471 1472 1473 1474 1475 1476

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

1477 1478
static inline void ixgbe_rx_hash(struct ixgbe_ring *ring,
				 union ixgbe_adv_rx_desc *rx_desc,
E
Emil Tantilov 已提交
1479 1480
				 struct sk_buff *skb)
{
1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494
	u16 rss_type;

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

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

	if (!rss_type)
		return;

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

1497
#ifdef IXGBE_FCOE
1498 1499
/**
 * ixgbe_rx_is_fcoe - check the rx desc for incoming pkt type
1500
 * @ring: structure containing ring specific data
1501 1502 1503 1504
 * @rx_desc: advanced rx descriptor
 *
 * Returns : true if it is FCoE pkt
 */
1505
static inline bool ixgbe_rx_is_fcoe(struct ixgbe_ring *ring,
1506 1507 1508 1509
				    union ixgbe_adv_rx_desc *rx_desc)
{
	__le16 pkt_info = rx_desc->wb.lower.lo_dword.hs_rss.pkt_info;

1510
	return test_bit(__IXGBE_RX_FCOE, &ring->state) &&
1511 1512 1513 1514 1515
	       ((pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_ETQF_MASK)) ==
		(cpu_to_le16(IXGBE_ETQF_FILTER_FCOE <<
			     IXGBE_RXDADV_PKTTYPE_ETQF_SHIFT)));
}

1516
#endif /* IXGBE_FCOE */
1517 1518
/**
 * ixgbe_rx_checksum - indicate in skb if hw indicated a good cksum
1519 1520
 * @ring: structure containing ring specific data
 * @rx_desc: current Rx descriptor being processed
1521 1522
 * @skb: skb currently being received and modified
 **/
1523
static inline void ixgbe_rx_checksum(struct ixgbe_ring *ring,
1524
				     union ixgbe_adv_rx_desc *rx_desc,
1525
				     struct sk_buff *skb)
1526
{
1527 1528 1529
	__le16 pkt_info = rx_desc->wb.lower.lo_dword.hs_rss.pkt_info;
	bool encap_pkt = false;

1530
	skb_checksum_none_assert(skb);
1531

1532
	/* Rx csum disabled */
1533
	if (!(ring->netdev->features & NETIF_F_RXCSUM))
1534
		return;
1535

1536 1537
	/* check for VXLAN and Geneve packets */
	if (pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_VXLAN)) {
1538 1539 1540 1541
		encap_pkt = true;
		skb->encapsulation = 1;
	}

1542
	/* if IP and error */
1543 1544
	if (ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_IPCS) &&
	    ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_IPE)) {
1545
		ring->rx_stats.csum_err++;
1546 1547
		return;
	}
1548

1549
	if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_L4CS))
1550 1551
		return;

1552
	if (ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_TCPE)) {
1553 1554 1555 1556
		/*
		 * 82599 errata, UDP frames with a 0 checksum can be marked as
		 * checksum errors.
		 */
1557 1558
		if ((pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_UDP)) &&
		    test_bit(__IXGBE_RX_CSUM_UDP_ZERO_ERR, &ring->state))
1559 1560
			return;

1561
		ring->rx_stats.csum_err++;
1562 1563 1564
		return;
	}

1565
	/* It must be a TCP or UDP packet with a valid checksum */
1566
	skb->ip_summed = CHECKSUM_UNNECESSARY;
1567 1568 1569 1570 1571
	if (encap_pkt) {
		if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_OUTERIPCS))
			return;

		if (ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_OUTERIPER)) {
1572
			skb->ip_summed = CHECKSUM_NONE;
1573 1574 1575 1576 1577
			return;
		}
		/* If we checked the outer header let the stack know */
		skb->csum_level = 1;
	}
1578 1579
}

1580 1581 1582 1583 1584
static inline unsigned int ixgbe_rx_offset(struct ixgbe_ring *rx_ring)
{
	return ring_uses_build_skb(rx_ring) ? IXGBE_SKB_PAD : 0;
}

1585 1586 1587 1588
static bool ixgbe_alloc_mapped_page(struct ixgbe_ring *rx_ring,
				    struct ixgbe_rx_buffer *bi)
{
	struct page *page = bi->page;
A
Alexander Duyck 已提交
1589
	dma_addr_t dma;
1590

1591
	/* since we are recycling buffers we should seldom need to alloc */
A
Alexander Duyck 已提交
1592
	if (likely(page))
1593 1594
		return true;

1595
	/* alloc new page for storage */
A
Alexander Duyck 已提交
1596 1597 1598 1599
	page = dev_alloc_pages(ixgbe_rx_pg_order(rx_ring));
	if (unlikely(!page)) {
		rx_ring->rx_stats.alloc_rx_page_failed++;
		return false;
1600 1601
	}

1602
	/* map page for use */
1603 1604 1605 1606
	dma = dma_map_page_attrs(rx_ring->dev, page, 0,
				 ixgbe_rx_pg_size(rx_ring),
				 DMA_FROM_DEVICE,
				 IXGBE_RX_DMA_ATTR);
1607 1608 1609 1610 1611 1612

	/*
	 * 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)) {
1613
		__free_pages(page, ixgbe_rx_pg_order(rx_ring));
1614 1615 1616 1617 1618

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

1619
	bi->dma = dma;
A
Alexander Duyck 已提交
1620
	bi->page = page;
1621
	bi->page_offset = ixgbe_rx_offset(rx_ring);
1622
	bi->pagecnt_bias = 1;
1623
	rx_ring->rx_stats.alloc_rx_page++;
1624

1625 1626 1627
	return true;
}

1628
/**
1629
 * ixgbe_alloc_rx_buffers - Replace used receive buffers
1630 1631
 * @rx_ring: ring to place buffers on
 * @cleaned_count: number of buffers to replace
1632
 **/
1633
void ixgbe_alloc_rx_buffers(struct ixgbe_ring *rx_ring, u16 cleaned_count)
1634 1635
{
	union ixgbe_adv_rx_desc *rx_desc;
1636
	struct ixgbe_rx_buffer *bi;
1637
	u16 i = rx_ring->next_to_use;
1638
	u16 bufsz;
1639

1640 1641
	/* nothing to do */
	if (!cleaned_count)
1642 1643
		return;

1644
	rx_desc = IXGBE_RX_DESC(rx_ring, i);
1645 1646
	bi = &rx_ring->rx_buffer_info[i];
	i -= rx_ring->count;
1647

1648 1649
	bufsz = ixgbe_rx_bufsz(rx_ring);

1650 1651
	do {
		if (!ixgbe_alloc_mapped_page(rx_ring, bi))
1652
			break;
1653

1654 1655
		/* sync the buffer for use by the device */
		dma_sync_single_range_for_device(rx_ring->dev, bi->dma,
1656
						 bi->page_offset, bufsz,
1657 1658
						 DMA_FROM_DEVICE);

1659 1660 1661 1662 1663
		/*
		 * 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);
1664

1665 1666
		rx_desc++;
		bi++;
1667
		i++;
1668
		if (unlikely(!i)) {
1669
			rx_desc = IXGBE_RX_DESC(rx_ring, 0);
1670 1671 1672 1673
			bi = rx_ring->rx_buffer_info;
			i -= rx_ring->count;
		}

1674 1675
		/* clear the length for the next_to_use descriptor */
		rx_desc->wb.upper.length = 0;
1676 1677 1678

		cleaned_count--;
	} while (cleaned_count);
1679

1680 1681
	i += rx_ring->count;

1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695
	if (rx_ring->next_to_use != i) {
		rx_ring->next_to_use = i;

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

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

1698 1699 1700
static void ixgbe_set_rsc_gso_size(struct ixgbe_ring *ring,
				   struct sk_buff *skb)
{
1701
	u16 hdr_len = skb_headlen(skb);
1702 1703 1704 1705

	/* 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);
1706
	skb_shinfo(skb)->gso_type = SKB_GSO_TCPV4;
1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724
}

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

1725 1726 1727 1728 1729
/**
 * 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 已提交
1730
 *
1731 1732 1733
 * 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 已提交
1734
 **/
1735 1736 1737
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 已提交
1738
{
1739
	struct net_device *dev = rx_ring->netdev;
1740
	u32 flags = rx_ring->q_vector->adapter->flags;
1741

1742 1743 1744
	ixgbe_update_rsc_stats(rx_ring, skb);

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

1746 1747
	ixgbe_rx_checksum(rx_ring, rx_desc, skb);

1748 1749
	if (unlikely(flags & IXGBE_FLAG_RX_HWTSTAMP_ENABLED))
		ixgbe_ptp_rx_hwtstamp(rx_ring, rx_desc, skb);
1750

1751
	if ((dev->features & NETIF_F_HW_VLAN_CTAG_RX) &&
1752
	    ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_VP)) {
1753
		u16 vid = le16_to_cpu(rx_desc->wb.upper.vlan);
1754
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vid);
A
Alexander Duyck 已提交
1755 1756
	}

1757
	skb_record_rx_queue(skb, rx_ring->queue_index);
1758

1759
	skb->protocol = eth_type_trans(skb, dev);
A
Alexander Duyck 已提交
1760 1761
}

1762 1763
static void ixgbe_rx_skb(struct ixgbe_q_vector *q_vector,
			 struct sk_buff *skb)
1764
{
1765
	napi_gro_receive(&q_vector->napi, skb);
1766
}
1767

1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790
/**
 * 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));

1791 1792 1793 1794 1795 1796 1797 1798 1799 1800
	/* 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;
1801

1802 1803 1804 1805 1806
			/* 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;
		}
1807 1808
	}

1809 1810 1811 1812
	/* 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;

1813 1814 1815 1816 1817 1818 1819
	/* 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;
}

1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849
/**
 * 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.
	 */
1850
	pull_len = eth_get_headlen(va, IXGBE_RX_HDR_SIZE);
1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861

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

1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876
/**
 * 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)) {
1877 1878 1879 1880
		dma_unmap_page_attrs(rx_ring->dev, IXGBE_CB(skb)->dma,
				     ixgbe_rx_pg_size(rx_ring),
				     DMA_FROM_DEVICE,
				     IXGBE_RX_DMA_ATTR);
1881 1882 1883 1884 1885 1886
	} 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,
1887
					      skb_frag_size(frag),
1888 1889 1890 1891
					      DMA_FROM_DEVICE);
	}
}

1892 1893 1894 1895 1896 1897
/**
 * 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
 *
1898 1899 1900 1901
 * Check if the skb is valid in the XDP case it will be an error pointer.
 * Return true in this case to abort processing and advance to next
 * descriptor.
 *
1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919
 * 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;

1920 1921 1922 1923
	/* XDP packets use error pointer so abort at this point */
	if (IS_ERR(skb))
		return true;

1924 1925 1926 1927 1928 1929 1930 1931
	/* 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;
	}

1932
	/* place header in linear portion of buffer */
1933
	if (!skb_headlen(skb))
1934
		ixgbe_pull_tail(rx_ring, skb);
1935

1936 1937 1938 1939 1940 1941
#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
1942 1943 1944
	/* if eth_skb_pad returns an error the skb was freed */
	if (eth_skb_pad(skb))
		return true;
1945 1946 1947 1948 1949 1950 1951 1952 1953

	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
 *
1954
 * Synchronizes page for reuse by the adapter
1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967
 **/
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;

1968 1969 1970 1971 1972 1973 1974 1975
	/* Transfer page from old buffer to new buffer.
	 * Move each member individually to avoid possible store
	 * forwarding stalls and unnecessary copy of skb.
	 */
	new_buff->dma		= old_buff->dma;
	new_buff->page		= old_buff->page;
	new_buff->page_offset	= old_buff->page_offset;
	new_buff->pagecnt_bias	= old_buff->pagecnt_bias;
1976 1977
}

A
Alexander Duyck 已提交
1978 1979
static inline bool ixgbe_page_is_reserved(struct page *page)
{
1980
	return (page_to_nid(page) != numa_mem_id()) || page_is_pfmemalloc(page);
A
Alexander Duyck 已提交
1981 1982
}

1983
static bool ixgbe_can_reuse_rx_page(struct ixgbe_rx_buffer *rx_buffer)
1984
{
1985 1986
	unsigned int pagecnt_bias = rx_buffer->pagecnt_bias;
	struct page *page = rx_buffer->page;
1987

1988 1989 1990 1991 1992 1993
	/* avoid re-using remote pages */
	if (unlikely(ixgbe_page_is_reserved(page)))
		return false;

#if (PAGE_SIZE < 8192)
	/* if we are only owner of page we can reuse it */
1994
	if (unlikely((page_ref_count(page) - pagecnt_bias) > 1))
1995 1996
		return false;
#else
1997 1998 1999 2000 2001 2002 2003 2004
	/* The last offset is a bit aggressive in that we assume the
	 * worst case of FCoE being enabled and using a 3K buffer.
	 * However this should have minimal impact as the 1K extra is
	 * still less than one buffer in size.
	 */
#define IXGBE_LAST_OFFSET \
	(SKB_WITH_OVERHEAD(PAGE_SIZE) - IXGBE_RXBUFFER_3K)
	if (rx_buffer->page_offset > IXGBE_LAST_OFFSET)
2005 2006 2007
		return false;
#endif

2008 2009 2010
	/* If we have drained the page fragment pool we need to update
	 * the pagecnt_bias and page count so that we fully restock the
	 * number of references the driver holds.
2011
	 */
2012
	if (unlikely(!pagecnt_bias)) {
2013 2014 2015
		page_ref_add(page, USHRT_MAX);
		rx_buffer->pagecnt_bias = USHRT_MAX;
	}
2016 2017 2018 2019

	return true;
}

2020 2021 2022 2023 2024 2025 2026
/**
 * 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
 *
2027 2028 2029 2030 2031 2032 2033
 * 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.
2034
 **/
2035
static void ixgbe_add_rx_frag(struct ixgbe_ring *rx_ring,
2036
			      struct ixgbe_rx_buffer *rx_buffer,
2037 2038
			      struct sk_buff *skb,
			      unsigned int size)
2039
{
2040
#if (PAGE_SIZE < 8192)
2041
	unsigned int truesize = ixgbe_rx_pg_size(rx_ring) / 2;
2042
#else
2043 2044 2045
	unsigned int truesize = ring_uses_build_skb(rx_ring) ?
				SKB_DATA_ALIGN(IXGBE_SKB_PAD + size) :
				SKB_DATA_ALIGN(size);
2046
#endif
2047
	skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, rx_buffer->page,
2048
			rx_buffer->page_offset, size, truesize);
2049 2050 2051 2052 2053
#if (PAGE_SIZE < 8192)
	rx_buffer->page_offset ^= truesize;
#else
	rx_buffer->page_offset += truesize;
#endif
2054 2055
}

2056 2057 2058 2059
static struct ixgbe_rx_buffer *ixgbe_get_rx_buffer(struct ixgbe_ring *rx_ring,
						   union ixgbe_adv_rx_desc *rx_desc,
						   struct sk_buff **skb,
						   const unsigned int size)
2060 2061 2062 2063
{
	struct ixgbe_rx_buffer *rx_buffer;

	rx_buffer = &rx_ring->rx_buffer_info[rx_ring->next_to_clean];
2064 2065
	prefetchw(rx_buffer->page);
	*skb = rx_buffer->skb;
2066

2067 2068 2069 2070 2071 2072 2073
	/* Delay unmapping of the first packet. It carries the header
	 * information, HW may still access the header after the writeback.
	 * Only unmap it when EOP is reached
	 */
	if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP)) {
		if (!*skb)
			goto skip_sync;
2074
	} else {
2075 2076 2077
		if (*skb)
			ixgbe_dma_sync_frag(rx_ring, *skb);
	}
2078

2079 2080 2081 2082 2083 2084 2085 2086
	/* we are reusing so sync this buffer for CPU use */
	dma_sync_single_range_for_cpu(rx_ring->dev,
				      rx_buffer->dma,
				      rx_buffer->page_offset,
				      size,
				      DMA_FROM_DEVICE);
skip_sync:
	rx_buffer->pagecnt_bias--;
A
Alexander Duyck 已提交
2087

2088 2089
	return rx_buffer;
}
2090

2091 2092 2093 2094 2095
static void ixgbe_put_rx_buffer(struct ixgbe_ring *rx_ring,
				struct ixgbe_rx_buffer *rx_buffer,
				struct sk_buff *skb)
{
	if (ixgbe_can_reuse_rx_page(rx_buffer)) {
2096 2097 2098
		/* hand second half of page back to the ring */
		ixgbe_reuse_rx_page(rx_ring, rx_buffer);
	} else {
2099
		if (!IS_ERR(skb) && IXGBE_CB(skb)->dma == rx_buffer->dma) {
2100 2101 2102 2103 2104 2105 2106 2107 2108
			/* the page has been released from the ring */
			IXGBE_CB(skb)->page_released = true;
		} else {
			/* we are not reusing the buffer so unmap it */
			dma_unmap_page_attrs(rx_ring->dev, rx_buffer->dma,
					     ixgbe_rx_pg_size(rx_ring),
					     DMA_FROM_DEVICE,
					     IXGBE_RX_DMA_ATTR);
		}
2109
		__page_frag_cache_drain(rx_buffer->page,
2110
					rx_buffer->pagecnt_bias);
2111 2112
	}

2113
	/* clear contents of rx_buffer */
2114
	rx_buffer->page = NULL;
2115 2116 2117 2118 2119
	rx_buffer->skb = NULL;
}

static struct sk_buff *ixgbe_construct_skb(struct ixgbe_ring *rx_ring,
					   struct ixgbe_rx_buffer *rx_buffer,
2120 2121
					   struct xdp_buff *xdp,
					   union ixgbe_adv_rx_desc *rx_desc)
2122
{
2123
	unsigned int size = xdp->data_end - xdp->data;
2124 2125 2126
#if (PAGE_SIZE < 8192)
	unsigned int truesize = ixgbe_rx_pg_size(rx_ring) / 2;
#else
2127 2128
	unsigned int truesize = SKB_DATA_ALIGN(xdp->data_end -
					       xdp->data_hard_start);
2129 2130 2131 2132
#endif
	struct sk_buff *skb;

	/* prefetch first cache line of first page */
2133
	prefetch(xdp->data);
2134
#if L1_CACHE_BYTES < 128
2135
	prefetch(xdp->data + L1_CACHE_BYTES);
2136
#endif
2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151
	/* Note, we get here by enabling legacy-rx via:
	 *
	 *    ethtool --set-priv-flags <dev> legacy-rx on
	 *
	 * In this mode, we currently get 0 extra XDP headroom as
	 * opposed to having legacy-rx off, where we process XDP
	 * packets going to stack via ixgbe_build_skb(). The latter
	 * provides us currently with 192 bytes of headroom.
	 *
	 * For ixgbe_construct_skb() mode it means that the
	 * xdp->data_meta will always point to xdp->data, since
	 * the helper cannot expand the head. Should this ever
	 * change in future for legacy-rx mode on, then lets also
	 * add xdp->data_meta handling here.
	 */
2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162

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

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

		skb_add_rx_frag(skb, 0, rx_buffer->page,
2163
				xdp->data - page_address(rx_buffer->page),
2164 2165 2166 2167 2168 2169 2170
				size, truesize);
#if (PAGE_SIZE < 8192)
		rx_buffer->page_offset ^= truesize;
#else
		rx_buffer->page_offset += truesize;
#endif
	} else {
2171 2172
		memcpy(__skb_put(skb, size),
		       xdp->data, ALIGN(size, sizeof(long)));
2173 2174
		rx_buffer->pagecnt_bias++;
	}
2175 2176

	return skb;
2177 2178
}

2179 2180
static struct sk_buff *ixgbe_build_skb(struct ixgbe_ring *rx_ring,
				       struct ixgbe_rx_buffer *rx_buffer,
2181 2182
				       struct xdp_buff *xdp,
				       union ixgbe_adv_rx_desc *rx_desc)
2183
{
2184
	unsigned int metasize = xdp->data - xdp->data_meta;
2185 2186 2187 2188
#if (PAGE_SIZE < 8192)
	unsigned int truesize = ixgbe_rx_pg_size(rx_ring) / 2;
#else
	unsigned int truesize = SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) +
2189 2190
				SKB_DATA_ALIGN(xdp->data_end -
					       xdp->data_hard_start);
2191 2192 2193
#endif
	struct sk_buff *skb;

2194 2195 2196 2197 2198 2199
	/* Prefetch first cache line of first page. If xdp->data_meta
	 * is unused, this points extactly as xdp->data, otherwise we
	 * likely have a consumer accessing first few bytes of meta
	 * data, and then actual data.
	 */
	prefetch(xdp->data_meta);
2200
#if L1_CACHE_BYTES < 128
2201
	prefetch(xdp->data_meta + L1_CACHE_BYTES);
2202 2203
#endif

2204 2205
	/* build an skb to around the page buffer */
	skb = build_skb(xdp->data_hard_start, truesize);
2206 2207 2208 2209
	if (unlikely(!skb))
		return NULL;

	/* update pointers within the skb to store the data */
2210 2211
	skb_reserve(skb, xdp->data - xdp->data_hard_start);
	__skb_put(skb, xdp->data_end - xdp->data);
2212 2213
	if (metasize)
		skb_metadata_set(skb, metasize);
2214 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228

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

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

	return skb;
}

2229 2230
#define IXGBE_XDP_PASS 0
#define IXGBE_XDP_CONSUMED 1
2231
#define IXGBE_XDP_TX 2
2232

2233 2234 2235 2236 2237
static int ixgbe_xmit_xdp_ring(struct ixgbe_adapter *adapter,
			       struct xdp_buff *xdp);

static struct sk_buff *ixgbe_run_xdp(struct ixgbe_adapter *adapter,
				     struct ixgbe_ring *rx_ring,
2238 2239
				     struct xdp_buff *xdp)
{
2240
	int err, result = IXGBE_XDP_PASS;
2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253
	struct bpf_prog *xdp_prog;
	u32 act;

	rcu_read_lock();
	xdp_prog = READ_ONCE(rx_ring->xdp_prog);

	if (!xdp_prog)
		goto xdp_out;

	act = bpf_prog_run_xdp(xdp_prog, xdp);
	switch (act) {
	case XDP_PASS:
		break;
2254 2255 2256
	case XDP_TX:
		result = ixgbe_xmit_xdp_ring(adapter, xdp);
		break;
2257
	case XDP_REDIRECT:
2258
		err = xdp_do_redirect(adapter->netdev, xdp, xdp_prog);
2259 2260 2261 2262 2263
		if (!err)
			result = IXGBE_XDP_TX;
		else
			result = IXGBE_XDP_CONSUMED;
		break;
2264 2265
	default:
		bpf_warn_invalid_xdp_action(act);
2266
		/* fallthrough */
2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278
	case XDP_ABORTED:
		trace_xdp_exception(rx_ring->netdev, xdp_prog, act);
		/* fallthrough -- handle aborts by dropping packet */
	case XDP_DROP:
		result = IXGBE_XDP_CONSUMED;
		break;
	}
xdp_out:
	rcu_read_unlock();
	return ERR_PTR(-result);
}

2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295
static void ixgbe_rx_buffer_flip(struct ixgbe_ring *rx_ring,
				 struct ixgbe_rx_buffer *rx_buffer,
				 unsigned int size)
{
#if (PAGE_SIZE < 8192)
	unsigned int truesize = ixgbe_rx_pg_size(rx_ring) / 2;

	rx_buffer->page_offset ^= truesize;
#else
	unsigned int truesize = ring_uses_build_skb(rx_ring) ?
				SKB_DATA_ALIGN(IXGBE_SKB_PAD + size) :
				SKB_DATA_ALIGN(size);

	rx_buffer->page_offset += truesize;
#endif
}

2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306
/**
 * 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.
 *
2307
 * Returns amount of work completed
2308
 **/
2309
static int ixgbe_clean_rx_irq(struct ixgbe_q_vector *q_vector,
2310
			       struct ixgbe_ring *rx_ring,
2311
			       const int budget)
2312
{
2313
	unsigned int total_rx_bytes = 0, total_rx_packets = 0;
2314
	struct ixgbe_adapter *adapter = q_vector->adapter;
2315
#ifdef IXGBE_FCOE
2316 2317
	int ddp_bytes;
	unsigned int mss = 0;
2318
#endif /* IXGBE_FCOE */
2319
	u16 cleaned_count = ixgbe_desc_unused(rx_ring);
2320
	bool xdp_xmit = false;
2321 2322 2323
	struct xdp_buff xdp;

	xdp.rxq = &rx_ring->xdp_rxq;
2324

2325
	while (likely(total_rx_packets < budget)) {
2326
		union ixgbe_adv_rx_desc *rx_desc;
2327
		struct ixgbe_rx_buffer *rx_buffer;
2328
		struct sk_buff *skb;
2329
		unsigned int size;
2330 2331 2332 2333 2334 2335 2336

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

2337
		rx_desc = IXGBE_RX_DESC(rx_ring, rx_ring->next_to_clean);
2338 2339
		size = le16_to_cpu(rx_desc->wb.upper.length);
		if (!size)
2340
			break;
2341

2342
		/* This memory barrier is needed to keep us from reading
2343
		 * any other fields out of the rx_desc until we know the
2344
		 * descriptor has been written back
2345
		 */
2346
		dma_rmb();
2347

2348 2349
		rx_buffer = ixgbe_get_rx_buffer(rx_ring, rx_desc, &skb, size);

2350
		/* retrieve a buffer from the ring */
2351 2352 2353
		if (!skb) {
			xdp.data = page_address(rx_buffer->page) +
				   rx_buffer->page_offset;
2354
			xdp.data_meta = xdp.data;
2355 2356 2357 2358
			xdp.data_hard_start = xdp.data -
					      ixgbe_rx_offset(rx_ring);
			xdp.data_end = xdp.data + size;

2359
			skb = ixgbe_run_xdp(adapter, rx_ring, &xdp);
2360 2361 2362
		}

		if (IS_ERR(skb)) {
2363 2364
			if (PTR_ERR(skb) == -IXGBE_XDP_TX) {
				xdp_xmit = true;
2365
				ixgbe_rx_buffer_flip(rx_ring, rx_buffer, size);
2366
			} else {
2367
				rx_buffer->pagecnt_bias++;
2368
			}
2369 2370 2371
			total_rx_packets++;
			total_rx_bytes += size;
		} else if (skb) {
2372
			ixgbe_add_rx_frag(rx_ring, rx_buffer, skb, size);
2373
		} else if (ring_uses_build_skb(rx_ring)) {
2374
			skb = ixgbe_build_skb(rx_ring, rx_buffer,
2375 2376
					      &xdp, rx_desc);
		} else {
2377
			skb = ixgbe_construct_skb(rx_ring, rx_buffer,
2378 2379
						  &xdp, rx_desc);
		}
2380

2381
		/* exit if we failed to retrieve a buffer */
2382 2383 2384
		if (!skb) {
			rx_ring->rx_stats.alloc_rx_buff_failed++;
			rx_buffer->pagecnt_bias++;
2385
			break;
2386
		}
2387

2388
		ixgbe_put_rx_buffer(rx_ring, rx_buffer, skb);
2389
		cleaned_count++;
A
Alexander Duyck 已提交
2390

2391 2392 2393
		/* place incomplete frames back on ring for completion */
		if (ixgbe_is_non_eop(rx_ring, rx_desc, skb))
			continue;
2394

2395 2396 2397
		/* verify the packet layout is correct */
		if (ixgbe_cleanup_headers(rx_ring, rx_desc, skb))
			continue;
2398

2399 2400 2401
		/* probably a little skewed due to removing CRC */
		total_rx_bytes += skb->len;

2402 2403 2404
		/* populate checksum, timestamp, VLAN, and protocol */
		ixgbe_process_skb_fields(rx_ring, rx_desc, skb);

2405 2406
#ifdef IXGBE_FCOE
		/* if ddp, not passing to ULD unless for FCP_RSP or error */
2407
		if (ixgbe_rx_is_fcoe(rx_ring, rx_desc)) {
2408
			ddp_bytes = ixgbe_fcoe_ddp(adapter, rx_desc, skb);
2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422
			/* 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);
			}
2423 2424
			if (!ddp_bytes) {
				dev_kfree_skb_any(skb);
2425
				continue;
2426
			}
2427
		}
2428

2429
#endif /* IXGBE_FCOE */
2430
		ixgbe_rx_skb(q_vector, skb);
2431

2432
		/* update budget accounting */
2433
		total_rx_packets++;
2434
	}
2435

2436 2437 2438 2439 2440 2441 2442 2443
	if (xdp_xmit) {
		struct ixgbe_ring *ring = adapter->xdp_ring[smp_processor_id()];

		/* Force memory writes to complete before letting h/w
		 * know there are new descriptors to fetch.
		 */
		wmb();
		writel(ring->next_to_use, ring->tail);
2444 2445

		xdp_do_flush_map();
2446 2447
	}

2448 2449 2450 2451
	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);
2452 2453
	q_vector->rx.total_packets += total_rx_packets;
	q_vector->rx.total_bytes += total_rx_bytes;
2454

2455
	return total_rx_packets;
2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466
}

/**
 * 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)
{
2467
	struct ixgbe_q_vector *q_vector;
2468
	int v_idx;
2469
	u32 mask;
2470

2471 2472
	/* Populate MSIX to EITR Select */
	if (adapter->num_vfs > 32) {
J
Jacob Keller 已提交
2473
		u32 eitrsel = BIT(adapter->num_vfs - 32) - 1;
2474 2475 2476
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITRSEL, eitrsel);
	}

2477 2478
	/*
	 * Populate the IVAR table and set the ITR values to the
2479 2480
	 * corresponding register.
	 */
2481
	for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
2482
		struct ixgbe_ring *ring;
2483
		q_vector = adapter->q_vector[v_idx];
2484

2485
		ixgbe_for_each_ring(ring, q_vector->rx)
2486 2487
			ixgbe_set_ivar(adapter, 0, ring->reg_idx, v_idx);

2488
		ixgbe_for_each_ring(ring, q_vector->tx)
2489 2490
			ixgbe_set_ivar(adapter, 1, ring->reg_idx, v_idx);

2491
		ixgbe_write_eitr(q_vector);
2492 2493
	}

2494 2495
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
2496
		ixgbe_set_ivar(adapter, -1, IXGBE_IVAR_OTHER_CAUSES_INDEX,
2497
			       v_idx);
2498 2499
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2500
	case ixgbe_mac_X540:
2501 2502
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
2503
	case ixgbe_mac_x550em_a:
2504
		ixgbe_set_ivar(adapter, -1, 1, v_idx);
2505 2506 2507 2508
		break;
	default:
		break;
	}
2509 2510
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITR(v_idx), 1950);

2511
	/* set up to autoclear timer, and the vectors */
2512
	mask = IXGBE_EIMS_ENABLE_MASK;
2513 2514 2515 2516
	mask &= ~(IXGBE_EIMS_OTHER |
		  IXGBE_EIMS_MAILBOX |
		  IXGBE_EIMS_LSC);

2517
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIAC, mask);
2518 2519
}

2520 2521
/**
 * ixgbe_update_itr - update the dynamic ITR value based on statistics
2522 2523
 * @q_vector: structure containing interrupt and ring information
 * @ring_container: structure containing ring performance data
2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534
 *
 *      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)
 **/
2535 2536
static void ixgbe_update_itr(struct ixgbe_q_vector *q_vector,
			     struct ixgbe_ring_container *ring_container)
2537
{
2538 2539 2540 2541
	unsigned int itr = IXGBE_ITR_ADAPTIVE_MIN_USECS |
			   IXGBE_ITR_ADAPTIVE_LATENCY;
	unsigned int avg_wire_size, packets, bytes;
	unsigned long next_update = jiffies;
2542

2543 2544 2545 2546
	/* If we don't have any rings just leave ourselves set for maximum
	 * possible latency so we take ourselves out of the equation.
	 */
	if (!ring_container->ring)
2547
		return;
2548

2549 2550 2551 2552
	/* If we didn't update within up to 1 - 2 jiffies we can assume
	 * that either packets are coming in so slow there hasn't been
	 * any work, or that there is so much work that NAPI is dealing
	 * with interrupt moderation and we don't need to do anything.
2553
	 */
2554 2555
	if (time_after(next_update, ring_container->next_update))
		goto clear_counts;
2556

2557
	packets = ring_container->total_packets;
2558

2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576 2577 2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660 2661 2662 2663 2664 2665 2666 2667 2668 2669 2670 2671 2672 2673 2674 2675 2676 2677 2678 2679 2680 2681 2682 2683 2684 2685 2686
	/* We have no packets to actually measure against. This means
	 * either one of the other queues on this vector is active or
	 * we are a Tx queue doing TSO with too high of an interrupt rate.
	 *
	 * When this occurs just tick up our delay by the minimum value
	 * and hope that this extra delay will prevent us from being called
	 * without any work on our queue.
	 */
	if (!packets) {
		itr = (q_vector->itr >> 2) + IXGBE_ITR_ADAPTIVE_MIN_INC;
		if (itr > IXGBE_ITR_ADAPTIVE_MAX_USECS)
			itr = IXGBE_ITR_ADAPTIVE_MAX_USECS;
		itr += ring_container->itr & IXGBE_ITR_ADAPTIVE_LATENCY;
		goto clear_counts;
	}

	bytes = ring_container->total_bytes;

	/* If packets are less than 4 or bytes are less than 9000 assume
	 * insufficient data to use bulk rate limiting approach. We are
	 * likely latency driven.
	 */
	if (packets < 4 && bytes < 9000) {
		itr = IXGBE_ITR_ADAPTIVE_LATENCY;
		goto adjust_by_size;
	}

	/* Between 4 and 48 we can assume that our current interrupt delay
	 * is only slightly too low. As such we should increase it by a small
	 * fixed amount.
	 */
	if (packets < 48) {
		itr = (q_vector->itr >> 2) + IXGBE_ITR_ADAPTIVE_MIN_INC;
		if (itr > IXGBE_ITR_ADAPTIVE_MAX_USECS)
			itr = IXGBE_ITR_ADAPTIVE_MAX_USECS;
		goto clear_counts;
	}

	/* Between 48 and 96 is our "goldilocks" zone where we are working
	 * out "just right". Just report that our current ITR is good for us.
	 */
	if (packets < 96) {
		itr = q_vector->itr >> 2;
		goto clear_counts;
	}

	/* If packet count is 96 or greater we are likely looking at a slight
	 * overrun of the delay we want. Try halving our delay to see if that
	 * will cut the number of packets in half per interrupt.
	 */
	if (packets < 256) {
		itr = q_vector->itr >> 3;
		if (itr < IXGBE_ITR_ADAPTIVE_MIN_USECS)
			itr = IXGBE_ITR_ADAPTIVE_MIN_USECS;
		goto clear_counts;
	}

	/* The paths below assume we are dealing with a bulk ITR since number
	 * of packets is 256 or greater. We are just going to have to compute
	 * a value and try to bring the count under control, though for smaller
	 * packet sizes there isn't much we can do as NAPI polling will likely
	 * be kicking in sooner rather than later.
	 */
	itr = IXGBE_ITR_ADAPTIVE_BULK;

adjust_by_size:
	/* If packet counts are 256 or greater we can assume we have a gross
	 * overestimation of what the rate should be. Instead of trying to fine
	 * tune it just use the formula below to try and dial in an exact value
	 * give the current packet size of the frame.
	 */
	avg_wire_size = bytes / packets;

	/* The following is a crude approximation of:
	 *  wmem_default / (size + overhead) = desired_pkts_per_int
	 *  rate / bits_per_byte / (size + ethernet overhead) = pkt_rate
	 *  (desired_pkt_rate / pkt_rate) * usecs_per_sec = ITR value
	 *
	 * Assuming wmem_default is 212992 and overhead is 640 bytes per
	 * packet, (256 skb, 64 headroom, 320 shared info), we can reduce the
	 * formula down to
	 *
	 *  (170 * (size + 24)) / (size + 640) = ITR
	 *
	 * We first do some math on the packet size and then finally bitshift
	 * by 8 after rounding up. We also have to account for PCIe link speed
	 * difference as ITR scales based on this.
	 */
	if (avg_wire_size <= 60) {
		/* Start at 50k ints/sec */
		avg_wire_size = 5120;
	} else if (avg_wire_size <= 316) {
		/* 50K ints/sec to 16K ints/sec */
		avg_wire_size *= 40;
		avg_wire_size += 2720;
	} else if (avg_wire_size <= 1084) {
		/* 16K ints/sec to 9.2K ints/sec */
		avg_wire_size *= 15;
		avg_wire_size += 11452;
	} else if (avg_wire_size <= 1980) {
		/* 9.2K ints/sec to 8K ints/sec */
		avg_wire_size *= 5;
		avg_wire_size += 22420;
	} else {
		/* plateau at a limit of 8K ints/sec */
		avg_wire_size = 32256;
	}

	/* If we are in low latency mode half our delay which doubles the rate
	 * to somewhere between 100K to 16K ints/sec
	 */
	if (itr & IXGBE_ITR_ADAPTIVE_LATENCY)
		avg_wire_size >>= 1;

	/* Resultant value is 256 times larger than it needs to be. This
	 * gives us room to adjust the value as needed to either increase
	 * or decrease the value based on link speeds of 10G, 2.5G, 1G, etc.
	 *
	 * Use addition as we have already recorded the new latency flag
	 * for the ITR value.
	 */
	switch (q_vector->adapter->link_speed) {
	case IXGBE_LINK_SPEED_10GB_FULL:
	case IXGBE_LINK_SPEED_100_FULL:
	default:
		itr += DIV_ROUND_UP(avg_wire_size,
				    IXGBE_ITR_ADAPTIVE_MIN_INC * 256) *
		       IXGBE_ITR_ADAPTIVE_MIN_INC;
2687
		break;
2688 2689 2690 2691 2692 2693
	case IXGBE_LINK_SPEED_2_5GB_FULL:
	case IXGBE_LINK_SPEED_1GB_FULL:
	case IXGBE_LINK_SPEED_10_FULL:
		itr += DIV_ROUND_UP(avg_wire_size,
				    IXGBE_ITR_ADAPTIVE_MIN_INC * 64) *
		       IXGBE_ITR_ADAPTIVE_MIN_INC;
2694 2695 2696
		break;
	}

2697 2698 2699 2700 2701 2702 2703
clear_counts:
	/* write back value */
	ring_container->itr = itr;

	/* next update should occur within next jiffy */
	ring_container->next_update = next_update + 1;

2704 2705
	ring_container->total_bytes = 0;
	ring_container->total_packets = 0;
2706 2707
}

2708 2709
/**
 * ixgbe_write_eitr - write EITR register in hardware specific way
2710
 * @q_vector: structure containing interrupt and ring information
2711 2712 2713 2714 2715
 *
 * 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.
 */
2716
void ixgbe_write_eitr(struct ixgbe_q_vector *q_vector)
2717
{
2718
	struct ixgbe_adapter *adapter = q_vector->adapter;
2719
	struct ixgbe_hw *hw = &adapter->hw;
2720
	int v_idx = q_vector->v_idx;
2721
	u32 itr_reg = q_vector->itr & IXGBE_MAX_EITR;
2722

2723 2724
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
2725 2726
		/* must write high and low 16 bits to reset counter */
		itr_reg |= (itr_reg << 16);
2727 2728
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2729
	case ixgbe_mac_X540:
2730 2731
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
2732
	case ixgbe_mac_x550em_a:
2733 2734 2735 2736 2737
		/*
		 * set the WDIS bit to not clear the timer bits and cause an
		 * immediate assertion of the interrupt
		 */
		itr_reg |= IXGBE_EITR_CNT_WDIS;
2738 2739 2740
		break;
	default:
		break;
2741 2742 2743 2744
	}
	IXGBE_WRITE_REG(hw, IXGBE_EITR(v_idx), itr_reg);
}

2745
static void ixgbe_set_itr(struct ixgbe_q_vector *q_vector)
2746
{
2747
	u32 new_itr;
2748

2749 2750
	ixgbe_update_itr(q_vector, &q_vector->tx);
	ixgbe_update_itr(q_vector, &q_vector->rx);
2751

2752 2753
	/* use the smallest value of new ITR delay calculations */
	new_itr = min(q_vector->rx.itr, q_vector->tx.itr);
2754

2755 2756 2757
	/* Clear latency flag if set, shift into correct position */
	new_itr &= ~IXGBE_ITR_ADAPTIVE_LATENCY;
	new_itr <<= 2;
2758

2759
	if (new_itr != q_vector->itr) {
2760
		/* save the algorithm value here */
2761
		q_vector->itr = new_itr;
2762 2763

		ixgbe_write_eitr(q_vector);
2764 2765 2766
	}
}

2767
/**
2768
 * ixgbe_check_overtemp_subtask - check for over temperature
2769
 * @adapter: pointer to adapter
2770
 **/
2771
static void ixgbe_check_overtemp_subtask(struct ixgbe_adapter *adapter)
2772 2773 2774
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 eicr = adapter->interrupt_event;
2775
	s32 rc;
2776

2777
	if (test_bit(__IXGBE_DOWN, &adapter->state))
2778 2779
		return;

2780
	if (!(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_EVENT))
2781 2782 2783 2784
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_TEMP_SENSOR_EVENT;

2785
	switch (hw->device_id) {
2786 2787 2788 2789 2790 2791 2792 2793
	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
		 */
2794
		if (!(eicr & IXGBE_EICR_GPI_SDP0_8259X) &&
2795 2796 2797 2798
		    !(eicr & IXGBE_EICR_LSC))
			return;

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

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

2804 2805 2806 2807 2808 2809 2810 2811 2812
			if (link_up)
				return;
		}

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

		break;
2813 2814 2815 2816 2817 2818
	case IXGBE_DEV_ID_X550EM_A_1G_T:
	case IXGBE_DEV_ID_X550EM_A_1G_T_L:
		rc = hw->phy.ops.check_overtemp(hw);
		if (rc != IXGBE_ERR_OVERTEMP)
			return;
		break;
2819
	default:
2820 2821
		if (adapter->hw.mac.type >= ixgbe_mac_X540)
			return;
2822
		if (!(eicr & IXGBE_EICR_GPI_SDP0(hw)))
2823
			return;
2824
		break;
2825
	}
2826
	e_crit(drv, "%s\n", ixgbe_overheat_msg);
2827 2828

	adapter->interrupt_event = 0;
2829 2830
}

2831 2832 2833 2834 2835
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) &&
2836
	    (eicr & IXGBE_EICR_GPI_SDP1(hw))) {
2837
		e_crit(probe, "Fan has stopped, replace the adapter\n");
2838
		/* write to clear the interrupt */
2839
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1(hw));
2840 2841
	}
}
2842

2843 2844
static void ixgbe_check_overtemp_event(struct ixgbe_adapter *adapter, u32 eicr)
{
2845 2846
	struct ixgbe_hw *hw = &adapter->hw;

2847 2848 2849 2850 2851 2852 2853 2854 2855
	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
		 */
2856 2857
		if (((eicr & IXGBE_EICR_GPI_SDP0(hw)) ||
		     (eicr & IXGBE_EICR_LSC)) &&
2858 2859 2860 2861 2862 2863 2864
		    (!test_bit(__IXGBE_DOWN, &adapter->state))) {
			adapter->interrupt_event = eicr;
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_EVENT;
			ixgbe_service_event_schedule(adapter);
			return;
		}
		return;
2865 2866 2867 2868 2869 2870 2871 2872 2873 2874 2875 2876
	case ixgbe_mac_x550em_a:
		if (eicr & IXGBE_EICR_GPI_SDP0_X550EM_a) {
			adapter->interrupt_event = eicr;
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_EVENT;
			ixgbe_service_event_schedule(adapter);
			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC,
					IXGBE_EICR_GPI_SDP0_X550EM_a);
			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICR,
					IXGBE_EICR_GPI_SDP0_X550EM_a);
		}
		return;
	case ixgbe_mac_X550:
2877 2878 2879 2880 2881 2882 2883 2884
	case ixgbe_mac_X540:
		if (!(eicr & IXGBE_EICR_TS))
			return;
		break;
	default:
		return;
	}

2885
	e_crit(drv, "%s\n", ixgbe_overheat_msg);
2886 2887
}

2888 2889 2890 2891 2892 2893 2894 2895 2896
static inline bool ixgbe_is_sfp(struct ixgbe_hw *hw)
{
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
		if (hw->phy.type == ixgbe_phy_nl)
			return true;
		return false;
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X550EM_x:
2897
	case ixgbe_mac_x550em_a:
2898 2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909
		switch (hw->mac.ops.get_media_type(hw)) {
		case ixgbe_media_type_fiber:
		case ixgbe_media_type_fiber_qsfp:
			return true;
		default:
			return false;
		}
	default:
		return false;
	}
}

2910 2911 2912
static void ixgbe_check_sfp_event(struct ixgbe_adapter *adapter, u32 eicr)
{
	struct ixgbe_hw *hw = &adapter->hw;
2913
	u32 eicr_mask = IXGBE_EICR_GPI_SDP2(hw);
2914

2915 2916 2917 2918 2919 2920 2921 2922
	if (!ixgbe_is_sfp(hw))
		return;

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

	if (eicr & eicr_mask) {
2923
		/* Clear the interrupt */
2924
		IXGBE_WRITE_REG(hw, IXGBE_EICR, eicr_mask);
2925 2926
		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
			adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
M
Mark Rustad 已提交
2927
			adapter->sfp_poll_time = 0;
2928 2929
			ixgbe_service_event_schedule(adapter);
		}
2930 2931
	}

2932 2933
	if (adapter->hw.mac.type == ixgbe_mac_82599EB &&
	    (eicr & IXGBE_EICR_GPI_SDP1(hw))) {
2934
		/* Clear the interrupt */
2935
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1(hw));
2936 2937 2938 2939
		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
			adapter->flags |= IXGBE_FLAG_NEED_LINK_CONFIG;
			ixgbe_service_event_schedule(adapter);
		}
2940 2941 2942
	}
}

2943 2944 2945 2946 2947 2948 2949 2950 2951
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);
2952
		IXGBE_WRITE_FLUSH(hw);
2953
		ixgbe_service_event_schedule(adapter);
2954 2955 2956
	}
}

2957 2958 2959 2960
static inline void ixgbe_irq_enable_queues(struct ixgbe_adapter *adapter,
					   u64 qmask)
{
	u32 mask;
2961
	struct ixgbe_hw *hw = &adapter->hw;
2962

2963 2964
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
2965
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
2966 2967 2968
		IXGBE_WRITE_REG(hw, IXGBE_EIMS, mask);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2969
	case ixgbe_mac_X540:
2970 2971
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
2972
	case ixgbe_mac_x550em_a:
2973
		mask = (qmask & 0xFFFFFFFF);
2974 2975
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(0), mask);
2976
		mask = (qmask >> 32);
2977 2978 2979 2980 2981
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(1), mask);
		break;
	default:
		break;
2982 2983 2984 2985 2986
	}
	/* skip the flush */
}

static inline void ixgbe_irq_disable_queues(struct ixgbe_adapter *adapter,
2987
					    u64 qmask)
2988 2989
{
	u32 mask;
2990
	struct ixgbe_hw *hw = &adapter->hw;
2991

2992 2993
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
2994
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
2995 2996 2997
		IXGBE_WRITE_REG(hw, IXGBE_EIMC, mask);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2998
	case ixgbe_mac_X540:
2999 3000
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
3001
	case ixgbe_mac_x550em_a:
3002
		mask = (qmask & 0xFFFFFFFF);
3003 3004
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMC_EX(0), mask);
3005
		mask = (qmask >> 32);
3006 3007 3008 3009 3010
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMC_EX(1), mask);
		break;
	default:
		break;
3011 3012 3013 3014
	}
	/* skip the flush */
}

3015
/**
3016 3017
 * ixgbe_irq_enable - Enable default interrupt generation settings
 * @adapter: board private structure
3018
 **/
3019 3020
static inline void ixgbe_irq_enable(struct ixgbe_adapter *adapter, bool queues,
				    bool flush)
3021
{
3022
	struct ixgbe_hw *hw = &adapter->hw;
3023
	u32 mask = (IXGBE_EIMS_ENABLE_MASK & ~IXGBE_EIMS_RTX_QUEUE);
3024

3025 3026 3027
	/* don't reenable LSC while waiting for link */
	if (adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE)
		mask &= ~IXGBE_EIMS_LSC;
3028

3029
	if (adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE)
3030 3031
		switch (adapter->hw.mac.type) {
		case ixgbe_mac_82599EB:
3032
			mask |= IXGBE_EIMS_GPI_SDP0(hw);
3033 3034
			break;
		case ixgbe_mac_X540:
3035 3036
		case ixgbe_mac_X550:
		case ixgbe_mac_X550EM_x:
3037
		case ixgbe_mac_x550em_a:
3038 3039 3040 3041 3042
			mask |= IXGBE_EIMS_TS;
			break;
		default:
			break;
		}
3043
	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE)
3044
		mask |= IXGBE_EIMS_GPI_SDP1(hw);
3045 3046
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
3047 3048
		mask |= IXGBE_EIMS_GPI_SDP1(hw);
		mask |= IXGBE_EIMS_GPI_SDP2(hw);
3049
		/* fall through */
3050
	case ixgbe_mac_X540:
3051 3052
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
3053 3054
	case ixgbe_mac_x550em_a:
		if (adapter->hw.device_id == IXGBE_DEV_ID_X550EM_X_SFP ||
3055
		    adapter->hw.device_id == IXGBE_DEV_ID_X550EM_A_SFP ||
3056
		    adapter->hw.device_id == IXGBE_DEV_ID_X550EM_A_SFP_N)
3057
			mask |= IXGBE_EIMS_GPI_SDP0(&adapter->hw);
3058 3059
		if (adapter->hw.phy.type == ixgbe_phy_x550em_ext_t)
			mask |= IXGBE_EICR_GPI_SDP0_X540;
3060
		mask |= IXGBE_EIMS_ECC;
3061 3062 3063 3064
		mask |= IXGBE_EIMS_MAILBOX;
		break;
	default:
		break;
3065
	}
J
Jacob Keller 已提交
3066

3067 3068 3069
	if ((adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) &&
	    !(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
		mask |= IXGBE_EIMS_FLOW_DIR;
3070

3071 3072 3073 3074 3075
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMS, mask);
	if (queues)
		ixgbe_irq_enable_queues(adapter, ~0);
	if (flush)
		IXGBE_WRITE_FLUSH(&adapter->hw);
3076 3077
}

3078
static irqreturn_t ixgbe_msix_other(int irq, void *data)
3079
{
3080
	struct ixgbe_adapter *adapter = data;
3081
	struct ixgbe_hw *hw = &adapter->hw;
3082
	u32 eicr;
3083

3084 3085 3086 3087 3088 3089 3090
	/*
	 * 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);
3091 3092

	/* The lower 16bits of the EICR register are for the queue interrupts
3093
	 * which should be masked here in order to not accidentally clear them if
3094 3095 3096 3097 3098 3099 3100
	 * 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;

3101
	IXGBE_WRITE_REG(hw, IXGBE_EICR, eicr);
3102

3103 3104
	if (eicr & IXGBE_EICR_LSC)
		ixgbe_check_lsc(adapter);
3105

3106 3107
	if (eicr & IXGBE_EICR_MAILBOX)
		ixgbe_msg_task(adapter);
3108

3109 3110
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3111
	case ixgbe_mac_X540:
3112 3113
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
3114
	case ixgbe_mac_x550em_a:
3115 3116 3117 3118 3119 3120 3121
		if (hw->phy.type == ixgbe_phy_x550em_ext_t &&
		    (eicr & IXGBE_EICR_GPI_SDP0_X540)) {
			adapter->flags2 |= IXGBE_FLAG2_PHY_INTERRUPT;
			ixgbe_service_event_schedule(adapter);
			IXGBE_WRITE_REG(hw, IXGBE_EICR,
					IXGBE_EICR_GPI_SDP0_X540);
		}
3122 3123
		if (eicr & IXGBE_EICR_ECC) {
			e_info(link, "Received ECC Err, initiating reset\n");
3124
			set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
3125 3126 3127
			ixgbe_service_event_schedule(adapter);
			IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_ECC);
		}
3128 3129
		/* Handle Flow Director Full threshold interrupt */
		if (eicr & IXGBE_EICR_FLOW_DIR) {
3130
			int reinit_count = 0;
3131 3132
			int i;
			for (i = 0; i < adapter->num_tx_queues; i++) {
3133
				struct ixgbe_ring *ring = adapter->tx_ring[i];
A
Alexander Duyck 已提交
3134
				if (test_and_clear_bit(__IXGBE_TX_FDIR_INIT_DONE,
3135 3136 3137 3138 3139 3140 3141 3142
						       &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);
3143 3144
			}
		}
3145
		ixgbe_check_sfp_event(adapter, eicr);
3146
		ixgbe_check_overtemp_event(adapter, eicr);
3147 3148 3149
		break;
	default:
		break;
3150
	}
3151

3152
	ixgbe_check_fan_failure(adapter, eicr);
J
Jacob Keller 已提交
3153 3154

	if (unlikely(eicr & IXGBE_EICR_TIMESYNC))
3155
		ixgbe_ptp_check_pps_event(adapter);
3156

3157
	/* re-enable the original interrupt state, no lsc, no queues */
3158
	if (!test_bit(__IXGBE_DOWN, &adapter->state))
3159
		ixgbe_irq_enable(adapter, false, false);
3160

3161
	return IRQ_HANDLED;
3162
}
3163

3164
static irqreturn_t ixgbe_msix_clean_rings(int irq, void *data)
3165
{
3166
	struct ixgbe_q_vector *q_vector = data;
3167

3168
	/* EIAM disabled interrupts (on this vector) for us */
3169

3170
	if (q_vector->rx.ring || q_vector->tx.ring)
3171
		napi_schedule_irqoff(&q_vector->napi);
3172

3173
	return IRQ_HANDLED;
3174 3175
}

3176 3177 3178 3179 3180 3181 3182
/**
 * 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
 **/
3183
int ixgbe_poll(struct napi_struct *napi, int budget)
3184 3185 3186 3187 3188
{
	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;
3189
	int per_ring_budget, work_done = 0;
3190 3191 3192 3193 3194 3195 3196
	bool clean_complete = true;

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

3197 3198 3199 3200
	ixgbe_for_each_ring(ring, q_vector->tx) {
		if (!ixgbe_clean_tx_irq(q_vector, ring, budget))
			clean_complete = false;
	}
3201

3202 3203
	/* Exit if we are called by netpoll */
	if (budget <= 0)
3204 3205
		return budget;

3206 3207 3208 3209 3210 3211 3212
	/* 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;

3213 3214 3215 3216 3217
	ixgbe_for_each_ring(ring, q_vector->rx) {
		int cleaned = ixgbe_clean_rx_irq(q_vector, ring,
						 per_ring_budget);

		work_done += cleaned;
3218 3219
		if (cleaned >= per_ring_budget)
			clean_complete = false;
3220
	}
3221 3222 3223 3224 3225 3226

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

	/* all work done, exit the polling mode */
3227
	napi_complete_done(napi, work_done);
3228 3229 3230
	if (adapter->rx_itr_setting & 1)
		ixgbe_set_itr(q_vector);
	if (!test_bit(__IXGBE_DOWN, &adapter->state))
J
Jacob Keller 已提交
3231
		ixgbe_irq_enable_queues(adapter, BIT_ULL(q_vector->v_idx));
3232

3233
	return min(work_done, budget - 1);
3234 3235
}

3236 3237 3238 3239 3240 3241 3242 3243 3244 3245
/**
 * 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;
3246
	unsigned int ri = 0, ti = 0;
3247
	int vector, err;
3248

3249
	for (vector = 0; vector < adapter->num_q_vectors; vector++) {
3250
		struct ixgbe_q_vector *q_vector = adapter->q_vector[vector];
3251
		struct msix_entry *entry = &adapter->msix_entries[vector];
R
Robert Olsson 已提交
3252

3253
		if (q_vector->tx.ring && q_vector->rx.ring) {
3254 3255
			snprintf(q_vector->name, sizeof(q_vector->name),
				 "%s-TxRx-%u", netdev->name, ri++);
3256 3257
			ti++;
		} else if (q_vector->rx.ring) {
3258 3259
			snprintf(q_vector->name, sizeof(q_vector->name),
				 "%s-rx-%u", netdev->name, ri++);
3260
		} else if (q_vector->tx.ring) {
3261 3262
			snprintf(q_vector->name, sizeof(q_vector->name),
				 "%s-tx-%u", netdev->name, ti++);
3263 3264 3265
		} else {
			/* skip this unused q_vector */
			continue;
3266
		}
3267 3268
		err = request_irq(entry->vector, &ixgbe_msix_clean_rings, 0,
				  q_vector->name, q_vector);
3269
		if (err) {
3270
			e_err(probe, "request_irq failed for MSIX interrupt "
3271
			      "Error: %d\n", err);
3272
			goto free_queue_irqs;
3273
		}
3274 3275 3276 3277
		/* 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,
3278
					      &q_vector->affinity_mask);
3279
		}
3280 3281
	}

3282
	err = request_irq(adapter->msix_entries[vector].vector,
3283
			  ixgbe_msix_other, 0, netdev->name, adapter);
3284
	if (err) {
3285
		e_err(probe, "request_irq for msix_other failed: %d\n", err);
3286
		goto free_queue_irqs;
3287 3288 3289 3290
	}

	return 0;

3291
free_queue_irqs:
3292 3293 3294 3295 3296 3297 3298
	while (vector) {
		vector--;
		irq_set_affinity_hint(adapter->msix_entries[vector].vector,
				      NULL);
		free_irq(adapter->msix_entries[vector].vector,
			 adapter->q_vector[vector]);
	}
3299 3300
	adapter->flags &= ~IXGBE_FLAG_MSIX_ENABLED;
	pci_disable_msix(adapter->pdev);
3301 3302 3303 3304 3305 3306
	kfree(adapter->msix_entries);
	adapter->msix_entries = NULL;
	return err;
}

/**
3307
 * ixgbe_intr - legacy mode Interrupt Handler
3308 3309 3310 3311 3312
 * @irq: interrupt number
 * @data: pointer to a network interface device structure
 **/
static irqreturn_t ixgbe_intr(int irq, void *data)
{
3313
	struct ixgbe_adapter *adapter = data;
3314
	struct ixgbe_hw *hw = &adapter->hw;
3315
	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
3316 3317
	u32 eicr;

3318
	/*
3319
	 * Workaround for silicon errata #26 on 82598.  Mask the interrupt
3320 3321 3322 3323
	 * before the read of EICR.
	 */
	IXGBE_WRITE_REG(hw, IXGBE_EIMC, IXGBE_IRQ_CLEAR_MASK);

3324
	/* for NAPI, using EIAM to auto-mask tx/rx interrupt bits on read
S
Stephen Hemminger 已提交
3325
	 * therefore no explicit interrupt disable is necessary */
3326
	eicr = IXGBE_READ_REG(hw, IXGBE_EICR);
3327
	if (!eicr) {
3328 3329
		/*
		 * shared interrupt alert!
3330
		 * make sure interrupts are enabled because the read will
3331 3332 3333 3334 3335 3336
		 * 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);
3337
		return IRQ_NONE;	/* Not our interrupt */
3338
	}
3339

3340 3341
	if (eicr & IXGBE_EICR_LSC)
		ixgbe_check_lsc(adapter);
3342

3343 3344
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
3345
		ixgbe_check_sfp_event(adapter, eicr);
3346 3347
		/* Fall through */
	case ixgbe_mac_X540:
3348 3349
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
3350
	case ixgbe_mac_x550em_a:
3351 3352
		if (eicr & IXGBE_EICR_ECC) {
			e_info(link, "Received ECC Err, initiating reset\n");
3353
			set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
3354 3355 3356
			ixgbe_service_event_schedule(adapter);
			IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_ECC);
		}
3357
		ixgbe_check_overtemp_event(adapter, eicr);
3358 3359 3360 3361
		break;
	default:
		break;
	}
3362

3363
	ixgbe_check_fan_failure(adapter, eicr);
J
Jacob Keller 已提交
3364
	if (unlikely(eicr & IXGBE_EICR_TIMESYNC))
3365
		ixgbe_ptp_check_pps_event(adapter);
3366

3367
	/* would disable interrupts here but EIAM disabled it */
3368
	napi_schedule_irqoff(&q_vector->napi);
3369

3370 3371 3372 3373 3374 3375 3376
	/*
	 * 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);

3377 3378 3379 3380 3381 3382 3383 3384 3385 3386
	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.
 **/
3387
static int ixgbe_request_irq(struct ixgbe_adapter *adapter)
3388 3389
{
	struct net_device *netdev = adapter->netdev;
3390
	int err;
3391

3392
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
3393
		err = ixgbe_request_msix_irqs(adapter);
3394
	else if (adapter->flags & IXGBE_FLAG_MSI_ENABLED)
3395
		err = request_irq(adapter->pdev->irq, ixgbe_intr, 0,
3396
				  netdev->name, adapter);
3397
	else
3398
		err = request_irq(adapter->pdev->irq, ixgbe_intr, IRQF_SHARED,
3399
				  netdev->name, adapter);
3400

3401
	if (err)
3402
		e_err(probe, "request_irq failed, Error %d\n", err);
3403 3404 3405 3406 3407 3408

	return err;
}

static void ixgbe_free_irq(struct ixgbe_adapter *adapter)
{
3409
	int vector;
3410

3411 3412 3413 3414
	if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED)) {
		free_irq(adapter->pdev->irq, adapter);
		return;
	}
3415

3416 3417 3418
	if (!adapter->msix_entries)
		return;

3419 3420 3421
	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];
3422

3423 3424 3425
		/* free only the irqs that were actually requested */
		if (!q_vector->rx.ring && !q_vector->tx.ring)
			continue;
3426

3427 3428 3429 3430
		/* clear the affinity_mask in the IRQ descriptor */
		irq_set_affinity_hint(entry->vector, NULL);

		free_irq(entry->vector, q_vector);
3431
	}
3432

3433
	free_irq(adapter->msix_entries[vector].vector, adapter);
3434 3435
}

3436 3437 3438 3439 3440 3441
/**
 * ixgbe_irq_disable - Mask off interrupt generation on the NIC
 * @adapter: board private structure
 **/
static inline void ixgbe_irq_disable(struct ixgbe_adapter *adapter)
{
3442 3443
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
3444
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, ~0);
3445 3446
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3447
	case ixgbe_mac_X540:
3448 3449
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
3450
	case ixgbe_mac_x550em_a:
3451 3452
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFF0000);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(0), ~0);
3453
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(1), ~0);
3454 3455 3456
		break;
	default:
		break;
3457 3458 3459
	}
	IXGBE_WRITE_FLUSH(&adapter->hw);
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
3460 3461 3462 3463 3464 3465
		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);
3466 3467 3468 3469 3470
	} else {
		synchronize_irq(adapter->pdev->irq);
	}
}

3471 3472 3473 3474 3475 3476
/**
 * ixgbe_configure_msi_and_legacy - Initialize PIN (INTA...) and MSI interrupts
 *
 **/
static void ixgbe_configure_msi_and_legacy(struct ixgbe_adapter *adapter)
{
3477
	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
3478

3479
	ixgbe_write_eitr(q_vector);
3480

3481 3482
	ixgbe_set_ivar(adapter, 0, 0, 0);
	ixgbe_set_ivar(adapter, 1, 0, 0);
3483

3484
	e_info(hw, "Legacy interrupt IVAR setup done\n");
3485 3486
}

3487 3488 3489 3490 3491 3492 3493
/**
 * 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.
 **/
3494 3495
void ixgbe_configure_tx_ring(struct ixgbe_adapter *adapter,
			     struct ixgbe_ring *ring)
3496 3497 3498
{
	struct ixgbe_hw *hw = &adapter->hw;
	u64 tdba = ring->dma;
3499
	int wait_loop = 10;
3500
	u32 txdctl = IXGBE_TXDCTL_ENABLE;
3501
	u8 reg_idx = ring->reg_idx;
3502

3503
	/* disable queue to avoid issues while updating state */
3504
	IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), 0);
3505 3506
	IXGBE_WRITE_FLUSH(hw);

3507
	IXGBE_WRITE_REG(hw, IXGBE_TDBAL(reg_idx),
3508
			(tdba & DMA_BIT_MASK(32)));
3509 3510 3511 3512 3513
	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);
3514
	ring->tail = adapter->io_addr + IXGBE_TDT(reg_idx);
3515

3516 3517
	/*
	 * set WTHRESH to encourage burst writeback, it should not be set
E
Emil Tantilov 已提交
3518 3519 3520
	 * 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
3521 3522 3523 3524 3525
	 *
	 * 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 已提交
3526
	if (!ring->q_vector || (ring->q_vector->itr < IXGBE_100K_ITR))
J
Jacob Keller 已提交
3527
		txdctl |= 1u << 16;	/* WTHRESH = 1 */
3528
	else
J
Jacob Keller 已提交
3529
		txdctl |= 8u << 16;	/* WTHRESH = 8 */
3530

3531 3532 3533 3534
	/*
	 * Setting PTHRESH to 32 both improves performance
	 * and avoids a TX hang with DFP enabled
	 */
J
Jacob Keller 已提交
3535
	txdctl |= (1u << 8) |	/* HTHRESH = 1 */
3536
		   32;		/* PTHRESH = 32 */
3537 3538

	/* reinitialize flowdirector state */
3539
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
3540 3541 3542 3543 3544 3545
		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;
	}
3546

3547 3548 3549 3550 3551
	/* 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)
3552
			netif_set_xps_queue(ring->netdev,
3553 3554 3555 3556
					    &q_vector->affinity_mask,
					    ring->queue_index);
	}

3557 3558
	clear_bit(__IXGBE_HANG_CHECK_ARMED, &ring->state);

3559 3560 3561 3562
	/* reinitialize tx_buffer_info */
	memset(ring->tx_buffer_info, 0,
	       sizeof(struct ixgbe_tx_buffer) * ring->count);

3563 3564 3565 3566 3567 3568 3569 3570 3571 3572
	/* 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 {
3573
		usleep_range(1000, 2000);
3574 3575 3576
		txdctl = IXGBE_READ_REG(hw, IXGBE_TXDCTL(reg_idx));
	} while (--wait_loop && !(txdctl & IXGBE_TXDCTL_ENABLE));
	if (!wait_loop)
3577
		hw_dbg(hw, "Could not enable Tx Queue %d\n", reg_idx);
3578 3579
}

3580 3581 3582
static void ixgbe_setup_mtqc(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3583
	u32 rttdcs, mtqc;
3584
	u8 tcs = netdev_get_num_tc(adapter->netdev);
3585 3586 3587 3588 3589 3590 3591 3592 3593 3594

	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 */
3595 3596 3597 3598 3599 3600
	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;
3601 3602
		else if (adapter->ring_feature[RING_F_VMDQ].mask ==
			 IXGBE_82599_VMDQ_4Q_MASK)
3603 3604 3605 3606 3607 3608 3609 3610
			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;
3611
		else
3612 3613
			mtqc = IXGBE_MTQC_64Q_1PB;
	}
3614

3615
	IXGBE_WRITE_REG(hw, IXGBE_MTQC, mtqc);
3616

3617 3618 3619 3620 3621
	/* 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);
3622 3623 3624 3625 3626 3627 3628
	}

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

3629
/**
3630
 * ixgbe_configure_tx - Configure 8259x Transmit Unit after Reset
3631 3632 3633 3634 3635 3636
 * @adapter: board private structure
 *
 * Configure the Tx unit of the MAC after a reset.
 **/
static void ixgbe_configure_tx(struct ixgbe_adapter *adapter)
{
3637 3638
	struct ixgbe_hw *hw = &adapter->hw;
	u32 dmatxctl;
3639
	u32 i;
3640

3641 3642 3643 3644 3645 3646 3647 3648 3649
	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);
	}

3650
	/* Setup the HW Tx Head and Tail descriptor pointers */
3651 3652
	for (i = 0; i < adapter->num_tx_queues; i++)
		ixgbe_configure_tx_ring(adapter, adapter->tx_ring[i]);
3653 3654
	for (i = 0; i < adapter->num_xdp_queues; i++)
		ixgbe_configure_tx_ring(adapter, adapter->xdp_ring[i]);
3655 3656
}

3657 3658 3659 3660 3661 3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672 3673 3674 3675 3676 3677 3678 3679 3680 3681 3682 3683 3684 3685 3686 3687 3688 3689 3690 3691 3692 3693 3694 3695 3696 3697 3698 3699 3700 3701 3702 3703 3704 3705 3706 3707 3708 3709 3710 3711
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]);
	}
}

3712
#define IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT 2
3713

3714
static void ixgbe_configure_srrctl(struct ixgbe_adapter *adapter,
3715
				   struct ixgbe_ring *rx_ring)
3716
{
3717
	struct ixgbe_hw *hw = &adapter->hw;
3718
	u32 srrctl;
3719
	u8 reg_idx = rx_ring->reg_idx;
3720

3721 3722
	if (hw->mac.type == ixgbe_mac_82598EB) {
		u16 mask = adapter->ring_feature[RING_F_RSS].mask;
3723

3724 3725 3726 3727 3728 3729
		/*
		 * if VMDq is not active we must program one srrctl register
		 * per RSS queue since we have enabled RDRXCTL.MVMEN
		 */
		reg_idx &= mask;
	}
3730

3731 3732
	/* configure header buffer length, needed for RSC */
	srrctl = IXGBE_RX_HDR_SIZE << IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT;
3733

3734
	/* configure the packet buffer length */
3735 3736 3737 3738
	if (test_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state))
		srrctl |= IXGBE_RXBUFFER_3K >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
	else
		srrctl |= IXGBE_RXBUFFER_2K >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
3739 3740

	/* configure descriptor type */
3741
	srrctl |= IXGBE_SRRCTL_DESCTYPE_ADV_ONEBUF;
3742

3743
	IXGBE_WRITE_REG(hw, IXGBE_SRRCTL(reg_idx), srrctl);
3744
}
3745

3746
/**
3747
 * ixgbe_rss_indir_tbl_entries - Return RSS indirection table entries
3748 3749 3750 3751 3752 3753
 * @adapter: device handle
 *
 *  - 82598/82599/X540:     128
 *  - X550(non-SRIOV mode): 512
 *  - X550(SRIOV mode):     64
 */
3754
u32 ixgbe_rss_indir_tbl_entries(struct ixgbe_adapter *adapter)
3755 3756 3757 3758 3759 3760 3761 3762 3763
{
	if (adapter->hw.mac.type < ixgbe_mac_X550)
		return 128;
	else if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
		return 64;
	else
		return 512;
}

3764 3765 3766 3767 3768 3769 3770 3771 3772 3773 3774 3775 3776 3777 3778
/**
 * ixgbe_store_key - Write the RSS key to HW
 * @adapter: device handle
 *
 * Write the RSS key stored in adapter.rss_key to HW.
 */
void ixgbe_store_key(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	int i;

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

3779 3780 3781 3782 3783 3784 3785 3786 3787 3788 3789 3790 3791 3792 3793 3794 3795 3796 3797 3798 3799 3800
/**
 * ixgbe_init_rss_key - Initialize adapter RSS key
 * @adapter: device handle
 *
 * Allocates and initializes the RSS key if it is not allocated.
 **/
static inline int ixgbe_init_rss_key(struct ixgbe_adapter *adapter)
{
	u32 *rss_key;

	if (!adapter->rss_key) {
		rss_key = kzalloc(IXGBE_RSS_KEY_SIZE, GFP_KERNEL);
		if (unlikely(!rss_key))
			return -ENOMEM;

		netdev_rss_key_fill(rss_key, IXGBE_RSS_KEY_SIZE);
		adapter->rss_key = rss_key;
	}

	return 0;
}

3801
/**
3802
 * ixgbe_store_reta - Write the RETA table to HW
3803 3804 3805 3806
 * @adapter: device handle
 *
 * Write the RSS redirection table stored in adapter.rss_indir_tbl[] to HW.
 */
3807
void ixgbe_store_reta(struct ixgbe_adapter *adapter)
3808
{
3809
	u32 i, reta_entries = ixgbe_rss_indir_tbl_entries(adapter);
3810
	struct ixgbe_hw *hw = &adapter->hw;
3811
	u32 reta = 0;
3812 3813
	u32 indices_multi;
	u8 *indir_tbl = adapter->rss_indir_tbl;
3814

3815
	/* Fill out the redirection table as follows:
3816 3817 3818 3819
	 *  - 82598:      8 bit wide entries containing pair of 4 bit RSS
	 *    indices.
	 *  - 82599/X540: 8 bit wide entries containing 4 bit RSS index
	 *  - X550:       8 bit wide entries containing 6 bit RSS index
3820 3821 3822 3823 3824 3825
	 */
	if (adapter->hw.mac.type == ixgbe_mac_82598EB)
		indices_multi = 0x11;
	else
		indices_multi = 0x1;

3826 3827 3828
	/* Write redirection table to HW */
	for (i = 0; i < reta_entries; i++) {
		reta |= indices_multi * indir_tbl[i] << (i & 0x3) * 8;
3829 3830 3831 3832 3833 3834
		if ((i & 3) == 3) {
			if (i < 128)
				IXGBE_WRITE_REG(hw, IXGBE_RETA(i >> 2), reta);
			else
				IXGBE_WRITE_REG(hw, IXGBE_ERETA((i >> 2) - 32),
						reta);
3835
			reta = 0;
3836 3837 3838 3839
		}
	}
}

3840
/**
3841
 * ixgbe_store_vfreta - Write the RETA table to HW (x550 devices in SRIOV mode)
3842 3843 3844 3845 3846
 * @adapter: device handle
 *
 * Write the RSS redirection table stored in adapter.rss_indir_tbl[] to HW.
 */
static void ixgbe_store_vfreta(struct ixgbe_adapter *adapter)
3847
{
3848
	u32 i, reta_entries = ixgbe_rss_indir_tbl_entries(adapter);
3849 3850
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vfreta = 0;
3851 3852 3853 3854 3855 3856 3857 3858 3859 3860 3861 3862 3863 3864 3865 3866 3867 3868 3869
	unsigned int pf_pool = adapter->num_vfs;

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

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

3870
	/* Program table for at least 4 queues w/ SR-IOV so that VFs can
3871 3872 3873
	 * 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.
	 */
3874 3875
	if ((adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) && (rss_i < 4))
		rss_i = 4;
3876 3877

	/* Fill out hash function seeds */
3878
	ixgbe_store_key(adapter);
3879 3880 3881 3882 3883 3884 3885 3886 3887 3888 3889 3890 3891 3892 3893 3894 3895

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

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

		adapter->rss_indir_tbl[i] = j;
	}

	ixgbe_store_reta(adapter);
}

static void ixgbe_setup_vfreta(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3896 3897 3898 3899 3900 3901
	u16 rss_i = adapter->ring_feature[RING_F_RSS].indices;
	unsigned int pf_pool = adapter->num_vfs;
	int i, j;

	/* Fill out hash function seeds */
	for (i = 0; i < 10; i++)
3902
		IXGBE_WRITE_REG(hw, IXGBE_PFVFRSSRK(i, pf_pool),
3903
				*(adapter->rss_key + i));
3904 3905 3906

	/* Fill out the redirection table */
	for (i = 0, j = 0; i < 64; i++, j++) {
3907
		if (j == rss_i)
3908
			j = 0;
3909 3910

		adapter->rss_indir_tbl[i] = j;
3911
	}
3912 3913

	ixgbe_store_vfreta(adapter);
3914 3915 3916 3917 3918
}

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

3922 3923 3924 3925 3926
	/* 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);

3927
	if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
3928
		if (adapter->ring_feature[RING_F_RSS].mask)
3929
			mrqc = IXGBE_MRQC_RSSEN;
3930
	} else {
3931 3932 3933 3934 3935 3936 3937
		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 */
3938 3939
			else if (adapter->ring_feature[RING_F_VMDQ].mask ==
				 IXGBE_82599_VMDQ_4Q_MASK)
3940
				mrqc = IXGBE_MRQC_VMDQRSS32EN;
3941
			else
3942
				mrqc = IXGBE_MRQC_VMDQRSS64EN;
3943 3944 3945

			/* Enable L3/L4 for Tx Switched packets */
			mrqc |= IXGBE_MRQC_L3L4TXSWEN;
3946 3947
		} else {
			if (tcs > 4)
3948
				mrqc = IXGBE_MRQC_RTRSS8TCEN;
3949 3950 3951 3952
			else if (tcs > 1)
				mrqc = IXGBE_MRQC_RTRSS4TCEN;
			else
				mrqc = IXGBE_MRQC_RSSEN;
3953
		}
3954 3955
	}

3956
	/* Perform hash on these packet types */
3957 3958 3959 3960
	rss_field |= IXGBE_MRQC_RSS_FIELD_IPV4 |
		     IXGBE_MRQC_RSS_FIELD_IPV4_TCP |
		     IXGBE_MRQC_RSS_FIELD_IPV6 |
		     IXGBE_MRQC_RSS_FIELD_IPV6_TCP;
3961

3962
	if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV4_UDP)
3963
		rss_field |= IXGBE_MRQC_RSS_FIELD_IPV4_UDP;
3964
	if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV6_UDP)
3965
		rss_field |= IXGBE_MRQC_RSS_FIELD_IPV6_UDP;
3966

3967 3968 3969 3970 3971 3972 3973 3974 3975
	if ((hw->mac.type >= ixgbe_mac_X550) &&
	    (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)) {
		unsigned int pf_pool = adapter->num_vfs;

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

		/* Setup RSS through the VF registers */
3976
		ixgbe_setup_vfreta(adapter);
3977 3978 3979 3980
		vfmrqc = IXGBE_MRQC_RSSEN;
		vfmrqc |= rss_field;
		IXGBE_WRITE_REG(hw, IXGBE_PFVFMRQC(pf_pool), vfmrqc);
	} else {
3981
		ixgbe_setup_reta(adapter);
3982 3983 3984
		mrqc |= rss_field;
		IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
	}
3985 3986
}

3987 3988 3989 3990 3991
/**
 * ixgbe_configure_rscctl - enable RSC for the indicated ring
 * @adapter:    address of board private structure
 * @index:      index of ring to set
 **/
3992
static void ixgbe_configure_rscctl(struct ixgbe_adapter *adapter,
3993
				   struct ixgbe_ring *ring)
3994 3995 3996
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 rscctrl;
3997
	u8 reg_idx = ring->reg_idx;
3998

A
Alexander Duyck 已提交
3999
	if (!ring_is_rsc_enabled(ring))
4000
		return;
4001

4002
	rscctrl = IXGBE_READ_REG(hw, IXGBE_RSCCTL(reg_idx));
4003 4004 4005 4006
	rscctrl |= IXGBE_RSCCTL_RSCEN;
	/*
	 * we must limit the number of descriptors so that the
	 * total size of max desc * buf_len is not greater
4007
	 * than 65536
4008
	 */
4009
	rscctrl |= IXGBE_RSCCTL_MAXDESC_16;
4010
	IXGBE_WRITE_REG(hw, IXGBE_RSCCTL(reg_idx), rscctrl);
4011 4012
}

4013 4014 4015 4016 4017 4018 4019
#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;
4020
	u8 reg_idx = ring->reg_idx;
4021

4022 4023
	if (ixgbe_removed(hw->hw_addr))
		return;
4024 4025 4026 4027 4028 4029
	/* 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 {
4030
		usleep_range(1000, 2000);
4031 4032 4033 4034 4035 4036 4037 4038 4039
		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);
	}
}

4040 4041 4042 4043 4044 4045 4046 4047
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;

4048 4049
	if (ixgbe_removed(hw->hw_addr))
		return;
4050 4051 4052 4053 4054 4055 4056 4057 4058 4059 4060 4061 4062 4063 4064 4065 4066 4067 4068 4069 4070 4071
	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);
	}
}

4072 4073
void ixgbe_configure_rx_ring(struct ixgbe_adapter *adapter,
			     struct ixgbe_ring *ring)
4074 4075
{
	struct ixgbe_hw *hw = &adapter->hw;
4076
	union ixgbe_adv_rx_desc *rx_desc;
4077
	u64 rdba = ring->dma;
4078
	u32 rxdctl;
4079
	u8 reg_idx = ring->reg_idx;
4080

4081 4082
	/* disable queue to avoid issues while updating state */
	rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
4083
	ixgbe_disable_rx_queue(adapter, ring);
4084

4085 4086 4087 4088
	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));
4089 4090 4091
	/* Force flushing of IXGBE_RDLEN to prevent MDD */
	IXGBE_WRITE_FLUSH(hw);

4092 4093
	IXGBE_WRITE_REG(hw, IXGBE_RDH(reg_idx), 0);
	IXGBE_WRITE_REG(hw, IXGBE_RDT(reg_idx), 0);
4094
	ring->tail = adapter->io_addr + IXGBE_RDT(reg_idx);
4095 4096 4097 4098 4099 4100 4101 4102 4103 4104 4105 4106 4107 4108

	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;
4109 4110 4111 4112 4113 4114 4115 4116
#if (PAGE_SIZE < 8192)
	} else {
		rxdctl &= ~(IXGBE_RXDCTL_RLPMLMASK |
			    IXGBE_RXDCTL_RLPML_EN);

		/* Limit the maximum frame size so we don't overrun the skb */
		if (ring_uses_build_skb(ring) &&
		    !test_bit(__IXGBE_RX_3K_BUFFER, &ring->state))
4117
			rxdctl |= IXGBE_MAX_2K_FRAME_BUILD_SKB |
4118 4119
				  IXGBE_RXDCTL_RLPML_EN;
#endif
4120 4121
	}

4122 4123 4124 4125
	/* initialize rx_buffer_info */
	memset(ring->rx_buffer_info, 0,
	       sizeof(struct ixgbe_rx_buffer) * ring->count);

4126 4127 4128 4129
	/* initialize Rx descriptor 0 */
	rx_desc = IXGBE_RX_DESC(ring, 0);
	rx_desc->wb.upper.length = 0;

4130 4131 4132 4133 4134
	/* enable receive descriptor ring */
	rxdctl |= IXGBE_RXDCTL_ENABLE;
	IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(reg_idx), rxdctl);

	ixgbe_rx_desc_queue_enable(adapter, ring);
4135
	ixgbe_alloc_rx_buffers(ring, ixgbe_desc_unused(ring));
4136 4137
}

4138 4139 4140
static void ixgbe_setup_psrtype(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
4141
	int rss_i = adapter->ring_feature[RING_F_RSS].indices;
4142
	u16 pool;
4143 4144 4145

	/* PSRTYPE must be initialized in non 82598 adapters */
	u32 psrtype = IXGBE_PSRTYPE_TCPHDR |
4146 4147
		      IXGBE_PSRTYPE_UDPHDR |
		      IXGBE_PSRTYPE_IPV4HDR |
4148
		      IXGBE_PSRTYPE_L2HDR |
4149
		      IXGBE_PSRTYPE_IPV6HDR;
4150 4151 4152 4153

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

4154
	if (rss_i > 3)
J
Jacob Keller 已提交
4155
		psrtype |= 2u << 29;
4156
	else if (rss_i > 1)
J
Jacob Keller 已提交
4157
		psrtype |= 1u << 29;
4158

4159 4160
	for_each_set_bit(pool, &adapter->fwd_bitmask, 32)
		IXGBE_WRITE_REG(hw, IXGBE_PSRTYPE(VMDQ_P(pool)), psrtype);
4161 4162
}

4163 4164 4165 4166
static void ixgbe_configure_virtualization(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 reg_offset, vf_shift;
4167
	u32 gcr_ext, vmdctl;
4168
	int i;
4169 4170 4171 4172 4173

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

	vmdctl = IXGBE_READ_REG(hw, IXGBE_VT_CTL);
4174 4175
	vmdctl |= IXGBE_VMD_CTL_VMDQ_EN;
	vmdctl &= ~IXGBE_VT_CTL_POOL_MASK;
4176
	vmdctl |= VMDQ_P(0) << IXGBE_VT_CTL_POOL_SHIFT;
4177 4178
	vmdctl |= IXGBE_VT_CTL_REPLEN;
	IXGBE_WRITE_REG(hw, IXGBE_VT_CTL, vmdctl);
4179

4180 4181
	vf_shift = VMDQ_P(0) % 32;
	reg_offset = (VMDQ_P(0) >= 32) ? 1 : 0;
4182 4183

	/* Enable only the PF's pool for Tx/Rx */
4184
	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), GENMASK(31, vf_shift));
4185
	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset ^ 1), reg_offset - 1);
4186
	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), GENMASK(31, vf_shift));
4187
	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset ^ 1), reg_offset - 1);
4188
	if (adapter->bridge_mode == BRIDGE_MODE_VEB)
4189
		IXGBE_WRITE_REG(hw, IXGBE_PFDTXGSWC, IXGBE_PFDTXGSWC_VT_LBEN);
4190 4191

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

4194 4195 4196
	/* clear VLAN promisc flag so VFTA will be updated if necessary */
	adapter->flags2 &= ~IXGBE_FLAG2_VLAN_PROMISC;

4197 4198 4199 4200
	/*
	 * Set up VF register offsets for selected VT Mode,
	 * i.e. 32 or 64 VFs for SR-IOV
	 */
4201 4202 4203 4204 4205 4206 4207 4208 4209 4210 4211 4212
	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;
	}

4213 4214
	IXGBE_WRITE_REG(hw, IXGBE_GCR_EXT, gcr_ext);

4215
	for (i = 0; i < adapter->num_vfs; i++) {
4216 4217 4218
		/* configure spoof checking */
		ixgbe_ndo_set_vf_spoofchk(adapter->netdev, i,
					  adapter->vfinfo[i].spoofchk_enabled);
4219 4220 4221 4222

		/* Enable/Disable RSS query feature  */
		ixgbe_ndo_set_vf_rss_query_en(adapter->netdev, i,
					  adapter->vfinfo[i].rss_query_enabled);
4223
	}
4224 4225
}

4226
static void ixgbe_set_rx_buffer_len(struct ixgbe_adapter *adapter)
4227 4228 4229 4230
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct net_device *netdev = adapter->netdev;
	int max_frame = netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
4231 4232 4233
	struct ixgbe_ring *rx_ring;
	int i;
	u32 mhadd, hlreg0;
4234

4235
#ifdef IXGBE_FCOE
4236 4237 4238 4239
	/* 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;
4240

4241
#endif /* IXGBE_FCOE */
4242 4243 4244 4245 4246

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

4247 4248 4249 4250 4251 4252 4253 4254 4255 4256 4257 4258
	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);
4259

4260 4261 4262 4263
	/*
	 * Setup the HW Rx Head and Tail Descriptor Pointers and
	 * the Base and Length of the Rx Descriptor Ring
	 */
4264
	for (i = 0; i < adapter->num_rx_queues; i++) {
4265
		rx_ring = adapter->rx_ring[i];
4266 4267 4268

		clear_ring_rsc_enabled(rx_ring);
		clear_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state);
4269
		clear_bit(__IXGBE_RX_BUILD_SKB_ENABLED, &rx_ring->state);
4270

A
Alexander Duyck 已提交
4271 4272
		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
			set_ring_rsc_enabled(rx_ring);
4273 4274 4275

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

4277
		clear_bit(__IXGBE_RX_BUILD_SKB_ENABLED, &rx_ring->state);
4278 4279 4280 4281 4282 4283 4284 4285 4286
		if (adapter->flags2 & IXGBE_FLAG2_RX_LEGACY)
			continue;

		set_bit(__IXGBE_RX_BUILD_SKB_ENABLED, &rx_ring->state);

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

4287 4288
		if (IXGBE_2K_TOO_SMALL_WITH_PADDING ||
		    (max_frame > (ETH_FRAME_LEN + ETH_FCS_LEN)))
4289 4290
			set_bit(__IXGBE_RX_3K_BUFFER, &rx_ring->state);
#endif
4291 4292 4293
	}
}

4294 4295 4296 4297 4298 4299 4300 4301 4302 4303 4304 4305 4306 4307 4308 4309 4310 4311 4312
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;
4313 4314
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
4315
	case ixgbe_mac_x550em_a:
4316 4317
		if (adapter->num_vfs)
			rdrxctl |= IXGBE_RDRXCTL_PSP;
4318
		/* fall through */
4319
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
4320
	case ixgbe_mac_X540:
4321 4322 4323 4324 4325 4326 4327 4328 4329 4330 4331 4332 4333 4334 4335 4336
		/* 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);
}

4337 4338 4339 4340 4341 4342 4343 4344 4345 4346
/**
 * 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;
4347
	u32 rxctrl, rfctl;
4348 4349

	/* disable receives while setting up the descriptors */
4350
	hw->mac.ops.disable_rx(hw);
4351 4352

	ixgbe_setup_psrtype(adapter);
4353
	ixgbe_setup_rdrxctl(adapter);
4354

4355 4356 4357 4358 4359
	/* 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;
4360 4361 4362

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

4365
	/* Program registers for the distribution of queues */
4366 4367
	ixgbe_setup_mrqc(adapter);

4368 4369 4370 4371 4372 4373 4374
	/* 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
	 */
4375 4376
	for (i = 0; i < adapter->num_rx_queues; i++)
		ixgbe_configure_rx_ring(adapter, adapter->rx_ring[i]);
4377

4378
	rxctrl = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
4379 4380 4381 4382 4383 4384 4385
	/* 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);
4386 4387
}

4388 4389
static int ixgbe_vlan_rx_add_vid(struct net_device *netdev,
				 __be16 proto, u16 vid)
4390 4391 4392 4393 4394
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

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

4398
	set_bit(vid, adapter->active_vlans);
4399 4400

	return 0;
4401 4402
}

4403 4404 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
static int ixgbe_find_vlvf_entry(struct ixgbe_hw *hw, u32 vlan)
{
	u32 vlvf;
	int idx;

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

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

	return idx;
}

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

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

	/* See if any other pools are set for this VLAN filter
	 * entry other than the PF.
	 */
	word = idx * 2 + (VMDQ_P(0) / 32);
J
Jacob Keller 已提交
4436
	bits = ~BIT(VMDQ_P(0) % 32);
4437 4438 4439 4440 4441 4442 4443 4444 4445 4446
	bits &= IXGBE_READ_REG(hw, IXGBE_VLVFB(word));

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

4447 4448
static int ixgbe_vlan_rx_kill_vid(struct net_device *netdev,
				  __be16 proto, u16 vid)
4449 4450 4451 4452 4453
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

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

4457
	clear_bit(vid, adapter->active_vlans);
4458 4459

	return 0;
4460 4461
}

4462 4463 4464 4465 4466 4467 4468 4469
/**
 * 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;
4470 4471 4472 4473
	int i, j;

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
4474 4475
		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
		vlnctrl &= ~IXGBE_VLNCTRL_VME;
4476 4477 4478
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
4479
	case ixgbe_mac_X540:
4480 4481
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
4482
	case ixgbe_mac_x550em_a:
4483
		for (i = 0; i < adapter->num_rx_queues; i++) {
4484 4485 4486 4487 4488
			struct ixgbe_ring *ring = adapter->rx_ring[i];

			if (ring->l2_accel_priv)
				continue;
			j = ring->reg_idx;
4489 4490 4491 4492 4493 4494 4495 4496 4497 4498 4499
			vlnctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(j));
			vlnctrl &= ~IXGBE_RXDCTL_VME;
			IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(j), vlnctrl);
		}
		break;
	default:
		break;
	}
}

/**
4500
 * ixgbe_vlan_strip_enable - helper to enable hw vlan stripping
4501 4502
 * @adapter: driver data
 */
4503
static void ixgbe_vlan_strip_enable(struct ixgbe_adapter *adapter)
4504 4505
{
	struct ixgbe_hw *hw = &adapter->hw;
4506
	u32 vlnctrl;
4507 4508 4509 4510
	int i, j;

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
4511 4512
		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
		vlnctrl |= IXGBE_VLNCTRL_VME;
4513 4514 4515
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
4516
	case ixgbe_mac_X540:
4517 4518
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
4519
	case ixgbe_mac_x550em_a:
4520
		for (i = 0; i < adapter->num_rx_queues; i++) {
4521 4522 4523 4524 4525
			struct ixgbe_ring *ring = adapter->rx_ring[i];

			if (ring->l2_accel_priv)
				continue;
			j = ring->reg_idx;
4526 4527 4528 4529 4530 4531 4532 4533 4534 4535
			vlnctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(j));
			vlnctrl |= IXGBE_RXDCTL_VME;
			IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(j), vlnctrl);
		}
		break;
	default:
		break;
	}
}

4536 4537 4538 4539 4540
static void ixgbe_vlan_promisc_enable(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vlnctrl, i;

4541 4542
	vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);

4543 4544 4545 4546 4547
	if (adapter->flags & IXGBE_FLAG_VMDQ_ENABLED) {
	/* For VMDq and SR-IOV we must leave VLAN filtering enabled */
		vlnctrl |= IXGBE_VLNCTRL_VFE;
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
	} else {
4548
		vlnctrl &= ~IXGBE_VLNCTRL_VFE;
4549 4550 4551 4552
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		return;
	}

4553 4554 4555 4556
	/* Nothing to do for 82598 */
	if (hw->mac.type == ixgbe_mac_82598EB)
		return;

4557 4558 4559 4560 4561 4562 4563 4564 4565 4566 4567 4568
	/* We are already in VLAN promisc, nothing to do */
	if (adapter->flags2 & IXGBE_FLAG2_VLAN_PROMISC)
		return;

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

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

J
Jacob Keller 已提交
4569
		vlvfb |= BIT(VMDQ_P(0) % 32);
4570 4571 4572 4573 4574 4575 4576 4577 4578 4579 4580 4581 4582 4583 4584 4585 4586 4587 4588 4589 4590 4591 4592 4593 4594 4595 4596 4597 4598
		IXGBE_WRITE_REG(hw, reg_offset, vlvfb);
	}

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

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

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

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

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

		if (vlvf) {
			/* record VLAN ID in VFTA */
J
Jacob Keller 已提交
4599
			vfta[(vid - vid_start) / 32] |= BIT(vid % 32);
4600 4601 4602 4603 4604 4605 4606 4607

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

		/* remove PF from the pool */
		word = i * 2 + VMDQ_P(0) / 32;
J
Jacob Keller 已提交
4608
		bits = ~BIT(VMDQ_P(0) % 32);
4609 4610 4611 4612 4613 4614 4615 4616 4617 4618 4619 4620 4621 4622 4623 4624 4625 4626 4627 4628 4629
		bits &= IXGBE_READ_REG(hw, IXGBE_VLVFB(word));
		IXGBE_WRITE_REG(hw, IXGBE_VLVFB(word), bits);
	}

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

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

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

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

4630 4631 4632 4633 4634
	/* Set VLAN filtering to enabled */
	vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
	vlnctrl |= IXGBE_VLNCTRL_VFE;
	IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);

4635 4636
	if (!(adapter->flags & IXGBE_FLAG_VMDQ_ENABLED) ||
	    hw->mac.type == ixgbe_mac_82598EB)
4637 4638 4639 4640 4641 4642 4643 4644 4645 4646 4647 4648 4649
		return;

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

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

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

4650 4651
static void ixgbe_restore_vlan(struct ixgbe_adapter *adapter)
{
4652
	u16 vid = 1;
4653

4654
	ixgbe_vlan_rx_add_vid(adapter->netdev, htons(ETH_P_8021Q), 0);
4655

4656
	for_each_set_bit_from(vid, adapter->active_vlans, VLAN_N_VID)
4657
		ixgbe_vlan_rx_add_vid(adapter->netdev, htons(ETH_P_8021Q), vid);
4658 4659
}

4660 4661 4662 4663 4664 4665 4666 4667 4668 4669 4670 4671 4672 4673 4674 4675 4676 4677 4678 4679 4680 4681 4682
/**
 * 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
4683
	ixgbe_restore_vf_multicasts(adapter);
4684 4685 4686 4687 4688
#endif

	return netdev_mc_count(netdev);
}

4689 4690 4691
#ifdef CONFIG_PCI_IOV
void ixgbe_full_sync_mac_table(struct ixgbe_adapter *adapter)
{
4692
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4693 4694
	struct ixgbe_hw *hw = &adapter->hw;
	int i;
4695 4696 4697 4698 4699 4700 4701 4702

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

		if (mac_table->state & IXGBE_MAC_STATE_IN_USE)
			hw->mac.ops.set_rar(hw, i,
					    mac_table->addr,
					    mac_table->pool,
4703 4704 4705 4706 4707 4708
					    IXGBE_RAH_AV);
		else
			hw->mac.ops.clear_rar(hw, i);
	}
}

4709
#endif
4710 4711
static void ixgbe_sync_mac_table(struct ixgbe_adapter *adapter)
{
4712
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4713 4714 4715
	struct ixgbe_hw *hw = &adapter->hw;
	int i;

4716 4717 4718 4719 4720 4721 4722 4723 4724 4725 4726 4727 4728
	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
		if (!(mac_table->state & IXGBE_MAC_STATE_MODIFIED))
			continue;

		mac_table->state &= ~IXGBE_MAC_STATE_MODIFIED;

		if (mac_table->state & IXGBE_MAC_STATE_IN_USE)
			hw->mac.ops.set_rar(hw, i,
					    mac_table->addr,
					    mac_table->pool,
					    IXGBE_RAH_AV);
		else
			hw->mac.ops.clear_rar(hw, i);
4729 4730 4731 4732 4733
	}
}

static void ixgbe_flush_sw_mac_table(struct ixgbe_adapter *adapter)
{
4734
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4735
	struct ixgbe_hw *hw = &adapter->hw;
4736
	int i;
4737

4738 4739 4740
	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
		mac_table->state |= IXGBE_MAC_STATE_MODIFIED;
		mac_table->state &= ~IXGBE_MAC_STATE_IN_USE;
4741
	}
4742

4743 4744 4745
	ixgbe_sync_mac_table(adapter);
}

4746
static int ixgbe_available_rars(struct ixgbe_adapter *adapter, u16 pool)
4747
{
4748
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4749 4750 4751
	struct ixgbe_hw *hw = &adapter->hw;
	int i, count = 0;

4752 4753 4754 4755 4756 4757 4758 4759 4760 4761 4762 4763
	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
		/* do not count default RAR as available */
		if (mac_table->state & IXGBE_MAC_STATE_DEFAULT)
			continue;

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

		count++;
4764
	}
4765

4766 4767 4768 4769
	return count;
}

/* this function destroys the first RAR entry */
4770
static void ixgbe_mac_set_default_filter(struct ixgbe_adapter *adapter)
4771
{
4772
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4773 4774
	struct ixgbe_hw *hw = &adapter->hw;

4775 4776 4777 4778 4779 4780
	memcpy(&mac_table->addr, hw->mac.addr, ETH_ALEN);
	mac_table->pool = VMDQ_P(0);

	mac_table->state = IXGBE_MAC_STATE_DEFAULT | IXGBE_MAC_STATE_IN_USE;

	hw->mac.ops.set_rar(hw, 0, mac_table->addr, mac_table->pool,
4781 4782 4783
			    IXGBE_RAH_AV);
}

4784 4785
int ixgbe_add_mac_filter(struct ixgbe_adapter *adapter,
			 const u8 *addr, u16 pool)
4786
{
4787
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4788 4789 4790 4791 4792 4793
	struct ixgbe_hw *hw = &adapter->hw;
	int i;

	if (is_zero_ether_addr(addr))
		return -EINVAL;

4794 4795
	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
		if (mac_table->state & IXGBE_MAC_STATE_IN_USE)
4796
			continue;
4797 4798 4799 4800 4801 4802 4803

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

		mac_table->state |= IXGBE_MAC_STATE_MODIFIED |
				    IXGBE_MAC_STATE_IN_USE;

4804
		ixgbe_sync_mac_table(adapter);
4805

4806 4807
		return i;
	}
4808

4809 4810 4811
	return -ENOMEM;
}

4812 4813
int ixgbe_del_mac_filter(struct ixgbe_adapter *adapter,
			 const u8 *addr, u16 pool)
4814
{
4815
	struct ixgbe_mac_addr *mac_table = &adapter->mac_table[0];
4816
	struct ixgbe_hw *hw = &adapter->hw;
4817
	int i;
4818 4819 4820 4821

	if (is_zero_ether_addr(addr))
		return -EINVAL;

4822 4823 4824 4825 4826 4827 4828 4829 4830 4831 4832 4833 4834 4835 4836 4837 4838 4839
	/* search table for addr, if found clear IN_USE flag and sync */
	for (i = 0; i < hw->mac.num_rar_entries; i++, mac_table++) {
		/* we can only delete an entry if it is in use */
		if (!(mac_table->state & IXGBE_MAC_STATE_IN_USE))
			continue;
		/* we only care about entries that belong to the given pool */
		if (mac_table->pool != pool)
			continue;
		/* we only care about a specific MAC address */
		if (!ether_addr_equal(addr, mac_table->addr))
			continue;

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

		ixgbe_sync_mac_table(adapter);

		return 0;
4840
	}
4841

4842 4843
	return -ENOMEM;
}
4844 4845 4846 4847 4848 4849 4850 4851 4852
/**
 * 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
 **/
4853
static int ixgbe_write_uc_addr_list(struct net_device *netdev, int vfn)
4854 4855 4856 4857 4858
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	int count = 0;

	/* return ENOMEM indicating insufficient memory for addresses */
4859
	if (netdev_uc_count(netdev) > ixgbe_available_rars(adapter, vfn))
4860 4861
		return -ENOMEM;

4862
	if (!netdev_uc_empty(netdev)) {
4863 4864
		struct netdev_hw_addr *ha;
		netdev_for_each_uc_addr(ha, netdev) {
4865 4866
			ixgbe_del_mac_filter(adapter, ha->addr, vfn);
			ixgbe_add_mac_filter(adapter, ha->addr, vfn);
4867 4868 4869 4870 4871 4872
			count++;
		}
	}
	return count;
}

4873 4874 4875 4876 4877 4878 4879 4880 4881 4882 4883 4884 4885 4886 4887 4888 4889 4890 4891
static int ixgbe_uc_sync(struct net_device *netdev, const unsigned char *addr)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	int ret;

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

	return min_t(int, ret, 0);
}

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

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

	return 0;
}

4892
/**
4893
 * ixgbe_set_rx_mode - Unicast, Multicast and Promiscuous mode set
4894 4895
 * @netdev: network interface device structure
 *
4896 4897 4898 4899
 * 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.
4900
 **/
4901
void ixgbe_set_rx_mode(struct net_device *netdev)
4902 4903 4904
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;
4905
	u32 fctrl, vmolr = IXGBE_VMOLR_BAM | IXGBE_VMOLR_AUPE;
4906
	netdev_features_t features = netdev->features;
4907
	int count;
4908 4909 4910 4911

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

4912
	/* set all bits that we expect to always be set */
B
Ben Greear 已提交
4913
	fctrl &= ~IXGBE_FCTRL_SBP; /* disable store-bad-packets */
4914 4915 4916 4917
	fctrl |= IXGBE_FCTRL_BAM;
	fctrl |= IXGBE_FCTRL_DPF; /* discard pause frames when FC enabled */
	fctrl |= IXGBE_FCTRL_PMCF;

4918 4919
	/* clear the bits we are changing the status of */
	fctrl &= ~(IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);
4920
	if (netdev->flags & IFF_PROMISC) {
4921
		hw->addr_ctrl.user_set_promisc = true;
4922
		fctrl |= (IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);
4923
		vmolr |= IXGBE_VMOLR_MPE;
4924
		features &= ~NETIF_F_HW_VLAN_CTAG_FILTER;
4925
	} else {
4926 4927
		if (netdev->flags & IFF_ALLMULTI) {
			fctrl |= IXGBE_FCTRL_MPE;
4928
			vmolr |= IXGBE_VMOLR_MPE;
4929
		}
4930
		hw->addr_ctrl.user_set_promisc = false;
4931 4932 4933 4934 4935 4936 4937
	}

	/*
	 * Write addresses to available RAR registers, if there is not
	 * sufficient space to store all the addresses then enable
	 * unicast promiscuous mode
	 */
4938
	if (__dev_uc_sync(netdev, ixgbe_uc_sync, ixgbe_uc_unsync)) {
4939 4940
		fctrl |= IXGBE_FCTRL_UPE;
		vmolr |= IXGBE_VMOLR_ROPE;
4941 4942
	}

4943 4944 4945 4946
	/* 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
	 */
4947 4948 4949 4950 4951 4952 4953
	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;
	}
4954 4955 4956

	if (hw->mac.type != ixgbe_mac_82598EB) {
		vmolr |= IXGBE_READ_REG(hw, IXGBE_VMOLR(VMDQ_P(0))) &
4957 4958
			 ~(IXGBE_VMOLR_MPE | IXGBE_VMOLR_ROMPE |
			   IXGBE_VMOLR_ROPE);
4959
		IXGBE_WRITE_REG(hw, IXGBE_VMOLR(VMDQ_P(0)), vmolr);
4960 4961
	}

B
Ben Greear 已提交
4962
	/* This is useful for sniffing bad packets. */
4963
	if (features & NETIF_F_RXALL) {
B
Ben Greear 已提交
4964 4965 4966 4967 4968 4969 4970 4971 4972 4973
		/* 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 */
	}

4974
	IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
4975

4976
	if (features & NETIF_F_HW_VLAN_CTAG_RX)
4977 4978 4979
		ixgbe_vlan_strip_enable(adapter);
	else
		ixgbe_vlan_strip_disable(adapter);
4980 4981 4982 4983 4984

	if (features & NETIF_F_HW_VLAN_CTAG_FILTER)
		ixgbe_vlan_promisc_disable(adapter);
	else
		ixgbe_vlan_promisc_enable(adapter);
4985 4986
}

4987 4988 4989 4990
static void ixgbe_napi_enable_all(struct ixgbe_adapter *adapter)
{
	int q_idx;

4991
	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++)
4992
		napi_enable(&adapter->q_vector[q_idx]->napi);
4993 4994 4995 4996 4997 4998
}

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

4999
	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++)
5000
		napi_disable(&adapter->q_vector[q_idx]->napi);
5001 5002
}

5003
static void ixgbe_clear_udp_tunnel_port(struct ixgbe_adapter *adapter, u32 mask)
5004
{
5005 5006 5007 5008 5009 5010 5011
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vxlanctrl;

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

5012
	vxlanctrl = IXGBE_READ_REG(hw, IXGBE_VXLANCTRL) & ~mask;
5013 5014 5015
	IXGBE_WRITE_REG(hw, IXGBE_VXLANCTRL, vxlanctrl);

	if (mask & IXGBE_VXLANCTRL_VXLAN_UDPPORT_MASK)
5016
		adapter->vxlan_port = 0;
5017 5018 5019

	if (mask & IXGBE_VXLANCTRL_GENEVE_UDPPORT_MASK)
		adapter->geneve_port = 0;
5020 5021
}

J
Jeff Kirsher 已提交
5022
#ifdef CONFIG_IXGBE_DCB
5023
/**
5024 5025 5026 5027 5028 5029 5030 5031 5032 5033
 * 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;
5034
	int max_frame = adapter->netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
5035

5036 5037 5038 5039 5040 5041 5042 5043 5044
	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);

5045
#ifdef IXGBE_FCOE
5046 5047
	if (adapter->netdev->features & NETIF_F_FCOE_MTU)
		max_frame = max(max_frame, IXGBE_FCOE_JUMBO_FRAME_SIZE);
5048
#endif
5049 5050 5051

	/* reconfigure the hardware */
	if (adapter->dcbx_cap & DCB_CAP_DCBX_VER_CEE) {
5052 5053 5054 5055 5056
		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);
5057 5058 5059 5060 5061 5062 5063
	} 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);
5064
	}
5065 5066 5067

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

5071 5072 5073 5074
		while (rss_i) {
			msb++;
			rss_i >>= 1;
		}
5075

5076 5077
		/* write msb to all 8 TCs in one write */
		IXGBE_WRITE_REG(hw, IXGBE_RQTC, msb * 0x11111111);
5078
	}
5079
}
5080 5081 5082 5083 5084
#endif

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

5085
/**
5086 5087 5088
 * ixgbe_hpbthresh - calculate high water mark for flow control
 *
 * @adapter: board private structure to calculate for
5089
 * @pb: packet buffer to calculate
5090 5091 5092 5093 5094 5095 5096 5097 5098 5099 5100 5101 5102
 */
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 */
5103 5104 5105 5106
	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;
5107
#endif
5108

5109 5110 5111
	/* Calculate delay value for device */
	switch (hw->mac.type) {
	case ixgbe_mac_X540:
5112 5113
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
5114
	case ixgbe_mac_x550em_a:
5115 5116 5117 5118 5119 5120 5121 5122 5123 5124 5125 5126 5127 5128 5129 5130 5131 5132 5133 5134 5135 5136 5137 5138 5139 5140 5141 5142 5143 5144 5145
		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;
}

5146
/**
5147 5148 5149
 * ixgbe_lpbthresh - calculate low water mark for for flow control
 *
 * @adapter: board private structure to calculate for
5150
 * @pb: packet buffer to calculate
5151
 */
5152
static int ixgbe_lpbthresh(struct ixgbe_adapter *adapter, int pb)
5153 5154 5155 5156 5157 5158 5159 5160 5161
{
	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;

5162 5163 5164 5165 5166 5167 5168 5169
#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

5170 5171 5172
	/* Calculate delay value for device */
	switch (hw->mac.type) {
	case ixgbe_mac_X540:
5173 5174
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
5175
	case ixgbe_mac_x550em_a:
5176 5177 5178 5179 5180 5181 5182 5183 5184 5185 5186 5187 5188 5189 5190 5191 5192 5193 5194 5195 5196 5197 5198 5199 5200
		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);
5201
		hw->fc.low_water[i] = ixgbe_lpbthresh(adapter, i);
5202 5203

		/* Low water marks must not be larger than high water marks */
5204 5205
		if (hw->fc.low_water[i] > hw->fc.high_water[i])
			hw->fc.low_water[i] = 0;
5206
	}
5207 5208 5209

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

5212 5213 5214
static void ixgbe_configure_pb(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
5215 5216
	int hdrm;
	u8 tc = netdev_get_num_tc(adapter->netdev);
5217 5218 5219

	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE ||
	    adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE)
5220 5221 5222
		hdrm = 32 << adapter->fdir_pballoc;
	else
		hdrm = 0;
5223

5224
	hw->mac.ops.set_rxpba(hw, tc, hdrm, PBA_STRATEGY_EQUAL);
5225
	ixgbe_pbthresh_setup(adapter);
5226 5227
}

5228 5229 5230
static void ixgbe_fdir_filter_restore(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
5231
	struct hlist_node *node2;
5232 5233 5234 5235 5236 5237 5238
	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);

5239
	hlist_for_each_entry_safe(filter, node2,
5240 5241
				  &adapter->fdir_filter_list, fdir_node) {
		ixgbe_fdir_write_perfect_filter_82599(hw,
5242 5243 5244 5245 5246
				&filter->filter,
				filter->sw_idx,
				(filter->action == IXGBE_FDIR_DROP_QUEUE) ?
				IXGBE_FDIR_DROP_QUEUE :
				adapter->rx_ring[filter->action]->reg_idx);
5247 5248 5249 5250 5251
	}

	spin_unlock(&adapter->fdir_perfect_lock);
}

5252 5253 5254 5255 5256 5257 5258 5259 5260 5261 5262 5263 5264 5265 5266 5267 5268 5269 5270
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);
	}
5271
	ixgbe_write_uc_addr_list(adapter->netdev, pool);
5272 5273 5274 5275 5276 5277
	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;
5278
	int rss_i = adapter->num_rx_queues_per_pool;
5279 5280 5281 5282 5283 5284 5285 5286 5287 5288 5289 5290
	struct ixgbe_hw *hw = &adapter->hw;
	u16 pool = vadapter->pool;
	u32 psrtype = IXGBE_PSRTYPE_TCPHDR |
		      IXGBE_PSRTYPE_UDPHDR |
		      IXGBE_PSRTYPE_IPV4HDR |
		      IXGBE_PSRTYPE_L2HDR |
		      IXGBE_PSRTYPE_IPV6HDR;

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

	if (rss_i > 3)
J
Jacob Keller 已提交
5291
		psrtype |= 2u << 29;
5292
	else if (rss_i > 1)
J
Jacob Keller 已提交
5293
		psrtype |= 1u << 29;
5294 5295 5296 5297 5298 5299 5300 5301 5302 5303

	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)
{
5304 5305
	u16 i = rx_ring->next_to_clean;
	struct ixgbe_rx_buffer *rx_buffer = &rx_ring->rx_buffer_info[i];
5306 5307

	/* Free all the Rx ring sk_buffs */
5308
	while (i != rx_ring->next_to_alloc) {
5309 5310
		if (rx_buffer->skb) {
			struct sk_buff *skb = rx_buffer->skb;
A
Alexander Duyck 已提交
5311
			if (IXGBE_CB(skb)->page_released)
5312
				dma_unmap_page_attrs(rx_ring->dev,
5313 5314 5315 5316
						     IXGBE_CB(skb)->dma,
						     ixgbe_rx_pg_size(rx_ring),
						     DMA_FROM_DEVICE,
						     IXGBE_RX_DMA_ATTR);
5317 5318
			dev_kfree_skb(skb);
		}
A
Alexander Duyck 已提交
5319

5320 5321 5322 5323 5324 5325 5326 5327 5328 5329
		/* Invalidate cache lines that may have been written to by
		 * device so that we avoid corrupting memory.
		 */
		dma_sync_single_range_for_cpu(rx_ring->dev,
					      rx_buffer->dma,
					      rx_buffer->page_offset,
					      ixgbe_rx_bufsz(rx_ring),
					      DMA_FROM_DEVICE);

		/* free resources associated with mapping */
5330
		dma_unmap_page_attrs(rx_ring->dev, rx_buffer->dma,
5331 5332 5333
				     ixgbe_rx_pg_size(rx_ring),
				     DMA_FROM_DEVICE,
				     IXGBE_RX_DMA_ATTR);
5334 5335
		__page_frag_cache_drain(rx_buffer->page,
					rx_buffer->pagecnt_bias);
A
Alexander Duyck 已提交
5336

5337 5338 5339 5340 5341 5342
		i++;
		rx_buffer++;
		if (i == rx_ring->count) {
			i = 0;
			rx_buffer = rx_ring->rx_buffer_info;
		}
5343 5344 5345 5346 5347 5348 5349 5350 5351 5352 5353 5354 5355 5356 5357 5358
	}

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

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

	/* shutdown specific queue receive and wait for dma to settle */
	ixgbe_disable_rx_queue(adapter, rx_ring);
	usleep_range(10000, 20000);
J
Jacob Keller 已提交
5359
	ixgbe_irq_disable_queues(adapter, BIT_ULL(index));
5360 5361 5362 5363
	ixgbe_clean_rx_ring(rx_ring);
	rx_ring->l2_accel_priv = NULL;
}

5364 5365
static int ixgbe_fwd_ring_down(struct net_device *vdev,
			       struct ixgbe_fwd_adapter *accel)
5366 5367 5368 5369 5370 5371 5372 5373 5374 5375 5376 5377 5378 5379 5380 5381 5382 5383 5384 5385 5386 5387 5388 5389 5390 5391 5392 5393 5394 5395 5396 5397 5398 5399 5400 5401 5402 5403 5404 5405 5406 5407 5408 5409 5410 5411 5412 5413 5414 5415 5416 5417 5418 5419 5420 5421 5422 5423 5424 5425 5426 5427 5428 5429 5430 5431 5432 5433 5434 5435 5436 5437 5438 5439 5440 5441 5442
{
	struct ixgbe_adapter *adapter = accel->real_adapter;
	unsigned int rxbase = accel->rx_base_queue;
	unsigned int txbase = accel->tx_base_queue;
	int i;

	netif_tx_stop_all_queues(vdev);

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

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


	return 0;
}

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

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

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

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

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

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

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

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

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

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

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

D
David Ahern 已提交
5443
static int ixgbe_upper_dev_walk(struct net_device *upper, void *data)
5444
{
D
David Ahern 已提交
5445 5446 5447
	if (netif_is_macvlan(upper)) {
		struct macvlan_dev *dfwd = netdev_priv(upper);
		struct ixgbe_fwd_adapter *vadapter = dfwd->fwd_priv;
5448

D
David Ahern 已提交
5449 5450
		if (dfwd->fwd_priv)
			ixgbe_fwd_ring_up(upper, vadapter);
5451
	}
D
David Ahern 已提交
5452 5453 5454 5455 5456 5457 5458 5459

	return 0;
}

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

5462 5463
static void ixgbe_configure(struct ixgbe_adapter *adapter)
{
5464 5465
	struct ixgbe_hw *hw = &adapter->hw;

5466
	ixgbe_configure_pb(adapter);
J
Jeff Kirsher 已提交
5467
#ifdef CONFIG_IXGBE_DCB
5468
	ixgbe_configure_dcb(adapter);
5469
#endif
5470 5471 5472 5473 5474
	/*
	 * We must restore virtualization before VLANs or else
	 * the VLVF registers will not be populated
	 */
	ixgbe_configure_virtualization(adapter);
5475

5476
	ixgbe_set_rx_mode(adapter->netdev);
5477 5478
	ixgbe_restore_vlan(adapter);

5479 5480 5481 5482 5483 5484 5485 5486 5487
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
		hw->mac.ops.disable_rx_buff(hw);
		break;
	default:
		break;
	}

5488
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
5489 5490
		ixgbe_init_fdir_signature_82599(&adapter->hw,
						adapter->fdir_pballoc);
5491 5492 5493 5494
	} else if (adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE) {
		ixgbe_init_fdir_perfect_82599(&adapter->hw,
					      adapter->fdir_pballoc);
		ixgbe_fdir_filter_restore(adapter);
5495
	}
5496

5497 5498 5499 5500 5501 5502 5503 5504 5505
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
		hw->mac.ops.enable_rx_buff(hw);
		break;
	default:
		break;
	}

5506 5507 5508 5509 5510 5511
#ifdef CONFIG_IXGBE_DCA
	/* configure DCA */
	if (adapter->flags & IXGBE_FLAG_DCA_CAPABLE)
		ixgbe_setup_dca(adapter);
#endif /* CONFIG_IXGBE_DCA */

5512 5513 5514 5515 5516
#ifdef IXGBE_FCOE
	/* configure FCoE L2 filters, redirection table, and Rx control */
	ixgbe_configure_fcoe(adapter);

#endif /* IXGBE_FCOE */
5517 5518
	ixgbe_configure_tx(adapter);
	ixgbe_configure_rx(adapter);
5519
	ixgbe_configure_dfwd(adapter);
5520 5521
}

5522
/**
5523 5524 5525 5526 5527
 * ixgbe_sfp_link_config - set up SFP+ link
 * @adapter: pointer to private adapter struct
 **/
static void ixgbe_sfp_link_config(struct ixgbe_adapter *adapter)
{
5528
	/*
S
Stephen Hemminger 已提交
5529
	 * We are assuming the worst case scenario here, and that
5530 5531 5532 5533 5534 5535
	 * 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;
5536

5537
	adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
M
Mark Rustad 已提交
5538
	adapter->sfp_poll_time = 0;
5539 5540 5541 5542
}

/**
 * ixgbe_non_sfp_link_config - set up non-SFP+ link
5543 5544 5545 5546
 * @hw: pointer to private hardware struct
 *
 * Returns 0 on success, negative on failure
 **/
5547
static int ixgbe_non_sfp_link_config(struct ixgbe_hw *hw)
5548
{
J
Josh Hay 已提交
5549 5550
	u32 speed;
	bool autoneg, link_up = false;
5551
	int ret = IXGBE_ERR_LINK_SETUP;
5552 5553

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

	if (ret)
5557
		return ret;
5558

J
Josh Hay 已提交
5559 5560 5561 5562
	speed = hw->phy.autoneg_advertised;
	if ((!speed) && (hw->mac.ops.get_link_capabilities))
		ret = hw->mac.ops.get_link_capabilities(hw, &speed,
							&autoneg);
5563
	if (ret)
5564
		return ret;
5565

5566
	if (hw->mac.ops.setup_link)
J
Josh Hay 已提交
5567
		ret = hw->mac.ops.setup_link(hw, speed, link_up);
5568

5569 5570 5571
	return ret;
}

5572
static void ixgbe_setup_gpie(struct ixgbe_adapter *adapter)
5573 5574
{
	struct ixgbe_hw *hw = &adapter->hw;
5575
	u32 gpie = 0;
5576

5577
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
5578 5579 5580
		gpie = IXGBE_GPIE_MSIX_MODE | IXGBE_GPIE_PBA_SUPPORT |
		       IXGBE_GPIE_OCD;
		gpie |= IXGBE_GPIE_EIAME;
5581 5582 5583 5584 5585 5586 5587 5588 5589
		/*
		 * 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 已提交
5590
		case ixgbe_mac_X540:
5591 5592
		case ixgbe_mac_X550:
		case ixgbe_mac_X550EM_x:
5593
		case ixgbe_mac_x550em_a:
D
Don Skidmore 已提交
5594
		default:
5595 5596 5597 5598 5599
			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(0), 0xFFFFFFFF);
			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(1), 0xFFFFFFFF);
			break;
		}
	} else {
5600 5601 5602 5603
		/* 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);
	}
5604

5605 5606 5607 5608 5609
	/* 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;
5610 5611 5612 5613 5614 5615 5616 5617 5618 5619 5620 5621

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

5624
	/* Enable Thermal over heat sensor interrupt */
5625 5626 5627
	if (adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE) {
		switch (adapter->hw.mac.type) {
		case ixgbe_mac_82599EB:
5628
			gpie |= IXGBE_SDP0_GPIEN_8259X;
5629 5630 5631 5632 5633
			break;
		default:
			break;
		}
	}
5634

5635 5636
	/* Enable fan failure interrupt */
	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE)
5637
		gpie |= IXGBE_SDP1_GPIEN(hw);
5638

5639 5640 5641 5642 5643
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
		gpie |= IXGBE_SDP1_GPIEN_8259X | IXGBE_SDP2_GPIEN_8259X;
		break;
	case ixgbe_mac_X550EM_x:
5644
	case ixgbe_mac_x550em_a:
5645 5646 5647 5648
		gpie |= IXGBE_SDP0_GPIEN_X540;
		break;
	default:
		break;
5649
	}
5650 5651 5652 5653

	IXGBE_WRITE_REG(hw, IXGBE_GPIE, gpie);
}

5654
static void ixgbe_up_complete(struct ixgbe_adapter *adapter)
5655 5656 5657 5658 5659 5660 5661
{
	struct ixgbe_hw *hw = &adapter->hw;
	int err;
	u32 ctrl_ext;

	ixgbe_get_hw_control(adapter);
	ixgbe_setup_gpie(adapter);
5662

5663 5664 5665 5666 5667
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
		ixgbe_configure_msix(adapter);
	else
		ixgbe_configure_msi_and_legacy(adapter);

5668 5669
	/* enable the optics for 82599 SFP+ fiber */
	if (hw->mac.ops.enable_tx_laser)
5670 5671
		hw->mac.ops.enable_tx_laser(hw);

5672 5673 5674
	if (hw->phy.ops.set_phy_power)
		hw->phy.ops.set_phy_power(hw, true);

5675
	smp_mb__before_atomic();
5676
	clear_bit(__IXGBE_DOWN, &adapter->state);
5677 5678
	ixgbe_napi_enable_all(adapter);

5679 5680 5681 5682 5683 5684 5685 5686
	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);
	}

5687 5688
	/* clear any pending interrupts, may auto mask */
	IXGBE_READ_REG(hw, IXGBE_EICR);
5689
	ixgbe_irq_enable(adapter, true, true);
5690

5691 5692 5693 5694 5695 5696 5697
	/*
	 * 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)
5698
			e_crit(drv, "Fan has stopped, replace the adapter\n");
5699 5700
	}

5701 5702
	/* bring the link up in the watchdog, this could race with our first
	 * link up interrupt but shouldn't be a problem */
5703 5704
	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
	adapter->link_check_timeout = jiffies;
5705
	mod_timer(&adapter->service_timer, jiffies);
5706 5707 5708 5709 5710

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

5713 5714 5715
void ixgbe_reinit_locked(struct ixgbe_adapter *adapter)
{
	WARN_ON(in_interrupt());
5716
	/* put off any impending NetWatchDogTimeout */
5717
	netif_trans_update(adapter->netdev);
5718

5719
	while (test_and_set_bit(__IXGBE_RESETTING, &adapter->state))
5720
		usleep_range(1000, 2000);
5721 5722
	if (adapter->hw.phy.type == ixgbe_phy_fw)
		ixgbe_watchdog_link_is_down(adapter);
5723
	ixgbe_down(adapter);
5724 5725 5726 5727 5728 5729 5730 5731
	/*
	 * 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);
5732 5733 5734 5735
	ixgbe_up(adapter);
	clear_bit(__IXGBE_RESETTING, &adapter->state);
}

5736
void ixgbe_up(struct ixgbe_adapter *adapter)
5737 5738 5739 5740
{
	/* hardware has been reset, we need to reload some things */
	ixgbe_configure(adapter);

5741
	ixgbe_up_complete(adapter);
5742 5743 5744 5745
}

void ixgbe_reset(struct ixgbe_adapter *adapter)
{
5746
	struct ixgbe_hw *hw = &adapter->hw;
5747
	struct net_device *netdev = adapter->netdev;
5748 5749
	int err;

5750 5751
	if (ixgbe_removed(hw->hw_addr))
		return;
5752 5753 5754 5755 5756 5757 5758 5759 5760
	/* 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;

5761
	err = hw->mac.ops.init_hw(hw);
5762 5763 5764
	switch (err) {
	case 0:
	case IXGBE_ERR_SFP_NOT_PRESENT:
5765
	case IXGBE_ERR_SFP_NOT_SUPPORTED:
5766 5767
		break;
	case IXGBE_ERR_MASTER_REQUESTS_PENDING:
5768
		e_dev_err("master disable timed out\n");
5769
		break;
5770 5771
	case IXGBE_ERR_EEPROM_VERSION:
		/* We are running on a pre-production device, log a warning */
5772
		e_dev_warn("This device is a pre-production adapter/LOM. "
S
Stephen Hemminger 已提交
5773
			   "Please be aware there may be issues associated with "
5774 5775 5776 5777
			   "your hardware.  If you are experiencing problems "
			   "please contact your Intel or hardware "
			   "representative who provided you with this "
			   "hardware.\n");
5778
		break;
5779
	default:
5780
		e_dev_err("Hardware Error: %d\n", err);
5781
	}
5782

5783
	clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);
5784 5785

	/* flush entries out of MAC table */
5786
	ixgbe_flush_sw_mac_table(adapter);
5787 5788 5789
	__dev_uc_unsync(netdev, NULL);

	/* do not flush user set addresses */
5790
	ixgbe_mac_set_default_filter(adapter);
5791 5792 5793 5794

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

5796
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
5797
		ixgbe_ptp_reset(adapter);
5798 5799 5800 5801 5802 5803 5804

	if (hw->phy.ops.set_phy_power) {
		if (!netif_running(adapter->netdev) && !adapter->wol)
			hw->phy.ops.set_phy_power(hw, false);
		else
			hw->phy.ops.set_phy_power(hw, true);
	}
5805 5806 5807 5808 5809 5810
}

/**
 * ixgbe_clean_tx_ring - Free Tx Buffers
 * @tx_ring: ring to be cleaned
 **/
5811
static void ixgbe_clean_tx_ring(struct ixgbe_ring *tx_ring)
5812
{
5813 5814
	u16 i = tx_ring->next_to_clean;
	struct ixgbe_tx_buffer *tx_buffer = &tx_ring->tx_buffer_info[i];
5815

5816 5817
	while (i != tx_ring->next_to_use) {
		union ixgbe_adv_tx_desc *eop_desc, *tx_desc;
5818

5819
		/* Free all the Tx ring sk_buffs */
5820 5821 5822 5823
		if (ring_is_xdp(tx_ring))
			page_frag_free(tx_buffer->data);
		else
			dev_kfree_skb_any(tx_buffer->skb);
5824

5825 5826 5827 5828 5829
		/* 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);
5830

5831 5832 5833 5834 5835 5836 5837 5838 5839 5840 5841 5842 5843 5844
		/* check for eop_desc to determine the end of the packet */
		eop_desc = tx_buffer->next_to_watch;
		tx_desc = IXGBE_TX_DESC(tx_ring, i);

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

5846 5847 5848 5849 5850 5851 5852
			/* 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);
		}
5853

5854 5855 5856 5857 5858 5859 5860 5861 5862 5863
		/* move us one more past the eop_desc for start of next pkt */
		tx_buffer++;
		i++;
		if (unlikely(i == tx_ring->count)) {
			i = 0;
			tx_buffer = tx_ring->tx_buffer_info;
		}
	}

	/* reset BQL for queue */
5864 5865
	if (!ring_is_xdp(tx_ring))
		netdev_tx_reset_queue(txring_txq(tx_ring));
5866 5867

	/* reset next_to_use and next_to_clean */
5868 5869 5870 5871 5872
	tx_ring->next_to_use = 0;
	tx_ring->next_to_clean = 0;
}

/**
5873
 * ixgbe_clean_all_rx_rings - Free Rx Buffers for all queues
5874 5875
 * @adapter: board private structure
 **/
5876
static void ixgbe_clean_all_rx_rings(struct ixgbe_adapter *adapter)
5877 5878 5879
{
	int i;

5880
	for (i = 0; i < adapter->num_rx_queues; i++)
5881
		ixgbe_clean_rx_ring(adapter->rx_ring[i]);
5882 5883 5884
}

/**
5885
 * ixgbe_clean_all_tx_rings - Free Tx Buffers for all queues
5886 5887
 * @adapter: board private structure
 **/
5888
static void ixgbe_clean_all_tx_rings(struct ixgbe_adapter *adapter)
5889 5890 5891
{
	int i;

5892
	for (i = 0; i < adapter->num_tx_queues; i++)
5893
		ixgbe_clean_tx_ring(adapter->tx_ring[i]);
5894 5895
	for (i = 0; i < adapter->num_xdp_queues; i++)
		ixgbe_clean_tx_ring(adapter->xdp_ring[i]);
5896 5897
}

5898 5899
static void ixgbe_fdir_filter_exit(struct ixgbe_adapter *adapter)
{
5900
	struct hlist_node *node2;
5901 5902 5903 5904
	struct ixgbe_fdir_filter *filter;

	spin_lock(&adapter->fdir_perfect_lock);

5905
	hlist_for_each_entry_safe(filter, node2,
5906 5907 5908 5909 5910 5911 5912 5913 5914
				  &adapter->fdir_filter_list, fdir_node) {
		hlist_del(&filter->fdir_node);
		kfree(filter);
	}
	adapter->fdir_filter_count = 0;

	spin_unlock(&adapter->fdir_perfect_lock);
}

D
David Ahern 已提交
5915 5916 5917 5918 5919 5920 5921 5922 5923 5924 5925 5926 5927 5928 5929
static int ixgbe_disable_macvlan(struct net_device *upper, void *data)
{
	if (netif_is_macvlan(upper)) {
		struct macvlan_dev *vlan = netdev_priv(upper);

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

	return 0;
}

5930 5931 5932
void ixgbe_down(struct ixgbe_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
5933
	struct ixgbe_hw *hw = &adapter->hw;
5934
	int i;
5935 5936

	/* signal that we are down to the interrupt handler */
5937 5938
	if (test_and_set_bit(__IXGBE_DOWN, &adapter->state))
		return; /* do nothing if already down */
5939 5940

	/* disable receives */
5941
	hw->mac.ops.disable_rx(hw);
5942

5943 5944 5945 5946 5947
	/* 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]);

5948
	usleep_range(10000, 20000);
5949

5950 5951 5952
	/* synchronize_sched() needed for pending XDP buffers to drain */
	if (adapter->xdp_ring[0])
		synchronize_sched();
5953 5954
	netif_tx_stop_all_queues(netdev);

5955
	/* call carrier off first to avoid false dev_watchdog timeouts */
5956 5957 5958
	netif_carrier_off(netdev);
	netif_tx_disable(netdev);

5959
	/* disable any upper devices */
D
David Ahern 已提交
5960 5961
	netdev_walk_all_upper_dev_rcu(adapter->netdev,
				      ixgbe_disable_macvlan, NULL);
5962

5963 5964 5965 5966
	ixgbe_irq_disable(adapter);

	ixgbe_napi_disable_all(adapter);

5967 5968
	clear_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
	adapter->flags2 &= ~IXGBE_FLAG2_FDIR_REQUIRES_REINIT;
5969 5970 5971 5972
	adapter->flags &= ~IXGBE_FLAG_NEED_LINK_UPDATE;

	del_timer_sync(&adapter->service_timer);

5973
	if (adapter->num_vfs) {
5974 5975
		/* Clear EITR Select mapping */
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITRSEL, 0);
5976 5977 5978

		/* Mark all the VFs as inactive */
		for (i = 0 ; i < adapter->num_vfs; i++)
5979
			adapter->vfinfo[i].clear_to_send = false;
5980 5981 5982 5983 5984 5985

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

5988 5989
	/* disable transmits in the hardware now that interrupts are off */
	for (i = 0; i < adapter->num_tx_queues; i++) {
5990
		u8 reg_idx = adapter->tx_ring[i]->reg_idx;
5991
		IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), IXGBE_TXDCTL_SWFLSH);
5992
	}
5993 5994 5995 5996 5997
	for (i = 0; i < adapter->num_xdp_queues; i++) {
		u8 reg_idx = adapter->xdp_ring[i]->reg_idx;

		IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), IXGBE_TXDCTL_SWFLSH);
	}
5998

5999
	/* Disable the Tx DMA engine on 82599 and later MAC */
6000 6001
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
6002
	case ixgbe_mac_X540:
6003 6004
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
6005
	case ixgbe_mac_x550em_a:
6006
		IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL,
6007 6008
				(IXGBE_READ_REG(hw, IXGBE_DMATXCTL) &
				 ~IXGBE_DMATXCTL_TE));
6009 6010 6011 6012
		break;
	default:
		break;
	}
6013

6014 6015
	if (!pci_channel_offline(adapter->pdev))
		ixgbe_reset(adapter);
6016

6017 6018
	/* power down the optics for 82599 SFP+ fiber */
	if (hw->mac.ops.disable_tx_laser)
6019 6020
		hw->mac.ops.disable_tx_laser(hw);

6021 6022 6023 6024
	ixgbe_clean_all_tx_rings(adapter);
	ixgbe_clean_all_rx_rings(adapter);
}

6025 6026 6027 6028 6029 6030 6031 6032 6033 6034 6035 6036 6037 6038 6039 6040 6041 6042 6043 6044 6045 6046 6047 6048 6049
/**
 * ixgbe_eee_capable - helper function to determine EEE support on X550
 * @adapter: board private structure
 */
static void ixgbe_set_eee_capable(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;

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

6050 6051 6052 6053 6054 6055 6056 6057 6058
/**
 * 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 */
6059
	ixgbe_tx_timeout_reset(adapter);
6060 6061
}

6062 6063 6064 6065 6066 6067 6068 6069 6070 6071 6072 6073 6074 6075 6076 6077 6078 6079 6080 6081 6082 6083 6084 6085 6086 6087 6088 6089 6090 6091 6092 6093 6094 6095 6096 6097 6098 6099 6100 6101 6102 6103 6104 6105 6106 6107 6108 6109 6110 6111 6112 6113
#ifdef CONFIG_IXGBE_DCB
static void ixgbe_init_dcb(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct tc_configuration *tc;
	int j;

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

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

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

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

6114 6115 6116 6117 6118 6119 6120 6121
/**
 * 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).
 **/
6122 6123
static int ixgbe_sw_init(struct ixgbe_adapter *adapter,
			 const struct ixgbe_info *ii)
6124 6125 6126
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct pci_dev *pdev = adapter->pdev;
6127
	unsigned int rss, fdir;
6128
	u32 fwsm;
6129
	int i;
6130

6131 6132 6133 6134 6135 6136 6137 6138
	/* 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;

6139 6140 6141
	/* get_invariants needs the device IDs */
	ii->get_invariants(hw);

6142
	/* Set common capability flags and settings */
6143
	rss = min_t(int, ixgbe_max_rss_indices(adapter), num_online_cpus());
6144
	adapter->ring_feature[RING_F_RSS].limit = rss;
6145 6146 6147
	adapter->flags2 |= IXGBE_FLAG2_RSC_CAPABLE;
	adapter->max_q_vectors = MAX_Q_VECTORS_82599;
	adapter->atr_sample_rate = 20;
6148 6149
	fdir = min_t(int, IXGBE_MAX_FDIR_INDICES, num_online_cpus());
	adapter->ring_feature[RING_F_FDIR].limit = fdir;
6150 6151 6152 6153
	adapter->fdir_pballoc = IXGBE_FDIR_PBALLOC_64K;
#ifdef CONFIG_IXGBE_DCA
	adapter->flags |= IXGBE_FLAG_DCA_CAPABLE;
#endif
6154 6155 6156 6157
#ifdef CONFIG_IXGBE_DCB
	adapter->flags |= IXGBE_FLAG_DCB_CAPABLE;
	adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;
#endif
6158 6159 6160 6161 6162 6163 6164 6165 6166
#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 */

6167
	/* initialize static ixgbe jump table entries */
6168 6169 6170 6171 6172 6173 6174 6175
	adapter->jump_tables[0] = kzalloc(sizeof(*adapter->jump_tables[0]),
					  GFP_KERNEL);
	if (!adapter->jump_tables[0])
		return -ENOMEM;
	adapter->jump_tables[0]->mat = ixgbe_ipv4_fields;

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

6177 6178 6179
	adapter->mac_table = kzalloc(sizeof(struct ixgbe_mac_addr) *
				     hw->mac.num_rar_entries,
				     GFP_ATOMIC);
6180 6181
	if (!adapter->mac_table)
		return -ENOMEM;
6182

6183 6184 6185
	if (ixgbe_init_rss_key(adapter))
		return -ENOMEM;

6186
	/* Set MAC specific capability flags and exceptions */
6187 6188
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
6189 6190
		adapter->flags2 &= ~IXGBE_FLAG2_RSC_CAPABLE;

6191 6192
		if (hw->device_id == IXGBE_DEV_ID_82598AT)
			adapter->flags |= IXGBE_FLAG_FAN_FAIL_CAPABLE;
6193

6194
		adapter->max_q_vectors = MAX_Q_VECTORS_82598;
6195 6196 6197 6198 6199 6200 6201 6202 6203 6204 6205 6206 6207 6208
		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;
6209
		break;
D
Don Skidmore 已提交
6210
	case ixgbe_mac_X540:
6211
		fwsm = IXGBE_READ_REG(hw, IXGBE_FWSM(hw));
6212 6213
		if (fwsm & IXGBE_FWSM_TS_ENABLED)
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
6214
		break;
6215
	case ixgbe_mac_x550em_a:
6216
		adapter->flags |= IXGBE_FLAG_GENEVE_OFFLOAD_CAPABLE;
6217 6218 6219 6220 6221 6222 6223 6224
		switch (hw->device_id) {
		case IXGBE_DEV_ID_X550EM_A_1G_T:
		case IXGBE_DEV_ID_X550EM_A_1G_T_L:
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
			break;
		default:
			break;
		}
6225 6226
	/* fall through */
	case ixgbe_mac_X550EM_x:
6227 6228 6229 6230 6231 6232 6233 6234 6235 6236
#ifdef CONFIG_IXGBE_DCB
		adapter->flags &= ~IXGBE_FLAG_DCB_CAPABLE;
#endif
#ifdef IXGBE_FCOE
		adapter->flags &= ~IXGBE_FLAG_FCOE_CAPABLE;
#ifdef CONFIG_IXGBE_DCB
		adapter->fcoe.up = 0;
#endif /* IXGBE_DCB */
#endif /* IXGBE_FCOE */
	/* Fall Through */
6237
	case ixgbe_mac_X550:
6238 6239
		if (hw->mac.type == ixgbe_mac_X550)
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
6240 6241
#ifdef CONFIG_IXGBE_DCA
		adapter->flags &= ~IXGBE_FLAG_DCA_CAPABLE;
6242 6243
#endif
		adapter->flags |= IXGBE_FLAG_VXLAN_OFFLOAD_CAPABLE;
6244
		break;
6245 6246
	default:
		break;
A
Alexander Duyck 已提交
6247
	}
6248

6249 6250 6251 6252 6253
#ifdef IXGBE_FCOE
	/* FCoE support exists, always init the FCoE lock */
	spin_lock_init(&adapter->fcoe.lock);

#endif
6254 6255 6256
	/* n-tuple support exists, always init our spinlock */
	spin_lock_init(&adapter->fdir_perfect_lock);

J
Jeff Kirsher 已提交
6257
#ifdef CONFIG_IXGBE_DCB
6258
	ixgbe_init_dcb(adapter);
6259
#endif
6260 6261

	/* default flow control settings */
6262
	hw->fc.requested_mode = ixgbe_fc_full;
D
Don Skidmore 已提交
6263
	hw->fc.current_mode = ixgbe_fc_full;	/* init for ethtool output */
6264
	ixgbe_pbthresh_setup(adapter);
6265 6266
	hw->fc.pause_time = IXGBE_DEFAULT_FCPAUSE;
	hw->fc.send_xon = true;
6267
	hw->fc.disable_fc_autoneg = ixgbe_device_supports_autoneg_fc(hw);
6268

6269
#ifdef CONFIG_PCI_IOV
6270 6271 6272
	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");

6273
	/* assign number of SR-IOV VFs */
6274
	if (hw->mac.type != ixgbe_mac_82598EB) {
6275
		if (max_vfs > IXGBE_MAX_VFS_DRV_LIMIT) {
6276
			max_vfs = 0;
6277 6278 6279 6280
			e_dev_warn("max_vfs parameter out of range. Not assigning any SR-IOV VFs\n");
		}
	}
#endif /* CONFIG_PCI_IOV */
6281

6282
	/* enable itr by default in dynamic mode */
6283 6284
	adapter->rx_itr_setting = 1;
	adapter->tx_itr_setting = 1;
6285 6286 6287 6288 6289

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

6290
	/* set default work limits */
6291
	adapter->tx_work_limit = IXGBE_DEFAULT_TX_WORK;
6292

6293
	/* initialize eeprom parameters */
6294
	if (ixgbe_init_eeprom_params_generic(hw)) {
6295
		e_dev_err("EEPROM initialization failed\n");
6296 6297 6298
		return -EIO;
	}

6299 6300
	/* PF holds first pool slot */
	set_bit(0, &adapter->fwd_bitmask);
6301 6302 6303 6304 6305 6306 6307
	set_bit(__IXGBE_DOWN, &adapter->state);

	return 0;
}

/**
 * ixgbe_setup_tx_resources - allocate Tx resources (Descriptors)
6308
 * @tx_ring:    tx descriptor ring (for a specific queue) to setup
6309 6310 6311
 *
 * Return 0 on success, negative on failure
 **/
6312
int ixgbe_setup_tx_resources(struct ixgbe_ring *tx_ring)
6313
{
6314
	struct device *dev = tx_ring->dev;
6315
	int orig_node = dev_to_node(dev);
6316
	int ring_node = -1;
6317 6318
	int size;

6319
	size = sizeof(struct ixgbe_tx_buffer) * tx_ring->count;
6320 6321

	if (tx_ring->q_vector)
6322
		ring_node = tx_ring->q_vector->numa_node;
6323

6324
	tx_ring->tx_buffer_info = vmalloc_node(size, ring_node);
6325
	if (!tx_ring->tx_buffer_info)
6326
		tx_ring->tx_buffer_info = vmalloc(size);
6327 6328
	if (!tx_ring->tx_buffer_info)
		goto err;
6329 6330

	/* round up to nearest 4K */
6331
	tx_ring->size = tx_ring->count * sizeof(union ixgbe_adv_tx_desc);
6332
	tx_ring->size = ALIGN(tx_ring->size, 4096);
6333

6334
	set_dev_node(dev, ring_node);
6335 6336 6337 6338 6339 6340 6341 6342
	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);
6343 6344
	if (!tx_ring->desc)
		goto err;
6345

6346 6347
	tx_ring->next_to_use = 0;
	tx_ring->next_to_clean = 0;
6348
	return 0;
6349 6350 6351 6352

err:
	vfree(tx_ring->tx_buffer_info);
	tx_ring->tx_buffer_info = NULL;
6353
	dev_err(dev, "Unable to allocate memory for the Tx descriptor ring\n");
6354
	return -ENOMEM;
6355 6356
}

6357 6358 6359 6360 6361 6362 6363 6364 6365 6366 6367 6368
/**
 * 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)
{
6369
	int i, j = 0, err = 0;
6370 6371

	for (i = 0; i < adapter->num_tx_queues; i++) {
6372
		err = ixgbe_setup_tx_resources(adapter->tx_ring[i]);
6373 6374
		if (!err)
			continue;
6375

6376
		e_err(probe, "Allocation for Tx Queue %u failed\n", i);
6377
		goto err_setup_tx;
6378
	}
6379 6380 6381 6382 6383 6384 6385 6386
	for (j = 0; j < adapter->num_xdp_queues; j++) {
		err = ixgbe_setup_tx_resources(adapter->xdp_ring[j]);
		if (!err)
			continue;

		e_err(probe, "Allocation for Tx Queue %u failed\n", j);
		goto err_setup_tx;
	}
6387

6388 6389 6390
	return 0;
err_setup_tx:
	/* rewind the index freeing the rings as we go */
6391 6392
	while (j--)
		ixgbe_free_tx_resources(adapter->xdp_ring[j]);
6393 6394
	while (i--)
		ixgbe_free_tx_resources(adapter->tx_ring[i]);
6395 6396 6397
	return err;
}

6398 6399
/**
 * ixgbe_setup_rx_resources - allocate Rx resources (Descriptors)
6400
 * @rx_ring:    rx descriptor ring (for a specific queue) to setup
6401 6402 6403
 *
 * Returns 0 on success, negative on failure
 **/
6404 6405
int ixgbe_setup_rx_resources(struct ixgbe_adapter *adapter,
			     struct ixgbe_ring *rx_ring)
6406
{
6407
	struct device *dev = rx_ring->dev;
6408
	int orig_node = dev_to_node(dev);
6409
	int ring_node = -1;
6410
	int size;
6411

6412
	size = sizeof(struct ixgbe_rx_buffer) * rx_ring->count;
6413 6414

	if (rx_ring->q_vector)
6415
		ring_node = rx_ring->q_vector->numa_node;
6416

6417
	rx_ring->rx_buffer_info = vmalloc_node(size, ring_node);
6418
	if (!rx_ring->rx_buffer_info)
6419
		rx_ring->rx_buffer_info = vmalloc(size);
6420 6421
	if (!rx_ring->rx_buffer_info)
		goto err;
6422 6423

	/* Round up to nearest 4K */
6424 6425
	rx_ring->size = rx_ring->count * sizeof(union ixgbe_adv_rx_desc);
	rx_ring->size = ALIGN(rx_ring->size, 4096);
6426

6427
	set_dev_node(dev, ring_node);
6428 6429 6430 6431 6432 6433 6434 6435
	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);
6436 6437
	if (!rx_ring->desc)
		goto err;
6438

6439 6440
	rx_ring->next_to_clean = 0;
	rx_ring->next_to_use = 0;
6441

6442 6443 6444 6445 6446
	/* XDP RX-queue info */
	if (xdp_rxq_info_reg(&rx_ring->xdp_rxq, adapter->netdev,
			     rx_ring->queue_index) < 0)
		goto err;

6447 6448
	rx_ring->xdp_prog = adapter->xdp_prog;

6449
	return 0;
6450 6451 6452 6453
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");
6454
	return -ENOMEM;
6455 6456
}

6457 6458 6459 6460 6461 6462 6463 6464 6465 6466 6467 6468 6469 6470 6471
/**
 * 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++) {
6472
		err = ixgbe_setup_rx_resources(adapter, adapter->rx_ring[i]);
6473 6474
		if (!err)
			continue;
6475

6476
		e_err(probe, "Allocation for Rx Queue %u failed\n", i);
6477
		goto err_setup_rx;
6478 6479
	}

6480 6481 6482 6483 6484
#ifdef IXGBE_FCOE
	err = ixgbe_setup_fcoe_ddp_resources(adapter);
	if (!err)
#endif
		return 0;
6485 6486 6487 6488
err_setup_rx:
	/* rewind the index freeing the rings as we go */
	while (i--)
		ixgbe_free_rx_resources(adapter->rx_ring[i]);
6489 6490 6491
	return err;
}

6492 6493 6494 6495 6496 6497
/**
 * ixgbe_free_tx_resources - Free Tx Resources per Queue
 * @tx_ring: Tx descriptor ring for a specific queue
 *
 * Free all transmit software resources
 **/
6498
void ixgbe_free_tx_resources(struct ixgbe_ring *tx_ring)
6499
{
6500
	ixgbe_clean_tx_ring(tx_ring);
6501 6502 6503 6504

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

6505 6506 6507 6508 6509 6510
	/* 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);
6511 6512 6513 6514 6515 6516 6517 6518 6519 6520 6521 6522 6523 6524 6525

	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++)
6526
		if (adapter->tx_ring[i]->desc)
6527
			ixgbe_free_tx_resources(adapter->tx_ring[i]);
6528 6529 6530
	for (i = 0; i < adapter->num_xdp_queues; i++)
		if (adapter->xdp_ring[i]->desc)
			ixgbe_free_tx_resources(adapter->xdp_ring[i]);
6531 6532 6533
}

/**
6534
 * ixgbe_free_rx_resources - Free Rx Resources
6535 6536 6537 6538
 * @rx_ring: ring to clean the resources from
 *
 * Free all receive software resources
 **/
6539
void ixgbe_free_rx_resources(struct ixgbe_ring *rx_ring)
6540
{
6541
	ixgbe_clean_rx_ring(rx_ring);
6542

6543
	rx_ring->xdp_prog = NULL;
6544
	xdp_rxq_info_unreg(&rx_ring->xdp_rxq);
6545 6546 6547
	vfree(rx_ring->rx_buffer_info);
	rx_ring->rx_buffer_info = NULL;

6548 6549 6550 6551 6552 6553
	/* 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);
6554 6555 6556 6557 6558 6559 6560 6561 6562 6563 6564 6565 6566 6567

	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;

6568 6569 6570 6571
#ifdef IXGBE_FCOE
	ixgbe_free_fcoe_ddp_resources(adapter);

#endif
6572
	for (i = 0; i < adapter->num_rx_queues; i++)
6573
		if (adapter->rx_ring[i]->desc)
6574
			ixgbe_free_rx_resources(adapter->rx_ring[i]);
6575 6576 6577 6578 6579 6580 6581 6582 6583 6584 6585 6586
}

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

	/*
6589 6590 6591
	 * 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.
6592 6593 6594
	 */
	if ((adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) &&
	    (adapter->hw.mac.type == ixgbe_mac_82599EB) &&
6595
	    (new_mtu > ETH_DATA_LEN))
6596
		e_warn(probe, "Setting MTU > 1500 will disable legacy VFs\n");
6597

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

6600
	/* must set new MTU before calling down or up */
6601 6602
	netdev->mtu = new_mtu;

6603 6604
	if (netif_running(netdev))
		ixgbe_reinit_locked(adapter);
6605 6606 6607 6608 6609 6610 6611 6612 6613 6614 6615 6616 6617 6618 6619 6620

	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.
 **/
6621
int ixgbe_open(struct net_device *netdev)
6622 6623
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
6624
	struct ixgbe_hw *hw = &adapter->hw;
6625
	int err, queues;
6626 6627 6628 6629

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

6631 6632
	netif_carrier_off(netdev);

6633 6634 6635 6636 6637 6638 6639 6640 6641 6642 6643 6644
	/* 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);

6645
	err = ixgbe_request_irq(adapter);
6646 6647 6648
	if (err)
		goto err_req_irq;

6649
	/* Notify the stack of the actual queue counts. */
6650 6651 6652 6653 6654 6655
	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);
6656 6657 6658
	if (err)
		goto err_set_queues;

6659 6660 6661 6662 6663 6664
	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);
6665 6666 6667
	if (err)
		goto err_set_queues;

6668 6669
	ixgbe_ptp_init(adapter);

6670
	ixgbe_up_complete(adapter);
6671

6672
	ixgbe_clear_udp_tunnel_port(adapter, IXGBE_VXLANCTRL_ALL_UDPPORT_MASK);
6673
	udp_tunnel_get_rx_info(netdev);
6674

6675 6676
	return 0;

6677 6678
err_set_queues:
	ixgbe_free_irq(adapter);
6679
err_req_irq:
6680
	ixgbe_free_all_rx_resources(adapter);
6681 6682
	if (hw->phy.ops.set_phy_power && !adapter->wol)
		hw->phy.ops.set_phy_power(&adapter->hw, false);
6683
err_setup_rx:
6684
	ixgbe_free_all_tx_resources(adapter);
6685
err_setup_tx:
6686 6687 6688 6689 6690
	ixgbe_reset(adapter);

	return err;
}

6691 6692 6693 6694
static void ixgbe_close_suspend(struct ixgbe_adapter *adapter)
{
	ixgbe_ptp_suspend(adapter);

6695 6696 6697 6698 6699 6700 6701 6702 6703
	if (adapter->hw.phy.ops.enter_lplu) {
		adapter->hw.phy.reset_disable = true;
		ixgbe_down(adapter);
		adapter->hw.phy.ops.enter_lplu(&adapter->hw);
		adapter->hw.phy.reset_disable = false;
	} else {
		ixgbe_down(adapter);
	}

6704 6705 6706 6707 6708 6709
	ixgbe_free_irq(adapter);

	ixgbe_free_all_tx_resources(adapter);
	ixgbe_free_all_rx_resources(adapter);
}

6710 6711 6712 6713 6714 6715 6716 6717 6718 6719 6720
/**
 * 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.
 **/
6721
int ixgbe_close(struct net_device *netdev)
6722 6723 6724
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

6725 6726
	ixgbe_ptp_stop(adapter);

6727 6728
	if (netif_device_present(netdev))
		ixgbe_close_suspend(adapter);
6729

6730 6731
	ixgbe_fdir_filter_exit(adapter);

6732
	ixgbe_release_hw_control(adapter);
6733 6734 6735 6736

	return 0;
}

6737 6738 6739
#ifdef CONFIG_PM
static int ixgbe_resume(struct pci_dev *pdev)
{
6740 6741
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
6742 6743
	u32 err;

6744
	adapter->hw.hw_addr = adapter->io_addr;
6745 6746
	pci_set_power_state(pdev, PCI_D0);
	pci_restore_state(pdev);
6747 6748 6749 6750 6751
	/*
	 * pci_restore_state clears dev->state_saved so call
	 * pci_save_state to restore it.
	 */
	pci_save_state(pdev);
6752 6753

	err = pci_enable_device_mem(pdev);
6754
	if (err) {
6755
		e_dev_err("Cannot enable PCI device from suspend\n");
6756 6757
		return err;
	}
6758
	smp_mb__before_atomic();
6759
	clear_bit(__IXGBE_DISABLED, &adapter->state);
6760 6761
	pci_set_master(pdev);

6762
	pci_wake_from_d3(pdev, false);
6763 6764 6765

	ixgbe_reset(adapter);

6766 6767
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);

6768 6769 6770
	rtnl_lock();
	err = ixgbe_init_interrupt_scheme(adapter);
	if (!err && netif_running(netdev))
6771
		err = ixgbe_open(netdev);
6772 6773


6774 6775 6776
	if (!err)
		netif_device_attach(netdev);
	rtnl_unlock();
6777

6778
	return err;
6779 6780
}
#endif /* CONFIG_PM */
6781 6782

static int __ixgbe_shutdown(struct pci_dev *pdev, bool *enable_wake)
6783
{
6784 6785
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
6786
	struct ixgbe_hw *hw = &adapter->hw;
6787
	u32 ctrl;
6788
	u32 wufc = adapter->wol;
6789 6790 6791 6792
#ifdef CONFIG_PM
	int retval = 0;
#endif

6793
	rtnl_lock();
6794 6795
	netif_device_detach(netdev);

6796 6797
	if (netif_running(netdev))
		ixgbe_close_suspend(adapter);
6798

6799
	ixgbe_clear_interrupt_scheme(adapter);
6800
	rtnl_unlock();
6801

6802 6803 6804 6805
#ifdef CONFIG_PM
	retval = pci_save_state(pdev);
	if (retval)
		return retval;
6806

6807
#endif
6808 6809 6810
	if (hw->mac.ops.stop_link_on_d3)
		hw->mac.ops.stop_link_on_d3(hw);

6811
	if (wufc) {
6812 6813
		u32 fctrl;

6814
		ixgbe_set_rx_mode(netdev);
6815

6816 6817
		/* enable the optics for 82599 SFP+ fiber as we can WoL */
		if (hw->mac.ops.enable_tx_laser)
D
Don Skidmore 已提交
6818 6819
			hw->mac.ops.enable_tx_laser(hw);

6820 6821 6822 6823
		/* enable the reception of multicast packets */
		fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
		fctrl |= IXGBE_FCTRL_MPE;
		IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
6824 6825 6826 6827 6828 6829 6830 6831 6832 6833 6834

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

6835 6836
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
6837
		pci_wake_from_d3(pdev, false);
6838 6839
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
6840
	case ixgbe_mac_X540:
6841 6842
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
6843
	case ixgbe_mac_x550em_a:
6844 6845 6846 6847 6848
		pci_wake_from_d3(pdev, !!wufc);
		break;
	default:
		break;
	}
6849

6850
	*enable_wake = !!wufc;
6851 6852
	if (hw->phy.ops.set_phy_power && !*enable_wake)
		hw->phy.ops.set_phy_power(hw, false);
6853

6854 6855
	ixgbe_release_hw_control(adapter);

6856 6857
	if (!test_and_set_bit(__IXGBE_DISABLED, &adapter->state))
		pci_disable_device(pdev);
6858

6859 6860 6861 6862 6863 6864 6865 6866 6867 6868 6869 6870 6871 6872 6873 6874 6875 6876 6877
	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);
	}
6878 6879 6880

	return 0;
}
6881
#endif /* CONFIG_PM */
6882 6883 6884

static void ixgbe_shutdown(struct pci_dev *pdev)
{
6885 6886 6887 6888 6889 6890 6891 6892
	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);
	}
6893 6894
}

6895 6896 6897 6898 6899 6900
/**
 * ixgbe_update_stats - Update the board statistics counters.
 * @adapter: board private structure
 **/
void ixgbe_update_stats(struct ixgbe_adapter *adapter)
{
6901
	struct net_device *netdev = adapter->netdev;
6902
	struct ixgbe_hw *hw = &adapter->hw;
6903
	struct ixgbe_hw_stats *hwstats = &adapter->stats;
6904 6905
	u64 total_mpc = 0;
	u32 i, missed_rx = 0, mpc, bprc, lxon, lxoff, xon_off_tot;
6906 6907
	u64 non_eop_descs = 0, restart_queue = 0, tx_busy = 0;
	u64 alloc_rx_page_failed = 0, alloc_rx_buff_failed = 0;
6908
	u64 alloc_rx_page = 0;
6909
	u64 bytes = 0, packets = 0, hw_csum_rx_error = 0;
6910

6911 6912 6913 6914
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;

6915
	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED) {
A
Alexander Duyck 已提交
6916
		u64 rsc_count = 0;
6917 6918
		u64 rsc_flush = 0;
		for (i = 0; i < adapter->num_rx_queues; i++) {
6919 6920
			rsc_count += adapter->rx_ring[i]->rx_stats.rsc_count;
			rsc_flush += adapter->rx_ring[i]->rx_stats.rsc_flush;
6921 6922 6923
		}
		adapter->rsc_total_count = rsc_count;
		adapter->rsc_total_flush = rsc_flush;
6924 6925
	}

6926 6927 6928
	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;
6929
		alloc_rx_page += rx_ring->rx_stats.alloc_rx_page;
6930 6931
		alloc_rx_page_failed += rx_ring->rx_stats.alloc_rx_page_failed;
		alloc_rx_buff_failed += rx_ring->rx_stats.alloc_rx_buff_failed;
6932
		hw_csum_rx_error += rx_ring->rx_stats.csum_err;
6933 6934 6935 6936
		bytes += rx_ring->stats.bytes;
		packets += rx_ring->stats.packets;
	}
	adapter->non_eop_descs = non_eop_descs;
6937
	adapter->alloc_rx_page = alloc_rx_page;
6938 6939
	adapter->alloc_rx_page_failed = alloc_rx_page_failed;
	adapter->alloc_rx_buff_failed = alloc_rx_buff_failed;
6940
	adapter->hw_csum_rx_error = hw_csum_rx_error;
6941 6942 6943 6944 6945
	netdev->stats.rx_bytes = bytes;
	netdev->stats.rx_packets = packets;

	bytes = 0;
	packets = 0;
J
Jesse Brandeburg 已提交
6946
	/* gather some stats to the adapter struct that are per queue */
6947 6948 6949 6950 6951 6952 6953
	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;
	}
6954 6955 6956 6957 6958 6959 6960 6961
	for (i = 0; i < adapter->num_xdp_queues; i++) {
		struct ixgbe_ring *xdp_ring = adapter->xdp_ring[i];

		restart_queue += xdp_ring->tx_stats.restart_queue;
		tx_busy += xdp_ring->tx_stats.tx_busy;
		bytes += xdp_ring->stats.bytes;
		packets += xdp_ring->stats.packets;
	}
6962
	adapter->restart_queue = restart_queue;
6963 6964 6965
	adapter->tx_busy = tx_busy;
	netdev->stats.tx_bytes = bytes;
	netdev->stats.tx_packets = packets;
J
Jesse Brandeburg 已提交
6966

6967
	hwstats->crcerrs += IXGBE_READ_REG(hw, IXGBE_CRCERRS);
6968 6969

	/* 8 register reads */
6970 6971 6972 6973
	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;
6974 6975
		hwstats->mpc[i] += mpc;
		total_mpc += hwstats->mpc[i];
6976 6977
		hwstats->pxontxc[i] += IXGBE_READ_REG(hw, IXGBE_PXONTXC(i));
		hwstats->pxofftxc[i] += IXGBE_READ_REG(hw, IXGBE_PXOFFTXC(i));
6978 6979
		switch (hw->mac.type) {
		case ixgbe_mac_82598EB:
6980 6981 6982
			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));
6983 6984
			hwstats->pxonrxc[i] +=
				IXGBE_READ_REG(hw, IXGBE_PXONRXC(i));
6985 6986
			break;
		case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
6987
		case ixgbe_mac_X540:
6988 6989
		case ixgbe_mac_X550:
		case ixgbe_mac_X550EM_x:
6990
		case ixgbe_mac_x550em_a:
6991 6992 6993 6994 6995
			hwstats->pxonrxc[i] +=
				IXGBE_READ_REG(hw, IXGBE_PXONRXCNT(i));
			break;
		default:
			break;
6996
		}
6997
	}
6998 6999 7000 7001 7002 7003

	/*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) ||
7004 7005
		    (hw->mac.type == ixgbe_mac_X540) ||
		    (hw->mac.type == ixgbe_mac_X550) ||
7006 7007
		    (hw->mac.type == ixgbe_mac_X550EM_x) ||
		    (hw->mac.type == ixgbe_mac_x550em_a)) {
7008 7009 7010 7011 7012 7013 7014
			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 */
		}
	}

7015
	hwstats->gprc += IXGBE_READ_REG(hw, IXGBE_GPRC);
7016
	/* work around hardware counting issue */
7017
	hwstats->gprc -= missed_rx;
7018

7019 7020
	ixgbe_update_xoff_received(adapter);

7021
	/* 82598 hardware only has a 32 bit counter in the high register */
7022 7023 7024 7025 7026 7027 7028
	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 已提交
7029
	case ixgbe_mac_X540:
7030 7031
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
7032
	case ixgbe_mac_x550em_a:
7033
		/* OS2BMC stats are X540 and later */
7034 7035 7036 7037
		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);
7038
		/* fall through */
7039
	case ixgbe_mac_82599EB:
7040 7041 7042
		for (i = 0; i < 16; i++)
			adapter->hw_rx_no_dma_resources +=
					     IXGBE_READ_REG(hw, IXGBE_QPRDC(i));
7043
		hwstats->gorc += IXGBE_READ_REG(hw, IXGBE_GORCL);
7044
		IXGBE_READ_REG(hw, IXGBE_GORCH); /* to clear */
7045
		hwstats->gotc += IXGBE_READ_REG(hw, IXGBE_GOTCL);
7046
		IXGBE_READ_REG(hw, IXGBE_GOTCH); /* to clear */
7047
		hwstats->tor += IXGBE_READ_REG(hw, IXGBE_TORL);
7048
		IXGBE_READ_REG(hw, IXGBE_TORH); /* to clear */
7049 7050 7051
		hwstats->lxonrxc += IXGBE_READ_REG(hw, IXGBE_LXONRXCNT);
		hwstats->fdirmatch += IXGBE_READ_REG(hw, IXGBE_FDIRMATCH);
		hwstats->fdirmiss += IXGBE_READ_REG(hw, IXGBE_FDIRMISS);
7052
#ifdef IXGBE_FCOE
7053 7054 7055 7056 7057 7058
		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);
7059
		/* Add up per cpu counters for total ddp aloc fail */
7060 7061 7062 7063 7064
		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;
7065
			for_each_possible_cpu(cpu) {
7066 7067 7068
				ddp_pool = per_cpu_ptr(fcoe->ddp_pool, cpu);
				noddp += ddp_pool->noddp;
				noddp_ext_buff += ddp_pool->noddp_ext_buff;
7069
			}
7070 7071
			hwstats->fcoe_noddp = noddp;
			hwstats->fcoe_noddp_ext_buff = noddp_ext_buff;
7072
		}
7073
#endif /* IXGBE_FCOE */
7074 7075 7076
		break;
	default:
		break;
7077
	}
7078
	bprc = IXGBE_READ_REG(hw, IXGBE_BPRC);
7079 7080
	hwstats->bprc += bprc;
	hwstats->mprc += IXGBE_READ_REG(hw, IXGBE_MPRC);
7081
	if (hw->mac.type == ixgbe_mac_82598EB)
7082 7083 7084 7085 7086 7087 7088 7089 7090
		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);
7091
	lxon = IXGBE_READ_REG(hw, IXGBE_LXONTXC);
7092
	hwstats->lxontxc += lxon;
7093
	lxoff = IXGBE_READ_REG(hw, IXGBE_LXOFFTXC);
7094 7095 7096
	hwstats->lxofftxc += lxoff;
	hwstats->gptc += IXGBE_READ_REG(hw, IXGBE_GPTC);
	hwstats->mptc += IXGBE_READ_REG(hw, IXGBE_MPTC);
7097 7098 7099 7100
	/*
	 * 82598 errata - tx of flow control packets is included in tx counters
	 */
	xon_off_tot = lxon + lxoff;
7101 7102 7103 7104 7105 7106 7107 7108 7109 7110 7111 7112 7113 7114 7115
	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);
7116 7117

	/* Fill out the OS statistics structure */
7118
	netdev->stats.multicast = hwstats->mprc;
7119 7120

	/* Rx Errors */
7121
	netdev->stats.rx_errors = hwstats->crcerrs + hwstats->rlec;
7122
	netdev->stats.rx_dropped = 0;
7123 7124
	netdev->stats.rx_length_errors = hwstats->rlec;
	netdev->stats.rx_crc_errors = hwstats->crcerrs;
7125
	netdev->stats.rx_missed_errors = total_mpc;
7126 7127 7128
}

/**
7129
 * ixgbe_fdir_reinit_subtask - worker thread to reinit FDIR filter table
7130
 * @adapter: pointer to the device adapter structure
7131
 **/
7132
static void ixgbe_fdir_reinit_subtask(struct ixgbe_adapter *adapter)
7133
{
7134
	struct ixgbe_hw *hw = &adapter->hw;
7135
	int i;
7136

7137 7138 7139 7140
	if (!(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_FDIR_REQUIRES_REINIT;
7141

7142
	/* if interface is down do nothing */
7143
	if (test_bit(__IXGBE_DOWN, &adapter->state))
7144 7145 7146 7147 7148 7149 7150 7151
		return;

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

	adapter->fdir_overflow++;

7152 7153 7154
	if (ixgbe_reinit_fdir_tables_82599(hw) == 0) {
		for (i = 0; i < adapter->num_tx_queues; i++)
			set_bit(__IXGBE_TX_FDIR_INIT_DONE,
7155
				&(adapter->tx_ring[i]->state));
7156 7157 7158
		for (i = 0; i < adapter->num_xdp_queues; i++)
			set_bit(__IXGBE_TX_FDIR_INIT_DONE,
				&adapter->xdp_ring[i]->state);
7159 7160
		/* re-enable flow director interrupts */
		IXGBE_WRITE_REG(hw, IXGBE_EIMS, IXGBE_EIMS_FLOW_DIR);
7161 7162 7163 7164 7165 7166 7167 7168
	} 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
7169
 * @adapter: pointer to the device adapter structure
7170 7171
 *
 * This function serves two purposes.  First it strobes the interrupt lines
S
Stephen Hemminger 已提交
7172
 * in order to make certain interrupts are occurring.  Secondly it sets the
7173
 * bits needed to check for TX hangs.  As a result we should immediately
S
Stephen Hemminger 已提交
7174
 * determine if a hang has occurred.
7175 7176
 */
static void ixgbe_check_hang_subtask(struct ixgbe_adapter *adapter)
7177
{
7178
	struct ixgbe_hw *hw = &adapter->hw;
7179 7180
	u64 eics = 0;
	int i;
7181

7182
	/* If we're down, removing or resetting, just bail */
7183
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
7184
	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
7185 7186
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;
7187

7188 7189 7190 7191
	/* 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]);
7192 7193
		for (i = 0; i < adapter->num_xdp_queues; i++)
			set_check_for_tx_hang(adapter->xdp_ring[i]);
7194
	}
7195

7196 7197 7198 7199 7200 7201 7202 7203
	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));
7204 7205
	} else {
		/* get one bit for every active tx/rx interrupt vector */
7206
		for (i = 0; i < adapter->num_q_vectors; i++) {
7207
			struct ixgbe_q_vector *qv = adapter->q_vector[i];
7208
			if (qv->rx.ring || qv->tx.ring)
J
Jacob Keller 已提交
7209
				eics |= BIT_ULL(i);
7210
		}
7211
	}
7212

7213
	/* Cause software interrupt to ensure rings are cleaned */
7214
	ixgbe_irq_rearm_queues(adapter, eics);
7215 7216
}

7217
/**
7218
 * ixgbe_watchdog_update_link - update the link status
7219 7220
 * @adapter: pointer to the device adapter structure
 * @link_speed: pointer to a u32 to store the link_speed
7221
 **/
7222
static void ixgbe_watchdog_update_link(struct ixgbe_adapter *adapter)
7223 7224
{
	struct ixgbe_hw *hw = &adapter->hw;
7225 7226
	u32 link_speed = adapter->link_speed;
	bool link_up = adapter->link_up;
7227
	bool pfc_en = adapter->dcb_cfg.pfc_mode_enable;
7228

7229 7230 7231 7232 7233
	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);
7234
	} else {
7235 7236 7237
		/* always assume link is up, if no check link function */
		link_speed = IXGBE_LINK_SPEED_10GB_FULL;
		link_up = true;
7238
	}
7239 7240 7241 7242

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

7243
	if (link_up && !((adapter->flags & IXGBE_FLAG_DCB_ENABLED) && pfc_en)) {
7244
		hw->mac.ops.fc_enable(hw);
7245 7246
		ixgbe_set_rx_drop_en(adapter);
	}
7247 7248 7249 7250 7251 7252 7253 7254 7255 7256 7257

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

7260 7261 7262 7263 7264 7265 7266 7267 7268 7269 7270 7271 7272 7273 7274 7275 7276
static void ixgbe_update_default_up(struct ixgbe_adapter *adapter)
{
#ifdef CONFIG_IXGBE_DCB
	struct net_device *netdev = adapter->netdev;
	struct dcb_app app = {
			      .selector = IEEE_8021QAZ_APP_SEL_ETHERTYPE,
			      .protocol = 0,
			     };
	u8 up = 0;

	if (adapter->dcbx_cap & DCB_CAP_DCBX_VER_IEEE)
		up = dcb_ieee_getapp_mask(netdev, &app);

	adapter->default_up = (up > 1) ? (ffs(up) - 1) : 0;
#endif
}

D
David Ahern 已提交
7277 7278 7279 7280 7281 7282 7283 7284 7285 7286 7287 7288
static int ixgbe_enable_macvlan(struct net_device *upper, void *data)
{
	if (netif_is_macvlan(upper)) {
		struct macvlan_dev *vlan = netdev_priv(upper);

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

	return 0;
}

7289
/**
7290 7291
 * ixgbe_watchdog_link_is_up - update netif_carrier status and
 *                             print link up message
7292
 * @adapter: pointer to the device adapter structure
7293
 **/
7294
static void ixgbe_watchdog_link_is_up(struct ixgbe_adapter *adapter)
7295
{
7296
	struct net_device *netdev = adapter->netdev;
7297
	struct ixgbe_hw *hw = &adapter->hw;
7298
	u32 link_speed = adapter->link_speed;
7299
	const char *speed_str;
7300
	bool flow_rx, flow_tx;
7301

7302 7303
	/* only continue if link was previously down */
	if (netif_carrier_ok(netdev))
7304
		return;
7305

7306
	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
7307

7308 7309 7310 7311 7312 7313 7314 7315 7316
	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:
7317 7318
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
7319
	case ixgbe_mac_x550em_a:
7320 7321 7322 7323 7324 7325 7326 7327 7328 7329 7330
	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;
7331
	}
7332

7333 7334
	adapter->last_rx_ptp_check = jiffies;

7335
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
7336
		ixgbe_ptp_start_cyclecounter(adapter);
7337

7338 7339 7340 7341 7342 7343 7344 7345 7346 7347 7348 7349 7350
	switch (link_speed) {
	case IXGBE_LINK_SPEED_10GB_FULL:
		speed_str = "10 Gbps";
		break;
	case IXGBE_LINK_SPEED_2_5GB_FULL:
		speed_str = "2.5 Gbps";
		break;
	case IXGBE_LINK_SPEED_1GB_FULL:
		speed_str = "1 Gbps";
		break;
	case IXGBE_LINK_SPEED_100_FULL:
		speed_str = "100 Mbps";
		break;
7351 7352 7353
	case IXGBE_LINK_SPEED_10_FULL:
		speed_str = "10 Mbps";
		break;
7354 7355 7356 7357 7358
	default:
		speed_str = "unknown speed";
		break;
	}
	e_info(drv, "NIC Link is Up %s, Flow Control: %s\n", speed_str,
7359 7360 7361
	       ((flow_rx && flow_tx) ? "RX/TX" :
	       (flow_rx ? "RX" :
	       (flow_tx ? "TX" : "None"))));
7362

7363 7364
	netif_carrier_on(netdev);
	ixgbe_check_vf_rate_limit(adapter);
7365

7366 7367 7368 7369 7370
	/* enable transmits */
	netif_tx_wake_all_queues(adapter->netdev);

	/* enable any upper devices */
	rtnl_lock();
D
David Ahern 已提交
7371 7372
	netdev_walk_all_upper_dev_rcu(adapter->netdev,
				      ixgbe_enable_macvlan, NULL);
7373 7374
	rtnl_unlock();

7375 7376 7377
	/* update the default user priority for VFs */
	ixgbe_update_default_up(adapter);

7378 7379
	/* ping all the active vfs to let them know link has changed */
	ixgbe_ping_all_vfs(adapter);
7380 7381
}

7382
/**
7383 7384
 * ixgbe_watchdog_link_is_down - update netif_carrier status and
 *                               print link down message
7385
 * @adapter: pointer to the adapter structure
7386
 **/
A
Alexander Duyck 已提交
7387
static void ixgbe_watchdog_link_is_down(struct ixgbe_adapter *adapter)
7388
{
7389
	struct net_device *netdev = adapter->netdev;
7390
	struct ixgbe_hw *hw = &adapter->hw;
7391

7392 7393
	adapter->link_up = false;
	adapter->link_speed = 0;
7394

7395 7396 7397
	/* only continue if link was up previously */
	if (!netif_carrier_ok(netdev))
		return;
7398

7399 7400 7401
	/* 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;
7402

7403
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state))
7404
		ixgbe_ptp_start_cyclecounter(adapter);
7405

7406 7407
	e_info(drv, "NIC Link is Down\n");
	netif_carrier_off(netdev);
7408 7409 7410

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

7413 7414 7415 7416 7417 7418 7419 7420 7421 7422 7423
static bool ixgbe_ring_tx_pending(struct ixgbe_adapter *adapter)
{
	int i;

	for (i = 0; i < adapter->num_tx_queues; i++) {
		struct ixgbe_ring *tx_ring = adapter->tx_ring[i];

		if (tx_ring->next_to_use != tx_ring->next_to_clean)
			return true;
	}

7424 7425 7426 7427 7428 7429 7430
	for (i = 0; i < adapter->num_xdp_queues; i++) {
		struct ixgbe_ring *ring = adapter->xdp_ring[i];

		if (ring->next_to_use != ring->next_to_clean)
			return true;
	}

7431 7432 7433 7434 7435 7436 7437 7438 7439 7440 7441 7442 7443 7444
	return false;
}

static bool ixgbe_vf_tx_pending(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_ring_feature *vmdq = &adapter->ring_feature[RING_F_VMDQ];
	u32 q_per_pool = __ALIGN_MASK(1, ~vmdq->mask);

	int i, j;

	if (!adapter->num_vfs)
		return false;

7445 7446 7447 7448
	/* resetting the PF is only needed for MAC before X550 */
	if (hw->mac.type >= ixgbe_mac_X550)
		return false;

7449 7450 7451 7452 7453 7454 7455 7456 7457 7458 7459 7460 7461 7462 7463
	for (i = 0; i < adapter->num_vfs; i++) {
		for (j = 0; j < q_per_pool; j++) {
			u32 h, t;

			h = IXGBE_READ_REG(hw, IXGBE_PVFTDHN(q_per_pool, i, j));
			t = IXGBE_READ_REG(hw, IXGBE_PVFTDTN(q_per_pool, i, j));

			if (h != t)
				return true;
		}
	}

	return false;
}

7464 7465
/**
 * ixgbe_watchdog_flush_tx - flush queues on link down
7466
 * @adapter: pointer to the device adapter structure
7467 7468 7469 7470
 **/
static void ixgbe_watchdog_flush_tx(struct ixgbe_adapter *adapter)
{
	if (!netif_carrier_ok(adapter->netdev)) {
7471 7472
		if (ixgbe_ring_tx_pending(adapter) ||
		    ixgbe_vf_tx_pending(adapter)) {
7473 7474 7475 7476 7477
			/* 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).
			 */
7478
			e_warn(drv, "initiating reset to clear Tx work after link loss\n");
7479
			set_bit(__IXGBE_RESET_REQUESTED, &adapter->state);
7480
		}
7481 7482 7483
	}
}

7484 7485 7486 7487 7488
#ifdef CONFIG_PCI_IOV
static void ixgbe_check_for_bad_vf(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct pci_dev *pdev = adapter->pdev;
7489
	unsigned int vf;
7490 7491 7492 7493 7494 7495 7496 7497 7498 7499 7500 7501 7502 7503 7504 7505 7506 7507
	u32 gpc;

	if (!(netif_carrier_ok(adapter->netdev)))
		return;

	gpc = IXGBE_READ_REG(hw, IXGBE_TXDGPC);
	if (gpc) /* If incrementing then no need for the check below */
		return;
	/* Check to see if a bad DMA write target from an errant or
	 * malicious VF has caused a PCIe error.  If so then we can
	 * issue a VFLR to the offending VF(s) and then resume without
	 * requesting a full slot reset.
	 */

	if (!pdev)
		return;

	/* check status reg for all VFs owned by this PF */
7508 7509 7510
	for (vf = 0; vf < adapter->num_vfs; ++vf) {
		struct pci_dev *vfdev = adapter->vfinfo[vf].vfdev;
		u16 status_reg;
7511

7512 7513 7514 7515 7516
		if (!vfdev)
			continue;
		pci_read_config_word(vfdev, PCI_STATUS, &status_reg);
		if (status_reg != IXGBE_FAILED_READ_CFG_WORD &&
		    status_reg & PCI_STATUS_REC_MASTER_ABORT)
7517
			pcie_flr(vfdev);
7518 7519 7520
	}
}

7521 7522 7523 7524
static void ixgbe_spoof_check(struct ixgbe_adapter *adapter)
{
	u32 ssvpc;

7525 7526 7527
	/* 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)
7528 7529 7530 7531 7532 7533 7534 7535 7536 7537 7538
		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;

7539
	e_warn(drv, "%u Spoofed packets detected\n", ssvpc);
7540
}
7541 7542 7543 7544 7545 7546 7547 7548 7549 7550 7551
#else
static void ixgbe_spoof_check(struct ixgbe_adapter __always_unused *adapter)
{
}

static void
ixgbe_check_for_bad_vf(struct ixgbe_adapter __always_unused *adapter)
{
}
#endif /* CONFIG_PCI_IOV */

7552

7553 7554
/**
 * ixgbe_watchdog_subtask - check and bring link up
7555
 * @adapter: pointer to the device adapter structure
7556 7557 7558
 **/
static void ixgbe_watchdog_subtask(struct ixgbe_adapter *adapter)
{
7559
	/* if interface is down, removing or resetting, do nothing */
7560
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
7561
	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
7562
	    test_bit(__IXGBE_RESETTING, &adapter->state))
7563 7564 7565 7566 7567 7568 7569 7570
		return;

	ixgbe_watchdog_update_link(adapter);

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

7572
	ixgbe_check_for_bad_vf(adapter);
7573
	ixgbe_spoof_check(adapter);
7574
	ixgbe_update_stats(adapter);
7575 7576

	ixgbe_watchdog_flush_tx(adapter);
7577
}
7578

7579
/**
7580
 * ixgbe_sfp_detection_subtask - poll for SFP+ cable
7581
 * @adapter: the ixgbe adapter structure
7582
 **/
7583
static void ixgbe_sfp_detection_subtask(struct ixgbe_adapter *adapter)
7584 7585
{
	struct ixgbe_hw *hw = &adapter->hw;
7586
	s32 err;
7587

7588 7589 7590 7591
	/* 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;
7592

M
Mark Rustad 已提交
7593 7594 7595 7596
	if (adapter->sfp_poll_time &&
	    time_after(adapter->sfp_poll_time, jiffies))
		return; /* If not yet time to poll for SFP */

7597 7598 7599
	/* someone else is in init, wait until next service event */
	if (test_and_set_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
		return;
7600

M
Mark Rustad 已提交
7601 7602
	adapter->sfp_poll_time = jiffies + IXGBE_SFP_POLL_JIFFIES - 1;

7603 7604 7605
	err = hw->phy.ops.identify_sfp(hw);
	if (err == IXGBE_ERR_SFP_NOT_SUPPORTED)
		goto sfp_out;
7606

7607 7608 7609 7610
	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;
7611
	}
7612

7613 7614 7615
	/* exit on error */
	if (err)
		goto sfp_out;
7616

7617 7618 7619
	/* exit if reset not needed */
	if (!(adapter->flags2 & IXGBE_FLAG2_SFP_NEEDS_RESET))
		goto sfp_out;
7620

7621
	adapter->flags2 &= ~IXGBE_FLAG2_SFP_NEEDS_RESET;
7622

7623 7624 7625 7626 7627 7628 7629 7630 7631 7632 7633 7634 7635 7636 7637 7638 7639 7640 7641 7642 7643 7644 7645 7646 7647 7648
	/*
	 * 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);
7649
	}
7650
}
7651

7652 7653
/**
 * ixgbe_sfp_link_config_subtask - set up link SFP after module install
7654
 * @adapter: the ixgbe adapter structure
7655 7656 7657 7658
 **/
static void ixgbe_sfp_link_config_subtask(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
7659
	u32 cap_speed;
J
Josh Hay 已提交
7660 7661
	u32 speed;
	bool autoneg = false;
7662 7663 7664 7665 7666 7667 7668 7669 7670 7671

	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;

7672
	hw->mac.ops.get_link_capabilities(hw, &cap_speed, &autoneg);
7673

7674 7675 7676 7677 7678 7679
	/* advertise highest capable link speed */
	if (!autoneg && (cap_speed & IXGBE_LINK_SPEED_10GB_FULL))
		speed = IXGBE_LINK_SPEED_10GB_FULL;
	else
		speed = cap_speed & (IXGBE_LINK_SPEED_10GB_FULL |
				     IXGBE_LINK_SPEED_1GB_FULL);
7680

7681
	if (hw->mac.ops.setup_link)
J
Josh Hay 已提交
7682
		hw->mac.ops.setup_link(hw, speed, true);
7683 7684 7685 7686 7687 7688 7689 7690 7691 7692

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

/**
 * ixgbe_service_timer - Timer Call-back
 * @data: pointer to adapter cast into an unsigned long
 **/
7693
static void ixgbe_service_timer(struct timer_list *t)
7694
{
7695
	struct ixgbe_adapter *adapter = from_timer(adapter, t, service_timer);
7696 7697
	unsigned long next_event_offset;

7698 7699 7700 7701 7702
	/* 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;
7703

7704 7705 7706
	/* Reset the timer */
	mod_timer(&adapter->service_timer, next_event_offset + jiffies);

7707
	ixgbe_service_event_schedule(adapter);
7708 7709
}

7710 7711 7712 7713 7714 7715 7716 7717 7718 7719 7720 7721 7722 7723 7724 7725 7726 7727 7728 7729
static void ixgbe_phy_interrupt_subtask(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 status;

	if (!(adapter->flags2 & IXGBE_FLAG2_PHY_INTERRUPT))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_PHY_INTERRUPT;

	if (!hw->phy.ops.handle_lasi)
		return;

	status = hw->phy.ops.handle_lasi(&adapter->hw);
	if (status != IXGBE_ERR_OVERTEMP)
		return;

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

7730 7731
static void ixgbe_reset_subtask(struct ixgbe_adapter *adapter)
{
7732
	if (!test_and_clear_bit(__IXGBE_RESET_REQUESTED, &adapter->state))
7733 7734
		return;

7735
	/* If we're already down, removing or resetting, just bail */
7736
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
7737
	    test_bit(__IXGBE_REMOVING, &adapter->state) ||
7738 7739 7740 7741 7742 7743 7744
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;

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

7745
	rtnl_lock();
7746
	ixgbe_reinit_locked(adapter);
7747
	rtnl_unlock();
7748 7749
}

7750 7751 7752 7753 7754 7755 7756 7757 7758
/**
 * 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);
7759 7760 7761 7762 7763 7764 7765 7766 7767
	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;
	}
7768
	if (adapter->flags2 & IXGBE_FLAG2_UDP_TUN_REREG_NEEDED) {
7769
		rtnl_lock();
7770
		adapter->flags2 &= ~IXGBE_FLAG2_UDP_TUN_REREG_NEEDED;
7771 7772
		udp_tunnel_get_rx_info(adapter->netdev);
		rtnl_unlock();
7773
	}
7774
	ixgbe_reset_subtask(adapter);
7775
	ixgbe_phy_interrupt_subtask(adapter);
7776 7777
	ixgbe_sfp_detection_subtask(adapter);
	ixgbe_sfp_link_config_subtask(adapter);
7778
	ixgbe_check_overtemp_subtask(adapter);
7779
	ixgbe_watchdog_subtask(adapter);
7780
	ixgbe_fdir_reinit_subtask(adapter);
7781
	ixgbe_check_hang_subtask(adapter);
7782

7783
	if (test_bit(__IXGBE_PTP_RUNNING, &adapter->state)) {
7784 7785
		ixgbe_ptp_overflow_check(adapter);
		ixgbe_ptp_rx_hang(adapter);
7786
		ixgbe_ptp_tx_hang(adapter);
7787
	}
7788 7789

	ixgbe_service_event_complete(adapter);
7790 7791
}

7792 7793
static int ixgbe_tso(struct ixgbe_ring *tx_ring,
		     struct ixgbe_tx_buffer *first,
7794
		     u8 *hdr_len)
7795
{
7796
	u32 vlan_macip_lens, type_tucmd, mss_l4len_idx;
7797
	struct sk_buff *skb = first->skb;
7798 7799 7800 7801 7802 7803 7804 7805 7806 7807
	union {
		struct iphdr *v4;
		struct ipv6hdr *v6;
		unsigned char *hdr;
	} ip;
	union {
		struct tcphdr *tcp;
		unsigned char *hdr;
	} l4;
	u32 paylen, l4_offset;
7808
	int err;
7809

7810 7811 7812
	if (skb->ip_summed != CHECKSUM_PARTIAL)
		return 0;

7813 7814
	if (!skb_is_gso(skb))
		return 0;
7815

7816 7817 7818
	err = skb_cow_head(skb, 0);
	if (err < 0)
		return err;
7819

7820 7821 7822 7823
	if (eth_p_mpls(first->protocol))
		ip.hdr = skb_inner_network_header(skb);
	else
		ip.hdr = skb_network_header(skb);
7824 7825
	l4.hdr = skb_checksum_start(skb);

7826 7827 7828
	/* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
	type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;

7829 7830
	/* initialize outer IP header fields */
	if (ip.v4->version == 4) {
7831 7832 7833
		unsigned char *csum_start = skb_checksum_start(skb);
		unsigned char *trans_start = ip.hdr + (ip.v4->ihl * 4);

7834 7835 7836
		/* IP header will have to cancel out any data that
		 * is not a part of the outer IP header
		 */
7837 7838 7839
		ip.v4->check = csum_fold(csum_partial(trans_start,
						      csum_start - trans_start,
						      0));
7840
		type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
7841 7842

		ip.v4->tot_len = 0;
7843 7844 7845
		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
				   IXGBE_TX_FLAGS_CSUM |
				   IXGBE_TX_FLAGS_IPV4;
7846 7847
	} else {
		ip.v6->payload_len = 0;
7848 7849
		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
				   IXGBE_TX_FLAGS_CSUM;
7850 7851
	}

7852 7853 7854 7855 7856 7857 7858 7859 7860
	/* determine offset of inner transport header */
	l4_offset = l4.hdr - skb->data;

	/* compute length of segmentation header */
	*hdr_len = (l4.tcp->doff * 4) + l4_offset;

	/* remove payload length from inner checksum */
	paylen = skb->len - l4_offset;
	csum_replace_by_diff(&l4.tcp->check, htonl(paylen));
7861

7862 7863 7864 7865
	/* update gso size and bytecount with header size */
	first->gso_segs = skb_shinfo(skb)->gso_segs;
	first->bytecount += (first->gso_segs - 1) * *hdr_len;

7866
	/* mss_l4len_id: use 0 as index for TSO */
7867
	mss_l4len_idx = (*hdr_len - l4_offset) << IXGBE_ADVTXD_L4LEN_SHIFT;
7868 7869 7870
	mss_l4len_idx |= skb_shinfo(skb)->gso_size << IXGBE_ADVTXD_MSS_SHIFT;

	/* vlan_macip_lens: HEADLEN, MACLEN, VLAN tag */
7871 7872
	vlan_macip_lens = l4.hdr - ip.hdr;
	vlan_macip_lens |= (ip.hdr - skb->data) << IXGBE_ADVTXD_MACLEN_SHIFT;
7873
	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
7874 7875

	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, 0, type_tucmd,
7876
			  mss_l4len_idx);
7877 7878 7879 7880

	return 1;
}

7881 7882 7883 7884 7885 7886 7887 7888 7889
static inline bool ixgbe_ipv6_csum_is_sctp(struct sk_buff *skb)
{
	unsigned int offset = 0;

	ipv6_find_hdr(skb, &offset, IPPROTO_SCTP, NULL, NULL);

	return offset == skb_checksum_start_offset(skb);
}

7890 7891
static void ixgbe_tx_csum(struct ixgbe_ring *tx_ring,
			  struct ixgbe_tx_buffer *first)
7892
{
7893
	struct sk_buff *skb = first->skb;
7894 7895
	u32 vlan_macip_lens = 0;
	u32 type_tucmd = 0;
7896

7897
	if (skb->ip_summed != CHECKSUM_PARTIAL) {
7898 7899 7900
csum_failed:
		if (!(first->tx_flags & (IXGBE_TX_FLAGS_HW_VLAN |
					 IXGBE_TX_FLAGS_CC)))
7901
			return;
7902 7903
		goto no_csum;
	}
7904

7905 7906 7907 7908 7909 7910 7911 7912 7913 7914 7915 7916 7917
	switch (skb->csum_offset) {
	case offsetof(struct tcphdr, check):
		type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;
		/* fall through */
	case offsetof(struct udphdr, check):
		break;
	case offsetof(struct sctphdr, checksum):
		/* validate that this is actually an SCTP request */
		if (((first->protocol == htons(ETH_P_IP)) &&
		     (ip_hdr(skb)->protocol == IPPROTO_SCTP)) ||
		    ((first->protocol == htons(ETH_P_IPV6)) &&
		     ixgbe_ipv6_csum_is_sctp(skb))) {
			type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_SCTP;
7918
			break;
7919
		}
7920 7921 7922 7923
		/* fall through */
	default:
		skb_checksum_help(skb);
		goto csum_failed;
7924 7925
	}

7926 7927 7928 7929
	/* update TX checksum flag */
	first->tx_flags |= IXGBE_TX_FLAGS_CSUM;
	vlan_macip_lens = skb_checksum_start_offset(skb) -
			  skb_network_offset(skb);
7930
no_csum:
7931
	/* vlan_macip_lens: MACLEN, VLAN tag */
7932
	vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
7933
	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
7934

7935
	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, 0, type_tucmd, 0);
7936 7937
}

7938 7939 7940 7941 7942 7943
#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)
7944
{
7945
	/* set type for advanced descriptor with frame checksum insertion */
7946 7947 7948
	u32 cmd_type = IXGBE_ADVTXD_DTYP_DATA |
		       IXGBE_ADVTXD_DCMD_DEXT |
		       IXGBE_ADVTXD_DCMD_IFCS;
7949

7950
	/* set HW vlan bit if vlan is present */
7951 7952
	cmd_type |= IXGBE_SET_FLAG(tx_flags, IXGBE_TX_FLAGS_HW_VLAN,
				   IXGBE_ADVTXD_DCMD_VLE);
7953

7954
	/* set segmentation enable bits for TSO/FSO */
7955 7956 7957 7958 7959 7960
	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);
7961

7962
	/* insert frame checksum */
7963
	cmd_type ^= IXGBE_SET_FLAG(skb->no_fcs, 1, IXGBE_ADVTXD_DCMD_IFCS);
7964

7965 7966
	return cmd_type;
}
7967

7968 7969
static void ixgbe_tx_olinfo_status(union ixgbe_adv_tx_desc *tx_desc,
				   u32 tx_flags, unsigned int paylen)
7970
{
7971
	u32 olinfo_status = paylen << IXGBE_ADVTXD_PAYLEN_SHIFT;
7972

7973
	/* enable L4 checksum for TSO and TX checksum offload */
7974 7975 7976
	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
					IXGBE_TX_FLAGS_CSUM,
					IXGBE_ADVTXD_POPTS_TXSM);
7977

7978
	/* enble IPv4 checksum for TSO */
7979 7980 7981
	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
					IXGBE_TX_FLAGS_IPV4,
					IXGBE_ADVTXD_POPTS_IXSM);
7982

7983 7984 7985 7986
	/*
	 * Check Context must be set if Tx switch is enabled, which it
	 * always is for case where virtual functions are running
	 */
7987 7988 7989
	olinfo_status |= IXGBE_SET_FLAG(tx_flags,
					IXGBE_TX_FLAGS_CC,
					IXGBE_ADVTXD_CC);
7990

7991
	tx_desc->read.olinfo_status = cpu_to_le32(olinfo_status);
7992
}
7993

7994 7995 7996 7997 7998 7999 8000 8001 8002 8003 8004 8005 8006 8007 8008 8009 8010 8011 8012 8013 8014 8015 8016 8017 8018 8019 8020 8021 8022 8023
static int __ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
{
	netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);

	/* Herbert's original patch had:
	 *  smp_mb__after_netif_stop_queue();
	 * but since that doesn't exist yet, just open code it.
	 */
	smp_mb();

	/* We need to check again in a case another CPU has just
	 * made room available.
	 */
	if (likely(ixgbe_desc_unused(tx_ring) < size))
		return -EBUSY;

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

static inline int ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
{
	if (likely(ixgbe_desc_unused(tx_ring) >= size))
		return 0;

	return __ixgbe_maybe_stop_tx(tx_ring, size);
}

8024 8025 8026
#define IXGBE_TXD_CMD (IXGBE_TXD_CMD_EOP | \
		       IXGBE_TXD_CMD_RS)

8027 8028 8029
static int ixgbe_tx_map(struct ixgbe_ring *tx_ring,
			struct ixgbe_tx_buffer *first,
			const u8 hdr_len)
8030
{
8031
	struct sk_buff *skb = first->skb;
8032
	struct ixgbe_tx_buffer *tx_buffer;
8033
	union ixgbe_adv_tx_desc *tx_desc;
8034 8035 8036
	struct skb_frag_struct *frag;
	dma_addr_t dma;
	unsigned int data_len, size;
8037
	u32 tx_flags = first->tx_flags;
8038
	u32 cmd_type = ixgbe_tx_cmd_type(skb, tx_flags);
8039 8040
	u16 i = tx_ring->next_to_use;

8041 8042
	tx_desc = IXGBE_TX_DESC(tx_ring, i);

8043 8044 8045 8046
	ixgbe_tx_olinfo_status(tx_desc, tx_flags, skb->len - hdr_len);

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

8048 8049
#ifdef IXGBE_FCOE
	if (tx_flags & IXGBE_TX_FLAGS_FCOE) {
8050
		if (data_len < sizeof(struct fcoe_crc_eof)) {
8051 8052
			size -= sizeof(struct fcoe_crc_eof) - data_len;
			data_len = 0;
8053 8054
		} else {
			data_len -= sizeof(struct fcoe_crc_eof);
8055 8056
		}
	}
8057

8058
#endif
8059
	dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
8060

8061
	tx_buffer = first;
8062

8063 8064 8065 8066 8067 8068 8069 8070 8071
	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);
8072

8073
		while (unlikely(size > IXGBE_MAX_DATA_PER_TXD)) {
8074
			tx_desc->read.cmd_type_len =
8075
				cpu_to_le32(cmd_type ^ IXGBE_MAX_DATA_PER_TXD);
8076

8077
			i++;
8078
			tx_desc++;
8079
			if (i == tx_ring->count) {
8080
				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
8081 8082
				i = 0;
			}
8083
			tx_desc->read.olinfo_status = 0;
8084 8085 8086 8087 8088

			dma += IXGBE_MAX_DATA_PER_TXD;
			size -= IXGBE_MAX_DATA_PER_TXD;

			tx_desc->read.buffer_addr = cpu_to_le64(dma);
8089
		}
8090

8091 8092
		if (likely(!data_len))
			break;
8093

8094
		tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type ^ size);
8095

8096 8097 8098 8099 8100 8101
		i++;
		tx_desc++;
		if (i == tx_ring->count) {
			tx_desc = IXGBE_TX_DESC(tx_ring, 0);
			i = 0;
		}
8102
		tx_desc->read.olinfo_status = 0;
8103

8104
#ifdef IXGBE_FCOE
E
Eric Dumazet 已提交
8105
		size = min_t(unsigned int, data_len, skb_frag_size(frag));
8106
#else
E
Eric Dumazet 已提交
8107
		size = skb_frag_size(frag);
8108 8109
#endif
		data_len -= size;
8110

8111 8112
		dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
				       DMA_TO_DEVICE);
8113

8114 8115
		tx_buffer = &tx_ring->tx_buffer_info[i];
	}
8116

8117
	/* write last descriptor with RS and EOP bits */
8118 8119
	cmd_type |= size | IXGBE_TXD_CMD;
	tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type);
8120

8121
	netdev_tx_sent_queue(txring_txq(tx_ring), first->bytecount);
8122

8123 8124
	/* set the timestamp */
	first->time_stamp = jiffies;
8125 8126

	/*
8127 8128 8129 8130 8131 8132
	 * 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.
8133 8134 8135
	 */
	wmb();

8136 8137 8138
	/* set next_to_watch value indicating a packet is present */
	first->next_to_watch = tx_desc;

8139 8140 8141 8142 8143 8144
	i++;
	if (i == tx_ring->count)
		i = 0;

	tx_ring->next_to_use = i;

8145 8146 8147
	ixgbe_maybe_stop_tx(tx_ring, DESC_NEEDED);

	if (netif_xmit_stopped(txring_txq(tx_ring)) || !skb->xmit_more) {
8148 8149 8150 8151 8152 8153
		writel(i, tx_ring->tail);

		/* we need this if more than one processor can write to our tail
		 * at a time, it synchronizes IO on IA64/Altix systems
		 */
		mmiowb();
8154
	}
8155

8156
	return 0;
8157
dma_error:
8158
	dev_err(tx_ring->dev, "TX DMA map failed\n");
8159 8160

	/* clear dma mappings for failed tx_buffer_info map */
A
Alexander Duyck 已提交
8161 8162
	for (;;) {
		tx_buffer = &tx_ring->tx_buffer_info[i];
8163 8164 8165 8166 8167 8168
		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);
A
Alexander Duyck 已提交
8169 8170 8171
		if (tx_buffer == first)
			break;
		if (i == 0)
8172
			i += tx_ring->count;
A
Alexander Duyck 已提交
8173
		i--;
8174 8175
	}

8176 8177 8178
	dev_kfree_skb_any(first->skb);
	first->skb = NULL;

8179
	tx_ring->next_to_use = i;
8180 8181

	return -1;
8182 8183
}

8184
static void ixgbe_atr(struct ixgbe_ring *ring,
8185
		      struct ixgbe_tx_buffer *first)
8186 8187 8188 8189 8190 8191 8192 8193 8194
{
	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;
8195
	struct tcphdr *th;
8196
	unsigned int hlen;
8197
	struct sk_buff *skb;
8198
	__be16 vlan_id;
8199
	int l4_proto;
8200

8201 8202 8203 8204 8205 8206
	/* 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)
8207
		return;
8208

8209
	ring->atr_count++;
8210

8211 8212 8213 8214 8215
	/* currently only IPv4/IPv6 with TCP is supported */
	if ((first->protocol != htons(ETH_P_IP)) &&
	    (first->protocol != htons(ETH_P_IPV6)))
		return;

8216
	/* snag network header to get L4 type and address */
8217 8218
	skb = first->skb;
	hdr.network = skb_network_header(skb);
8219 8220
	if (unlikely(hdr.network <= skb->data))
		return;
8221 8222
	if (skb->encapsulation &&
	    first->protocol == htons(ETH_P_IP) &&
8223
	    hdr.ipv4->protocol == IPPROTO_UDP) {
8224
		struct ixgbe_adapter *adapter = q_vector->adapter;
8225

8226 8227 8228 8229
		if (unlikely(skb_tail_pointer(skb) < hdr.network +
			     VXLAN_HEADROOM))
			return;

8230 8231
		/* verify the port is recognized as VXLAN */
		if (adapter->vxlan_port &&
8232
		    udp_hdr(skb)->dest == adapter->vxlan_port)
8233
			hdr.network = skb_inner_network_header(skb);
8234 8235 8236 8237

		if (adapter->geneve_port &&
		    udp_hdr(skb)->dest == adapter->geneve_port)
			hdr.network = skb_inner_network_header(skb);
8238 8239
	}

8240 8241 8242 8243 8244 8245
	/* Make sure we have at least [minimum IPv4 header + TCP]
	 * or [IPv6 header] bytes
	 */
	if (unlikely(skb_tail_pointer(skb) < hdr.network + 40))
		return;

8246 8247 8248
	/* Currently only IPv4/IPv6 with TCP is supported */
	switch (hdr.ipv4->version) {
	case IPVERSION:
8249 8250 8251
		/* access ihl as u8 to avoid unaligned access on ia64 */
		hlen = (hdr.network[0] & 0x0F) << 2;
		l4_proto = hdr.ipv4->protocol;
8252 8253
		break;
	case 6:
8254 8255 8256
		hlen = hdr.network - skb->data;
		l4_proto = ipv6_find_hdr(skb, &hlen, IPPROTO_TCP, NULL, NULL);
		hlen -= hdr.network - skb->data;
8257 8258 8259
		break;
	default:
		return;
8260
	}
8261

8262 8263 8264
	if (l4_proto != IPPROTO_TCP)
		return;

8265 8266 8267 8268
	if (unlikely(skb_tail_pointer(skb) < hdr.network +
		     hlen + sizeof(struct tcphdr)))
		return;

8269 8270 8271 8272
	th = (struct tcphdr *)(hdr.network + hlen);

	/* skip this packet since the socket is closing */
	if (th->fin)
8273 8274 8275 8276 8277 8278 8279 8280 8281
		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;

8282
	vlan_id = htons(first->tx_flags >> IXGBE_TX_FLAGS_VLAN_SHIFT);
8283 8284 8285 8286 8287 8288 8289 8290 8291 8292 8293 8294 8295 8296

	/*
	 * 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
	 */
8297
	if (first->tx_flags & (IXGBE_TX_FLAGS_SW_VLAN | IXGBE_TX_FLAGS_HW_VLAN))
8298
		common.port.src ^= th->dest ^ htons(ETH_P_8021Q);
8299
	else
8300
		common.port.src ^= th->dest ^ first->protocol;
8301 8302
	common.port.dst ^= th->source;

8303 8304
	switch (hdr.ipv4->version) {
	case IPVERSION:
8305 8306
		input.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_TCPV4;
		common.ip ^= hdr.ipv4->saddr ^ hdr.ipv4->daddr;
8307 8308
		break;
	case 6:
8309 8310 8311 8312 8313 8314 8315 8316 8317
		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];
8318 8319 8320
		break;
	default:
		break;
8321
	}
8322

8323
	if (hdr.network != skb_network_header(skb))
8324 8325
		input.formatted.flow_type |= IXGBE_ATR_L4TYPE_TUNNEL_MASK;

8326
	/* This assumes the Rx queue and Tx queue are bound to the same CPU */
8327 8328
	ixgbe_fdir_add_signature_filter_82599(&q_vector->adapter->hw,
					      input, common, ring->queue_index);
8329 8330
}

8331
static u16 ixgbe_select_queue(struct net_device *dev, struct sk_buff *skb,
8332
			      void *accel_priv, select_queue_fallback_t fallback)
8333
{
8334 8335
	struct ixgbe_fwd_adapter *fwd_adapter = accel_priv;
#ifdef IXGBE_FCOE
8336 8337 8338
	struct ixgbe_adapter *adapter;
	struct ixgbe_ring_feature *f;
	int txq;
8339 8340 8341 8342 8343 8344
#endif

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

#ifdef IXGBE_FCOE
8345

8346 8347 8348 8349 8350
	/*
	 * only execute the code below if protocol is FCoE
	 * or FIP and we have FCoE enabled on the adapter
	 */
	switch (vlan_get_protocol(skb)) {
8351 8352
	case htons(ETH_P_FCOE):
	case htons(ETH_P_FIP):
8353
		adapter = netdev_priv(dev);
8354

8355 8356
		if (adapter->flags & IXGBE_FLAG_FCOE_ENABLED)
			break;
8357
		/* fall through */
8358
	default:
8359
		return fallback(dev, skb);
8360
	}
8361

8362
	f = &adapter->ring_feature[RING_F_FCOE];
8363

8364 8365
	txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) :
					   smp_processor_id();
8366

8367 8368
	while (txq >= f->indices)
		txq -= f->indices;
8369

8370
	return txq + f->offset;
8371
#else
8372
	return fallback(dev, skb);
8373
#endif
8374 8375
}

8376 8377 8378 8379 8380 8381 8382 8383 8384 8385 8386 8387 8388 8389 8390 8391 8392 8393 8394 8395 8396 8397 8398 8399 8400 8401 8402 8403 8404 8405 8406 8407 8408 8409 8410 8411 8412 8413 8414 8415 8416 8417
static int ixgbe_xmit_xdp_ring(struct ixgbe_adapter *adapter,
			       struct xdp_buff *xdp)
{
	struct ixgbe_ring *ring = adapter->xdp_ring[smp_processor_id()];
	struct ixgbe_tx_buffer *tx_buffer;
	union ixgbe_adv_tx_desc *tx_desc;
	u32 len, cmd_type;
	dma_addr_t dma;
	u16 i;

	len = xdp->data_end - xdp->data;

	if (unlikely(!ixgbe_desc_unused(ring)))
		return IXGBE_XDP_CONSUMED;

	dma = dma_map_single(ring->dev, xdp->data, len, DMA_TO_DEVICE);
	if (dma_mapping_error(ring->dev, dma))
		return IXGBE_XDP_CONSUMED;

	/* record the location of the first descriptor for this packet */
	tx_buffer = &ring->tx_buffer_info[ring->next_to_use];
	tx_buffer->bytecount = len;
	tx_buffer->gso_segs = 1;
	tx_buffer->protocol = 0;

	i = ring->next_to_use;
	tx_desc = IXGBE_TX_DESC(ring, i);

	dma_unmap_len_set(tx_buffer, len, len);
	dma_unmap_addr_set(tx_buffer, dma, dma);
	tx_buffer->data = xdp->data;
	tx_desc->read.buffer_addr = cpu_to_le64(dma);

	/* put descriptor type bits */
	cmd_type = IXGBE_ADVTXD_DTYP_DATA |
		   IXGBE_ADVTXD_DCMD_DEXT |
		   IXGBE_ADVTXD_DCMD_IFCS;
	cmd_type |= len | IXGBE_TXD_CMD;
	tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type);
	tx_desc->read.olinfo_status =
		cpu_to_le32(len << IXGBE_ADVTXD_PAYLEN_SHIFT);

8418 8419
	/* Avoid any potential race with xdp_xmit and cleanup */
	smp_wmb();
8420 8421 8422 8423 8424 8425 8426 8427 8428 8429 8430 8431

	/* set next_to_watch value indicating a packet is present */
	i++;
	if (i == ring->count)
		i = 0;

	tx_buffer->next_to_watch = tx_desc;
	ring->next_to_use = i;

	return IXGBE_XDP_TX;
}

8432
netdev_tx_t ixgbe_xmit_frame_ring(struct sk_buff *skb,
8433 8434
			  struct ixgbe_adapter *adapter,
			  struct ixgbe_ring *tx_ring)
8435
{
8436
	struct ixgbe_tx_buffer *first;
8437
	int tso;
8438
	u32 tx_flags = 0;
8439 8440
	unsigned short f;
	u16 count = TXD_USE_COUNT(skb_headlen(skb));
8441
	__be16 protocol = skb->protocol;
8442
	u8 hdr_len = 0;
8443

8444 8445
	/*
	 * need: 1 descriptor per page * PAGE_SIZE/IXGBE_MAX_DATA_PER_TXD,
8446
	 *       + 1 desc for skb_headlen/IXGBE_MAX_DATA_PER_TXD,
8447 8448 8449 8450 8451 8452
	 *       + 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);
8453

8454 8455 8456 8457 8458
	if (ixgbe_maybe_stop_tx(tx_ring, count + 3)) {
		tx_ring->tx_stats.tx_busy++;
		return NETDEV_TX_BUSY;
	}

8459 8460 8461
	/* record the location of the first descriptor for this packet */
	first = &tx_ring->tx_buffer_info[tx_ring->next_to_use];
	first->skb = skb;
8462 8463
	first->bytecount = skb->len;
	first->gso_segs = 1;
8464

8465
	/* if we have a HW VLAN tag being added default to the HW one */
8466 8467
	if (skb_vlan_tag_present(skb)) {
		tx_flags |= skb_vlan_tag_get(skb) << IXGBE_TX_FLAGS_VLAN_SHIFT;
8468 8469
		tx_flags |= IXGBE_TX_FLAGS_HW_VLAN;
	/* else if it is a SW VLAN check the next protocol and store the tag */
8470
	} else if (protocol == htons(ETH_P_8021Q)) {
8471 8472 8473 8474 8475
		struct vlan_hdr *vhdr, _vhdr;
		vhdr = skb_header_pointer(skb, ETH_HLEN, sizeof(_vhdr), &_vhdr);
		if (!vhdr)
			goto out_drop;

8476 8477
		tx_flags |= ntohs(vhdr->h_vlan_TCI) <<
				  IXGBE_TX_FLAGS_VLAN_SHIFT;
8478 8479
		tx_flags |= IXGBE_TX_FLAGS_SW_VLAN;
	}
8480
	protocol = vlan_get_protocol(skb);
8481

8482
	if (unlikely(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP) &&
8483 8484 8485 8486 8487 8488 8489 8490 8491 8492 8493 8494 8495
	    adapter->ptp_clock) {
		if (!test_and_set_bit_lock(__IXGBE_PTP_TX_IN_PROGRESS,
					   &adapter->state)) {
			skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
			tx_flags |= IXGBE_TX_FLAGS_TSTAMP;

			/* schedule check for Tx timestamp */
			adapter->ptp_tx_skb = skb_get(skb);
			adapter->ptp_tx_start = jiffies;
			schedule_work(&adapter->ptp_tx_work);
		} else {
			adapter->tx_hwtstamp_skipped++;
		}
8496 8497
	}

8498 8499
	skb_tx_timestamp(skb);

8500 8501 8502 8503 8504 8505
#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)
8506
		tx_flags |= IXGBE_TX_FLAGS_CC;
8507 8508

#endif
8509
	/* DCB maps skb priorities 0-7 onto 3 bit PCP of VLAN tag. */
8510
	if ((adapter->flags & IXGBE_FLAG_DCB_ENABLED) &&
8511 8512
	    ((tx_flags & (IXGBE_TX_FLAGS_HW_VLAN | IXGBE_TX_FLAGS_SW_VLAN)) ||
	     (skb->priority != TC_PRIO_CONTROL))) {
8513
		tx_flags &= ~IXGBE_TX_FLAGS_VLAN_PRIO_MASK;
8514 8515
		tx_flags |= (skb->priority & 0x7) <<
					IXGBE_TX_FLAGS_VLAN_PRIO_SHIFT;
8516 8517
		if (tx_flags & IXGBE_TX_FLAGS_SW_VLAN) {
			struct vlan_ethhdr *vhdr;
8518 8519

			if (skb_cow_head(skb, 0))
8520 8521 8522 8523 8524 8525
				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;
8526
		}
8527
	}
8528

8529 8530 8531 8532
	/* record initial flags and protocol */
	first->tx_flags = tx_flags;
	first->protocol = protocol;

8533
#ifdef IXGBE_FCOE
8534
	/* setup tx offload for FCoE */
8535
	if ((protocol == htons(ETH_P_FCOE)) &&
8536
	    (tx_ring->netdev->features & (NETIF_F_FSO | NETIF_F_FCOE_CRC))) {
8537
		tso = ixgbe_fso(tx_ring, first, &hdr_len);
8538 8539
		if (tso < 0)
			goto out_drop;
8540

8541
		goto xmit_fcoe;
8542
	}
8543

8544
#endif /* IXGBE_FCOE */
8545
	tso = ixgbe_tso(tx_ring, first, &hdr_len);
8546
	if (tso < 0)
8547
		goto out_drop;
8548 8549
	else if (!tso)
		ixgbe_tx_csum(tx_ring, first);
8550 8551 8552

	/* add the ATR filter if ATR is on */
	if (test_bit(__IXGBE_TX_FDIR_INIT_DONE, &tx_ring->state))
8553
		ixgbe_atr(tx_ring, first);
8554 8555 8556 8557

#ifdef IXGBE_FCOE
xmit_fcoe:
#endif /* IXGBE_FCOE */
8558 8559
	if (ixgbe_tx_map(tx_ring, first, hdr_len))
		goto cleanup_tx_timestamp;
8560

8561
	return NETDEV_TX_OK;
8562 8563

out_drop:
8564 8565
	dev_kfree_skb_any(first->skb);
	first->skb = NULL;
8566 8567 8568 8569 8570 8571 8572
cleanup_tx_timestamp:
	if (unlikely(tx_flags & IXGBE_TX_FLAGS_TSTAMP)) {
		dev_kfree_skb_any(adapter->ptp_tx_skb);
		adapter->ptp_tx_skb = NULL;
		cancel_work_sync(&adapter->ptp_tx_work);
		clear_bit_unlock(__IXGBE_PTP_TX_IN_PROGRESS, &adapter->state);
	}
8573

8574
	return NETDEV_TX_OK;
8575 8576
}

8577 8578 8579
static netdev_tx_t __ixgbe_xmit_frame(struct sk_buff *skb,
				      struct net_device *netdev,
				      struct ixgbe_ring *ring)
8580 8581 8582 8583
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_ring *tx_ring;

8584 8585 8586 8587
	/*
	 * The minimum packet size for olinfo paylen is 17 so pad the skb
	 * in order to meet this minimum size requirement.
	 */
8588 8589
	if (skb_put_padto(skb, 17))
		return NETDEV_TX_OK;
8590

8591 8592
	tx_ring = ring ? ring : adapter->tx_ring[skb->queue_mapping];

8593
	return ixgbe_xmit_frame_ring(skb, adapter, tx_ring);
8594 8595
}

8596 8597 8598 8599 8600 8601
static netdev_tx_t ixgbe_xmit_frame(struct sk_buff *skb,
				    struct net_device *netdev)
{
	return __ixgbe_xmit_frame(skb, netdev, NULL);
}

8602 8603 8604 8605 8606 8607 8608 8609 8610 8611
/**
 * 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);
8612
	struct ixgbe_hw *hw = &adapter->hw;
8613 8614 8615 8616 8617 8618
	struct sockaddr *addr = p;

	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
8619
	memcpy(hw->mac.addr, addr->sa_data, netdev->addr_len);
8620

8621 8622 8623
	ixgbe_mac_set_default_filter(adapter);

	return 0;
8624 8625
}

8626 8627 8628 8629 8630 8631 8632 8633 8634 8635 8636 8637 8638 8639 8640 8641 8642 8643 8644 8645 8646 8647 8648 8649 8650 8651 8652 8653 8654 8655 8656
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);

8657 8658
	switch (cmd) {
	case SIOCSHWTSTAMP:
8659 8660 8661
		return ixgbe_ptp_set_ts_config(adapter, req);
	case SIOCGHWTSTAMP:
		return ixgbe_ptp_get_ts_config(adapter, req);
8662 8663 8664 8665
	case SIOCGMIIPHY:
		if (!adapter->hw.phy.ops.read_reg)
			return -EOPNOTSUPP;
		/* fall through */
8666 8667 8668
	default:
		return mdio_mii_ioctl(&adapter->hw.phy.mdio, if_mii(req), cmd);
	}
8669 8670
}

8671 8672
/**
 * ixgbe_add_sanmac_netdev - Add the SAN MAC address to the corresponding
8673
 * netdev->dev_addrs
8674 8675 8676 8677 8678 8679 8680 8681
 * @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);
8682
	struct ixgbe_hw *hw = &adapter->hw;
8683

8684
	if (is_valid_ether_addr(hw->mac.san_addr)) {
8685
		rtnl_lock();
8686
		err = dev_addr_add(dev, hw->mac.san_addr, NETDEV_HW_ADDR_T_SAN);
8687
		rtnl_unlock();
8688 8689 8690

		/* update SAN MAC vmdq pool selection */
		hw->mac.ops.set_vmdq_san_mac(hw, VMDQ_P(0));
8691 8692 8693 8694 8695 8696
	}
	return err;
}

/**
 * ixgbe_del_sanmac_netdev - Removes the SAN MAC address to the corresponding
8697
 * netdev->dev_addrs
8698 8699 8700 8701 8702 8703 8704 8705 8706 8707 8708 8709 8710 8711 8712 8713 8714 8715
 * @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;
}

8716 8717 8718 8719 8720 8721 8722 8723 8724
#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);
8725
	int i;
8726

8727 8728 8729 8730
	/* if interface is down do nothing */
	if (test_bit(__IXGBE_DOWN, &adapter->state))
		return;

8731 8732 8733
	/* loop through and schedule all active queues */
	for (i = 0; i < adapter->num_q_vectors; i++)
		ixgbe_msix_clean_rings(0, adapter->q_vector[i]);
8734 8735
}

A
Alexander Duyck 已提交
8736
#endif
8737

8738 8739 8740 8741 8742 8743 8744 8745 8746 8747 8748 8749 8750 8751 8752 8753 8754
static void ixgbe_get_ring_stats64(struct rtnl_link_stats64 *stats,
				   struct ixgbe_ring *ring)
{
	u64 bytes, packets;
	unsigned int start;

	if (ring) {
		do {
			start = u64_stats_fetch_begin_irq(&ring->syncp);
			packets = ring->stats.packets;
			bytes   = ring->stats.bytes;
		} while (u64_stats_fetch_retry_irq(&ring->syncp, start));
		stats->tx_packets += packets;
		stats->tx_bytes   += bytes;
	}
}

8755 8756
static void ixgbe_get_stats64(struct net_device *netdev,
			      struct rtnl_link_stats64 *stats)
E
Eric Dumazet 已提交
8757 8758 8759 8760
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	int i;

E
Eric Dumazet 已提交
8761
	rcu_read_lock();
E
Eric Dumazet 已提交
8762
	for (i = 0; i < adapter->num_rx_queues; i++) {
8763
		struct ixgbe_ring *ring = READ_ONCE(adapter->rx_ring[i]);
E
Eric Dumazet 已提交
8764 8765 8766
		u64 bytes, packets;
		unsigned int start;

E
Eric Dumazet 已提交
8767 8768
		if (ring) {
			do {
8769
				start = u64_stats_fetch_begin_irq(&ring->syncp);
E
Eric Dumazet 已提交
8770 8771
				packets = ring->stats.packets;
				bytes   = ring->stats.bytes;
8772
			} while (u64_stats_fetch_retry_irq(&ring->syncp, start));
E
Eric Dumazet 已提交
8773 8774 8775
			stats->rx_packets += packets;
			stats->rx_bytes   += bytes;
		}
E
Eric Dumazet 已提交
8776
	}
E
Eric Dumazet 已提交
8777 8778

	for (i = 0; i < adapter->num_tx_queues; i++) {
8779
		struct ixgbe_ring *ring = READ_ONCE(adapter->tx_ring[i]);
E
Eric Dumazet 已提交
8780

8781 8782 8783
		ixgbe_get_ring_stats64(stats, ring);
	}
	for (i = 0; i < adapter->num_xdp_queues; i++) {
8784
		struct ixgbe_ring *ring = READ_ONCE(adapter->xdp_ring[i]);
8785 8786

		ixgbe_get_ring_stats64(stats, ring);
E
Eric Dumazet 已提交
8787
	}
E
Eric Dumazet 已提交
8788
	rcu_read_unlock();
8789

E
Eric Dumazet 已提交
8790 8791 8792 8793 8794 8795 8796 8797
	/* 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;
}

8798
#ifdef CONFIG_IXGBE_DCB
8799 8800 8801
/**
 * ixgbe_validate_rtr - verify 802.1Qp to Rx packet buffer mapping is valid.
 * @adapter: pointer to ixgbe_adapter
8802 8803 8804 8805 8806 8807 8808 8809 8810 8811 8812 8813 8814 8815 8816 8817 8818 8819 8820 8821 8822 8823 8824 8825 8826 8827 8828 8829 8830 8831 8832 8833 8834 8835
 * @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;
}

8836 8837 8838 8839 8840 8841 8842 8843 8844 8845 8846 8847 8848 8849 8850 8851 8852 8853 8854 8855 8856 8857 8858 8859 8860
/**
 * 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);
	}
}

8861
#endif /* CONFIG_IXGBE_DCB */
8862 8863
/**
 * ixgbe_setup_tc - configure net_device for multiple traffic classes
8864 8865 8866 8867 8868 8869 8870 8871
 *
 * @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;
8872
	bool pools;
8873 8874

	/* Hardware supports up to 8 traffic classes */
8875 8876 8877 8878
	if (tc > adapter->dcb_cfg.num_tcs.pg_tcs)
		return -EINVAL;

	if (hw->mac.type == ixgbe_mac_82598EB && tc && tc < MAX_TRAFFIC_CLASS)
8879 8880
		return -EINVAL;

8881 8882 8883 8884
	pools = (find_first_zero_bit(&adapter->fwd_bitmask, 32) > 1);
	if (tc && pools && adapter->num_rx_pools > IXGBE_MAX_DCBMACVLANS)
		return -EBUSY;

8885
	/* Hardware has to reinitialize queues and interrupts to
S
Stephen Hemminger 已提交
8886
	 * match packet buffer alignment. Unfortunately, the
8887 8888 8889 8890
	 * hardware is not flexible enough to do this dynamically.
	 */
	if (netif_running(dev))
		ixgbe_close(dev);
8891 8892 8893
	else
		ixgbe_reset(adapter);

8894 8895
	ixgbe_clear_interrupt_scheme(adapter);

8896
#ifdef CONFIG_IXGBE_DCB
8897
	if (tc) {
8898
		netdev_set_num_tc(dev, tc);
8899 8900
		ixgbe_set_prio_tc_map(adapter);

8901 8902
		adapter->flags |= IXGBE_FLAG_DCB_ENABLED;

8903 8904
		if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
			adapter->last_lfc_mode = adapter->hw.fc.requested_mode;
8905
			adapter->hw.fc.requested_mode = ixgbe_fc_none;
8906
		}
8907
	} else {
8908
		netdev_reset_tc(dev);
8909

8910 8911
		if (adapter->hw.mac.type == ixgbe_mac_82598EB)
			adapter->hw.fc.requested_mode = adapter->last_lfc_mode;
8912 8913 8914 8915 8916 8917 8918

		adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;

		adapter->temp_dcb_cfg.pfc_mode_enable = false;
		adapter->dcb_cfg.pfc_mode_enable = false;
	}

8919
	ixgbe_validate_rtr(adapter, tc);
8920 8921 8922 8923

#endif /* CONFIG_IXGBE_DCB */
	ixgbe_init_interrupt_scheme(adapter);

8924
	if (netif_running(dev))
8925
		return ixgbe_open(dev);
8926 8927 8928

	return 0;
}
E
Eric Dumazet 已提交
8929

8930 8931 8932
static int ixgbe_delete_clsu32(struct ixgbe_adapter *adapter,
			       struct tc_cls_u32_offload *cls)
{
8933
	u32 hdl = cls->knode.handle;
8934
	u32 uhtid = TC_U32_USERHTID(cls->knode.handle);
8935 8936 8937 8938 8939 8940
	u32 loc = cls->knode.handle & 0xfffff;
	int err = 0, i, j;
	struct ixgbe_jump_table *jump = NULL;

	if (loc > IXGBE_MAX_HW_ENTRIES)
		return -EINVAL;
8941

8942 8943 8944
	if ((uhtid != 0x800) && (uhtid >= IXGBE_MAX_LINK_HANDLE))
		return -EINVAL;

8945 8946 8947
	/* Clear this filter in the link data it is associated with */
	if (uhtid != 0x800) {
		jump = adapter->jump_tables[uhtid];
8948 8949 8950 8951 8952
		if (!jump)
			return -EINVAL;
		if (!test_bit(loc - 1, jump->child_loc_map))
			return -EINVAL;
		clear_bit(loc - 1, jump->child_loc_map);
8953 8954 8955 8956 8957 8958 8959 8960 8961 8962 8963 8964 8965 8966 8967 8968 8969 8970 8971 8972 8973 8974 8975 8976 8977 8978 8979
	}

	/* Check if the filter being deleted is a link */
	for (i = 1; i < IXGBE_MAX_LINK_HANDLE; i++) {
		jump = adapter->jump_tables[i];
		if (jump && jump->link_hdl == hdl) {
			/* Delete filters in the hardware in the child hash
			 * table associated with this link
			 */
			for (j = 0; j < IXGBE_MAX_HW_ENTRIES; j++) {
				if (!test_bit(j, jump->child_loc_map))
					continue;
				spin_lock(&adapter->fdir_perfect_lock);
				err = ixgbe_update_ethtool_fdir_entry(adapter,
								      NULL,
								      j + 1);
				spin_unlock(&adapter->fdir_perfect_lock);
				clear_bit(j, jump->child_loc_map);
			}
			/* Remove resources for this link */
			kfree(jump->input);
			kfree(jump->mask);
			kfree(jump);
			adapter->jump_tables[i] = NULL;
			return err;
		}
	}
8980

8981
	spin_lock(&adapter->fdir_perfect_lock);
8982
	err = ixgbe_update_ethtool_fdir_entry(adapter, NULL, loc);
8983 8984 8985 8986
	spin_unlock(&adapter->fdir_perfect_lock);
	return err;
}

8987 8988 8989
static int ixgbe_configure_clsu32_add_hnode(struct ixgbe_adapter *adapter,
					    struct tc_cls_u32_offload *cls)
{
8990 8991 8992 8993 8994
	u32 uhtid = TC_U32_USERHTID(cls->hnode.handle);

	if (uhtid >= IXGBE_MAX_LINK_HANDLE)
		return -EINVAL;

8995 8996 8997 8998 8999 9000
	/* This ixgbe devices do not support hash tables at the moment
	 * so abort when given hash tables.
	 */
	if (cls->hnode.divisor > 0)
		return -EINVAL;

9001
	set_bit(uhtid - 1, &adapter->tables);
9002 9003 9004 9005 9006 9007
	return 0;
}

static int ixgbe_configure_clsu32_del_hnode(struct ixgbe_adapter *adapter,
					    struct tc_cls_u32_offload *cls)
{
9008 9009 9010 9011 9012 9013
	u32 uhtid = TC_U32_USERHTID(cls->hnode.handle);

	if (uhtid >= IXGBE_MAX_LINK_HANDLE)
		return -EINVAL;

	clear_bit(uhtid - 1, &adapter->tables);
9014 9015 9016
	return 0;
}

9017
#ifdef CONFIG_NET_CLS_ACT
D
David Ahern 已提交
9018 9019 9020 9021 9022 9023 9024 9025 9026 9027 9028 9029 9030 9031 9032 9033 9034 9035 9036 9037 9038 9039 9040 9041 9042 9043
struct upper_walk_data {
	struct ixgbe_adapter *adapter;
	u64 action;
	int ifindex;
	u8 queue;
};

static int get_macvlan_queue(struct net_device *upper, void *_data)
{
	if (netif_is_macvlan(upper)) {
		struct macvlan_dev *dfwd = netdev_priv(upper);
		struct ixgbe_fwd_adapter *vadapter = dfwd->fwd_priv;
		struct upper_walk_data *data = _data;
		struct ixgbe_adapter *adapter = data->adapter;
		int ifindex = data->ifindex;

		if (vadapter && vadapter->netdev->ifindex == ifindex) {
			data->queue = adapter->rx_ring[vadapter->rx_base_queue]->reg_idx;
			data->action = data->queue;
			return 1;
		}
	}

	return 0;
}

9044 9045 9046 9047
static int handle_redirect_action(struct ixgbe_adapter *adapter, int ifindex,
				  u8 *queue, u64 *action)
{
	unsigned int num_vfs = adapter->num_vfs, vf;
D
David Ahern 已提交
9048
	struct upper_walk_data data;
9049 9050 9051 9052 9053 9054 9055 9056 9057 9058 9059 9060 9061 9062 9063 9064 9065 9066
	struct net_device *upper;

	/* redirect to a SRIOV VF */
	for (vf = 0; vf < num_vfs; ++vf) {
		upper = pci_get_drvdata(adapter->vfinfo[vf].vfdev);
		if (upper->ifindex == ifindex) {
			if (adapter->num_rx_pools > 1)
				*queue = vf * 2;
			else
				*queue = vf * adapter->num_rx_queues_per_pool;

			*action = vf + 1;
			*action <<= ETHTOOL_RX_FLOW_SPEC_RING_VF_OFF;
			return 0;
		}
	}

	/* redirect to a offloaded macvlan netdev */
D
David Ahern 已提交
9067 9068 9069 9070 9071 9072 9073 9074 9075 9076
	data.adapter = adapter;
	data.ifindex = ifindex;
	data.action = 0;
	data.queue = 0;
	if (netdev_walk_all_upper_dev_rcu(adapter->netdev,
					  get_macvlan_queue, &data)) {
		*action = data.action;
		*queue = data.queue;

		return 0;
9077 9078 9079 9080 9081 9082 9083 9084 9085
	}

	return -EINVAL;
}

static int parse_tc_actions(struct ixgbe_adapter *adapter,
			    struct tcf_exts *exts, u64 *action, u8 *queue)
{
	const struct tc_action *a;
9086
	LIST_HEAD(actions);
9087 9088
	int err;

9089
	if (!tcf_exts_has_actions(exts))
9090 9091
		return -EINVAL;

9092 9093
	tcf_exts_to_list(exts, &actions);
	list_for_each_entry(a, &actions, list) {
9094 9095 9096 9097 9098 9099 9100 9101 9102

		/* Drop action */
		if (is_tcf_gact_shot(a)) {
			*action = IXGBE_FDIR_DROP_QUEUE;
			*queue = IXGBE_FDIR_DROP_QUEUE;
			return 0;
		}

		/* Redirect to a VF or a offloaded macvlan */
9103
		if (is_tcf_mirred_egress_redirect(a)) {
9104
			struct net_device *dev = tcf_mirred_dev(a);
9105

9106 9107 9108
			if (!dev)
				return -EINVAL;
			err = handle_redirect_action(adapter, dev->ifindex, queue,
9109 9110 9111 9112 9113 9114 9115 9116 9117 9118 9119 9120 9121 9122 9123 9124
						     action);
			if (err == 0)
				return err;
		}
	}

	return -EINVAL;
}
#else
static int parse_tc_actions(struct ixgbe_adapter *adapter,
			    struct tcf_exts *exts, u64 *action, u8 *queue)
{
	return -EINVAL;
}
#endif /* CONFIG_NET_CLS_ACT */

9125 9126 9127 9128 9129 9130 9131 9132 9133 9134 9135 9136 9137 9138 9139 9140 9141 9142 9143 9144 9145 9146 9147 9148 9149 9150 9151 9152 9153 9154 9155 9156 9157 9158 9159 9160 9161 9162 9163 9164 9165 9166 9167 9168 9169 9170 9171 9172 9173
static int ixgbe_clsu32_build_input(struct ixgbe_fdir_filter *input,
				    union ixgbe_atr_input *mask,
				    struct tc_cls_u32_offload *cls,
				    struct ixgbe_mat_field *field_ptr,
				    struct ixgbe_nexthdr *nexthdr)
{
	int i, j, off;
	__be32 val, m;
	bool found_entry = false, found_jump_field = false;

	for (i = 0; i < cls->knode.sel->nkeys; i++) {
		off = cls->knode.sel->keys[i].off;
		val = cls->knode.sel->keys[i].val;
		m = cls->knode.sel->keys[i].mask;

		for (j = 0; field_ptr[j].val; j++) {
			if (field_ptr[j].off == off) {
				field_ptr[j].val(input, mask, val, m);
				input->filter.formatted.flow_type |=
					field_ptr[j].type;
				found_entry = true;
				break;
			}
		}
		if (nexthdr) {
			if (nexthdr->off == cls->knode.sel->keys[i].off &&
			    nexthdr->val == cls->knode.sel->keys[i].val &&
			    nexthdr->mask == cls->knode.sel->keys[i].mask)
				found_jump_field = true;
			else
				continue;
		}
	}

	if (nexthdr && !found_jump_field)
		return -EINVAL;

	if (!found_entry)
		return 0;

	mask->formatted.flow_type = IXGBE_ATR_L4TYPE_IPV6_MASK |
				    IXGBE_ATR_L4TYPE_MASK;

	if (input->filter.formatted.flow_type == IXGBE_ATR_FLOW_TYPE_IPV4)
		mask->formatted.flow_type &= IXGBE_ATR_L4TYPE_IPV6_MASK;

	return 0;
}

9174 9175 9176
static int ixgbe_configure_clsu32(struct ixgbe_adapter *adapter,
				  struct tc_cls_u32_offload *cls)
{
9177
	__be16 protocol = cls->common.protocol;
9178 9179 9180
	u32 loc = cls->knode.handle & 0xfffff;
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_mat_field *field_ptr;
9181 9182 9183 9184
	struct ixgbe_fdir_filter *input = NULL;
	union ixgbe_atr_input *mask = NULL;
	struct ixgbe_jump_table *jump = NULL;
	int i, err = -EINVAL;
9185
	u8 queue;
9186
	u32 uhtid, link_uhtid;
9187

9188 9189
	uhtid = TC_U32_USERHTID(cls->knode.handle);
	link_uhtid = TC_U32_USERHTID(cls->knode.link_handle);
9190

9191
	/* At the moment cls_u32 jumps to network layer and skips past
9192 9193 9194
	 * L2 headers. The canonical method to match L2 frames is to use
	 * negative values. However this is error prone at best but really
	 * just broken because there is no way to "know" what sort of hdr
9195
	 * is in front of the network layer. Fix cls_u32 to support L2
9196 9197 9198
	 * headers when needed.
	 */
	if (protocol != htons(ETH_P_IP))
9199
		return err;
9200 9201 9202

	if (loc >= ((1024 << adapter->fdir_pballoc) - 2)) {
		e_err(drv, "Location out of range\n");
9203
		return err;
9204 9205 9206 9207 9208 9209 9210 9211 9212
	}

	/* cls u32 is a graph starting at root node 0x800. The driver tracks
	 * links and also the fields used to advance the parser across each
	 * link (e.g. nexthdr/eat parameters from 'tc'). This way we can map
	 * the u32 graph onto the hardware parse graph denoted in ixgbe_model.h
	 * To add support for new nodes update ixgbe_model.h parse structures
	 * this function _should_ be generic try not to hardcode values here.
	 */
9213
	if (uhtid == 0x800) {
9214
		field_ptr = (adapter->jump_tables[0])->mat;
9215
	} else {
9216
		if (uhtid >= IXGBE_MAX_LINK_HANDLE)
9217 9218 9219 9220
			return err;
		if (!adapter->jump_tables[uhtid])
			return err;
		field_ptr = (adapter->jump_tables[uhtid])->mat;
9221 9222 9223
	}

	if (!field_ptr)
9224
		return err;
9225

9226 9227 9228 9229 9230
	/* At this point we know the field_ptr is valid and need to either
	 * build cls_u32 link or attach filter. Because adding a link to
	 * a handle that does not exist is invalid and the same for adding
	 * rules to handles that don't exist.
	 */
9231

9232 9233
	if (link_uhtid) {
		struct ixgbe_nexthdr *nexthdr = ixgbe_ipv4_jumps;
9234

9235 9236 9237 9238 9239 9240
		if (link_uhtid >= IXGBE_MAX_LINK_HANDLE)
			return err;

		if (!test_bit(link_uhtid - 1, &adapter->tables))
			return err;

9241 9242 9243 9244 9245 9246 9247 9248 9249 9250 9251 9252
		/* Multiple filters as links to the same hash table are not
		 * supported. To add a new filter with the same next header
		 * but different match/jump conditions, create a new hash table
		 * and link to it.
		 */
		if (adapter->jump_tables[link_uhtid] &&
		    (adapter->jump_tables[link_uhtid])->link_hdl) {
			e_err(drv, "Link filter exists for link: %x\n",
			      link_uhtid);
			return err;
		}

9253 9254 9255 9256 9257 9258 9259 9260 9261 9262 9263 9264 9265 9266 9267 9268 9269
		for (i = 0; nexthdr[i].jump; i++) {
			if (nexthdr[i].o != cls->knode.sel->offoff ||
			    nexthdr[i].s != cls->knode.sel->offshift ||
			    nexthdr[i].m != cls->knode.sel->offmask)
				return err;

			jump = kzalloc(sizeof(*jump), GFP_KERNEL);
			if (!jump)
				return -ENOMEM;
			input = kzalloc(sizeof(*input), GFP_KERNEL);
			if (!input) {
				err = -ENOMEM;
				goto free_jump;
			}
			mask = kzalloc(sizeof(*mask), GFP_KERNEL);
			if (!mask) {
				err = -ENOMEM;
9270
				goto free_input;
9271 9272 9273
			}
			jump->input = input;
			jump->mask = mask;
9274 9275
			jump->link_hdl = cls->knode.handle;

9276 9277 9278 9279 9280
			err = ixgbe_clsu32_build_input(input, mask, cls,
						       field_ptr, &nexthdr[i]);
			if (!err) {
				jump->mat = nexthdr[i].jump;
				adapter->jump_tables[link_uhtid] = jump;
9281 9282 9283
				break;
			}
		}
9284
		return 0;
9285 9286
	}

9287 9288 9289 9290 9291 9292
	input = kzalloc(sizeof(*input), GFP_KERNEL);
	if (!input)
		return -ENOMEM;
	mask = kzalloc(sizeof(*mask), GFP_KERNEL);
	if (!mask) {
		err = -ENOMEM;
9293
		goto free_input;
9294
	}
9295

9296 9297 9298 9299 9300 9301 9302
	if ((uhtid != 0x800) && (adapter->jump_tables[uhtid])) {
		if ((adapter->jump_tables[uhtid])->input)
			memcpy(input, (adapter->jump_tables[uhtid])->input,
			       sizeof(*input));
		if ((adapter->jump_tables[uhtid])->mask)
			memcpy(mask, (adapter->jump_tables[uhtid])->mask,
			       sizeof(*mask));
9303 9304 9305 9306 9307 9308 9309 9310 9311 9312 9313 9314 9315 9316

		/* Lookup in all child hash tables if this location is already
		 * filled with a filter
		 */
		for (i = 1; i < IXGBE_MAX_LINK_HANDLE; i++) {
			struct ixgbe_jump_table *link = adapter->jump_tables[i];

			if (link && (test_bit(loc - 1, link->child_loc_map))) {
				e_err(drv, "Filter exists in location: %x\n",
				      loc);
				err = -EINVAL;
				goto err_out;
			}
		}
9317 9318 9319
	}
	err = ixgbe_clsu32_build_input(input, mask, cls, field_ptr, NULL);
	if (err)
9320 9321
		goto err_out;

9322 9323 9324
	err = parse_tc_actions(adapter, cls->knode.exts, &input->action,
			       &queue);
	if (err < 0)
9325 9326 9327 9328 9329 9330 9331
		goto err_out;

	input->sw_idx = loc;

	spin_lock(&adapter->fdir_perfect_lock);

	if (hlist_empty(&adapter->fdir_filter_list)) {
9332 9333
		memcpy(&adapter->fdir_mask, mask, sizeof(*mask));
		err = ixgbe_fdir_set_input_mask_82599(hw, mask);
9334 9335
		if (err)
			goto err_out_w_lock;
9336
	} else if (memcmp(&adapter->fdir_mask, mask, sizeof(*mask))) {
9337 9338 9339 9340
		err = -EINVAL;
		goto err_out_w_lock;
	}

9341
	ixgbe_atr_compute_perfect_hash_82599(&input->filter, mask);
9342 9343 9344 9345 9346 9347
	err = ixgbe_fdir_write_perfect_filter_82599(hw, &input->filter,
						    input->sw_idx, queue);
	if (!err)
		ixgbe_update_ethtool_fdir_entry(adapter, input, input->sw_idx);
	spin_unlock(&adapter->fdir_perfect_lock);

9348 9349
	if ((uhtid != 0x800) && (adapter->jump_tables[uhtid]))
		set_bit(loc - 1, (adapter->jump_tables[uhtid])->child_loc_map);
9350

9351
	kfree(mask);
9352 9353 9354 9355
	return err;
err_out_w_lock:
	spin_unlock(&adapter->fdir_perfect_lock);
err_out:
9356
	kfree(mask);
9357 9358
free_input:
	kfree(input);
9359 9360 9361
free_jump:
	kfree(jump);
	return err;
9362 9363
}

9364
static int ixgbe_setup_tc_cls_u32(struct ixgbe_adapter *adapter,
9365
				  struct tc_cls_u32_offload *cls_u32)
9366
{
9367
	if (cls_u32->common.chain_index)
9368 9369
		return -EOPNOTSUPP;

9370 9371 9372
	switch (cls_u32->command) {
	case TC_CLSU32_NEW_KNODE:
	case TC_CLSU32_REPLACE_KNODE:
9373
		return ixgbe_configure_clsu32(adapter, cls_u32);
9374 9375 9376 9377
	case TC_CLSU32_DELETE_KNODE:
		return ixgbe_delete_clsu32(adapter, cls_u32);
	case TC_CLSU32_NEW_HNODE:
	case TC_CLSU32_REPLACE_HNODE:
9378
		return ixgbe_configure_clsu32_add_hnode(adapter, cls_u32);
9379 9380 9381 9382
	case TC_CLSU32_DELETE_HNODE:
		return ixgbe_configure_clsu32_del_hnode(adapter, cls_u32);
	default:
		return -EOPNOTSUPP;
9383
	}
9384
}
9385

9386 9387 9388 9389 9390
static int ixgbe_setup_tc_block_cb(enum tc_setup_type type, void *type_data,
				   void *cb_priv)
{
	struct ixgbe_adapter *adapter = cb_priv;

9391 9392 9393
	if (!tc_can_offload(adapter->netdev))
		return -EOPNOTSUPP;

9394 9395 9396 9397 9398 9399 9400 9401 9402 9403 9404 9405 9406 9407 9408 9409 9410 9411 9412 9413 9414 9415 9416 9417 9418 9419 9420 9421 9422
	switch (type) {
	case TC_SETUP_CLSU32:
		return ixgbe_setup_tc_cls_u32(adapter, type_data);
	default:
		return -EOPNOTSUPP;
	}
}

static int ixgbe_setup_tc_block(struct net_device *dev,
				struct tc_block_offload *f)
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);

	if (f->binder_type != TCF_BLOCK_BINDER_TYPE_CLSACT_INGRESS)
		return -EOPNOTSUPP;

	switch (f->command) {
	case TC_BLOCK_BIND:
		return tcf_block_cb_register(f->block, ixgbe_setup_tc_block_cb,
					     adapter, adapter);
	case TC_BLOCK_UNBIND:
		tcf_block_cb_unregister(f->block, ixgbe_setup_tc_block_cb,
					adapter);
		return 0;
	default:
		return -EOPNOTSUPP;
	}
}

9423 9424 9425 9426 9427 9428
static int ixgbe_setup_tc_mqprio(struct net_device *dev,
				 struct tc_mqprio_qopt *mqprio)
{
	mqprio->hw = TC_MQPRIO_HW_OFFLOAD_TCS;
	return ixgbe_setup_tc(dev, mqprio->num_tc);
}
9429

9430
static int __ixgbe_setup_tc(struct net_device *dev, enum tc_setup_type type,
9431
			    void *type_data)
9432 9433
{
	switch (type) {
9434 9435
	case TC_SETUP_BLOCK:
		return ixgbe_setup_tc_block(dev, type_data);
9436
	case TC_SETUP_QDISC_MQPRIO:
9437
		return ixgbe_setup_tc_mqprio(dev, type_data);
9438 9439 9440
	default:
		return -EOPNOTSUPP;
	}
9441 9442
}

9443 9444 9445 9446 9447 9448 9449 9450 9451 9452 9453
#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
9454 9455 9456 9457 9458 9459 9460 9461 9462 9463
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);
}

9464
static netdev_features_t ixgbe_fix_features(struct net_device *netdev,
9465
					    netdev_features_t features)
9466 9467 9468 9469
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

	/* If Rx checksum is disabled, then RSC/LRO should also be disabled */
9470 9471
	if (!(features & NETIF_F_RXCSUM))
		features &= ~NETIF_F_LRO;
9472

9473 9474 9475
	/* Turn off LRO if not RSC capable */
	if (!(adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE))
		features &= ~NETIF_F_LRO;
9476

9477
	return features;
9478 9479
}

9480
static int ixgbe_set_features(struct net_device *netdev,
9481
			      netdev_features_t features)
9482 9483
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
9484
	netdev_features_t changed = netdev->features ^ features;
9485 9486 9487
	bool need_reset = false;

	/* Make sure RSC matches LRO, reset if change */
9488 9489
	if (!(features & NETIF_F_LRO)) {
		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
9490
			need_reset = true;
9491 9492 9493 9494 9495 9496 9497 9498 9499 9500
		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");
9501 9502 9503 9504
		}
	}

	/*
9505 9506
	 * Check if Flow Director n-tuple support or hw_tc support was
	 * enabled or disabled.  If the state changed, we need to reset.
9507
	 */
9508
	if ((features & NETIF_F_NTUPLE) || (features & NETIF_F_HW_TC)) {
9509
		/* turn off ATR, enable perfect filters and reset */
9510 9511 9512
		if (!(adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE))
			need_reset = true;

9513 9514
		adapter->flags &= ~IXGBE_FLAG_FDIR_HASH_CAPABLE;
		adapter->flags |= IXGBE_FLAG_FDIR_PERFECT_CAPABLE;
9515
	} else {
9516 9517 9518 9519 9520 9521 9522
		/* 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 */
9523 9524 9525 9526 9527 9528 9529 9530 9531 9532
		if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED ||
		    /* We cannot enable ATR if we have 2 or more tcs */
		    (netdev_get_num_tc(netdev) > 1) ||
		    /* We cannot enable ATR if RSS is disabled */
		    (adapter->ring_feature[RING_F_RSS].limit <= 1) ||
		    /* A sample rate of 0 indicates ATR disabled */
		    (!adapter->atr_sample_rate))
			; /* do nothing not supported */
		else /* otherwise supported and set the flag */
			adapter->flags |= IXGBE_FLAG_FDIR_HASH_CAPABLE;
9533 9534
	}

B
Ben Greear 已提交
9535 9536 9537
	if (changed & NETIF_F_RXALL)
		need_reset = true;

9538
	netdev->features = features;
9539 9540

	if ((adapter->flags & IXGBE_FLAG_VXLAN_OFFLOAD_CAPABLE)) {
9541 9542 9543 9544 9545 9546 9547 9548 9549 9550 9551 9552 9553 9554 9555 9556 9557
		if (features & NETIF_F_RXCSUM) {
			adapter->flags2 |= IXGBE_FLAG2_UDP_TUN_REREG_NEEDED;
		} else {
			u32 port_mask = IXGBE_VXLANCTRL_VXLAN_UDPPORT_MASK;

			ixgbe_clear_udp_tunnel_port(adapter, port_mask);
		}
	}

	if ((adapter->flags & IXGBE_FLAG_GENEVE_OFFLOAD_CAPABLE)) {
		if (features & NETIF_F_RXCSUM) {
			adapter->flags2 |= IXGBE_FLAG2_UDP_TUN_REREG_NEEDED;
		} else {
			u32 port_mask = IXGBE_VXLANCTRL_GENEVE_UDPPORT_MASK;

			ixgbe_clear_udp_tunnel_port(adapter, port_mask);
		}
9558 9559
	}

9560 9561
	if (need_reset)
		ixgbe_do_reset(netdev);
9562 9563 9564
	else if (changed & (NETIF_F_HW_VLAN_CTAG_RX |
			    NETIF_F_HW_VLAN_CTAG_FILTER))
		ixgbe_set_rx_mode(netdev);
9565 9566 9567 9568

	return 0;
}

9569
/**
9570
 * ixgbe_add_udp_tunnel_port - Get notifications about adding UDP tunnel ports
9571
 * @dev: The port's netdev
9572
 * @ti: Tunnel endpoint information
9573
 **/
9574 9575
static void ixgbe_add_udp_tunnel_port(struct net_device *dev,
				      struct udp_tunnel_info *ti)
9576 9577 9578
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
	struct ixgbe_hw *hw = &adapter->hw;
9579
	__be16 port = ti->port;
9580 9581
	u32 port_shift = 0;
	u32 reg;
9582

9583 9584 9585
	if (ti->sa_family != AF_INET)
		return;

9586 9587 9588 9589
	switch (ti->type) {
	case UDP_TUNNEL_TYPE_VXLAN:
		if (!(adapter->flags & IXGBE_FLAG_VXLAN_OFFLOAD_CAPABLE))
			return;
9590

9591 9592 9593 9594 9595 9596 9597 9598 9599 9600 9601 9602 9603 9604 9605 9606 9607 9608 9609 9610 9611 9612 9613 9614 9615 9616 9617
		if (adapter->vxlan_port == port)
			return;

		if (adapter->vxlan_port) {
			netdev_info(dev,
				    "VXLAN port %d set, not adding port %d\n",
				    ntohs(adapter->vxlan_port),
				    ntohs(port));
			return;
		}

		adapter->vxlan_port = port;
		break;
	case UDP_TUNNEL_TYPE_GENEVE:
		if (!(adapter->flags & IXGBE_FLAG_GENEVE_OFFLOAD_CAPABLE))
			return;

		if (adapter->geneve_port == port)
			return;

		if (adapter->geneve_port) {
			netdev_info(dev,
				    "GENEVE port %d set, not adding port %d\n",
				    ntohs(adapter->geneve_port),
				    ntohs(port));
			return;
		}
9618

9619 9620 9621 9622
		port_shift = IXGBE_VXLANCTRL_GENEVE_UDPPORT_SHIFT;
		adapter->geneve_port = port;
		break;
	default:
9623 9624 9625
		return;
	}

9626 9627
	reg = IXGBE_READ_REG(hw, IXGBE_VXLANCTRL) | ntohs(port) << port_shift;
	IXGBE_WRITE_REG(hw, IXGBE_VXLANCTRL, reg);
9628 9629 9630
}

/**
9631
 * ixgbe_del_udp_tunnel_port - Get notifications about removing UDP tunnel ports
9632
 * @dev: The port's netdev
9633
 * @ti: Tunnel endpoint information
9634
 **/
9635 9636
static void ixgbe_del_udp_tunnel_port(struct net_device *dev,
				      struct udp_tunnel_info *ti)
9637 9638
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
9639
	u32 port_mask;
9640

9641 9642
	if (ti->type != UDP_TUNNEL_TYPE_VXLAN &&
	    ti->type != UDP_TUNNEL_TYPE_GENEVE)
9643 9644
		return;

9645
	if (ti->sa_family != AF_INET)
9646 9647
		return;

9648 9649 9650 9651
	switch (ti->type) {
	case UDP_TUNNEL_TYPE_VXLAN:
		if (!(adapter->flags & IXGBE_FLAG_VXLAN_OFFLOAD_CAPABLE))
			return;
9652

9653 9654 9655 9656 9657 9658 9659 9660 9661 9662 9663 9664 9665 9666 9667 9668 9669 9670 9671 9672 9673
		if (adapter->vxlan_port != ti->port) {
			netdev_info(dev, "VXLAN port %d not found\n",
				    ntohs(ti->port));
			return;
		}

		port_mask = IXGBE_VXLANCTRL_VXLAN_UDPPORT_MASK;
		break;
	case UDP_TUNNEL_TYPE_GENEVE:
		if (!(adapter->flags & IXGBE_FLAG_GENEVE_OFFLOAD_CAPABLE))
			return;

		if (adapter->geneve_port != ti->port) {
			netdev_info(dev, "GENEVE port %d not found\n",
				    ntohs(ti->port));
			return;
		}

		port_mask = IXGBE_VXLANCTRL_GENEVE_UDPPORT_MASK;
		break;
	default:
9674 9675 9676
		return;
	}

9677 9678
	ixgbe_clear_udp_tunnel_port(adapter, port_mask);
	adapter->flags2 |= IXGBE_FLAG2_UDP_TUN_REREG_NEEDED;
9679 9680
}

9681
static int ixgbe_ndo_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
J
John Fastabend 已提交
9682
			     struct net_device *dev,
9683
			     const unsigned char *addr, u16 vid,
J
John Fastabend 已提交
9684 9685
			     u16 flags)
{
9686
	/* guarantee we can provide a unique filter for the unicast address */
9687
	if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) {
9688 9689 9690 9691
		struct ixgbe_adapter *adapter = netdev_priv(dev);
		u16 pool = VMDQ_P(0);

		if (netdev_uc_count(dev) >= ixgbe_available_rars(adapter, pool))
9692
			return -ENOMEM;
J
John Fastabend 已提交
9693 9694
	}

9695
	return ndo_dflt_fdb_add(ndm, tb, dev, addr, vid, flags);
J
John Fastabend 已提交
9696 9697
}

9698 9699 9700 9701 9702 9703 9704 9705 9706 9707
/**
 * ixgbe_configure_bridge_mode - set various bridge modes
 * @adapter - the private structure
 * @mode - requested bridge mode
 *
 * Configure some settings require for various bridge modes.
 **/
static int ixgbe_configure_bridge_mode(struct ixgbe_adapter *adapter,
				       __u16 mode)
{
9708 9709 9710 9711
	struct ixgbe_hw *hw = &adapter->hw;
	unsigned int p, num_pools;
	u32 vmdctl;

9712 9713
	switch (mode) {
	case BRIDGE_MODE_VEPA:
9714
		/* disable Tx loopback, rely on switch hairpin mode */
9715
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_PFDTXGSWC, 0);
9716 9717 9718 9719 9720 9721 9722 9723 9724 9725 9726 9727 9728 9729 9730 9731 9732 9733 9734

		/* must enable Rx switching replication to allow multicast
		 * packet reception on all VFs, and to enable source address
		 * pruning.
		 */
		vmdctl = IXGBE_READ_REG(hw, IXGBE_VMD_CTL);
		vmdctl |= IXGBE_VT_CTL_REPLEN;
		IXGBE_WRITE_REG(hw, IXGBE_VMD_CTL, vmdctl);

		/* enable Rx source address pruning. Note, this requires
		 * replication to be enabled or else it does nothing.
		 */
		num_pools = adapter->num_vfs + adapter->num_rx_pools;
		for (p = 0; p < num_pools; p++) {
			if (hw->mac.ops.set_source_address_pruning)
				hw->mac.ops.set_source_address_pruning(hw,
								       true,
								       p);
		}
9735 9736
		break;
	case BRIDGE_MODE_VEB:
9737
		/* enable Tx loopback for internal VF/PF communication */
9738 9739
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_PFDTXGSWC,
				IXGBE_PFDTXGSWC_VT_LBEN);
9740 9741 9742 9743 9744 9745 9746 9747 9748 9749 9750 9751 9752 9753 9754 9755 9756 9757 9758

		/* disable Rx switching replication unless we have SR-IOV
		 * virtual functions
		 */
		vmdctl = IXGBE_READ_REG(hw, IXGBE_VMD_CTL);
		if (!adapter->num_vfs)
			vmdctl &= ~IXGBE_VT_CTL_REPLEN;
		IXGBE_WRITE_REG(hw, IXGBE_VMD_CTL, vmdctl);

		/* disable Rx source address pruning, since we don't expect to
		 * be receiving external loopback of our transmitted frames.
		 */
		num_pools = adapter->num_vfs + adapter->num_rx_pools;
		for (p = 0; p < num_pools; p++) {
			if (hw->mac.ops.set_source_address_pruning)
				hw->mac.ops.set_source_address_pruning(hw,
								       false,
								       p);
		}
9759 9760 9761 9762 9763 9764 9765 9766 9767 9768 9769 9770 9771
		break;
	default:
		return -EINVAL;
	}

	adapter->bridge_mode = mode;

	e_info(drv, "enabling bridge mode: %s\n",
	       mode == BRIDGE_MODE_VEPA ? "VEPA" : "VEB");

	return 0;
}

9772
static int ixgbe_ndo_bridge_setlink(struct net_device *dev,
9773
				    struct nlmsghdr *nlh, u16 flags)
9774 9775 9776 9777 9778 9779 9780 9781 9782
{
	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);
9783 9784
	if (!br_spec)
		return -EINVAL;
9785 9786

	nla_for_each_nested(attr, br_spec, rem) {
9787
		int status;
9788 9789 9790 9791 9792
		__u16 mode;

		if (nla_type(attr) != IFLA_BRIDGE_MODE)
			continue;

9793 9794 9795
		if (nla_len(attr) < sizeof(mode))
			return -EINVAL;

9796
		mode = nla_get_u16(attr);
9797 9798 9799
		status = ixgbe_configure_bridge_mode(adapter, mode);
		if (status)
			return status;
9800 9801

		break;
9802 9803 9804 9805 9806 9807
	}

	return 0;
}

static int ixgbe_ndo_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq,
9808
				    struct net_device *dev,
9809
				    u32 filter_mask, int nlflags)
9810 9811 9812 9813 9814 9815
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);

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

9816
	return ndo_dflt_bridge_getlink(skb, pid, seq, dev,
9817 9818
				       adapter->bridge_mode, 0, 0, nlflags,
				       filter_mask, NULL);
9819 9820
}

9821 9822 9823 9824
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);
9825
	int used_pools = adapter->num_vfs + adapter->num_rx_pools;
9826
	unsigned int limit;
9827 9828
	int pool, err;

9829 9830 9831 9832 9833 9834 9835
	/* Hardware has a limited number of available pools. Each VF, and the
	 * PF require a pool. Check to ensure we don't attempt to use more
	 * then the available number of pools.
	 */
	if (used_pools >= IXGBE_MAX_VF_FUNCTIONS)
		return ERR_PTR(-EINVAL);

9836 9837 9838 9839 9840 9841 9842
#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
9843
	/* Check for hardware restriction on number of rx/tx queues */
9844
	if (vdev->num_tx_queues > IXGBE_MAX_L2A_QUEUES ||
9845 9846 9847 9848 9849 9850 9851 9852 9853 9854 9855 9856
	    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);

9857
	fwd_adapter = kzalloc(sizeof(*fwd_adapter), GFP_KERNEL);
9858 9859 9860 9861 9862 9863
	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);
9864
	limit = find_last_bit(&adapter->fwd_bitmask, 32);
9865 9866 9867

	/* Enable VMDq flag so device will be set in VM mode */
	adapter->flags |= IXGBE_FLAG_VMDQ_ENABLED | IXGBE_FLAG_SRIOV_ENABLED;
9868
	adapter->ring_feature[RING_F_VMDQ].limit = limit + 1;
9869
	adapter->ring_feature[RING_F_RSS].limit = vdev->num_tx_queues;
9870 9871 9872 9873 9874 9875 9876

	/* 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;
9877 9878 9879 9880 9881 9882 9883 9884

	if (netif_running(pdev)) {
		err = ixgbe_fwd_ring_up(vdev, fwd_adapter);
		if (err)
			goto fwd_add_err;
		netif_tx_start_all_queues(vdev);
	}

9885 9886 9887 9888 9889 9890 9891 9892 9893 9894 9895 9896 9897 9898 9899
	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;
9900
	unsigned int limit;
9901 9902 9903 9904

	clear_bit(fwd_adapter->pool, &adapter->fwd_bitmask);
	adapter->num_rx_pools--;

9905 9906
	limit = find_last_bit(&adapter->fwd_bitmask, 32);
	adapter->ring_feature[RING_F_VMDQ].limit = limit + 1;
9907
	ixgbe_fwd_ring_down(fwd_adapter->netdev, fwd_adapter);
9908 9909 9910 9911 9912 9913 9914 9915 9916 9917 9918

	/* go back to full RSS if we're done with our VMQs */
	if (adapter->ring_feature[RING_F_VMDQ].limit == 1) {
		int rss = min_t(int, ixgbe_max_rss_indices(adapter),
				num_online_cpus());

		adapter->flags &= ~IXGBE_FLAG_VMDQ_ENABLED;
		adapter->flags &= ~IXGBE_FLAG_SRIOV_ENABLED;
		adapter->ring_feature[RING_F_RSS].limit = rss;
	}

9919 9920 9921 9922 9923 9924 9925 9926 9927
	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);
}

9928 9929 9930
#define IXGBE_MAX_MAC_HDR_LEN		127
#define IXGBE_MAX_NETWORK_HDR_LEN	511

9931 9932 9933 9934
static netdev_features_t
ixgbe_features_check(struct sk_buff *skb, struct net_device *dev,
		     netdev_features_t features)
{
9935 9936 9937 9938 9939 9940 9941 9942 9943 9944 9945 9946 9947 9948 9949 9950 9951 9952 9953 9954 9955 9956 9957
	unsigned int network_hdr_len, mac_hdr_len;

	/* Make certain the headers can be described by a context descriptor */
	mac_hdr_len = skb_network_header(skb) - skb->data;
	if (unlikely(mac_hdr_len > IXGBE_MAX_MAC_HDR_LEN))
		return features & ~(NETIF_F_HW_CSUM |
				    NETIF_F_SCTP_CRC |
				    NETIF_F_HW_VLAN_CTAG_TX |
				    NETIF_F_TSO |
				    NETIF_F_TSO6);

	network_hdr_len = skb_checksum_start(skb) - skb_network_header(skb);
	if (unlikely(network_hdr_len >  IXGBE_MAX_NETWORK_HDR_LEN))
		return features & ~(NETIF_F_HW_CSUM |
				    NETIF_F_SCTP_CRC |
				    NETIF_F_TSO |
				    NETIF_F_TSO6);

	/* We can only support IPV4 TSO in tunnels if we can mangle the
	 * inner IP ID field, so strip TSO if MANGLEID is not supported.
	 */
	if (skb->encapsulation && !(features & NETIF_F_TSO_MANGLEID))
		features &= ~NETIF_F_TSO;
9958 9959 9960 9961

	return features;
}

9962 9963 9964 9965 9966 9967 9968 9969 9970 9971 9972 9973 9974 9975 9976 9977 9978 9979 9980 9981 9982 9983 9984
static int ixgbe_xdp_setup(struct net_device *dev, struct bpf_prog *prog)
{
	int i, frame_size = dev->mtu + ETH_HLEN + ETH_FCS_LEN + VLAN_HLEN;
	struct ixgbe_adapter *adapter = netdev_priv(dev);
	struct bpf_prog *old_prog;

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

	if (adapter->flags & IXGBE_FLAG_DCB_ENABLED)
		return -EINVAL;

	/* verify ixgbe ring attributes are sufficient for XDP */
	for (i = 0; i < adapter->num_rx_queues; i++) {
		struct ixgbe_ring *ring = adapter->rx_ring[i];

		if (ring_is_rsc_enabled(ring))
			return -EINVAL;

		if (frame_size > ixgbe_rx_bufsz(ring))
			return -EINVAL;
	}

9985 9986 9987
	if (nr_cpu_ids > MAX_XDP_QUEUES)
		return -ENOMEM;

9988
	old_prog = xchg(&adapter->xdp_prog, prog);
9989 9990 9991 9992 9993 9994 9995 9996 9997 9998 9999 10000 10001

	/* If transitioning XDP modes reconfigure rings */
	if (!!prog != !!old_prog) {
		int err = ixgbe_setup_tc(dev, netdev_get_num_tc(dev));

		if (err) {
			rcu_assign_pointer(adapter->xdp_prog, old_prog);
			return -EINVAL;
		}
	} else {
		for (i = 0; i < adapter->num_rx_queues; i++)
			xchg(&adapter->rx_ring[i]->xdp_prog, adapter->xdp_prog);
	}
10002 10003 10004 10005 10006 10007 10008

	if (old_prog)
		bpf_prog_put(old_prog);

	return 0;
}

10009
static int ixgbe_xdp(struct net_device *dev, struct netdev_bpf *xdp)
10010 10011 10012 10013 10014 10015 10016 10017
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);

	switch (xdp->command) {
	case XDP_SETUP_PROG:
		return ixgbe_xdp_setup(dev, xdp->prog);
	case XDP_QUERY_PROG:
		xdp->prog_attached = !!(adapter->xdp_prog);
10018 10019
		xdp->prog_id = adapter->xdp_prog ?
			adapter->xdp_prog->aux->id : 0;
10020 10021 10022 10023 10024 10025
		return 0;
	default:
		return -EINVAL;
	}
}

10026 10027 10028 10029 10030 10031 10032
static int ixgbe_xdp_xmit(struct net_device *dev, struct xdp_buff *xdp)
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
	struct ixgbe_ring *ring;
	int err;

	if (unlikely(test_bit(__IXGBE_DOWN, &adapter->state)))
10033
		return -ENETDOWN;
10034 10035 10036 10037 10038 10039

	/* During program transitions its possible adapter->xdp_prog is assigned
	 * but ring has not been configured yet. In this case simply abort xmit.
	 */
	ring = adapter->xdp_prog ? adapter->xdp_ring[smp_processor_id()] : NULL;
	if (unlikely(!ring))
10040
		return -ENXIO;
10041 10042 10043

	err = ixgbe_xmit_xdp_ring(adapter, xdp);
	if (err != IXGBE_XDP_TX)
10044
		return -ENOSPC;
10045

10046 10047 10048 10049 10050 10051 10052 10053 10054 10055 10056 10057 10058 10059 10060 10061 10062 10063
	return 0;
}

static void ixgbe_xdp_flush(struct net_device *dev)
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
	struct ixgbe_ring *ring;

	/* Its possible the device went down between xdp xmit and flush so
	 * we need to ensure device is still up.
	 */
	if (unlikely(test_bit(__IXGBE_DOWN, &adapter->state)))
		return;

	ring = adapter->xdp_prog ? adapter->xdp_ring[smp_processor_id()] : NULL;
	if (unlikely(!ring))
		return;

10064 10065 10066 10067 10068 10069
	/* Force memory writes to complete before letting h/w know there
	 * are new descriptors to fetch.
	 */
	wmb();
	writel(ring->next_to_use, ring->tail);

10070
	return;
10071 10072
}

10073
static const struct net_device_ops ixgbe_netdev_ops = {
10074
	.ndo_open		= ixgbe_open,
10075
	.ndo_stop		= ixgbe_close,
10076
	.ndo_start_xmit		= ixgbe_xmit_frame,
10077
	.ndo_select_queue	= ixgbe_select_queue,
A
Alexander Duyck 已提交
10078
	.ndo_set_rx_mode	= ixgbe_set_rx_mode,
10079 10080 10081 10082
	.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,
10083
	.ndo_set_tx_maxrate	= ixgbe_tx_maxrate,
10084 10085
	.ndo_vlan_rx_add_vid	= ixgbe_vlan_rx_add_vid,
	.ndo_vlan_rx_kill_vid	= ixgbe_vlan_rx_kill_vid,
10086
	.ndo_do_ioctl		= ixgbe_ioctl,
10087 10088
	.ndo_set_vf_mac		= ixgbe_ndo_set_vf_mac,
	.ndo_set_vf_vlan	= ixgbe_ndo_set_vf_vlan,
10089
	.ndo_set_vf_rate	= ixgbe_ndo_set_vf_bw,
A
Alexander Duyck 已提交
10090
	.ndo_set_vf_spoofchk	= ixgbe_ndo_set_vf_spoofchk,
10091
	.ndo_set_vf_rss_query_en = ixgbe_ndo_set_vf_rss_query_en,
H
Hiroshi Shimamoto 已提交
10092
	.ndo_set_vf_trust	= ixgbe_ndo_set_vf_trust,
10093
	.ndo_get_vf_config	= ixgbe_ndo_get_vf_config,
E
Eric Dumazet 已提交
10094
	.ndo_get_stats64	= ixgbe_get_stats64,
10095
	.ndo_setup_tc		= __ixgbe_setup_tc,
10096 10097 10098
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= ixgbe_netpoll,
#endif
10099 10100
#ifdef IXGBE_FCOE
	.ndo_fcoe_ddp_setup = ixgbe_fcoe_ddp_get,
10101
	.ndo_fcoe_ddp_target = ixgbe_fcoe_ddp_target,
10102
	.ndo_fcoe_ddp_done = ixgbe_fcoe_ddp_put,
10103 10104
	.ndo_fcoe_enable = ixgbe_fcoe_enable,
	.ndo_fcoe_disable = ixgbe_fcoe_disable,
10105
	.ndo_fcoe_get_wwn = ixgbe_fcoe_get_wwn,
10106
	.ndo_fcoe_get_hbainfo = ixgbe_fcoe_get_hbainfo,
10107
#endif /* IXGBE_FCOE */
10108 10109
	.ndo_set_features = ixgbe_set_features,
	.ndo_fix_features = ixgbe_fix_features,
J
John Fastabend 已提交
10110
	.ndo_fdb_add		= ixgbe_ndo_fdb_add,
10111 10112
	.ndo_bridge_setlink	= ixgbe_ndo_bridge_setlink,
	.ndo_bridge_getlink	= ixgbe_ndo_bridge_getlink,
10113 10114
	.ndo_dfwd_add_station	= ixgbe_fwd_add,
	.ndo_dfwd_del_station	= ixgbe_fwd_del,
10115 10116
	.ndo_udp_tunnel_add	= ixgbe_add_udp_tunnel_port,
	.ndo_udp_tunnel_del	= ixgbe_del_udp_tunnel_port,
10117
	.ndo_features_check	= ixgbe_features_check,
10118
	.ndo_bpf		= ixgbe_xdp,
10119
	.ndo_xdp_xmit		= ixgbe_xdp_xmit,
10120
	.ndo_xdp_flush		= ixgbe_xdp_flush,
10121 10122
};

10123 10124 10125 10126 10127 10128 10129 10130 10131 10132 10133
/**
 * 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)
{
10134
	struct pci_dev *entry, *pdev = adapter->pdev;
10135 10136
	int physfns = 0;

10137 10138 10139
	/* 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.
10140
	 */
10141
	if (ixgbe_pcie_from_parent(&adapter->hw))
10142
		physfns = 4;
10143 10144 10145

	list_for_each_entry(entry, &adapter->pdev->bus->devices, bus_list) {
		/* don't count virtual functions */
10146 10147 10148 10149 10150 10151 10152 10153 10154 10155 10156 10157 10158 10159
		if (entry->is_virtfn)
			continue;

		/* When the devices on the bus don't all match our device ID,
		 * we can't reliably determine the correct number of
		 * functions. This can occur if a function has been direct
		 * attached to a virtual machine using VT-d, for example. In
		 * this case, simply return -1 to indicate this.
		 */
		if ((entry->vendor != pdev->vendor) ||
		    (entry->device != pdev->device))
			return -1;

		physfns++;
10160 10161 10162 10163 10164
	}

	return physfns;
}

10165 10166
/**
 * ixgbe_wol_supported - Check whether device supports WoL
10167
 * @adapter: the adapter private structure
10168 10169 10170 10171 10172 10173 10174
 * @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
 *
 **/
10175 10176
bool ixgbe_wol_supported(struct ixgbe_adapter *adapter, u16 device_id,
			 u16 subdevice_id)
10177 10178 10179 10180
{
	struct ixgbe_hw *hw = &adapter->hw;
	u16 wol_cap = adapter->eeprom_cap & IXGBE_DEVICE_CAPS_WOL_MASK;

10181 10182 10183 10184 10185 10186 10187 10188 10189 10190 10191 10192 10193
	/* WOL not supported on 82598 */
	if (hw->mac.type == ixgbe_mac_82598EB)
		return false;

	/* check eeprom to see if WOL is enabled for X540 and newer */
	if (hw->mac.type >= ixgbe_mac_X540) {
		if ((wol_cap == IXGBE_DEVICE_CAPS_WOL_PORT0_1) ||
		    ((wol_cap == IXGBE_DEVICE_CAPS_WOL_PORT0) &&
		     (hw->bus.func == 0)))
			return true;
	}

	/* WOL is determined based on device IDs for 82599 MACs */
10194 10195 10196 10197 10198
	switch (device_id) {
	case IXGBE_DEV_ID_82599_SFP:
		/* Only these subdevices could supports WOL */
		switch (subdevice_id) {
		case IXGBE_SUBDEV_ID_82599_560FLR:
10199 10200 10201
		case IXGBE_SUBDEV_ID_82599_LOM_SNAP6:
		case IXGBE_SUBDEV_ID_82599_SFP_WOL0:
		case IXGBE_SUBDEV_ID_82599_SFP_2OCP:
10202 10203 10204
			/* only support first port */
			if (hw->bus.func != 0)
				break;
10205
			/* fall through */
10206
		case IXGBE_SUBDEV_ID_82599_SP_560FLR:
10207
		case IXGBE_SUBDEV_ID_82599_SFP:
10208
		case IXGBE_SUBDEV_ID_82599_RNDC:
10209
		case IXGBE_SUBDEV_ID_82599_ECNA_DP:
10210 10211 10212
		case IXGBE_SUBDEV_ID_82599_SFP_1OCP:
		case IXGBE_SUBDEV_ID_82599_SFP_LOM_OEM1:
		case IXGBE_SUBDEV_ID_82599_SFP_LOM_OEM2:
10213
			return true;
10214 10215
		}
		break;
10216
	case IXGBE_DEV_ID_82599EN_SFP:
10217
		/* Only these subdevices support WOL */
10218 10219
		switch (subdevice_id) {
		case IXGBE_SUBDEV_ID_82599EN_SFP_OCP1:
10220
			return true;
10221 10222
		}
		break;
10223 10224 10225
	case IXGBE_DEV_ID_82599_COMBO_BACKPLANE:
		/* All except this subdevice support WOL */
		if (subdevice_id != IXGBE_SUBDEV_ID_82599_KX4_KR_MEZZ)
10226
			return true;
10227 10228
		break;
	case IXGBE_DEV_ID_82599_KX4:
10229 10230
		return  true;
	default:
10231 10232 10233
		break;
	}

10234
	return false;
10235 10236
}

10237 10238 10239 10240 10241 10242 10243 10244 10245 10246 10247
/**
 * 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.
 **/
10248
static int ixgbe_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
10249 10250 10251 10252 10253
{
	struct net_device *netdev;
	struct ixgbe_adapter *adapter = NULL;
	struct ixgbe_hw *hw;
	const struct ixgbe_info *ii = ixgbe_info_tbl[ent->driver_data];
10254
	int i, err, pci_using_dac, expected_gts;
10255
	unsigned int indices = MAX_TX_QUEUES;
10256
	u8 part_str[IXGBE_PBANUM_LENGTH];
10257
	bool disable_dev = false;
10258 10259 10260
#ifdef IXGBE_FCOE
	u16 device_caps;
#endif
10261
	u32 eec;
10262

10263 10264 10265 10266 10267 10268 10269 10270 10271
	/* 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;
	}

10272
	err = pci_enable_device_mem(pdev);
10273 10274 10275
	if (err)
		return err;

10276
	if (!dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64))) {
10277 10278
		pci_using_dac = 1;
	} else {
10279
		err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
10280
		if (err) {
10281 10282 10283
			dev_err(&pdev->dev,
				"No usable DMA configuration, aborting\n");
			goto err_dma;
10284 10285 10286 10287
		}
		pci_using_dac = 0;
	}

10288
	err = pci_request_mem_regions(pdev, ixgbe_driver_name);
10289
	if (err) {
10290 10291
		dev_err(&pdev->dev,
			"pci_request_selected_regions failed 0x%x\n", err);
10292 10293 10294
		goto err_pci_reg;
	}

10295
	pci_enable_pcie_error_reporting(pdev);
10296

10297
	pci_set_master(pdev);
10298
	pci_save_state(pdev);
10299

10300
	if (ii->mac == ixgbe_mac_82598EB) {
10301
#ifdef CONFIG_IXGBE_DCB
10302 10303 10304 10305
		/* 8 TC w/ 4 queues per TC */
		indices = 4 * MAX_TRAFFIC_CLASS;
#else
		indices = IXGBE_MAX_RSS_INDICES;
10306
#endif
10307
	}
10308

10309
	netdev = alloc_etherdev_mq(sizeof(struct ixgbe_adapter), indices);
10310 10311 10312 10313 10314 10315 10316 10317 10318 10319 10320 10321 10322
	if (!netdev) {
		err = -ENOMEM;
		goto err_alloc_etherdev;
	}

	SET_NETDEV_DEV(netdev, &pdev->dev);

	adapter = netdev_priv(netdev);

	adapter->netdev = netdev;
	adapter->pdev = pdev;
	hw = &adapter->hw;
	hw->back = adapter;
10323
	adapter->msg_enable = netif_msg_init(debug, DEFAULT_MSG_ENABLE);
10324

10325
	hw->hw_addr = ioremap(pci_resource_start(pdev, 0),
10326
			      pci_resource_len(pdev, 0));
10327
	adapter->io_addr = hw->hw_addr;
10328 10329 10330 10331 10332
	if (!hw->hw_addr) {
		err = -EIO;
		goto err_ioremap;
	}

10333
	netdev->netdev_ops = &ixgbe_netdev_ops;
10334 10335
	ixgbe_set_ethtool_ops(netdev);
	netdev->watchdog_timeo = 5 * HZ;
10336
	strlcpy(netdev->name, pci_name(pdev), sizeof(netdev->name));
10337 10338

	/* Setup hw api */
10339
	hw->mac.ops   = *ii->mac_ops;
10340
	hw->mac.type  = ii->mac;
10341
	hw->mvals     = ii->mvals;
10342 10343
	if (ii->link_ops)
		hw->link.ops  = *ii->link_ops;
10344

10345
	/* EEPROM */
10346
	hw->eeprom.ops = *ii->eeprom_ops;
10347
	eec = IXGBE_READ_REG(hw, IXGBE_EEC(hw));
10348 10349 10350 10351
	if (ixgbe_removed(hw->hw_addr)) {
		err = -EIO;
		goto err_ioremap;
	}
10352
	/* If EEPROM is valid (bit 8 = 1), use default otherwise use bit bang */
J
Jacob Keller 已提交
10353
	if (!(eec & BIT(8)))
10354 10355 10356
		hw->eeprom.ops.read = &ixgbe_read_eeprom_bit_bang_generic;

	/* PHY */
10357
	hw->phy.ops = *ii->phy_ops;
D
Donald Skidmore 已提交
10358
	hw->phy.sfp_type = ixgbe_sfp_type_unknown;
10359 10360 10361 10362 10363 10364 10365
	/* 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 已提交
10366

10367
	/* setup the private structure */
10368
	err = ixgbe_sw_init(adapter, ii);
10369 10370 10371
	if (err)
		goto err_sw_init;

10372 10373 10374 10375
	/* Make sure the SWFW semaphore is in a valid state */
	if (hw->mac.ops.init_swfw_sync)
		hw->mac.ops.init_swfw_sync(hw);

10376
	/* Make it possible the adapter to be woken up via WOL */
D
Don Skidmore 已提交
10377 10378 10379
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
10380 10381
	case ixgbe_mac_X550:
	case ixgbe_mac_X550EM_x:
10382
	case ixgbe_mac_x550em_a:
10383
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
D
Don Skidmore 已提交
10384 10385 10386 10387
		break;
	default:
		break;
	}
10388

10389 10390 10391 10392 10393 10394 10395
	/*
	 * 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)
10396
			e_crit(probe, "Fan has stopped, replace the adapter\n");
10397 10398
	}

10399 10400 10401
	if (allow_unsupported_sfp)
		hw->allow_unsupported_sfp = allow_unsupported_sfp;

10402
	/* reset_hw fills in the perm_addr as well */
10403
	hw->phy.reset_if_overtemp = true;
10404
	err = hw->mac.ops.reset_hw(hw);
10405
	hw->phy.reset_if_overtemp = false;
10406
	ixgbe_set_eee_capable(adapter);
10407
	if (err == IXGBE_ERR_SFP_NOT_PRESENT) {
10408 10409
		err = 0;
	} else if (err == IXGBE_ERR_SFP_NOT_SUPPORTED) {
D
Don Skidmore 已提交
10410 10411
		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");
10412 10413
		goto err_sw_init;
	} else if (err) {
10414
		e_dev_err("HW Init failed: %d\n", err);
10415 10416 10417
		goto err_sw_init;
	}

10418
#ifdef CONFIG_PCI_IOV
10419 10420 10421 10422 10423
	/* 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);
10424
	hw->mbx.ops = ii->mbx_ops;
10425
	pci_sriov_set_totalvfs(pdev, IXGBE_MAX_VFS_DRV_LIMIT);
10426
	ixgbe_enable_sriov(adapter, max_vfs);
10427
skip_sriov:
10428

10429
#endif
10430
	netdev->features = NETIF_F_SG |
10431 10432 10433
			   NETIF_F_TSO |
			   NETIF_F_TSO6 |
			   NETIF_F_RXHASH |
10434
			   NETIF_F_RXCSUM |
10435 10436 10437 10438
			   NETIF_F_HW_CSUM;

#define IXGBE_GSO_PARTIAL_FEATURES (NETIF_F_GSO_GRE | \
				    NETIF_F_GSO_GRE_CSUM | \
10439
				    NETIF_F_GSO_IPXIP4 | \
10440
				    NETIF_F_GSO_IPXIP6 | \
10441 10442 10443 10444 10445 10446
				    NETIF_F_GSO_UDP_TUNNEL | \
				    NETIF_F_GSO_UDP_TUNNEL_CSUM)

	netdev->gso_partial_features = IXGBE_GSO_PARTIAL_FEATURES;
	netdev->features |= NETIF_F_GSO_PARTIAL |
			    IXGBE_GSO_PARTIAL_FEATURES;
10447

10448
	if (hw->mac.type >= ixgbe_mac_82599EB)
10449
		netdev->features |= NETIF_F_SCTP_CRC;
10450 10451

	/* copy netdev features into list of user selectable features */
10452
	netdev->hw_features |= netdev->features |
10453
			       NETIF_F_HW_VLAN_CTAG_FILTER |
10454 10455 10456
			       NETIF_F_HW_VLAN_CTAG_RX |
			       NETIF_F_HW_VLAN_CTAG_TX |
			       NETIF_F_RXALL |
10457 10458 10459 10460
			       NETIF_F_HW_L2FW_DOFFLOAD;

	if (hw->mac.type >= ixgbe_mac_82599EB)
		netdev->hw_features |= NETIF_F_NTUPLE |
10461
				       NETIF_F_HW_TC;
10462

10463 10464 10465
	if (pci_using_dac)
		netdev->features |= NETIF_F_HIGHDMA;

A
Alexander Duyck 已提交
10466 10467
	netdev->vlan_features |= netdev->features | NETIF_F_TSO_MANGLEID;
	netdev->hw_enc_features |= netdev->vlan_features;
10468 10469 10470 10471 10472
	netdev->mpls_features |= NETIF_F_SG |
				 NETIF_F_TSO |
				 NETIF_F_TSO6 |
				 NETIF_F_HW_CSUM;
	netdev->mpls_features |= IXGBE_GSO_PARTIAL_FEATURES;
A
Alexander Duyck 已提交
10473

10474 10475 10476 10477
	/* set this bit last since it cannot be part of vlan_features */
	netdev->features |= NETIF_F_HW_VLAN_CTAG_FILTER |
			    NETIF_F_HW_VLAN_CTAG_RX |
			    NETIF_F_HW_VLAN_CTAG_TX;
10478

10479
	netdev->priv_flags |= IFF_UNICAST_FLT;
10480
	netdev->priv_flags |= IFF_SUPP_NOFCS;
10481

10482 10483 10484 10485
	/* MTU range: 68 - 9710 */
	netdev->min_mtu = ETH_MIN_MTU;
	netdev->max_mtu = IXGBE_MAX_JUMBO_FRAME_SIZE - (ETH_HLEN + ETH_FCS_LEN);

J
Jeff Kirsher 已提交
10486
#ifdef CONFIG_IXGBE_DCB
10487
	if (adapter->flags & IXGBE_FLAG_DCB_CAPABLE)
10488
		netdev->dcbnl_ops = &ixgbe_dcbnl_ops;
10489 10490
#endif

10491
#ifdef IXGBE_FCOE
10492
	if (adapter->flags & IXGBE_FLAG_FCOE_CAPABLE) {
10493 10494
		unsigned int fcoe_l;

10495 10496
		if (hw->mac.ops.get_device_caps) {
			hw->mac.ops.get_device_caps(hw, &device_caps);
10497 10498
			if (device_caps & IXGBE_DEVICE_CAPS_FCOE_OFFLOADS)
				adapter->flags &= ~IXGBE_FLAG_FCOE_CAPABLE;
10499
		}
10500

10501 10502 10503

		fcoe_l = min_t(int, IXGBE_FCRETA_SIZE, num_online_cpus());
		adapter->ring_feature[RING_F_FCOE].limit = fcoe_l;
10504

10505 10506 10507
		netdev->features |= NETIF_F_FSO |
				    NETIF_F_FCOE_CRC;

10508 10509 10510
		netdev->vlan_features |= NETIF_F_FSO |
					 NETIF_F_FCOE_CRC |
					 NETIF_F_FCOE_MTU;
10511
	}
10512
#endif /* IXGBE_FCOE */
10513

10514 10515
	if (adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE)
		netdev->hw_features |= NETIF_F_LRO;
10516
	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
A
Alexander Duyck 已提交
10517 10518
		netdev->features |= NETIF_F_LRO;

10519
	/* make sure the EEPROM is good */
10520
	if (hw->eeprom.ops.validate_checksum(hw, NULL) < 0) {
10521
		e_dev_err("The EEPROM Checksum Is Not Valid\n");
10522
		err = -EIO;
10523
		goto err_sw_init;
10524 10525
	}

10526 10527
	eth_platform_get_mac_address(&adapter->pdev->dev,
				     adapter->hw.mac.perm_addr);
10528

10529 10530
	memcpy(netdev->dev_addr, hw->mac.perm_addr, netdev->addr_len);

10531
	if (!is_valid_ether_addr(netdev->dev_addr)) {
10532
		e_dev_err("invalid MAC address\n");
10533
		err = -EIO;
10534
		goto err_sw_init;
10535 10536
	}

10537 10538
	/* Set hw->mac.addr to permanent MAC address */
	ether_addr_copy(hw->mac.addr, hw->mac.perm_addr);
10539
	ixgbe_mac_set_default_filter(adapter);
10540

10541
	timer_setup(&adapter->service_timer, ixgbe_service_timer, 0);
10542

10543 10544 10545 10546
	if (ixgbe_removed(hw->hw_addr)) {
		err = -EIO;
		goto err_sw_init;
	}
10547
	INIT_WORK(&adapter->service_task, ixgbe_service_task);
10548
	set_bit(__IXGBE_SERVICE_INITED, &adapter->state);
10549
	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
10550

10551 10552 10553
	err = ixgbe_init_interrupt_scheme(adapter);
	if (err)
		goto err_sw_init;
10554

10555 10556 10557 10558
	for (i = 0; i < adapter->num_rx_queues; i++)
		u64_stats_init(&adapter->rx_ring[i]->syncp);
	for (i = 0; i < adapter->num_tx_queues; i++)
		u64_stats_init(&adapter->tx_ring[i]->syncp);
10559 10560 10561
	for (i = 0; i < adapter->num_xdp_queues; i++)
		u64_stats_init(&adapter->xdp_ring[i]->syncp);

10562
	/* WOL not supported for all devices */
E
Emil Tantilov 已提交
10563
	adapter->wol = 0;
10564
	hw->eeprom.ops.read(hw, 0x2c, &adapter->eeprom_cap);
10565
	hw->wol_enabled = ixgbe_wol_supported(adapter, pdev->device,
D
Don Skidmore 已提交
10566
						pdev->subsystem_device);
10567
	if (hw->wol_enabled)
10568
		adapter->wol = IXGBE_WUFC_MAG;
E
Emil Tantilov 已提交
10569

10570 10571
	device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);

10572 10573 10574 10575
	/* save off EEPROM version number */
	hw->eeprom.ops.read(hw, 0x2e, &adapter->eeprom_verh);
	hw->eeprom.ops.read(hw, 0x2d, &adapter->eeprom_verl);

10576
	/* pick up the PCI bus settings for reporting later */
10577
	if (ixgbe_pcie_from_parent(hw))
10578
		ixgbe_get_parent_bus_info(adapter);
10579 10580
	else
		 hw->mac.ops.get_bus_info(hw);
10581

10582 10583 10584 10585 10586 10587 10588 10589 10590 10591 10592 10593
	/* 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;
10594
	}
10595 10596 10597 10598

	/* don't check link if we failed to enumerate functions */
	if (expected_gts > 0)
		ixgbe_check_minimum_link(adapter, expected_gts);
10599

10600
	err = ixgbe_read_pba_string_generic(hw, part_str, sizeof(part_str));
10601
	if (err)
10602
		strlcpy(part_str, "Unknown", sizeof(part_str));
10603 10604 10605
	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,
10606
			   part_str);
10607 10608 10609 10610 10611 10612
	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);

10613
	/* reset the hardware with the new settings */
10614 10615 10616
	err = hw->mac.ops.start_hw(hw);
	if (err == IXGBE_ERR_EEPROM_VERSION) {
		/* We are running on a pre-production device, log a warning */
10617 10618 10619 10620 10621 10622
		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");
10623
	}
10624
	strcpy(netdev->name, "eth%d");
10625
	pci_set_drvdata(pdev, adapter);
10626 10627 10628 10629
	err = register_netdev(netdev);
	if (err)
		goto err_register;

10630

10631 10632
	/* power down the optics for 82599 SFP+ fiber */
	if (hw->mac.ops.disable_tx_laser)
10633 10634
		hw->mac.ops.disable_tx_laser(hw);

10635 10636 10637
	/* carrier off reporting is important to ethtool even BEFORE open */
	netif_carrier_off(netdev);

10638
#ifdef CONFIG_IXGBE_DCA
10639
	if (dca_add_requester(&pdev->dev) == 0) {
10640 10641 10642 10643
		adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
		ixgbe_setup_dca(adapter);
	}
#endif
10644
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
10645
		e_info(probe, "IOV is enabled with %d VFs\n", adapter->num_vfs);
10646 10647 10648 10649
		for (i = 0; i < adapter->num_vfs; i++)
			ixgbe_vf_configuration(pdev, (i | 0x10000000));
	}

10650 10651 10652
	/* firmware requires driver version to be 0xFFFFFFFF
	 * since os does not support feature
	 */
E
Emil Tantilov 已提交
10653
	if (hw->mac.ops.set_fw_drv_ver)
10654 10655 10656
		hw->mac.ops.set_fw_drv_ver(hw, 0xFF, 0xFF, 0xFF, 0xFF,
					   sizeof(ixgbe_driver_version) - 1,
					   ixgbe_driver_version);
E
Emil Tantilov 已提交
10657

10658 10659
	/* add san mac addr to netdev */
	ixgbe_add_sanmac_netdev(netdev);
10660

10661
	e_dev_info("%s\n", ixgbe_default_device_descr);
10662

10663
#ifdef CONFIG_IXGBE_HWMON
10664 10665
	if (ixgbe_sysfs_init(adapter))
		e_err(probe, "failed to allocate sysfs resources\n");
10666
#endif /* CONFIG_IXGBE_HWMON */
10667

C
Catherine Sullivan 已提交
10668 10669
	ixgbe_dbg_adapter_init(adapter);

10670 10671
	/* 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)
10672 10673 10674 10675
		hw->mac.ops.setup_link(hw,
			IXGBE_LINK_SPEED_10GB_FULL | IXGBE_LINK_SPEED_1GB_FULL,
			true);

10676 10677 10678
	return 0;

err_register:
10679
	ixgbe_release_hw_control(adapter);
10680
	ixgbe_clear_interrupt_scheme(adapter);
10681
err_sw_init:
10682
	ixgbe_disable_sriov(adapter);
10683
	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
10684
	iounmap(adapter->io_addr);
10685
	kfree(adapter->jump_tables[0]);
10686
	kfree(adapter->mac_table);
10687
	kfree(adapter->rss_key);
10688
err_ioremap:
10689
	disable_dev = !test_and_set_bit(__IXGBE_DISABLED, &adapter->state);
10690 10691
	free_netdev(netdev);
err_alloc_etherdev:
10692
	pci_release_mem_regions(pdev);
10693 10694
err_pci_reg:
err_dma:
10695
	if (!adapter || disable_dev)
10696
		pci_disable_device(pdev);
10697 10698 10699 10700 10701 10702 10703 10704 10705 10706 10707 10708
	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.
 **/
10709
static void ixgbe_remove(struct pci_dev *pdev)
10710
{
10711
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
10712
	struct net_device *netdev;
10713
	bool disable_dev;
10714
	int i;
10715

10716 10717 10718 10719 10720
	/* if !adapter then we already cleaned up in probe */
	if (!adapter)
		return;

	netdev  = adapter->netdev;
C
Catherine Sullivan 已提交
10721 10722
	ixgbe_dbg_adapter_exit(adapter);

10723
	set_bit(__IXGBE_REMOVING, &adapter->state);
10724
	cancel_work_sync(&adapter->service_task);
10725

10726

10727
#ifdef CONFIG_IXGBE_DCA
10728 10729 10730
	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED) {
		adapter->flags &= ~IXGBE_FLAG_DCA_ENABLED;
		dca_remove_requester(&pdev->dev);
10731 10732
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL,
				IXGBE_DCA_CTRL_DCA_DISABLE);
10733 10734 10735
	}

#endif
10736
#ifdef CONFIG_IXGBE_HWMON
10737
	ixgbe_sysfs_exit(adapter);
10738
#endif /* CONFIG_IXGBE_HWMON */
10739

10740 10741 10742
	/* remove the added san mac */
	ixgbe_del_sanmac_netdev(netdev);

10743
#ifdef CONFIG_PCI_IOV
10744
	ixgbe_disable_sriov(adapter);
10745
#endif
10746 10747 10748
	if (netdev->reg_state == NETREG_REGISTERED)
		unregister_netdev(netdev);

10749
	ixgbe_clear_interrupt_scheme(adapter);
10750

10751
	ixgbe_release_hw_control(adapter);
10752

10753 10754 10755 10756 10757
#ifdef CONFIG_DCB
	kfree(adapter->ixgbe_ieee_pfc);
	kfree(adapter->ixgbe_ieee_ets);

#endif
10758
	iounmap(adapter->io_addr);
10759
	pci_release_mem_regions(pdev);
10760

10761
	e_dev_info("complete\n");
10762

10763 10764 10765 10766 10767 10768 10769 10770
	for (i = 0; i < IXGBE_MAX_LINK_HANDLE; i++) {
		if (adapter->jump_tables[i]) {
			kfree(adapter->jump_tables[i]->input);
			kfree(adapter->jump_tables[i]->mask);
		}
		kfree(adapter->jump_tables[i]);
	}

10771
	kfree(adapter->mac_table);
10772
	kfree(adapter->rss_key);
10773
	disable_dev = !test_and_set_bit(__IXGBE_DISABLED, &adapter->state);
10774 10775
	free_netdev(netdev);

10776
	pci_disable_pcie_error_reporting(pdev);
10777

10778
	if (disable_dev)
10779
		pci_disable_device(pdev);
10780 10781 10782 10783 10784 10785 10786 10787 10788 10789 10790
}

/**
 * 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,
10791
						pci_channel_state_t state)
10792
{
10793 10794
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
10795

10796
#ifdef CONFIG_PCI_IOV
10797
	struct ixgbe_hw *hw = &adapter->hw;
10798 10799 10800 10801 10802 10803 10804 10805 10806 10807
	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;
10808
	while (bdev && (pci_pcie_type(bdev) != PCI_EXP_TYPE_ROOT_PORT))
10809 10810 10811 10812 10813 10814 10815 10816 10817
		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;

10818 10819 10820 10821 10822 10823
	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;
10824 10825 10826 10827 10828 10829 10830 10831 10832 10833 10834 10835 10836 10837 10838 10839 10840 10841 10842 10843 10844 10845

	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;
10846 10847 10848 10849 10850 10851
		case ixgbe_mac_X550:
			device_id = IXGBE_DEV_ID_X550_VF;
			break;
		case ixgbe_mac_X550EM_x:
			device_id = IXGBE_DEV_ID_X550EM_X_VF;
			break;
10852 10853 10854
		case ixgbe_mac_x550em_a:
			device_id = IXGBE_DEV_ID_X550EM_A_VF;
			break;
10855 10856 10857 10858 10859 10860
		default:
			device_id = 0;
			break;
		}

		/* Find the pci device of the offending VF */
J
Jon Mason 已提交
10861
		vfdev = pci_get_device(PCI_VENDOR_ID_INTEL, device_id, NULL);
10862 10863 10864
		while (vfdev) {
			if (vfdev->devfn == (req_id & 0xFF))
				break;
J
Jon Mason 已提交
10865
			vfdev = pci_get_device(PCI_VENDOR_ID_INTEL,
10866 10867 10868 10869 10870 10871 10872 10873
					       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) {
10874
			pcie_flr(vfdev);
G
Greg Rose 已提交
10875 10876
			/* Free device reference count */
			pci_dev_put(vfdev);
10877 10878 10879 10880 10881 10882 10883 10884 10885 10886 10887 10888 10889 10890 10891 10892 10893
		}

		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 */
10894 10895
	if (!test_bit(__IXGBE_SERVICE_INITED, &adapter->state))
		return PCI_ERS_RESULT_DISCONNECT;
10896 10897 10898

	if (!netif_device_present(netdev))
		return PCI_ERS_RESULT_DISCONNECT;
10899

10900
	rtnl_lock();
10901 10902
	netif_device_detach(netdev);

10903 10904
	if (state == pci_channel_io_perm_failure) {
		rtnl_unlock();
10905
		return PCI_ERS_RESULT_DISCONNECT;
10906
	}
10907

10908
	if (netif_running(netdev))
E
Emil Tantilov 已提交
10909
		ixgbe_close_suspend(adapter);
10910 10911 10912 10913

	if (!test_and_set_bit(__IXGBE_DISABLED, &adapter->state))
		pci_disable_device(pdev);
	rtnl_unlock();
10914

10915
	/* Request a slot reset. */
10916 10917 10918 10919 10920 10921 10922 10923 10924 10925 10926
	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)
{
10927
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
10928 10929
	pci_ers_result_t result;
	int err;
10930

10931
	if (pci_enable_device_mem(pdev)) {
10932
		e_err(probe, "Cannot re-enable PCI device after reset.\n");
10933 10934
		result = PCI_ERS_RESULT_DISCONNECT;
	} else {
10935
		smp_mb__before_atomic();
10936
		clear_bit(__IXGBE_DISABLED, &adapter->state);
10937
		adapter->hw.hw_addr = adapter->io_addr;
10938 10939
		pci_set_master(pdev);
		pci_restore_state(pdev);
10940
		pci_save_state(pdev);
10941

10942
		pci_wake_from_d3(pdev, false);
10943

10944
		ixgbe_reset(adapter);
10945
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
10946 10947 10948 10949 10950
		result = PCI_ERS_RESULT_RECOVERED;
	}

	err = pci_cleanup_aer_uncorrect_error_status(pdev);
	if (err) {
10951 10952
		e_dev_err("pci_cleanup_aer_uncorrect_error_status "
			  "failed 0x%0x\n", err);
10953 10954
		/* non-fatal, continue */
	}
10955

10956
	return result;
10957 10958 10959 10960 10961 10962 10963 10964 10965 10966 10967
}

/**
 * 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)
{
10968 10969
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
10970

10971 10972 10973 10974 10975 10976 10977 10978
#ifdef CONFIG_PCI_IOV
	if (adapter->vferr_refcount) {
		e_info(drv, "Resuming after VF err\n");
		adapter->vferr_refcount--;
		return;
	}

#endif
E
Emil Tantilov 已提交
10979
	rtnl_lock();
10980
	if (netif_running(netdev))
E
Emil Tantilov 已提交
10981
		ixgbe_open(netdev);
10982 10983

	netif_device_attach(netdev);
E
Emil Tantilov 已提交
10984
	rtnl_unlock();
10985 10986
}

10987
static const struct pci_error_handlers ixgbe_err_handler = {
10988 10989 10990 10991 10992 10993 10994 10995 10996
	.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,
10997
	.remove   = ixgbe_remove,
10998 10999 11000 11001 11002
#ifdef CONFIG_PM
	.suspend  = ixgbe_suspend,
	.resume   = ixgbe_resume,
#endif
	.shutdown = ixgbe_shutdown,
11003
	.sriov_configure = ixgbe_pci_sriov_configure,
11004 11005 11006 11007 11008 11009 11010 11011 11012 11013 11014 11015
	.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;
11016
	pr_info("%s - version %s\n", ixgbe_driver_string, ixgbe_driver_version);
11017
	pr_info("%s\n", ixgbe_copyright);
11018

11019 11020 11021 11022 11023 11024
	ixgbe_wq = create_singlethread_workqueue(ixgbe_driver_name);
	if (!ixgbe_wq) {
		pr_err("%s: Failed to create workqueue\n", ixgbe_driver_name);
		return -ENOMEM;
	}

C
Catherine Sullivan 已提交
11025 11026
	ixgbe_dbg_init();

11027 11028
	ret = pci_register_driver(&ixgbe_driver);
	if (ret) {
11029
		destroy_workqueue(ixgbe_wq);
11030 11031 11032 11033
		ixgbe_dbg_exit();
		return ret;
	}

11034
#ifdef CONFIG_IXGBE_DCA
11035 11036
	dca_register_notify(&dca_notifier);
#endif
11037

11038
	return 0;
11039
}
11040

11041 11042 11043 11044 11045 11046 11047 11048 11049 11050
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)
{
11051
#ifdef CONFIG_IXGBE_DCA
11052 11053
	dca_unregister_notify(&dca_notifier);
#endif
11054
	pci_unregister_driver(&ixgbe_driver);
C
Catherine Sullivan 已提交
11055 11056

	ixgbe_dbg_exit();
11057 11058 11059 11060
	if (ixgbe_wq) {
		destroy_workqueue(ixgbe_wq);
		ixgbe_wq = NULL;
	}
11061
}
11062

11063
#ifdef CONFIG_IXGBE_DCA
11064
static int ixgbe_notify_dca(struct notifier_block *nb, unsigned long event,
11065
			    void *p)
11066 11067 11068 11069
{
	int ret_val;

	ret_val = driver_for_each_device(&ixgbe_driver.driver, NULL, &event,
11070
					 __ixgbe_notify_dca);
11071 11072 11073

	return ret_val ? NOTIFY_BAD : NOTIFY_DONE;
}
11074

11075
#endif /* CONFIG_IXGBE_DCA */
11076

11077 11078 11079
module_exit(ixgbe_exit_module);

/* ixgbe_main.c */