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

  Intel 10 Gigabit PCI Express Linux driver
D
Don Skidmore 已提交
4
  Copyright(c) 1999 - 2012 Intel Corporation.
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34

  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:
  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>
35
#include <linux/interrupt.h>
36 37
#include <linux/ip.h>
#include <linux/tcp.h>
38
#include <linux/sctp.h>
39
#include <linux/pkt_sched.h>
40
#include <linux/ipv6.h>
41
#include <linux/slab.h>
42 43 44
#include <net/checksum.h>
#include <net/ip6_checksum.h>
#include <linux/ethtool.h>
45
#include <linux/if.h>
46
#include <linux/if_vlan.h>
47
#include <linux/prefetch.h>
48
#include <scsi/fc/fc_fcoe.h>
49 50 51

#include "ixgbe.h"
#include "ixgbe_common.h"
52
#include "ixgbe_dcb_82599.h"
53
#include "ixgbe_sriov.h"
54 55

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

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

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

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

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

140 141 142 143 144
static unsigned int allow_unsupported_sfp;
module_param(allow_unsupported_sfp, uint, 0);
MODULE_PARM_DESC(allow_unsupported_sfp,
		 "Allow unsupported and untested SFP+ modules on 82599-based adapters");

145 146 147 148 149
#define DEFAULT_MSG_ENABLE (NETIF_MSG_DRV|NETIF_MSG_PROBE|NETIF_MSG_LINK)
static int debug = -1;
module_param(debug, int, 0);
MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)");

150 151 152 153 154
MODULE_AUTHOR("Intel Corporation, <linux.nics@intel.com>");
MODULE_DESCRIPTION("Intel(R) 10 Gigabit PCI Express Network Driver");
MODULE_LICENSE("GPL");
MODULE_VERSION(DRV_VERSION);

155 156 157 158 159 160 161 162 163 164 165
static void ixgbe_service_event_schedule(struct ixgbe_adapter *adapter)
{
	if (!test_bit(__IXGBE_DOWN, &adapter->state) &&
	    !test_and_set_bit(__IXGBE_SERVICE_SCHED, &adapter->state))
		schedule_work(&adapter->service_task);
}

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

S
Stephen Hemminger 已提交
166
	/* flush memory to make sure state is correct before next watchdog */
167 168 169 170
	smp_mb__before_clear_bit();
	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
}

171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275
struct ixgbe_reg_info {
	u32 ofs;
	char *name;
};

static const struct ixgbe_reg_info ixgbe_reg_info_tbl[] = {

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

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

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

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

	/* List Terminator */
	{}
};


/*
 * ixgbe_regdump - register printout routine
 */
static void ixgbe_regdump(struct ixgbe_hw *hw, struct ixgbe_reg_info *reginfo)
{
	int i = 0, j = 0;
	char rname[16];
	u32 regs[64];

	switch (reginfo->ofs) {
	case IXGBE_SRRCTL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_SRRCTL(i));
		break;
	case IXGBE_DCA_RXCTRL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_DCA_RXCTRL(i));
		break;
	case IXGBE_RDLEN(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDLEN(i));
		break;
	case IXGBE_RDH(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDH(i));
		break;
	case IXGBE_RDT(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDT(i));
		break;
	case IXGBE_RXDCTL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RXDCTL(i));
		break;
	case IXGBE_RDBAL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDBAL(i));
		break;
	case IXGBE_RDBAH(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_RDBAH(i));
		break;
	case IXGBE_TDBAL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDBAL(i));
		break;
	case IXGBE_TDBAH(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDBAH(i));
		break;
	case IXGBE_TDLEN(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDLEN(i));
		break;
	case IXGBE_TDH(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDH(i));
		break;
	case IXGBE_TDT(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TDT(i));
		break;
	case IXGBE_TXDCTL(0):
		for (i = 0; i < 64; i++)
			regs[i] = IXGBE_READ_REG(hw, IXGBE_TXDCTL(i));
		break;
	default:
276
		pr_info("%-15s %08x\n", reginfo->name,
277 278 279 280 281 282
			IXGBE_READ_REG(hw, reginfo->ofs));
		return;
	}

	for (i = 0; i < 8; i++) {
		snprintf(rname, 16, "%s[%d-%d]", reginfo->name, i*8, i*8+7);
283
		pr_err("%-15s", rname);
284
		for (j = 0; j < 8; j++)
285 286
			pr_cont(" %08x", regs[i*8+j]);
		pr_cont("\n");
287 288 289 290 291 292 293 294 295 296 297 298 299 300
	}

}

/*
 * ixgbe_dump - Print registers, tx-rings and rx-rings
 */
static void ixgbe_dump(struct ixgbe_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_reg_info *reginfo;
	int n = 0;
	struct ixgbe_ring *tx_ring;
301
	struct ixgbe_tx_buffer *tx_buffer;
302 303 304 305 306 307 308 309 310 311 312 313 314 315
	union ixgbe_adv_tx_desc *tx_desc;
	struct my_u0 { u64 a; u64 b; } *u0;
	struct ixgbe_ring *rx_ring;
	union ixgbe_adv_rx_desc *rx_desc;
	struct ixgbe_rx_buffer *rx_buffer_info;
	u32 staterr;
	int i = 0;

	if (!netif_msg_hw(adapter))
		return;

	/* Print netdevice Info */
	if (netdev) {
		dev_info(&adapter->pdev->dev, "Net device Info\n");
316
		pr_info("Device Name     state            "
317
			"trans_start      last_rx\n");
318 319 320 321 322
		pr_info("%-15s %016lX %016lX %016lX\n",
			netdev->name,
			netdev->state,
			netdev->trans_start,
			netdev->last_rx);
323 324 325 326
	}

	/* Print Registers */
	dev_info(&adapter->pdev->dev, "Register Dump\n");
327
	pr_info(" Register Name   Value\n");
328 329 330 331 332 333 334 335 336 337
	for (reginfo = (struct ixgbe_reg_info *)ixgbe_reg_info_tbl;
	     reginfo->name; reginfo++) {
		ixgbe_regdump(hw, reginfo);
	}

	/* Print TX Ring Summary */
	if (!netdev || !netif_running(netdev))
		goto exit;

	dev_info(&adapter->pdev->dev, "TX Rings Summary\n");
338
	pr_info("Queue [NTU] [NTC] [bi(ntc)->dma  ] leng ntw timestamp\n");
339 340
	for (n = 0; n < adapter->num_tx_queues; n++) {
		tx_ring = adapter->tx_ring[n];
341
		tx_buffer = &tx_ring->tx_buffer_info[tx_ring->next_to_clean];
342
		pr_info(" %5d %5X %5X %016llX %04X %p %016llX\n",
343
			   n, tx_ring->next_to_use, tx_ring->next_to_clean,
344 345 346 347
			   (u64)dma_unmap_addr(tx_buffer, dma),
			   dma_unmap_len(tx_buffer, len),
			   tx_buffer->next_to_watch,
			   (u64)tx_buffer->time_stamp);
348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368
	}

	/* 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
	 *
	 * Advanced Transmit Descriptor
	 *   +--------------------------------------------------------------+
	 * 0 |         Buffer Address [63:0]                                |
	 *   +--------------------------------------------------------------+
	 * 8 |  PAYLEN  | PORTS  | IDX | STA | DCMD  |DTYP |  RSV |  DTALEN |
	 *   +--------------------------------------------------------------+
	 *   63       46 45    40 39 36 35 32 31   24 23 20 19              0
	 */

	for (n = 0; n < adapter->num_tx_queues; n++) {
		tx_ring = adapter->tx_ring[n];
369 370 371 372
		pr_info("------------------------------------\n");
		pr_info("TX QUEUE INDEX = %d\n", tx_ring->queue_index);
		pr_info("------------------------------------\n");
		pr_info("T [desc]     [address 63:0  ] "
373 374 375 376
			"[PlPOIdStDDt Ln] [bi->dma       ] "
			"leng  ntw timestamp        bi->skb\n");

		for (i = 0; tx_ring->desc && (i < tx_ring->count); i++) {
377
			tx_desc = IXGBE_TX_DESC(tx_ring, i);
378
			tx_buffer = &tx_ring->tx_buffer_info[i];
379
			u0 = (struct my_u0 *)tx_desc;
380
			pr_info("T [0x%03X]    %016llX %016llX %016llX"
381
				" %04X  %p %016llX %p", i,
382 383
				le64_to_cpu(u0->a),
				le64_to_cpu(u0->b),
384 385 386 387 388
				(u64)dma_unmap_addr(tx_buffer, dma),
				dma_unmap_len(tx_buffer, len),
				tx_buffer->next_to_watch,
				(u64)tx_buffer->time_stamp,
				tx_buffer->skb);
389 390
			if (i == tx_ring->next_to_use &&
				i == tx_ring->next_to_clean)
391
				pr_cont(" NTC/U\n");
392
			else if (i == tx_ring->next_to_use)
393
				pr_cont(" NTU\n");
394
			else if (i == tx_ring->next_to_clean)
395
				pr_cont(" NTC\n");
396
			else
397
				pr_cont("\n");
398 399

			if (netif_msg_pktdata(adapter) &&
400
			    tx_buffer->skb)
401 402
				print_hex_dump(KERN_INFO, "",
					DUMP_PREFIX_ADDRESS, 16, 1,
403
					tx_buffer->skb->data,
404 405
					dma_unmap_len(tx_buffer, len),
					true);
406 407 408 409 410 411
		}
	}

	/* Print RX Rings Summary */
rx_ring_summary:
	dev_info(&adapter->pdev->dev, "RX Rings Summary\n");
412
	pr_info("Queue [NTU] [NTC]\n");
413 414
	for (n = 0; n < adapter->num_rx_queues; n++) {
		rx_ring = adapter->rx_ring[n];
415 416
		pr_info("%5d %5X %5X\n",
			n, rx_ring->next_to_use, rx_ring->next_to_clean);
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
	}

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

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

	/* Advanced Receive Descriptor (Read) Format
	 *    63                                           1        0
	 *    +-----------------------------------------------------+
	 *  0 |       Packet Buffer Address [63:1]           |A0/NSE|
	 *    +----------------------------------------------+------+
	 *  8 |       Header Buffer Address [63:1]           |  DD  |
	 *    +-----------------------------------------------------+
	 *
	 *
	 * Advanced Receive Descriptor (Write-Back) Format
	 *
	 *   63       48 47    32 31  30      21 20 16 15   4 3     0
	 *   +------------------------------------------------------+
	 * 0 | Packet     IP     |SPH| HDR_LEN   | RSV|Packet|  RSS |
	 *   | Checksum   Ident  |   |           |    | Type | Type |
	 *   +------------------------------------------------------+
	 * 8 | VLAN Tag | Length | Extended Error | Extended Status |
	 *   +------------------------------------------------------+
	 *   63       48 47    32 31            20 19               0
	 */
	for (n = 0; n < adapter->num_rx_queues; n++) {
		rx_ring = adapter->rx_ring[n];
447 448 449 450
		pr_info("------------------------------------\n");
		pr_info("RX QUEUE INDEX = %d\n", rx_ring->queue_index);
		pr_info("------------------------------------\n");
		pr_info("R  [desc]      [ PktBuf     A0] "
451 452
			"[  HeadBuf   DD] [bi->dma       ] [bi->skb] "
			"<-- Adv Rx Read format\n");
453
		pr_info("RWB[desc]      [PcsmIpSHl PtRs] "
454 455 456 457 458
			"[vl er S cks ln] ---------------- [bi->skb] "
			"<-- Adv Rx Write-Back format\n");

		for (i = 0; i < rx_ring->count; i++) {
			rx_buffer_info = &rx_ring->rx_buffer_info[i];
459
			rx_desc = IXGBE_RX_DESC(rx_ring, i);
460 461 462 463
			u0 = (struct my_u0 *)rx_desc;
			staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
			if (staterr & IXGBE_RXD_STAT_DD) {
				/* Descriptor Done */
464
				pr_info("RWB[0x%03X]     %016llX "
465 466 467 468 469
					"%016llX ---------------- %p", i,
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
					rx_buffer_info->skb);
			} else {
470
				pr_info("R  [0x%03X]     %016llX "
471 472 473 474 475 476
					"%016llX %016llX %p", i,
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
					(u64)rx_buffer_info->dma,
					rx_buffer_info->skb);

477 478
				if (netif_msg_pktdata(adapter) &&
				    rx_buffer_info->dma) {
479 480
					print_hex_dump(KERN_INFO, "",
					   DUMP_PREFIX_ADDRESS, 16, 1,
481 482
					   page_address(rx_buffer_info->page) +
						    rx_buffer_info->page_offset,
483
					   ixgbe_rx_bufsz(rx_ring), true);
484 485 486 487
				}
			}

			if (i == rx_ring->next_to_use)
488
				pr_cont(" NTU\n");
489
			else if (i == rx_ring->next_to_clean)
490
				pr_cont(" NTC\n");
491
			else
492
				pr_cont("\n");
493 494 495 496 497 498 499 500

		}
	}

exit:
	return;
}

501 502 503 504 505 506 507
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,
508
			ctrl_ext & ~IXGBE_CTRL_EXT_DRV_LOAD);
509 510 511 512 513 514 515 516 517
}

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,
518
			ctrl_ext | IXGBE_CTRL_EXT_DRV_LOAD);
519
}
520

521
/**
522 523 524 525 526 527 528 529
 * 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,
530
			   u8 queue, u8 msix_vector)
531 532
{
	u32 ivar, index;
533 534 535 536 537 538 539 540 541 542 543 544 545
	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 已提交
546
	case ixgbe_mac_X540:
547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568
		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;
	}
569 570
}

571
static inline void ixgbe_irq_rearm_queues(struct ixgbe_adapter *adapter,
572
					  u64 qmask)
573 574 575
{
	u32 mask;

576 577
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
578 579
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS, mask);
580 581
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
582
	case ixgbe_mac_X540:
583 584 585 586
		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);
587 588 589
		break;
	default:
		break;
590 591 592
	}
}

593 594
void ixgbe_unmap_and_free_tx_resource(struct ixgbe_ring *ring,
				      struct ixgbe_tx_buffer *tx_buffer)
595
{
596 597 598
	if (tx_buffer->skb) {
		dev_kfree_skb_any(tx_buffer->skb);
		if (dma_unmap_len(tx_buffer, len))
599
			dma_unmap_single(ring->dev,
600 601 602 603 604 605 606 607
					 dma_unmap_addr(tx_buffer, dma),
					 dma_unmap_len(tx_buffer, len),
					 DMA_TO_DEVICE);
	} else if (dma_unmap_len(tx_buffer, len)) {
		dma_unmap_page(ring->dev,
			       dma_unmap_addr(tx_buffer, dma),
			       dma_unmap_len(tx_buffer, len),
			       DMA_TO_DEVICE);
608
	}
609 610 611 612
	tx_buffer->next_to_watch = NULL;
	tx_buffer->skb = NULL;
	dma_unmap_len_set(tx_buffer, len, 0);
	/* tx_buffer must be completely set up in the transmit path */
613 614
}

615
static void ixgbe_update_xoff_rx_lfc(struct ixgbe_adapter *adapter)
616 617 618 619
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_hw_stats *hwstats = &adapter->stats;
	int i;
620
	u32 data;
621

622 623 624
	if ((hw->fc.current_mode != ixgbe_fc_full) &&
	    (hw->fc.current_mode != ixgbe_fc_rx_pause))
		return;
625

626 627 628 629 630 631 632 633
	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;
634

635 636
	/* refill credits (no tx hang) if we received xoff */
	if (!data)
637
		return;
638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656

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

static void ixgbe_update_xoff_received(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct ixgbe_hw_stats *hwstats = &adapter->stats;
	u32 xoff[8] = {0};
	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);
657
		return;
658
	}
659 660 661 662 663 664

	/* update stats for each tc, only valid with PFC enabled */
	for (i = 0; i < MAX_TX_PACKET_BUFFERS; i++) {
		switch (hw->mac.type) {
		case ixgbe_mac_82598EB:
			xoff[i] = IXGBE_READ_REG(hw, IXGBE_PXOFFRXC(i));
665
			break;
666 667
		default:
			xoff[i] = IXGBE_READ_REG(hw, IXGBE_PXOFFRXCNT(i));
668
		}
669 670 671 672 673 674
		hwstats->pxoffrxc[i] += xoff[i];
	}

	/* 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];
675
		u8 tc = tx_ring->dcb_tc;
676 677 678

		if (xoff[tc])
			clear_bit(__IXGBE_HANG_CHECK_ARMED, &tx_ring->state);
679 680 681
	}
}

682
static u64 ixgbe_get_tx_completed(struct ixgbe_ring *ring)
683
{
684
	return ring->stats.packets;
685 686 687 688 689
}

static u64 ixgbe_get_tx_pending(struct ixgbe_ring *ring)
{
	struct ixgbe_adapter *adapter = netdev_priv(ring->netdev);
690 691
	struct ixgbe_hw *hw = &adapter->hw;

692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708
	u32 head = IXGBE_READ_REG(hw, IXGBE_TDH(ring->reg_idx));
	u32 tail = IXGBE_READ_REG(hw, IXGBE_TDT(ring->reg_idx));

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

	return 0;
}

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

A
Alexander Duyck 已提交
709
	clear_check_for_tx_hang(tx_ring);
710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731

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

734
	return ret;
735 736
}

737 738 739 740 741 742 743 744 745 746 747 748 749
/**
 * ixgbe_tx_timeout_reset - initiate reset due to Tx timeout
 * @adapter: driver private struct
 **/
static void ixgbe_tx_timeout_reset(struct ixgbe_adapter *adapter)
{

	/* Do the reset outside of interrupt context */
	if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
		adapter->flags2 |= IXGBE_FLAG2_RESET_REQUESTED;
		ixgbe_service_event_schedule(adapter);
	}
}
750

751 752
/**
 * ixgbe_clean_tx_irq - Reclaim resources after transmit completes
753
 * @q_vector: structure containing interrupt and ring information
754
 * @tx_ring: tx ring to clean
755
 **/
756
static bool ixgbe_clean_tx_irq(struct ixgbe_q_vector *q_vector,
757
			       struct ixgbe_ring *tx_ring)
758
{
759
	struct ixgbe_adapter *adapter = q_vector->adapter;
760 761
	struct ixgbe_tx_buffer *tx_buffer;
	union ixgbe_adv_tx_desc *tx_desc;
762
	unsigned int total_bytes = 0, total_packets = 0;
763
	unsigned int budget = q_vector->tx.work_limit;
764 765 766 767
	unsigned int i = tx_ring->next_to_clean;

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

769
	tx_buffer = &tx_ring->tx_buffer_info[i];
770
	tx_desc = IXGBE_TX_DESC(tx_ring, i);
771
	i -= tx_ring->count;
772

773
	do {
774 775 776 777 778 779
		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;

780 781 782
		/* prevent any other reads prior to eop_desc */
		rmb();

783 784 785
		/* if DD is not set pending work has not been completed */
		if (!(eop_desc->wb.status & cpu_to_le32(IXGBE_TXD_STAT_DD)))
			break;
786

787 788
		/* clear next_to_watch to prevent false hangs */
		tx_buffer->next_to_watch = NULL;
789

790 791 792 793
		/* update the statistics for this packet */
		total_bytes += tx_buffer->bytecount;
		total_packets += tx_buffer->gso_segs;

794
#ifdef CONFIG_IXGBE_PTP
J
Jacob Keller 已提交
795 796
		if (unlikely(tx_buffer->tx_flags & IXGBE_TX_FLAGS_TSTAMP))
			ixgbe_ptp_tx_hwtstamp(q_vector, tx_buffer->skb);
797
#endif
J
Jacob Keller 已提交
798

799 800 801
		/* free the skb */
		dev_kfree_skb_any(tx_buffer->skb);

802 803 804 805 806 807
		/* 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);

808 809
		/* clear tx_buffer data */
		tx_buffer->skb = NULL;
810
		dma_unmap_len_set(tx_buffer, len, 0);
811

812 813
		/* unmap remaining buffers */
		while (tx_desc != eop_desc) {
814 815
			tx_buffer++;
			tx_desc++;
816
			i++;
817 818
			if (unlikely(!i)) {
				i -= tx_ring->count;
819
				tx_buffer = tx_ring->tx_buffer_info;
820
				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
821
			}
822

823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844
			/* 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);
845

846 847 848 849 850
		/* update budget accounting */
		budget--;
	} while (likely(budget));

	i += tx_ring->count;
851
	tx_ring->next_to_clean = i;
852
	u64_stats_update_begin(&tx_ring->syncp);
853
	tx_ring->stats.bytes += total_bytes;
854
	tx_ring->stats.packets += total_packets;
855
	u64_stats_update_end(&tx_ring->syncp);
856 857
	q_vector->tx.total_bytes += total_bytes;
	q_vector->tx.total_packets += total_packets;
858

859 860 861 862 863 864 865 866 867 868 869 870 871 872
	if (check_for_tx_hang(tx_ring) && ixgbe_check_tx_hang(tx_ring)) {
		/* schedule immediate reset if we believe we hung */
		struct ixgbe_hw *hw = &adapter->hw;
		e_err(drv, "Detected Tx Unit Hang\n"
			"  Tx Queue             <%d>\n"
			"  TDH, TDT             <%x>, <%x>\n"
			"  next_to_use          <%x>\n"
			"  next_to_clean        <%x>\n"
			"tx_buffer_info[next_to_clean]\n"
			"  time_stamp           <%lx>\n"
			"  jiffies              <%lx>\n",
			tx_ring->queue_index,
			IXGBE_READ_REG(hw, IXGBE_TDH(tx_ring->reg_idx)),
			IXGBE_READ_REG(hw, IXGBE_TDT(tx_ring->reg_idx)),
873 874
			tx_ring->next_to_use, i,
			tx_ring->tx_buffer_info[i].time_stamp, jiffies);
875 876 877 878 879 880 881

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

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

882
		/* schedule immediate reset if we believe we hung */
883
		ixgbe_tx_timeout_reset(adapter);
884 885

		/* the adapter is about to reset, no point in enabling stuff */
886
		return true;
887
	}
888

889 890 891
	netdev_tx_completed_queue(txring_txq(tx_ring),
				  total_packets, total_bytes);

892
#define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
893
	if (unlikely(total_packets && netif_carrier_ok(tx_ring->netdev) &&
894
		     (ixgbe_desc_unused(tx_ring) >= TX_WAKE_THRESHOLD))) {
895 896 897 898
		/* Make sure that anybody stopping the queue after this
		 * sees the new next_to_clean.
		 */
		smp_mb();
899 900 901 902 903
		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);
904
			++tx_ring->tx_stats.restart_queue;
905
		}
906
	}
907

908
	return !!budget;
909 910
}

911
#ifdef CONFIG_IXGBE_DCA
912 913
static void ixgbe_update_tx_dca(struct ixgbe_adapter *adapter,
				struct ixgbe_ring *tx_ring,
914
				int cpu)
915
{
916
	struct ixgbe_hw *hw = &adapter->hw;
917 918
	u32 txctrl = dca3_get_tag(tx_ring->dev, cpu);
	u16 reg_offset;
919 920 921

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
922
		reg_offset = IXGBE_DCA_TXCTRL(tx_ring->reg_idx);
923 924
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
925
	case ixgbe_mac_X540:
926 927
		reg_offset = IXGBE_DCA_TXCTRL_82599(tx_ring->reg_idx);
		txctrl <<= IXGBE_DCA_TXCTRL_CPUID_SHIFT_82599;
928 929
		break;
	default:
930 931
		/* for unknown hardware do not write register */
		return;
932
	}
933 934 935 936 937 938 939 940 941 942 943

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

946 947
static void ixgbe_update_rx_dca(struct ixgbe_adapter *adapter,
				struct ixgbe_ring *rx_ring,
948
				int cpu)
949
{
950
	struct ixgbe_hw *hw = &adapter->hw;
951 952 953
	u32 rxctrl = dca3_get_tag(rx_ring->dev, cpu);
	u8 reg_idx = rx_ring->reg_idx;

954 955 956

	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
957
	case ixgbe_mac_X540:
958
		rxctrl <<= IXGBE_DCA_RXCTRL_CPUID_SHIFT_82599;
959 960 961 962
		break;
	default:
		break;
	}
963 964 965 966 967 968 969 970 971 972 973

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

	IXGBE_WRITE_REG(hw, IXGBE_DCA_RXCTRL(reg_idx), rxctrl);
974 975 976 977 978
}

static void ixgbe_update_dca(struct ixgbe_q_vector *q_vector)
{
	struct ixgbe_adapter *adapter = q_vector->adapter;
979
	struct ixgbe_ring *ring;
980 981
	int cpu = get_cpu();

982 983 984
	if (q_vector->cpu == cpu)
		goto out_no_update;

985
	ixgbe_for_each_ring(ring, q_vector->tx)
986
		ixgbe_update_tx_dca(adapter, ring, cpu);
987

988
	ixgbe_for_each_ring(ring, q_vector->rx)
989
		ixgbe_update_rx_dca(adapter, ring, cpu);
990 991 992

	q_vector->cpu = cpu;
out_no_update:
993 994 995 996 997 998 999 1000 1001 1002
	put_cpu();
}

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

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

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

1006
	for (i = 0; i < adapter->num_q_vectors; i++) {
1007 1008
		adapter->q_vector[i]->cpu = -1;
		ixgbe_update_dca(adapter->q_vector[i]);
1009 1010 1011 1012 1013
	}
}

static int __ixgbe_notify_dca(struct device *dev, void *data)
{
1014
	struct ixgbe_adapter *adapter = dev_get_drvdata(dev);
1015 1016
	unsigned long event = *(unsigned long *)data;

1017
	if (!(adapter->flags & IXGBE_FLAG_DCA_CAPABLE))
1018 1019
		return 0;

1020 1021
	switch (event) {
	case DCA_PROVIDER_ADD:
1022 1023 1024
		/* if we're already enabled, don't do it again */
		if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
			break;
1025
		if (dca_add_requester(dev) == 0) {
1026
			adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039
			ixgbe_setup_dca(adapter);
			break;
		}
		/* Fall Through since DCA is disabled. */
	case DCA_PROVIDER_REMOVE:
		if (adapter->flags & IXGBE_FLAG_DCA_ENABLED) {
			dca_remove_requester(dev);
			adapter->flags &= ~IXGBE_FLAG_DCA_ENABLED;
			IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL, 1);
		}
		break;
	}

1040
	return 0;
1041
}
E
Emil Tantilov 已提交
1042

1043
#endif /* CONFIG_IXGBE_DCA */
1044 1045
static inline void ixgbe_rx_hash(struct ixgbe_ring *ring,
				 union ixgbe_adv_rx_desc *rx_desc,
E
Emil Tantilov 已提交
1046 1047
				 struct sk_buff *skb)
{
1048 1049
	if (ring->netdev->features & NETIF_F_RXHASH)
		skb->rxhash = le32_to_cpu(rx_desc->wb.lower.hi_dword.rss);
E
Emil Tantilov 已提交
1050 1051
}

1052
#ifdef IXGBE_FCOE
1053 1054
/**
 * ixgbe_rx_is_fcoe - check the rx desc for incoming pkt type
1055
 * @ring: structure containing ring specific data
1056 1057 1058 1059
 * @rx_desc: advanced rx descriptor
 *
 * Returns : true if it is FCoE pkt
 */
1060
static inline bool ixgbe_rx_is_fcoe(struct ixgbe_ring *ring,
1061 1062 1063 1064
				    union ixgbe_adv_rx_desc *rx_desc)
{
	__le16 pkt_info = rx_desc->wb.lower.lo_dword.hs_rss.pkt_info;

1065
	return test_bit(__IXGBE_RX_FCOE, &ring->state) &&
1066 1067 1068 1069 1070
	       ((pkt_info & cpu_to_le16(IXGBE_RXDADV_PKTTYPE_ETQF_MASK)) ==
		(cpu_to_le16(IXGBE_ETQF_FILTER_FCOE <<
			     IXGBE_RXDADV_PKTTYPE_ETQF_SHIFT)));
}

1071
#endif /* IXGBE_FCOE */
1072 1073
/**
 * ixgbe_rx_checksum - indicate in skb if hw indicated a good cksum
1074 1075
 * @ring: structure containing ring specific data
 * @rx_desc: current Rx descriptor being processed
1076 1077
 * @skb: skb currently being received and modified
 **/
1078
static inline void ixgbe_rx_checksum(struct ixgbe_ring *ring,
1079
				     union ixgbe_adv_rx_desc *rx_desc,
1080
				     struct sk_buff *skb)
1081
{
1082
	skb_checksum_none_assert(skb);
1083

1084
	/* Rx csum disabled */
1085
	if (!(ring->netdev->features & NETIF_F_RXCSUM))
1086
		return;
1087 1088

	/* if IP and error */
1089 1090
	if (ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_IPCS) &&
	    ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_IPE)) {
1091
		ring->rx_stats.csum_err++;
1092 1093
		return;
	}
1094

1095
	if (!ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_L4CS))
1096 1097
		return;

1098
	if (ixgbe_test_staterr(rx_desc, IXGBE_RXDADV_ERR_TCPE)) {
1099
		__le16 pkt_info = rx_desc->wb.lower.lo_dword.hs_rss.pkt_info;
1100 1101 1102 1103 1104

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

1109
		ring->rx_stats.csum_err++;
1110 1111 1112
		return;
	}

1113
	/* It must be a TCP or UDP packet with a valid checksum */
1114
	skb->ip_summed = CHECKSUM_UNNECESSARY;
1115 1116
}

1117
static inline void ixgbe_release_rx_desc(struct ixgbe_ring *rx_ring, u32 val)
1118
{
1119
	rx_ring->next_to_use = val;
1120 1121 1122

	/* update next to alloc since we have filled the ring */
	rx_ring->next_to_alloc = val;
1123 1124 1125 1126 1127 1128 1129
	/*
	 * 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();
1130
	writel(val, rx_ring->tail);
1131 1132
}

1133 1134 1135 1136
static bool ixgbe_alloc_mapped_page(struct ixgbe_ring *rx_ring,
				    struct ixgbe_rx_buffer *bi)
{
	struct page *page = bi->page;
1137
	dma_addr_t dma = bi->dma;
1138

1139 1140
	/* since we are recycling buffers we should seldom need to alloc */
	if (likely(dma))
1141 1142
		return true;

1143 1144
	/* alloc new page for storage */
	if (likely(!page)) {
1145 1146
		page = __skb_alloc_pages(GFP_ATOMIC | __GFP_COLD | __GFP_COMP,
					 bi->skb, ixgbe_rx_pg_order(rx_ring));
1147 1148 1149 1150
		if (unlikely(!page)) {
			rx_ring->rx_stats.alloc_rx_page_failed++;
			return false;
		}
1151
		bi->page = page;
1152 1153
	}

1154 1155 1156 1157 1158 1159 1160 1161 1162
	/* map page for use */
	dma = dma_map_page(rx_ring->dev, page, 0,
			   ixgbe_rx_pg_size(rx_ring), DMA_FROM_DEVICE);

	/*
	 * if mapping failed free memory back to system since
	 * there isn't much point in holding memory we can't use
	 */
	if (dma_mapping_error(rx_ring->dev, dma)) {
1163
		__free_pages(page, ixgbe_rx_pg_order(rx_ring));
1164
		bi->page = NULL;
1165 1166 1167 1168 1169

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

1170
	bi->dma = dma;
1171
	bi->page_offset = 0;
1172

1173 1174 1175
	return true;
}

1176
/**
1177
 * ixgbe_alloc_rx_buffers - Replace used receive buffers
1178 1179
 * @rx_ring: ring to place buffers on
 * @cleaned_count: number of buffers to replace
1180
 **/
1181
void ixgbe_alloc_rx_buffers(struct ixgbe_ring *rx_ring, u16 cleaned_count)
1182 1183
{
	union ixgbe_adv_rx_desc *rx_desc;
1184
	struct ixgbe_rx_buffer *bi;
1185
	u16 i = rx_ring->next_to_use;
1186

1187 1188
	/* nothing to do */
	if (!cleaned_count)
1189 1190
		return;

1191
	rx_desc = IXGBE_RX_DESC(rx_ring, i);
1192 1193
	bi = &rx_ring->rx_buffer_info[i];
	i -= rx_ring->count;
1194

1195 1196
	do {
		if (!ixgbe_alloc_mapped_page(rx_ring, bi))
1197
			break;
1198

1199 1200 1201 1202 1203
		/*
		 * 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);
1204

1205 1206
		rx_desc++;
		bi++;
1207
		i++;
1208
		if (unlikely(!i)) {
1209
			rx_desc = IXGBE_RX_DESC(rx_ring, 0);
1210 1211 1212 1213 1214 1215
			bi = rx_ring->rx_buffer_info;
			i -= rx_ring->count;
		}

		/* clear the hdr_addr for the next_to_use descriptor */
		rx_desc->read.hdr_addr = 0;
1216 1217 1218

		cleaned_count--;
	} while (cleaned_count);
1219

1220 1221
	i += rx_ring->count;

1222
	if (rx_ring->next_to_use != i)
1223
		ixgbe_release_rx_desc(rx_ring, i);
1224 1225
}

1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286
/**
 * ixgbe_get_headlen - determine size of header for RSC/LRO/GRO/FCOE
 * @data: pointer to the start of the headers
 * @max_len: total length of section to find headers in
 *
 * This function is meant to determine the length of headers that will
 * be recognized by hardware for LRO, GRO, and RSC offloads.  The main
 * motivation of doing this is to only perform one pull for IPv4 TCP
 * packets so that we can do basic things like calculating the gso_size
 * based on the average data per packet.
 **/
static unsigned int ixgbe_get_headlen(unsigned char *data,
				      unsigned int max_len)
{
	union {
		unsigned char *network;
		/* l2 headers */
		struct ethhdr *eth;
		struct vlan_hdr *vlan;
		/* l3 headers */
		struct iphdr *ipv4;
	} hdr;
	__be16 protocol;
	u8 nexthdr = 0;	/* default to not TCP */
	u8 hlen;

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

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

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

	/* handle any vlan tag if present */
	if (protocol == __constant_htons(ETH_P_8021Q)) {
		if ((hdr.network - data) > (max_len - VLAN_HLEN))
			return max_len;

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

	/* handle L3 protocols */
	if (protocol == __constant_htons(ETH_P_IP)) {
		if ((hdr.network - data) > (max_len - sizeof(struct iphdr)))
			return max_len;

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

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

		/* record next protocol */
		nexthdr = hdr.ipv4->protocol;
		hdr.network += hlen;
1287
#ifdef IXGBE_FCOE
1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326
	} else if (protocol == __constant_htons(ETH_P_FCOE)) {
		if ((hdr.network - data) > (max_len - FCOE_HEADER_LEN))
			return max_len;
		hdr.network += FCOE_HEADER_LEN;
#endif
	} else {
		return hdr.network - data;
	}

	/* finally sort out TCP */
	if (nexthdr == IPPROTO_TCP) {
		if ((hdr.network - data) > (max_len - sizeof(struct tcphdr)))
			return max_len;

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

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

		hdr.network += hlen;
	}

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

static void ixgbe_set_rsc_gso_size(struct ixgbe_ring *ring,
				   struct sk_buff *skb)
{
1327
	u16 hdr_len = skb_headlen(skb);
1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349

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

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

1350 1351 1352 1353 1354
/**
 * 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 已提交
1355
 *
1356 1357 1358
 * 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 已提交
1359
 **/
1360 1361 1362
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 已提交
1363
{
1364 1365
	struct net_device *dev = rx_ring->netdev;

1366 1367 1368
	ixgbe_update_rsc_stats(rx_ring, skb);

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

1370 1371
	ixgbe_rx_checksum(rx_ring, rx_desc, skb);

1372
#ifdef CONFIG_IXGBE_PTP
1373
	ixgbe_ptp_rx_hwtstamp(rx_ring->q_vector, rx_desc, skb);
1374 1375
#endif

1376 1377
	if ((dev->features & NETIF_F_HW_VLAN_RX) &&
	    ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_VP)) {
1378 1379
		u16 vid = le16_to_cpu(rx_desc->wb.upper.vlan);
		__vlan_hwaccel_put_tag(skb, vid);
A
Alexander Duyck 已提交
1380 1381
	}

1382
	skb_record_rx_queue(skb, rx_ring->queue_index);
1383

1384
	skb->protocol = eth_type_trans(skb, dev);
A
Alexander Duyck 已提交
1385 1386
}

1387 1388
static void ixgbe_rx_skb(struct ixgbe_q_vector *q_vector,
			 struct sk_buff *skb)
1389
{
1390 1391 1392 1393 1394 1395
	struct ixgbe_adapter *adapter = q_vector->adapter;

	if (!(adapter->flags & IXGBE_FLAG_IN_NETPOLL))
		napi_gro_receive(&q_vector->napi, skb);
	else
		netif_rx(skb);
1396
}
1397

1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420
/**
 * 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));

1421 1422 1423 1424 1425 1426 1427 1428 1429 1430
	/* 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;
1431

1432 1433 1434 1435 1436
			/* 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;
		}
1437 1438
	}

1439 1440 1441 1442
	/* 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;

1443 1444 1445 1446 1447 1448 1449
	/* 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;
}

1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479
/**
 * 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.
	 */
1480
	pull_len = ixgbe_get_headlen(va, IXGBE_RX_HDR_SIZE);
1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491

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

1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521
/**
 * ixgbe_dma_sync_frag - perform DMA sync for first frag of SKB
 * @rx_ring: rx descriptor ring packet is being transacted on
 * @skb: pointer to current skb being updated
 *
 * This function provides a basic DMA sync up for the first fragment of an
 * skb.  The reason for doing this is that the first fragment cannot be
 * unmapped until we have reached the end of packet descriptor for a buffer
 * chain.
 */
static void ixgbe_dma_sync_frag(struct ixgbe_ring *rx_ring,
				struct sk_buff *skb)
{
	/* if the page was released unmap it, else just sync our portion */
	if (unlikely(IXGBE_CB(skb)->page_released)) {
		dma_unmap_page(rx_ring->dev, IXGBE_CB(skb)->dma,
			       ixgbe_rx_pg_size(rx_ring), DMA_FROM_DEVICE);
		IXGBE_CB(skb)->page_released = false;
	} else {
		struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[0];

		dma_sync_single_range_for_cpu(rx_ring->dev,
					      IXGBE_CB(skb)->dma,
					      frag->page_offset,
					      ixgbe_rx_bufsz(rx_ring),
					      DMA_FROM_DEVICE);
	}
	IXGBE_CB(skb)->dma = 0;
}

1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553
/**
 * ixgbe_cleanup_headers - Correct corrupted or empty headers
 * @rx_ring: rx descriptor ring packet is being transacted on
 * @rx_desc: pointer to the EOP Rx descriptor
 * @skb: pointer to current skb being fixed
 *
 * Check for corrupted packet headers caused by senders on the local L2
 * embedded NIC switch not setting up their Tx Descriptors right.  These
 * should be very rare.
 *
 * Also address the case where we are pulling data in on pages only
 * and as such no data is present in the skb header.
 *
 * In addition if skb is not at least 60 bytes we need to pad it so that
 * it is large enough to qualify as a valid Ethernet frame.
 *
 * Returns true if an error was encountered and skb was freed.
 **/
static bool ixgbe_cleanup_headers(struct ixgbe_ring *rx_ring,
				  union ixgbe_adv_rx_desc *rx_desc,
				  struct sk_buff *skb)
{
	struct net_device *netdev = rx_ring->netdev;

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

1554
	/* place header in linear portion of buffer */
1555 1556
	if (skb_is_nonlinear(skb))
		ixgbe_pull_tail(rx_ring, skb);
1557

1558 1559 1560 1561 1562 1563
#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
1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580
	/* if skb_pad returns an error the skb was freed */
	if (unlikely(skb->len < 60)) {
		int pad_len = 60 - skb->len;

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

	return false;
}

/**
 * ixgbe_reuse_rx_page - page flip buffer and store it back on the ring
 * @rx_ring: rx descriptor ring to store buffers on
 * @old_buff: donor buffer to have page reused
 *
1581
 * Synchronizes page for reuse by the adapter
1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597
 **/
static void ixgbe_reuse_rx_page(struct ixgbe_ring *rx_ring,
				struct ixgbe_rx_buffer *old_buff)
{
	struct ixgbe_rx_buffer *new_buff;
	u16 nta = rx_ring->next_to_alloc;

	new_buff = &rx_ring->rx_buffer_info[nta];

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

	/* transfer page from old buffer to new buffer */
	new_buff->page = old_buff->page;
	new_buff->dma = old_buff->dma;
1598
	new_buff->page_offset = old_buff->page_offset;
1599 1600 1601

	/* sync the buffer for use by the device */
	dma_sync_single_range_for_device(rx_ring->dev, new_buff->dma,
1602 1603
					 new_buff->page_offset,
					 ixgbe_rx_bufsz(rx_ring),
1604 1605 1606 1607 1608 1609 1610 1611 1612 1613
					 DMA_FROM_DEVICE);
}

/**
 * ixgbe_add_rx_frag - Add contents of Rx buffer to sk_buff
 * @rx_ring: rx descriptor ring to transact packets on
 * @rx_buffer: buffer containing page to add
 * @rx_desc: descriptor containing length of buffer written by hardware
 * @skb: sk_buff to place the data into
 *
1614 1615 1616 1617 1618 1619 1620
 * 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.
1621
 **/
1622
static bool ixgbe_add_rx_frag(struct ixgbe_ring *rx_ring,
1623
			      struct ixgbe_rx_buffer *rx_buffer,
1624 1625
			      union ixgbe_adv_rx_desc *rx_desc,
			      struct sk_buff *skb)
1626
{
1627 1628
	struct page *page = rx_buffer->page;
	unsigned int size = le16_to_cpu(rx_desc->wb.upper.length);
1629
#if (PAGE_SIZE < 8192)
1630
	unsigned int truesize = ixgbe_rx_bufsz(rx_ring);
1631 1632 1633 1634 1635
#else
	unsigned int truesize = ALIGN(size, L1_CACHE_BYTES);
	unsigned int last_offset = ixgbe_rx_pg_size(rx_ring) -
				   ixgbe_rx_bufsz(rx_ring);
#endif
1636

1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650
	if ((size <= IXGBE_RX_HDR_SIZE) && !skb_is_nonlinear(skb)) {
		unsigned char *va = page_address(page) + rx_buffer->page_offset;

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

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

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

1651 1652 1653
	skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, page,
			rx_buffer->page_offset, size, truesize);

1654 1655 1656 1657 1658 1659 1660
	/* avoid re-using remote pages */
	if (unlikely(page_to_nid(page) != numa_node_id()))
		return false;

#if (PAGE_SIZE < 8192)
	/* if we are only owner of page we can reuse it */
	if (unlikely(page_count(page) != 1))
1661 1662 1663 1664 1665
		return false;

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

1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678
	/*
	 * since we are the only owner of the page and we need to
	 * increment it, just set the value to 2 in order to avoid
	 * an unecessary locked operation
	 */
	atomic_set(&page->_count, 2);
#else
	/* move offset up to the next cache line */
	rx_buffer->page_offset += truesize;

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

1679 1680
	/* bump ref count on page before it is given to the stack */
	get_page(page);
1681
#endif
1682 1683

	return true;
1684 1685
}

1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766
static struct sk_buff *ixgbe_fetch_rx_buffer(struct ixgbe_ring *rx_ring,
					     union ixgbe_adv_rx_desc *rx_desc)
{
	struct ixgbe_rx_buffer *rx_buffer;
	struct sk_buff *skb;
	struct page *page;

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

	skb = rx_buffer->skb;

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

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

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

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

		/*
		 * Delay unmapping of the first packet. It carries the
		 * header information, HW may still access the header
		 * after the writeback.  Only unmap it when EOP is
		 * reached
		 */
		if (likely(ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP)))
			goto dma_sync;

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

dma_sync:
		/* we are reusing so sync this buffer for CPU use */
		dma_sync_single_range_for_cpu(rx_ring->dev,
					      rx_buffer->dma,
					      rx_buffer->page_offset,
					      ixgbe_rx_bufsz(rx_ring),
					      DMA_FROM_DEVICE);
	}

	/* pull page into skb */
	if (ixgbe_add_rx_frag(rx_ring, rx_buffer, rx_desc, skb)) {
		/* hand second half of page back to the ring */
		ixgbe_reuse_rx_page(rx_ring, rx_buffer);
	} else if (IXGBE_CB(skb)->dma == rx_buffer->dma) {
		/* the page has been released from the ring */
		IXGBE_CB(skb)->page_released = true;
	} else {
		/* we are not reusing the buffer so unmap it */
		dma_unmap_page(rx_ring->dev, rx_buffer->dma,
			       ixgbe_rx_pg_size(rx_ring),
			       DMA_FROM_DEVICE);
	}

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

	return skb;
1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781
}

/**
 * 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.
 *
 * Returns true if all work is completed without reaching budget
 **/
1782
static bool ixgbe_clean_rx_irq(struct ixgbe_q_vector *q_vector,
1783
			       struct ixgbe_ring *rx_ring,
1784
			       int budget)
1785
{
1786
	unsigned int total_rx_bytes = 0, total_rx_packets = 0;
B
Ben Greear 已提交
1787
#ifdef IXGBE_FCOE
1788
	struct ixgbe_adapter *adapter = q_vector->adapter;
1789 1790
	int ddp_bytes;
	unsigned int mss = 0;
1791
#endif /* IXGBE_FCOE */
1792
	u16 cleaned_count = ixgbe_desc_unused(rx_ring);
1793

1794 1795 1796 1797 1798 1799 1800 1801 1802 1803
	do {
		union ixgbe_adv_rx_desc *rx_desc;
		struct sk_buff *skb;

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

1804
		rx_desc = IXGBE_RX_DESC(rx_ring, rx_ring->next_to_clean);
1805 1806 1807

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

1809 1810 1811 1812 1813 1814
		/*
		 * This memory barrier is needed to keep us from reading
		 * any other fields out of the rx_desc until we know the
		 * RXD_STAT_DD bit is set
		 */
		rmb();
1815

1816 1817
		/* retrieve a buffer from the ring */
		skb = ixgbe_fetch_rx_buffer(rx_ring, rx_desc);
1818

1819 1820 1821
		/* exit if we failed to retrieve a buffer */
		if (!skb)
			break;
1822 1823

		cleaned_count++;
A
Alexander Duyck 已提交
1824

1825 1826 1827
		/* place incomplete frames back on ring for completion */
		if (ixgbe_is_non_eop(rx_ring, rx_desc, skb))
			continue;
1828

1829 1830 1831
		/* verify the packet layout is correct */
		if (ixgbe_cleanup_headers(rx_ring, rx_desc, skb))
			continue;
1832

1833 1834 1835 1836
		/* probably a little skewed due to removing CRC */
		total_rx_bytes += skb->len;
		total_rx_packets++;

1837 1838 1839
		/* populate checksum, timestamp, VLAN, and protocol */
		ixgbe_process_skb_fields(rx_ring, rx_desc, skb);

1840 1841
#ifdef IXGBE_FCOE
		/* if ddp, not passing to ULD unless for FCP_RSP or error */
1842
		if (ixgbe_rx_is_fcoe(rx_ring, rx_desc)) {
1843
			ddp_bytes = ixgbe_fcoe_ddp(adapter, rx_desc, skb);
1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857
			/* 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);
			}
1858 1859
			if (!ddp_bytes) {
				dev_kfree_skb_any(skb);
1860
				continue;
1861
			}
1862
		}
1863

1864
#endif /* IXGBE_FCOE */
1865
		ixgbe_rx_skb(q_vector, skb);
1866

1867
		/* update budget accounting */
1868
		budget--;
1869
	} while (likely(budget));
1870

1871 1872 1873 1874
	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);
1875 1876
	q_vector->rx.total_packets += total_rx_packets;
	q_vector->rx.total_bytes += total_rx_bytes;
1877

1878 1879 1880
	if (cleaned_count)
		ixgbe_alloc_rx_buffers(rx_ring, cleaned_count);

1881
	return !!budget;
1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892
}

/**
 * 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)
{
1893
	struct ixgbe_q_vector *q_vector;
1894
	int v_idx;
1895
	u32 mask;
1896

1897 1898 1899 1900 1901 1902
	/* Populate MSIX to EITR Select */
	if (adapter->num_vfs > 32) {
		u32 eitrsel = (1 << (adapter->num_vfs - 32)) - 1;
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITRSEL, eitrsel);
	}

1903 1904
	/*
	 * Populate the IVAR table and set the ITR values to the
1905 1906
	 * corresponding register.
	 */
1907
	for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
1908
		struct ixgbe_ring *ring;
1909
		q_vector = adapter->q_vector[v_idx];
1910

1911
		ixgbe_for_each_ring(ring, q_vector->rx)
1912 1913
			ixgbe_set_ivar(adapter, 0, ring->reg_idx, v_idx);

1914
		ixgbe_for_each_ring(ring, q_vector->tx)
1915 1916
			ixgbe_set_ivar(adapter, 1, ring->reg_idx, v_idx);

1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929
		if (q_vector->tx.ring && !q_vector->rx.ring) {
			/* tx only vector */
			if (adapter->tx_itr_setting == 1)
				q_vector->itr = IXGBE_10K_ITR;
			else
				q_vector->itr = adapter->tx_itr_setting;
		} else {
			/* rx or rx/tx vector */
			if (adapter->rx_itr_setting == 1)
				q_vector->itr = IXGBE_20K_ITR;
			else
				q_vector->itr = adapter->rx_itr_setting;
		}
1930

1931
		ixgbe_write_eitr(q_vector);
1932 1933
	}

1934 1935
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
1936
		ixgbe_set_ivar(adapter, -1, IXGBE_IVAR_OTHER_CAUSES_INDEX,
1937
			       v_idx);
1938 1939
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
1940
	case ixgbe_mac_X540:
1941
		ixgbe_set_ivar(adapter, -1, 1, v_idx);
1942 1943 1944 1945
		break;
	default:
		break;
	}
1946 1947
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITR(v_idx), 1950);

1948
	/* set up to autoclear timer, and the vectors */
1949
	mask = IXGBE_EIMS_ENABLE_MASK;
1950 1951 1952 1953
	mask &= ~(IXGBE_EIMS_OTHER |
		  IXGBE_EIMS_MAILBOX |
		  IXGBE_EIMS_LSC);

1954
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIAC, mask);
1955 1956
}

1957 1958 1959 1960 1961 1962 1963 1964 1965
enum latency_range {
	lowest_latency = 0,
	low_latency = 1,
	bulk_latency = 2,
	latency_invalid = 255
};

/**
 * ixgbe_update_itr - update the dynamic ITR value based on statistics
1966 1967
 * @q_vector: structure containing interrupt and ring information
 * @ring_container: structure containing ring performance data
1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978
 *
 *      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)
 **/
1979 1980
static void ixgbe_update_itr(struct ixgbe_q_vector *q_vector,
			     struct ixgbe_ring_container *ring_container)
1981
{
1982 1983 1984
	int bytes = ring_container->total_bytes;
	int packets = ring_container->total_packets;
	u32 timepassed_us;
1985
	u64 bytes_perint;
1986
	u8 itr_setting = ring_container->itr;
1987 1988

	if (packets == 0)
1989
		return;
1990 1991

	/* simple throttlerate management
1992 1993 1994
	 *   0-10MB/s   lowest (100000 ints/s)
	 *  10-20MB/s   low    (20000 ints/s)
	 *  20-1249MB/s bulk   (8000 ints/s)
1995 1996
	 */
	/* what was last interrupt timeslice? */
1997
	timepassed_us = q_vector->itr >> 2;
1998 1999 2000 2001
	bytes_perint = bytes / timepassed_us; /* bytes/usec */

	switch (itr_setting) {
	case lowest_latency:
2002
		if (bytes_perint > 10)
2003
			itr_setting = low_latency;
2004 2005
		break;
	case low_latency:
2006
		if (bytes_perint > 20)
2007
			itr_setting = bulk_latency;
2008
		else if (bytes_perint <= 10)
2009
			itr_setting = lowest_latency;
2010 2011
		break;
	case bulk_latency:
2012
		if (bytes_perint <= 20)
2013
			itr_setting = low_latency;
2014 2015 2016
		break;
	}

2017 2018 2019 2020 2021 2022
	/* clear work counters since we have the values we need */
	ring_container->total_bytes = 0;
	ring_container->total_packets = 0;

	/* write updated itr to ring container */
	ring_container->itr = itr_setting;
2023 2024
}

2025 2026
/**
 * ixgbe_write_eitr - write EITR register in hardware specific way
2027
 * @q_vector: structure containing interrupt and ring information
2028 2029 2030 2031 2032
 *
 * 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.
 */
2033
void ixgbe_write_eitr(struct ixgbe_q_vector *q_vector)
2034
{
2035
	struct ixgbe_adapter *adapter = q_vector->adapter;
2036
	struct ixgbe_hw *hw = &adapter->hw;
2037
	int v_idx = q_vector->v_idx;
2038
	u32 itr_reg = q_vector->itr & IXGBE_MAX_EITR;
2039

2040 2041
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
2042 2043
		/* must write high and low 16 bits to reset counter */
		itr_reg |= (itr_reg << 16);
2044 2045
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2046
	case ixgbe_mac_X540:
2047 2048 2049 2050 2051
		/*
		 * set the WDIS bit to not clear the timer bits and cause an
		 * immediate assertion of the interrupt
		 */
		itr_reg |= IXGBE_EITR_CNT_WDIS;
2052 2053 2054
		break;
	default:
		break;
2055 2056 2057 2058
	}
	IXGBE_WRITE_REG(hw, IXGBE_EITR(v_idx), itr_reg);
}

2059
static void ixgbe_set_itr(struct ixgbe_q_vector *q_vector)
2060
{
2061
	u32 new_itr = q_vector->itr;
2062
	u8 current_itr;
2063

2064 2065
	ixgbe_update_itr(q_vector, &q_vector->tx);
	ixgbe_update_itr(q_vector, &q_vector->rx);
2066

2067
	current_itr = max(q_vector->rx.itr, q_vector->tx.itr);
2068 2069 2070 2071

	switch (current_itr) {
	/* counts and packets in update_itr are dependent on these numbers */
	case lowest_latency:
2072
		new_itr = IXGBE_100K_ITR;
2073 2074
		break;
	case low_latency:
2075
		new_itr = IXGBE_20K_ITR;
2076 2077
		break;
	case bulk_latency:
2078
		new_itr = IXGBE_8K_ITR;
2079
		break;
2080 2081
	default:
		break;
2082 2083
	}

2084
	if (new_itr != q_vector->itr) {
2085
		/* do an exponential smoothing */
2086 2087
		new_itr = (10 * new_itr * q_vector->itr) /
			  ((9 * new_itr) + q_vector->itr);
2088

2089
		/* save the algorithm value here */
2090
		q_vector->itr = new_itr;
2091 2092

		ixgbe_write_eitr(q_vector);
2093 2094 2095
	}
}

2096
/**
2097
 * ixgbe_check_overtemp_subtask - check for over temperature
2098
 * @adapter: pointer to adapter
2099
 **/
2100
static void ixgbe_check_overtemp_subtask(struct ixgbe_adapter *adapter)
2101 2102 2103 2104
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 eicr = adapter->interrupt_event;

2105
	if (test_bit(__IXGBE_DOWN, &adapter->state))
2106 2107
		return;

2108 2109 2110 2111 2112 2113
	if (!(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE) &&
	    !(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_EVENT))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_TEMP_SENSOR_EVENT;

2114
	switch (hw->device_id) {
2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129
	case IXGBE_DEV_ID_82599_T3_LOM:
		/*
		 * Since the warning interrupt is for both ports
		 * we don't have to check if:
		 *  - This interrupt wasn't for our port.
		 *  - We may have missed the interrupt so always have to
		 *    check if we  got a LSC
		 */
		if (!(eicr & IXGBE_EICR_GPI_SDP0) &&
		    !(eicr & IXGBE_EICR_LSC))
			return;

		if (!(eicr & IXGBE_EICR_LSC) && hw->mac.ops.check_link) {
			u32 autoneg;
			bool link_up = false;
2130 2131 2132

			hw->mac.ops.check_link(hw, &autoneg, &link_up, false);

2133 2134 2135 2136 2137 2138 2139 2140 2141
			if (link_up)
				return;
		}

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

		break;
2142 2143
	default:
		if (!(eicr & IXGBE_EICR_GPI_SDP0))
2144
			return;
2145
		break;
2146
	}
2147 2148 2149 2150
	e_crit(drv,
	       "Network adapter has been stopped because it has over heated. "
	       "Restart the computer. If the problem persists, "
	       "power off the system and replace the adapter\n");
2151 2152

	adapter->interrupt_event = 0;
2153 2154
}

2155 2156 2157 2158 2159 2160
static void ixgbe_check_fan_failure(struct ixgbe_adapter *adapter, u32 eicr)
{
	struct ixgbe_hw *hw = &adapter->hw;

	if ((adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE) &&
	    (eicr & IXGBE_EICR_GPI_SDP1)) {
2161
		e_crit(probe, "Fan has stopped, replace the adapter\n");
2162 2163 2164 2165
		/* write to clear the interrupt */
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1);
	}
}
2166

2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199
static void ixgbe_check_overtemp_event(struct ixgbe_adapter *adapter, u32 eicr)
{
	if (!(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE))
		return;

	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
		/*
		 * Need to check link state so complete overtemp check
		 * on service task
		 */
		if (((eicr & IXGBE_EICR_GPI_SDP0) || (eicr & IXGBE_EICR_LSC)) &&
		    (!test_bit(__IXGBE_DOWN, &adapter->state))) {
			adapter->interrupt_event = eicr;
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_EVENT;
			ixgbe_service_event_schedule(adapter);
			return;
		}
		return;
	case ixgbe_mac_X540:
		if (!(eicr & IXGBE_EICR_TS))
			return;
		break;
	default:
		return;
	}

	e_crit(drv,
	       "Network adapter has been stopped because it has over heated. "
	       "Restart the computer. If the problem persists, "
	       "power off the system and replace the adapter\n");
}

2200 2201 2202 2203
static void ixgbe_check_sfp_event(struct ixgbe_adapter *adapter, u32 eicr)
{
	struct ixgbe_hw *hw = &adapter->hw;

2204 2205 2206
	if (eicr & IXGBE_EICR_GPI_SDP2) {
		/* Clear the interrupt */
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP2);
2207 2208 2209 2210
		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
			adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
			ixgbe_service_event_schedule(adapter);
		}
2211 2212
	}

2213 2214 2215
	if (eicr & IXGBE_EICR_GPI_SDP1) {
		/* Clear the interrupt */
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1);
2216 2217 2218 2219
		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
			adapter->flags |= IXGBE_FLAG_NEED_LINK_CONFIG;
			ixgbe_service_event_schedule(adapter);
		}
2220 2221 2222
	}
}

2223 2224 2225 2226 2227 2228 2229 2230 2231
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);
2232
		IXGBE_WRITE_FLUSH(hw);
2233
		ixgbe_service_event_schedule(adapter);
2234 2235 2236
	}
}

2237 2238 2239 2240
static inline void ixgbe_irq_enable_queues(struct ixgbe_adapter *adapter,
					   u64 qmask)
{
	u32 mask;
2241
	struct ixgbe_hw *hw = &adapter->hw;
2242

2243 2244
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
2245
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
2246 2247 2248
		IXGBE_WRITE_REG(hw, IXGBE_EIMS, mask);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2249
	case ixgbe_mac_X540:
2250
		mask = (qmask & 0xFFFFFFFF);
2251 2252
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(0), mask);
2253
		mask = (qmask >> 32);
2254 2255 2256 2257 2258
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(1), mask);
		break;
	default:
		break;
2259 2260 2261 2262 2263
	}
	/* skip the flush */
}

static inline void ixgbe_irq_disable_queues(struct ixgbe_adapter *adapter,
2264
					    u64 qmask)
2265 2266
{
	u32 mask;
2267
	struct ixgbe_hw *hw = &adapter->hw;
2268

2269 2270
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
2271
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
2272 2273 2274
		IXGBE_WRITE_REG(hw, IXGBE_EIMC, mask);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2275
	case ixgbe_mac_X540:
2276
		mask = (qmask & 0xFFFFFFFF);
2277 2278
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMC_EX(0), mask);
2279
		mask = (qmask >> 32);
2280 2281 2282 2283 2284
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMC_EX(1), mask);
		break;
	default:
		break;
2285 2286 2287 2288
	}
	/* skip the flush */
}

2289
/**
2290 2291
 * ixgbe_irq_enable - Enable default interrupt generation settings
 * @adapter: board private structure
2292
 **/
2293 2294
static inline void ixgbe_irq_enable(struct ixgbe_adapter *adapter, bool queues,
				    bool flush)
2295
{
2296
	u32 mask = (IXGBE_EIMS_ENABLE_MASK & ~IXGBE_EIMS_RTX_QUEUE);
2297

2298 2299 2300
	/* don't reenable LSC while waiting for link */
	if (adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE)
		mask &= ~IXGBE_EIMS_LSC;
2301

2302
	if (adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE)
2303 2304 2305 2306 2307 2308 2309 2310 2311 2312
		switch (adapter->hw.mac.type) {
		case ixgbe_mac_82599EB:
			mask |= IXGBE_EIMS_GPI_SDP0;
			break;
		case ixgbe_mac_X540:
			mask |= IXGBE_EIMS_TS;
			break;
		default:
			break;
		}
2313 2314 2315 2316 2317 2318
	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE)
		mask |= IXGBE_EIMS_GPI_SDP1;
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
		mask |= IXGBE_EIMS_GPI_SDP1;
		mask |= IXGBE_EIMS_GPI_SDP2;
2319 2320
	case ixgbe_mac_X540:
		mask |= IXGBE_EIMS_ECC;
2321 2322 2323 2324
		mask |= IXGBE_EIMS_MAILBOX;
		break;
	default:
		break;
2325
	}
J
Jacob Keller 已提交
2326 2327 2328 2329 2330 2331

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

2332 2333 2334
	if ((adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) &&
	    !(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
		mask |= IXGBE_EIMS_FLOW_DIR;
2335

2336 2337 2338 2339 2340
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMS, mask);
	if (queues)
		ixgbe_irq_enable_queues(adapter, ~0);
	if (flush)
		IXGBE_WRITE_FLUSH(&adapter->hw);
2341 2342
}

2343
static irqreturn_t ixgbe_msix_other(int irq, void *data)
2344
{
2345
	struct ixgbe_adapter *adapter = data;
2346
	struct ixgbe_hw *hw = &adapter->hw;
2347
	u32 eicr;
2348

2349 2350 2351 2352 2353 2354 2355 2356
	/*
	 * 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);
	IXGBE_WRITE_REG(hw, IXGBE_EICR, eicr);
2357

2358 2359
	if (eicr & IXGBE_EICR_LSC)
		ixgbe_check_lsc(adapter);
2360

2361 2362
	if (eicr & IXGBE_EICR_MAILBOX)
		ixgbe_msg_task(adapter);
2363

2364 2365
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2366
	case ixgbe_mac_X540:
2367 2368 2369
		if (eicr & IXGBE_EICR_ECC)
			e_info(link, "Received unrecoverable ECC Err, please "
			       "reboot\n");
2370 2371
		/* Handle Flow Director Full threshold interrupt */
		if (eicr & IXGBE_EICR_FLOW_DIR) {
2372
			int reinit_count = 0;
2373 2374
			int i;
			for (i = 0; i < adapter->num_tx_queues; i++) {
2375
				struct ixgbe_ring *ring = adapter->tx_ring[i];
A
Alexander Duyck 已提交
2376
				if (test_and_clear_bit(__IXGBE_TX_FDIR_INIT_DONE,
2377 2378 2379 2380 2381 2382 2383 2384
						       &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);
2385 2386
			}
		}
2387
		ixgbe_check_sfp_event(adapter, eicr);
2388
		ixgbe_check_overtemp_event(adapter, eicr);
2389 2390 2391
		break;
	default:
		break;
2392
	}
2393

2394
	ixgbe_check_fan_failure(adapter, eicr);
J
Jacob Keller 已提交
2395

2396
#ifdef CONFIG_IXGBE_PTP
J
Jacob Keller 已提交
2397 2398
	if (unlikely(eicr & IXGBE_EICR_TIMESYNC))
		ixgbe_ptp_check_pps_event(adapter, eicr);
2399
#endif
2400

2401
	/* re-enable the original interrupt state, no lsc, no queues */
2402
	if (!test_bit(__IXGBE_DOWN, &adapter->state))
2403
		ixgbe_irq_enable(adapter, false, false);
2404

2405
	return IRQ_HANDLED;
2406
}
2407

2408
static irqreturn_t ixgbe_msix_clean_rings(int irq, void *data)
2409
{
2410
	struct ixgbe_q_vector *q_vector = data;
2411

2412
	/* EIAM disabled interrupts (on this vector) for us */
2413

2414 2415
	if (q_vector->rx.ring || q_vector->tx.ring)
		napi_schedule(&q_vector->napi);
2416

2417
	return IRQ_HANDLED;
2418 2419
}

2420 2421 2422 2423 2424 2425 2426
/**
 * 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
 **/
2427
int ixgbe_poll(struct napi_struct *napi, int budget)
2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468
{
	struct ixgbe_q_vector *q_vector =
				container_of(napi, struct ixgbe_q_vector, napi);
	struct ixgbe_adapter *adapter = q_vector->adapter;
	struct ixgbe_ring *ring;
	int per_ring_budget;
	bool clean_complete = true;

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

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

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

	ixgbe_for_each_ring(ring, q_vector->rx)
		clean_complete &= ixgbe_clean_rx_irq(q_vector, ring,
						     per_ring_budget);

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

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

	return 0;
}

2469 2470 2471 2472 2473 2474 2475 2476 2477 2478
/**
 * 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;
2479
	int vector, err;
2480
	int ri = 0, ti = 0;
2481

2482
	for (vector = 0; vector < adapter->num_q_vectors; vector++) {
2483
		struct ixgbe_q_vector *q_vector = adapter->q_vector[vector];
2484
		struct msix_entry *entry = &adapter->msix_entries[vector];
R
Robert Olsson 已提交
2485

2486
		if (q_vector->tx.ring && q_vector->rx.ring) {
2487
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2488 2489 2490
				 "%s-%s-%d", netdev->name, "TxRx", ri++);
			ti++;
		} else if (q_vector->rx.ring) {
2491
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2492 2493
				 "%s-%s-%d", netdev->name, "rx", ri++);
		} else if (q_vector->tx.ring) {
2494
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2495
				 "%s-%s-%d", netdev->name, "tx", ti++);
2496 2497 2498
		} else {
			/* skip this unused q_vector */
			continue;
2499
		}
2500 2501
		err = request_irq(entry->vector, &ixgbe_msix_clean_rings, 0,
				  q_vector->name, q_vector);
2502
		if (err) {
2503
			e_err(probe, "request_irq failed for MSIX interrupt "
2504
			      "Error: %d\n", err);
2505
			goto free_queue_irqs;
2506
		}
2507 2508 2509 2510
		/* 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,
2511
					      &q_vector->affinity_mask);
2512
		}
2513 2514
	}

2515
	err = request_irq(adapter->msix_entries[vector].vector,
2516
			  ixgbe_msix_other, 0, netdev->name, adapter);
2517
	if (err) {
2518
		e_err(probe, "request_irq for msix_other failed: %d\n", err);
2519
		goto free_queue_irqs;
2520 2521 2522 2523
	}

	return 0;

2524
free_queue_irqs:
2525 2526 2527 2528 2529 2530 2531
	while (vector) {
		vector--;
		irq_set_affinity_hint(adapter->msix_entries[vector].vector,
				      NULL);
		free_irq(adapter->msix_entries[vector].vector,
			 adapter->q_vector[vector]);
	}
2532 2533
	adapter->flags &= ~IXGBE_FLAG_MSIX_ENABLED;
	pci_disable_msix(adapter->pdev);
2534 2535 2536 2537 2538 2539
	kfree(adapter->msix_entries);
	adapter->msix_entries = NULL;
	return err;
}

/**
2540
 * ixgbe_intr - legacy mode Interrupt Handler
2541 2542 2543 2544 2545
 * @irq: interrupt number
 * @data: pointer to a network interface device structure
 **/
static irqreturn_t ixgbe_intr(int irq, void *data)
{
2546
	struct ixgbe_adapter *adapter = data;
2547
	struct ixgbe_hw *hw = &adapter->hw;
2548
	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
2549 2550
	u32 eicr;

2551
	/*
2552
	 * Workaround for silicon errata #26 on 82598.  Mask the interrupt
2553 2554 2555 2556
	 * before the read of EICR.
	 */
	IXGBE_WRITE_REG(hw, IXGBE_EIMC, IXGBE_IRQ_CLEAR_MASK);

2557
	/* for NAPI, using EIAM to auto-mask tx/rx interrupt bits on read
S
Stephen Hemminger 已提交
2558
	 * therefore no explicit interrupt disable is necessary */
2559
	eicr = IXGBE_READ_REG(hw, IXGBE_EICR);
2560
	if (!eicr) {
2561 2562
		/*
		 * shared interrupt alert!
2563
		 * make sure interrupts are enabled because the read will
2564 2565 2566 2567 2568 2569
		 * 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);
2570
		return IRQ_NONE;	/* Not our interrupt */
2571
	}
2572

2573 2574
	if (eicr & IXGBE_EICR_LSC)
		ixgbe_check_lsc(adapter);
2575

2576 2577
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
2578
		ixgbe_check_sfp_event(adapter, eicr);
2579 2580 2581 2582 2583
		/* Fall through */
	case ixgbe_mac_X540:
		if (eicr & IXGBE_EICR_ECC)
			e_info(link, "Received unrecoverable ECC err, please "
				     "reboot\n");
2584
		ixgbe_check_overtemp_event(adapter, eicr);
2585 2586 2587 2588
		break;
	default:
		break;
	}
2589

2590
	ixgbe_check_fan_failure(adapter, eicr);
2591
#ifdef CONFIG_IXGBE_PTP
J
Jacob Keller 已提交
2592 2593
	if (unlikely(eicr & IXGBE_EICR_TIMESYNC))
		ixgbe_ptp_check_pps_event(adapter, eicr);
2594
#endif
2595

2596 2597
	/* would disable interrupts here but EIAM disabled it */
	napi_schedule(&q_vector->napi);
2598

2599 2600 2601 2602 2603 2604 2605
	/*
	 * 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);

2606 2607 2608 2609 2610 2611 2612 2613 2614 2615
	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.
 **/
2616
static int ixgbe_request_irq(struct ixgbe_adapter *adapter)
2617 2618
{
	struct net_device *netdev = adapter->netdev;
2619
	int err;
2620

2621
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
2622
		err = ixgbe_request_msix_irqs(adapter);
2623
	else if (adapter->flags & IXGBE_FLAG_MSI_ENABLED)
2624
		err = request_irq(adapter->pdev->irq, ixgbe_intr, 0,
2625
				  netdev->name, adapter);
2626
	else
2627
		err = request_irq(adapter->pdev->irq, ixgbe_intr, IRQF_SHARED,
2628
				  netdev->name, adapter);
2629

2630
	if (err)
2631
		e_err(probe, "request_irq failed, Error %d\n", err);
2632 2633 2634 2635 2636 2637

	return err;
}

static void ixgbe_free_irq(struct ixgbe_adapter *adapter)
{
2638
	int vector;
2639

2640 2641 2642 2643
	if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED)) {
		free_irq(adapter->pdev->irq, adapter);
		return;
	}
2644

2645 2646 2647
	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];
2648

2649 2650 2651
		/* free only the irqs that were actually requested */
		if (!q_vector->rx.ring && !q_vector->tx.ring)
			continue;
2652

2653 2654 2655 2656
		/* clear the affinity_mask in the IRQ descriptor */
		irq_set_affinity_hint(entry->vector, NULL);

		free_irq(entry->vector, q_vector);
2657
	}
2658 2659

	free_irq(adapter->msix_entries[vector++].vector, adapter);
2660 2661
}

2662 2663 2664 2665 2666 2667
/**
 * ixgbe_irq_disable - Mask off interrupt generation on the NIC
 * @adapter: board private structure
 **/
static inline void ixgbe_irq_disable(struct ixgbe_adapter *adapter)
{
2668 2669
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
2670
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, ~0);
2671 2672
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2673
	case ixgbe_mac_X540:
2674 2675
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFF0000);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(0), ~0);
2676
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(1), ~0);
2677 2678 2679
		break;
	default:
		break;
2680 2681 2682
	}
	IXGBE_WRITE_FLUSH(&adapter->hw);
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
2683 2684 2685 2686 2687 2688
		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);
2689 2690 2691 2692 2693
	} else {
		synchronize_irq(adapter->pdev->irq);
	}
}

2694 2695 2696 2697 2698 2699
/**
 * ixgbe_configure_msi_and_legacy - Initialize PIN (INTA...) and MSI interrupts
 *
 **/
static void ixgbe_configure_msi_and_legacy(struct ixgbe_adapter *adapter)
{
2700
	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
2701

2702 2703 2704 2705 2706 2707 2708
	/* rx/tx vector */
	if (adapter->rx_itr_setting == 1)
		q_vector->itr = IXGBE_20K_ITR;
	else
		q_vector->itr = adapter->rx_itr_setting;

	ixgbe_write_eitr(q_vector);
2709

2710 2711
	ixgbe_set_ivar(adapter, 0, 0, 0);
	ixgbe_set_ivar(adapter, 1, 0, 0);
2712

2713
	e_info(hw, "Legacy interrupt IVAR setup done\n");
2714 2715
}

2716 2717 2718 2719 2720 2721 2722
/**
 * 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.
 **/
2723 2724
void ixgbe_configure_tx_ring(struct ixgbe_adapter *adapter,
			     struct ixgbe_ring *ring)
2725 2726 2727
{
	struct ixgbe_hw *hw = &adapter->hw;
	u64 tdba = ring->dma;
2728
	int wait_loop = 10;
2729
	u32 txdctl = IXGBE_TXDCTL_ENABLE;
2730
	u8 reg_idx = ring->reg_idx;
2731

2732
	/* disable queue to avoid issues while updating state */
2733
	IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), 0);
2734 2735
	IXGBE_WRITE_FLUSH(hw);

2736
	IXGBE_WRITE_REG(hw, IXGBE_TDBAL(reg_idx),
2737
			(tdba & DMA_BIT_MASK(32)));
2738 2739 2740 2741 2742
	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);
2743
	ring->tail = hw->hw_addr + IXGBE_TDT(reg_idx);
2744

2745 2746 2747 2748 2749 2750 2751 2752
	/*
	 * set WTHRESH to encourage burst writeback, it should not be set
	 * higher than 1 when ITR is 0 as it could cause false TX hangs
	 *
	 * 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.
	 */
2753
	if (!ring->q_vector || (ring->q_vector->itr < 8))
2754 2755 2756 2757
		txdctl |= (1 << 16);	/* WTHRESH = 1 */
	else
		txdctl |= (8 << 16);	/* WTHRESH = 8 */

2758 2759 2760 2761
	/*
	 * Setting PTHRESH to 32 both improves performance
	 * and avoids a TX hang with DFP enabled
	 */
2762 2763
	txdctl |= (1 << 8) |	/* HTHRESH = 1 */
		   32;		/* PTHRESH = 32 */
2764 2765

	/* reinitialize flowdirector state */
2766
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
2767 2768 2769 2770 2771 2772
		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;
	}
2773

2774 2775
	clear_bit(__IXGBE_HANG_CHECK_ARMED, &ring->state);

2776 2777 2778 2779 2780 2781 2782 2783 2784 2785
	/* 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 {
2786
		usleep_range(1000, 2000);
2787 2788 2789 2790
		txdctl = IXGBE_READ_REG(hw, IXGBE_TXDCTL(reg_idx));
	} while (--wait_loop && !(txdctl & IXGBE_TXDCTL_ENABLE));
	if (!wait_loop)
		e_err(drv, "Could not enable Tx Queue %d\n", reg_idx);
2791 2792
}

2793 2794 2795
static void ixgbe_setup_mtqc(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
2796
	u32 rttdcs, mtqc;
2797
	u8 tcs = netdev_get_num_tc(adapter->netdev);
2798 2799 2800 2801 2802 2803 2804 2805 2806 2807

	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 */
2808 2809 2810 2811 2812 2813 2814 2815 2816 2817 2818 2819 2820 2821 2822
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
		mtqc = IXGBE_MTQC_VT_ENA;
		if (tcs > 4)
			mtqc |= IXGBE_MTQC_RT_ENA | IXGBE_MTQC_8TC_8TQ;
		else if (tcs > 1)
			mtqc |= IXGBE_MTQC_RT_ENA | IXGBE_MTQC_4TC_4TQ;
		else if (adapter->ring_feature[RING_F_RSS].indices == 4)
			mtqc |= IXGBE_MTQC_32VF;
		else
			mtqc |= IXGBE_MTQC_64VF;
	} else {
		if (tcs > 4)
			mtqc = IXGBE_MTQC_RT_ENA | IXGBE_MTQC_8TC_8TQ;
		else if (tcs > 1)
			mtqc = IXGBE_MTQC_RT_ENA | IXGBE_MTQC_4TC_4TQ;
2823
		else
2824 2825
			mtqc = IXGBE_MTQC_64Q_1PB;
	}
2826

2827
	IXGBE_WRITE_REG(hw, IXGBE_MTQC, mtqc);
2828

2829 2830 2831 2832 2833
	/* 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);
2834 2835 2836 2837 2838 2839 2840
	}

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

2841
/**
2842
 * ixgbe_configure_tx - Configure 8259x Transmit Unit after Reset
2843 2844 2845 2846 2847 2848
 * @adapter: board private structure
 *
 * Configure the Tx unit of the MAC after a reset.
 **/
static void ixgbe_configure_tx(struct ixgbe_adapter *adapter)
{
2849 2850
	struct ixgbe_hw *hw = &adapter->hw;
	u32 dmatxctl;
2851
	u32 i;
2852

2853 2854 2855 2856 2857 2858 2859 2860 2861
	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);
	}

2862
	/* Setup the HW Tx Head and Tail descriptor pointers */
2863 2864
	for (i = 0; i < adapter->num_tx_queues; i++)
		ixgbe_configure_tx_ring(adapter, adapter->tx_ring[i]);
2865 2866
}

2867 2868 2869 2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918 2919 2920 2921
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]);
	}
}

2922
#define IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT 2
2923

2924
static void ixgbe_configure_srrctl(struct ixgbe_adapter *adapter,
2925
				   struct ixgbe_ring *rx_ring)
2926
{
2927
	struct ixgbe_hw *hw = &adapter->hw;
2928
	u32 srrctl;
2929
	u8 reg_idx = rx_ring->reg_idx;
2930

2931 2932
	if (hw->mac.type == ixgbe_mac_82598EB) {
		u16 mask = adapter->ring_feature[RING_F_RSS].mask;
2933

2934 2935 2936 2937 2938 2939
		/*
		 * if VMDq is not active we must program one srrctl register
		 * per RSS queue since we have enabled RDRXCTL.MVMEN
		 */
		reg_idx &= mask;
	}
2940

2941 2942
	/* configure header buffer length, needed for RSC */
	srrctl = IXGBE_RX_HDR_SIZE << IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT;
2943

2944
	/* configure the packet buffer length */
2945
	srrctl |= ixgbe_rx_bufsz(rx_ring) >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
2946 2947

	/* configure descriptor type */
2948
	srrctl |= IXGBE_SRRCTL_DESCTYPE_ADV_ONEBUF;
2949

2950
	IXGBE_WRITE_REG(hw, IXGBE_SRRCTL(reg_idx), srrctl);
2951
}
2952

2953
static void ixgbe_setup_mrqc(struct ixgbe_adapter *adapter)
2954
{
2955 2956
	struct ixgbe_hw *hw = &adapter->hw;
	static const u32 seed[10] = { 0xE291D73D, 0x1805EC6C, 0x2A94B30D,
2957 2958
			  0xA54F2BEC, 0xEA49AF7C, 0xE214AD3D, 0xB855AABE,
			  0x6A3E67EA, 0x14364D17, 0x3BED200D};
2959 2960 2961
	u32 mrqc = 0, reta = 0;
	u32 rxcsum;
	int i, j;
2962 2963 2964 2965 2966 2967 2968 2969 2970
	u16 rss_i = adapter->ring_feature[RING_F_RSS].indices;

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

2972 2973 2974 2975 2976 2977
	/* Fill out hash function seeds */
	for (i = 0; i < 10; i++)
		IXGBE_WRITE_REG(hw, IXGBE_RSSRK(i), seed[i]);

	/* Fill out redirection table */
	for (i = 0, j = 0; i < 128; i++, j++) {
2978
		if (j == rss_i)
2979 2980 2981 2982 2983 2984 2985
			j = 0;
		/* reta = 4-byte sliding window of
		 * 0x00..(indices-1)(indices-1)00..etc. */
		reta = (reta << 8) | (j * 0x11);
		if ((i & 3) == 3)
			IXGBE_WRITE_REG(hw, IXGBE_RETA(i >> 2), reta);
	}
2986

2987 2988 2989 2990 2991
	/* 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);

2992
	if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
2993
		if (adapter->ring_feature[RING_F_RSS].mask)
2994
			mrqc = IXGBE_MRQC_RSSEN;
2995
	} else {
2996 2997 2998 2999 3000 3001 3002 3003 3004
		u8 tcs = netdev_get_num_tc(adapter->netdev);

		if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
			if (tcs > 4)
				mrqc = IXGBE_MRQC_VMDQRT8TCEN;	/* 8 TCs */
			else if (tcs > 1)
				mrqc = IXGBE_MRQC_VMDQRT4TCEN;	/* 4 TCs */
			else if (adapter->ring_feature[RING_F_RSS].indices == 4)
				mrqc = IXGBE_MRQC_VMDQRSS32EN;
3005
			else
3006 3007 3008
				mrqc = IXGBE_MRQC_VMDQRSS64EN;
		} else {
			if (tcs > 4)
3009
				mrqc = IXGBE_MRQC_RTRSS8TCEN;
3010 3011 3012 3013
			else if (tcs > 1)
				mrqc = IXGBE_MRQC_RTRSS4TCEN;
			else
				mrqc = IXGBE_MRQC_RSSEN;
3014
		}
3015 3016
	}

3017
	/* Perform hash on these packet types */
3018 3019 3020 3021
	mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4 |
		IXGBE_MRQC_RSS_FIELD_IPV4_TCP |
		IXGBE_MRQC_RSS_FIELD_IPV6 |
		IXGBE_MRQC_RSS_FIELD_IPV6_TCP;
3022

3023 3024 3025 3026 3027
	if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV4_UDP)
		mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4_UDP;
	if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV6_UDP)
		mrqc |= IXGBE_MRQC_RSS_FIELD_IPV6_UDP;

3028
	IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
3029 3030
}

3031 3032 3033 3034 3035
/**
 * ixgbe_configure_rscctl - enable RSC for the indicated ring
 * @adapter:    address of board private structure
 * @index:      index of ring to set
 **/
3036
static void ixgbe_configure_rscctl(struct ixgbe_adapter *adapter,
3037
				   struct ixgbe_ring *ring)
3038 3039 3040
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 rscctrl;
3041
	u8 reg_idx = ring->reg_idx;
3042

A
Alexander Duyck 已提交
3043
	if (!ring_is_rsc_enabled(ring))
3044
		return;
3045

3046
	rscctrl = IXGBE_READ_REG(hw, IXGBE_RSCCTL(reg_idx));
3047 3048 3049 3050
	rscctrl |= IXGBE_RSCCTL_RSCEN;
	/*
	 * we must limit the number of descriptors so that the
	 * total size of max desc * buf_len is not greater
3051
	 * than 65536
3052
	 */
3053
	rscctrl |= IXGBE_RSCCTL_MAXDESC_16;
3054
	IXGBE_WRITE_REG(hw, IXGBE_RSCCTL(reg_idx), rscctrl);
3055 3056
}

3057 3058 3059 3060 3061 3062 3063
#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;
3064
	u8 reg_idx = ring->reg_idx;
3065 3066 3067 3068 3069 3070 3071

	/* 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 {
3072
		usleep_range(1000, 2000);
3073 3074 3075 3076 3077 3078 3079 3080 3081
		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);
	}
}

3082 3083 3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108 3109 3110 3111
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;

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

3112 3113
void ixgbe_configure_rx_ring(struct ixgbe_adapter *adapter,
			     struct ixgbe_ring *ring)
3114 3115 3116
{
	struct ixgbe_hw *hw = &adapter->hw;
	u64 rdba = ring->dma;
3117
	u32 rxdctl;
3118
	u8 reg_idx = ring->reg_idx;
3119

3120 3121
	/* disable queue to avoid issues while updating state */
	rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
3122
	ixgbe_disable_rx_queue(adapter, ring);
3123

3124 3125 3126 3127 3128 3129
	IXGBE_WRITE_REG(hw, IXGBE_RDBAL(reg_idx), (rdba & DMA_BIT_MASK(32)));
	IXGBE_WRITE_REG(hw, IXGBE_RDBAH(reg_idx), (rdba >> 32));
	IXGBE_WRITE_REG(hw, IXGBE_RDLEN(reg_idx),
			ring->count * sizeof(union ixgbe_adv_rx_desc));
	IXGBE_WRITE_REG(hw, IXGBE_RDH(reg_idx), 0);
	IXGBE_WRITE_REG(hw, IXGBE_RDT(reg_idx), 0);
3130
	ring->tail = hw->hw_addr + IXGBE_RDT(reg_idx);
3131 3132 3133 3134

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

3135 3136 3137 3138 3139 3140 3141 3142
	/* If operating in IOV mode set RLPML for X540 */
	if ((adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) &&
	    hw->mac.type == ixgbe_mac_X540) {
		rxdctl &= ~IXGBE_RXDCTL_RLPMLMASK;
		rxdctl |= ((ring->netdev->mtu + ETH_HLEN +
			    ETH_FCS_LEN + VLAN_HLEN) | IXGBE_RXDCTL_RLPML_EN);
	}

3143 3144 3145 3146 3147 3148 3149 3150 3151 3152 3153 3154 3155 3156 3157 3158 3159
	if (hw->mac.type == ixgbe_mac_82598EB) {
		/*
		 * enable cache line friendly hardware writes:
		 * PTHRESH=32 descriptors (half the internal cache),
		 * this also removes ugly rx_no_buffer_count increment
		 * HTHRESH=4 descriptors (to minimize latency on fetch)
		 * WTHRESH=8 burst writeback up to two cache lines
		 */
		rxdctl &= ~0x3FFFFF;
		rxdctl |=  0x080420;
	}

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

	ixgbe_rx_desc_queue_enable(adapter, ring);
3160
	ixgbe_alloc_rx_buffers(ring, ixgbe_desc_unused(ring));
3161 3162
}

3163 3164 3165
static void ixgbe_setup_psrtype(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3166
	int rss_i = adapter->ring_feature[RING_F_RSS].indices;
3167 3168 3169 3170
	int p;

	/* PSRTYPE must be initialized in non 82598 adapters */
	u32 psrtype = IXGBE_PSRTYPE_TCPHDR |
3171 3172
		      IXGBE_PSRTYPE_UDPHDR |
		      IXGBE_PSRTYPE_IPV4HDR |
3173
		      IXGBE_PSRTYPE_L2HDR |
3174
		      IXGBE_PSRTYPE_IPV6HDR;
3175 3176 3177 3178

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

3179 3180 3181 3182
	if (rss_i > 3)
		psrtype |= 2 << 29;
	else if (rss_i > 1)
		psrtype |= 1 << 29;
3183 3184

	for (p = 0; p < adapter->num_rx_pools; p++)
3185
		IXGBE_WRITE_REG(hw, IXGBE_PSRTYPE(VMDQ_P(p)),
3186 3187 3188
				psrtype);
}

3189 3190 3191 3192
static void ixgbe_configure_virtualization(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 reg_offset, vf_shift;
3193
	u32 gcr_ext, vmdctl;
3194
	int i;
3195 3196 3197 3198 3199

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

	vmdctl = IXGBE_READ_REG(hw, IXGBE_VT_CTL);
3200 3201
	vmdctl |= IXGBE_VMD_CTL_VMDQ_EN;
	vmdctl &= ~IXGBE_VT_CTL_POOL_MASK;
3202
	vmdctl |= VMDQ_P(0) << IXGBE_VT_CTL_POOL_SHIFT;
3203 3204
	vmdctl |= IXGBE_VT_CTL_REPLEN;
	IXGBE_WRITE_REG(hw, IXGBE_VT_CTL, vmdctl);
3205

3206 3207
	vf_shift = VMDQ_P(0) % 32;
	reg_offset = (VMDQ_P(0) >= 32) ? 1 : 0;
3208 3209

	/* Enable only the PF's pool for Tx/Rx */
3210 3211 3212 3213
	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset), (~0) << vf_shift);
	IXGBE_WRITE_REG(hw, IXGBE_VFRE(reg_offset ^ 1), reg_offset - 1);
	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset), (~0) << vf_shift);
	IXGBE_WRITE_REG(hw, IXGBE_VFTE(reg_offset ^ 1), reg_offset - 1);
3214 3215 3216
	IXGBE_WRITE_REG(hw, IXGBE_PFDTXGSWC, IXGBE_PFDTXGSWC_VT_LBEN);

	/* Map PF MAC address in RAR Entry 0 to first pool following VFs */
3217
	hw->mac.ops.set_vmdq(hw, 0, VMDQ_P(0));
3218 3219 3220 3221 3222

	/*
	 * Set up VF register offsets for selected VT Mode,
	 * i.e. 32 or 64 VFs for SR-IOV
	 */
3223 3224 3225 3226 3227 3228 3229 3230 3231 3232 3233 3234
	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;
	}

3235 3236 3237 3238
	IXGBE_WRITE_REG(hw, IXGBE_GCR_EXT, gcr_ext);

	/* enable Tx loopback for VF/PF communication */
	IXGBE_WRITE_REG(hw, IXGBE_PFDTXGSWC, IXGBE_PFDTXGSWC_VT_LBEN);
3239

3240
	/* Enable MAC Anti-Spoofing */
3241
	hw->mac.ops.set_mac_anti_spoofing(hw, (adapter->num_vfs != 0),
3242
					  adapter->num_vfs);
3243 3244 3245 3246 3247
	/* For VFs that have spoof checking turned off */
	for (i = 0; i < adapter->num_vfs; i++) {
		if (!adapter->vfinfo[i].spoofchk_enabled)
			ixgbe_ndo_set_vf_spoofchk(adapter->netdev, i, false);
	}
3248 3249
}

3250
static void ixgbe_set_rx_buffer_len(struct ixgbe_adapter *adapter)
3251 3252 3253 3254
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct net_device *netdev = adapter->netdev;
	int max_frame = netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
3255 3256 3257
	struct ixgbe_ring *rx_ring;
	int i;
	u32 mhadd, hlreg0;
3258

3259
#ifdef IXGBE_FCOE
3260 3261 3262 3263
	/* 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;
3264

3265 3266 3267 3268 3269 3270 3271 3272 3273
#endif /* IXGBE_FCOE */
	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);
	}

3274 3275 3276
	/* MHADD will allow an extra 4 bytes past for vlan tagged frames */
	max_frame += VLAN_HLEN;

3277 3278 3279 3280
	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);
3281

3282 3283 3284 3285
	/*
	 * Setup the HW Rx Head and Tail Descriptor Pointers and
	 * the Base and Length of the Rx Descriptor Ring
	 */
3286
	for (i = 0; i < adapter->num_rx_queues; i++) {
3287
		rx_ring = adapter->rx_ring[i];
A
Alexander Duyck 已提交
3288 3289
		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
			set_ring_rsc_enabled(rx_ring);
3290
		else
A
Alexander Duyck 已提交
3291
			clear_ring_rsc_enabled(rx_ring);
3292 3293 3294
	}
}

3295 3296 3297 3298 3299 3300 3301 3302 3303 3304 3305 3306 3307 3308 3309 3310 3311 3312 3313 3314
static void ixgbe_setup_rdrxctl(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 rdrxctl = IXGBE_READ_REG(hw, IXGBE_RDRXCTL);

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
		/*
		 * For VMDq support of different descriptor types or
		 * buffer sizes through the use of multiple SRRCTL
		 * registers, RDRXCTL.MVMEN must be set to 1
		 *
		 * also, the manual doesn't mention it clearly but DCA hints
		 * will only use queue 0's tags unless this bit is set.  Side
		 * effects of setting this bit are only that SRRCTL must be
		 * fully programmed [0..15]
		 */
		rdrxctl |= IXGBE_RDRXCTL_MVMEN;
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3315
	case ixgbe_mac_X540:
3316 3317 3318 3319 3320 3321 3322 3323 3324 3325 3326 3327 3328 3329 3330 3331
		/* 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);
}

3332 3333 3334 3335 3336 3337 3338 3339 3340 3341 3342 3343 3344 3345 3346 3347 3348
/**
 * 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;
	u32 rxctrl;

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

	ixgbe_setup_psrtype(adapter);
3349
	ixgbe_setup_rdrxctl(adapter);
3350

3351
	/* Program registers for the distribution of queues */
3352 3353
	ixgbe_setup_mrqc(adapter);

3354 3355 3356 3357 3358 3359 3360
	/* 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
	 */
3361 3362
	for (i = 0; i < adapter->num_rx_queues; i++)
		ixgbe_configure_rx_ring(adapter, adapter->rx_ring[i]);
3363

3364 3365 3366 3367 3368 3369 3370
	/* 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);
3371 3372
}

3373
static int ixgbe_vlan_rx_add_vid(struct net_device *netdev, u16 vid)
3374 3375 3376 3377 3378
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

	/* add VID to filter table */
3379
	hw->mac.ops.set_vfta(&adapter->hw, vid, VMDQ_P(0), true);
3380
	set_bit(vid, adapter->active_vlans);
3381 3382

	return 0;
3383 3384
}

3385
static int ixgbe_vlan_rx_kill_vid(struct net_device *netdev, u16 vid)
3386 3387 3388 3389 3390
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

	/* remove VID from filter table */
3391
	hw->mac.ops.set_vfta(&adapter->hw, vid, VMDQ_P(0), false);
3392
	clear_bit(vid, adapter->active_vlans);
3393 3394

	return 0;
3395 3396
}

3397 3398 3399 3400 3401 3402 3403
/**
 * ixgbe_vlan_filter_disable - helper to disable hw vlan filtering
 * @adapter: driver data
 */
static void ixgbe_vlan_filter_disable(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3404 3405 3406 3407 3408 3409 3410 3411 3412 3413 3414 3415 3416 3417 3418 3419 3420 3421 3422 3423 3424 3425 3426 3427 3428 3429 3430 3431 3432 3433
	u32 vlnctrl;

	vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
	vlnctrl &= ~(IXGBE_VLNCTRL_VFE | IXGBE_VLNCTRL_CFIEN);
	IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
}

/**
 * ixgbe_vlan_filter_enable - helper to enable hw vlan filtering
 * @adapter: driver data
 */
static void ixgbe_vlan_filter_enable(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 vlnctrl;

	vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
	vlnctrl |= IXGBE_VLNCTRL_VFE;
	vlnctrl &= ~IXGBE_VLNCTRL_CFIEN;
	IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
}

/**
 * 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;
3434 3435 3436 3437
	int i, j;

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
3438 3439
		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
		vlnctrl &= ~IXGBE_VLNCTRL_VME;
3440 3441 3442
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3443
	case ixgbe_mac_X540:
3444 3445 3446 3447 3448 3449 3450 3451 3452 3453 3454 3455 3456
		for (i = 0; i < adapter->num_rx_queues; i++) {
			j = adapter->rx_ring[i]->reg_idx;
			vlnctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(j));
			vlnctrl &= ~IXGBE_RXDCTL_VME;
			IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(j), vlnctrl);
		}
		break;
	default:
		break;
	}
}

/**
3457
 * ixgbe_vlan_strip_enable - helper to enable hw vlan stripping
3458 3459
 * @adapter: driver data
 */
3460
static void ixgbe_vlan_strip_enable(struct ixgbe_adapter *adapter)
3461 3462
{
	struct ixgbe_hw *hw = &adapter->hw;
3463
	u32 vlnctrl;
3464 3465 3466 3467
	int i, j;

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
3468 3469
		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
		vlnctrl |= IXGBE_VLNCTRL_VME;
3470 3471 3472
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3473
	case ixgbe_mac_X540:
3474 3475 3476 3477 3478 3479 3480 3481 3482 3483 3484 3485
		for (i = 0; i < adapter->num_rx_queues; i++) {
			j = adapter->rx_ring[i]->reg_idx;
			vlnctrl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(j));
			vlnctrl |= IXGBE_RXDCTL_VME;
			IXGBE_WRITE_REG(hw, IXGBE_RXDCTL(j), vlnctrl);
		}
		break;
	default:
		break;
	}
}

3486 3487
static void ixgbe_restore_vlan(struct ixgbe_adapter *adapter)
{
3488
	u16 vid;
3489

3490 3491 3492 3493
	ixgbe_vlan_rx_add_vid(adapter->netdev, 0);

	for_each_set_bit(vid, adapter->active_vlans, VLAN_N_VID)
		ixgbe_vlan_rx_add_vid(adapter->netdev, vid);
3494 3495
}

3496 3497 3498 3499 3500 3501 3502 3503 3504 3505 3506 3507 3508
/**
 * 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
 **/
static int ixgbe_write_uc_addr_list(struct net_device *netdev)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;
3509
	unsigned int rar_entries = hw->mac.num_rar_entries - 1;
3510 3511
	int count = 0;

3512 3513 3514 3515
	/* In SR-IOV mode significantly less RAR entries are available */
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
		rar_entries = IXGBE_MAX_PF_MACVLANS - 1;

3516 3517 3518 3519
	/* return ENOMEM indicating insufficient memory for addresses */
	if (netdev_uc_count(netdev) > rar_entries)
		return -ENOMEM;

3520
	if (!netdev_uc_empty(netdev)) {
3521 3522 3523 3524 3525 3526 3527 3528 3529
		struct netdev_hw_addr *ha;
		/* return error if we do not support writing to RAR table */
		if (!hw->mac.ops.set_rar)
			return -ENOMEM;

		netdev_for_each_uc_addr(ha, netdev) {
			if (!rar_entries)
				break;
			hw->mac.ops.set_rar(hw, rar_entries--, ha->addr,
3530
					    VMDQ_P(0), IXGBE_RAH_AV);
3531 3532 3533 3534 3535 3536 3537 3538 3539 3540
			count++;
		}
	}
	/* write the addresses in reverse order to avoid write combining */
	for (; rar_entries > 0 ; rar_entries--)
		hw->mac.ops.clear_rar(hw, rar_entries);

	return count;
}

3541
/**
3542
 * ixgbe_set_rx_mode - Unicast, Multicast and Promiscuous mode set
3543 3544
 * @netdev: network interface device structure
 *
3545 3546 3547 3548
 * 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.
3549
 **/
3550
void ixgbe_set_rx_mode(struct net_device *netdev)
3551 3552 3553
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;
3554 3555
	u32 fctrl, vmolr = IXGBE_VMOLR_BAM | IXGBE_VMOLR_AUPE;
	int count;
3556 3557 3558 3559 3560

	/* Check for Promiscuous and All Multicast modes */

	fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);

3561
	/* set all bits that we expect to always be set */
B
Ben Greear 已提交
3562
	fctrl &= ~IXGBE_FCTRL_SBP; /* disable store-bad-packets */
3563 3564 3565 3566
	fctrl |= IXGBE_FCTRL_BAM;
	fctrl |= IXGBE_FCTRL_DPF; /* discard pause frames when FC enabled */
	fctrl |= IXGBE_FCTRL_PMCF;

3567 3568 3569
	/* clear the bits we are changing the status of */
	fctrl &= ~(IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);

3570
	if (netdev->flags & IFF_PROMISC) {
3571
		hw->addr_ctrl.user_set_promisc = true;
3572
		fctrl |= (IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);
3573
		vmolr |= (IXGBE_VMOLR_ROPE | IXGBE_VMOLR_MPE);
3574 3575
		/* don't hardware filter vlans in promisc mode */
		ixgbe_vlan_filter_disable(adapter);
3576
	} else {
3577 3578
		if (netdev->flags & IFF_ALLMULTI) {
			fctrl |= IXGBE_FCTRL_MPE;
3579 3580 3581 3582
			vmolr |= IXGBE_VMOLR_MPE;
		} else {
			/*
			 * Write addresses to the MTA, if the attempt fails
L
Lucas De Marchi 已提交
3583
			 * then we should just turn on promiscuous mode so
3584 3585 3586 3587
			 * that we can at least receive multicast traffic
			 */
			hw->mac.ops.update_mc_addr_list(hw, netdev);
			vmolr |= IXGBE_VMOLR_ROMPE;
3588
		}
3589
		ixgbe_vlan_filter_enable(adapter);
3590
		hw->addr_ctrl.user_set_promisc = false;
3591 3592 3593 3594 3595 3596 3597 3598 3599 3600 3601
	}

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

3604
	if (adapter->num_vfs)
3605
		ixgbe_restore_vf_multicasts(adapter);
3606 3607 3608

	if (hw->mac.type != ixgbe_mac_82598EB) {
		vmolr |= IXGBE_READ_REG(hw, IXGBE_VMOLR(VMDQ_P(0))) &
3609 3610
			 ~(IXGBE_VMOLR_MPE | IXGBE_VMOLR_ROMPE |
			   IXGBE_VMOLR_ROPE);
3611
		IXGBE_WRITE_REG(hw, IXGBE_VMOLR(VMDQ_P(0)), vmolr);
3612 3613
	}

B
Ben Greear 已提交
3614 3615 3616 3617 3618 3619 3620 3621 3622 3623 3624 3625
	/* This is useful for sniffing bad packets. */
	if (adapter->netdev->features & NETIF_F_RXALL) {
		/* UPE and MPE will be handled by normal PROMISC logic
		 * in e1000e_set_rx_mode */
		fctrl |= (IXGBE_FCTRL_SBP | /* Receive bad packets */
			  IXGBE_FCTRL_BAM | /* RX All Bcast Pkts */
			  IXGBE_FCTRL_PMCF); /* RX All MAC Ctrl Pkts */

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

3626
	IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
3627 3628 3629 3630 3631

	if (netdev->features & NETIF_F_HW_VLAN_RX)
		ixgbe_vlan_strip_enable(adapter);
	else
		ixgbe_vlan_strip_disable(adapter);
3632 3633
}

3634 3635 3636 3637
static void ixgbe_napi_enable_all(struct ixgbe_adapter *adapter)
{
	int q_idx;

3638 3639
	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++)
		napi_enable(&adapter->q_vector[q_idx]->napi);
3640 3641 3642 3643 3644 3645
}

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

3646 3647
	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++)
		napi_disable(&adapter->q_vector[q_idx]->napi);
3648 3649
}

J
Jeff Kirsher 已提交
3650
#ifdef CONFIG_IXGBE_DCB
3651
/**
3652 3653 3654 3655 3656 3657 3658 3659 3660 3661
 * 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;
3662
	int max_frame = adapter->netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
3663

3664 3665 3666 3667 3668 3669 3670 3671 3672
	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);

3673
#ifdef IXGBE_FCOE
3674 3675
	if (adapter->netdev->features & NETIF_F_FCOE_MTU)
		max_frame = max(max_frame, IXGBE_FCOE_JUMBO_FRAME_SIZE);
3676
#endif
3677 3678 3679

	/* reconfigure the hardware */
	if (adapter->dcbx_cap & DCB_CAP_DCBX_VER_CEE) {
3680 3681 3682 3683 3684
		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);
3685 3686 3687 3688 3689 3690 3691
	} 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);
3692
	}
3693 3694 3695

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

3699 3700 3701 3702
		while (rss_i) {
			msb++;
			rss_i >>= 1;
		}
3703

3704 3705
		/* write msb to all 8 TCs in one write */
		IXGBE_WRITE_REG(hw, IXGBE_RQTC, msb * 0x11111111);
3706
	}
3707
}
3708 3709 3710 3711 3712
#endif

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

3713
/**
3714 3715 3716
 * ixgbe_hpbthresh - calculate high water mark for flow control
 *
 * @adapter: board private structure to calculate for
3717
 * @pb: packet buffer to calculate
3718 3719 3720 3721 3722 3723 3724 3725 3726 3727 3728 3729 3730
 */
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 */
3731 3732 3733 3734
	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;
3735 3736 3737 3738 3739 3740 3741 3742 3743 3744 3745 3746 3747 3748 3749 3750 3751 3752 3753 3754 3755 3756 3757 3758 3759 3760 3761 3762 3763 3764 3765 3766 3767 3768 3769 3770

#endif
	/* Calculate delay value for device */
	switch (hw->mac.type) {
	case ixgbe_mac_X540:
		dv_id = IXGBE_DV_X540(link, tc);
		break;
	default:
		dv_id = IXGBE_DV(link, tc);
		break;
	}

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

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

	marker = rx_pba - kb;

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

	return marker;
}

3771
/**
3772 3773 3774
 * ixgbe_lpbthresh - calculate low water mark for for flow control
 *
 * @adapter: board private structure to calculate for
3775
 * @pb: packet buffer to calculate
3776 3777 3778 3779 3780 3781 3782 3783 3784 3785 3786 3787 3788 3789 3790 3791 3792 3793 3794 3795 3796 3797 3798 3799 3800 3801 3802 3803 3804 3805 3806 3807 3808 3809 3810 3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823
 */
static int ixgbe_lpbthresh(struct ixgbe_adapter *adapter)
{
	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;

	/* Calculate delay value for device */
	switch (hw->mac.type) {
	case ixgbe_mac_X540:
		dv_id = IXGBE_LOW_DV_X540(tc);
		break;
	default:
		dv_id = IXGBE_LOW_DV(tc);
		break;
	}

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

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

	if (!num_tc)
		num_tc = 1;

	hw->fc.low_water = ixgbe_lpbthresh(adapter);

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

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

3824 3825 3826
static void ixgbe_configure_pb(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3827 3828
	int hdrm;
	u8 tc = netdev_get_num_tc(adapter->netdev);
3829 3830 3831

	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE ||
	    adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE)
3832 3833 3834
		hdrm = 32 << adapter->fdir_pballoc;
	else
		hdrm = 0;
3835

3836
	hw->mac.ops.set_rxpba(hw, tc, hdrm, PBA_STRATEGY_EQUAL);
3837
	ixgbe_pbthresh_setup(adapter);
3838 3839
}

3840 3841 3842 3843 3844 3845 3846 3847 3848 3849 3850 3851 3852 3853
static void ixgbe_fdir_filter_restore(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct hlist_node *node, *node2;
	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);

	hlist_for_each_entry_safe(filter, node, node2,
				  &adapter->fdir_filter_list, fdir_node) {
		ixgbe_fdir_write_perfect_filter_82599(hw,
3854 3855 3856 3857 3858
				&filter->filter,
				filter->sw_idx,
				(filter->action == IXGBE_FDIR_DROP_QUEUE) ?
				IXGBE_FDIR_DROP_QUEUE :
				adapter->rx_ring[filter->action]->reg_idx);
3859 3860 3861 3862 3863
	}

	spin_unlock(&adapter->fdir_perfect_lock);
}

3864 3865
static void ixgbe_configure(struct ixgbe_adapter *adapter)
{
3866 3867
	struct ixgbe_hw *hw = &adapter->hw;

3868
	ixgbe_configure_pb(adapter);
J
Jeff Kirsher 已提交
3869
#ifdef CONFIG_IXGBE_DCB
3870
	ixgbe_configure_dcb(adapter);
3871
#endif
3872 3873 3874 3875 3876
	/*
	 * We must restore virtualization before VLANs or else
	 * the VLVF registers will not be populated
	 */
	ixgbe_configure_virtualization(adapter);
3877

3878
	ixgbe_set_rx_mode(adapter->netdev);
3879 3880
	ixgbe_restore_vlan(adapter);

3881 3882 3883 3884 3885 3886 3887 3888 3889
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
		hw->mac.ops.disable_rx_buff(hw);
		break;
	default:
		break;
	}

3890
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
3891 3892
		ixgbe_init_fdir_signature_82599(&adapter->hw,
						adapter->fdir_pballoc);
3893 3894 3895 3896
	} else if (adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE) {
		ixgbe_init_fdir_perfect_82599(&adapter->hw,
					      adapter->fdir_pballoc);
		ixgbe_fdir_filter_restore(adapter);
3897
	}
3898

3899 3900 3901 3902 3903 3904 3905 3906 3907
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
		hw->mac.ops.enable_rx_buff(hw);
		break;
	default:
		break;
	}

3908 3909 3910 3911 3912
#ifdef IXGBE_FCOE
	/* configure FCoE L2 filters, redirection table, and Rx control */
	ixgbe_configure_fcoe(adapter);

#endif /* IXGBE_FCOE */
3913 3914 3915 3916
	ixgbe_configure_tx(adapter);
	ixgbe_configure_rx(adapter);
}

3917 3918 3919 3920 3921 3922 3923
static inline bool ixgbe_is_sfp(struct ixgbe_hw *hw)
{
	switch (hw->phy.type) {
	case ixgbe_phy_sfp_avago:
	case ixgbe_phy_sfp_ftl:
	case ixgbe_phy_sfp_intel:
	case ixgbe_phy_sfp_unknown:
3924 3925 3926 3927
	case ixgbe_phy_sfp_passive_tyco:
	case ixgbe_phy_sfp_passive_unknown:
	case ixgbe_phy_sfp_active_unknown:
	case ixgbe_phy_sfp_ftl_active:
3928
		return true;
3929 3930 3931
	case ixgbe_phy_nl:
		if (hw->mac.type == ixgbe_mac_82598EB)
			return true;
3932 3933 3934 3935 3936
	default:
		return false;
	}
}

3937
/**
3938 3939 3940 3941 3942
 * ixgbe_sfp_link_config - set up SFP+ link
 * @adapter: pointer to private adapter struct
 **/
static void ixgbe_sfp_link_config(struct ixgbe_adapter *adapter)
{
3943
	/*
S
Stephen Hemminger 已提交
3944
	 * We are assuming the worst case scenario here, and that
3945 3946 3947 3948 3949 3950
	 * 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;
3951

3952
	adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
3953 3954 3955 3956
}

/**
 * ixgbe_non_sfp_link_config - set up non-SFP+ link
3957 3958 3959 3960
 * @hw: pointer to private hardware struct
 *
 * Returns 0 on success, negative on failure
 **/
3961
static int ixgbe_non_sfp_link_config(struct ixgbe_hw *hw)
3962 3963
{
	u32 autoneg;
3964
	bool negotiation, link_up = false;
3965 3966 3967 3968 3969 3970 3971 3972
	u32 ret = IXGBE_ERR_LINK_SETUP;

	if (hw->mac.ops.check_link)
		ret = hw->mac.ops.check_link(hw, &autoneg, &link_up, false);

	if (ret)
		goto link_cfg_out;

3973 3974
	autoneg = hw->phy.autoneg_advertised;
	if ((!autoneg) && (hw->mac.ops.get_link_capabilities))
3975 3976
		ret = hw->mac.ops.get_link_capabilities(hw, &autoneg,
							&negotiation);
3977 3978 3979
	if (ret)
		goto link_cfg_out;

3980 3981
	if (hw->mac.ops.setup_link)
		ret = hw->mac.ops.setup_link(hw, autoneg, negotiation, link_up);
3982 3983 3984 3985
link_cfg_out:
	return ret;
}

3986
static void ixgbe_setup_gpie(struct ixgbe_adapter *adapter)
3987 3988
{
	struct ixgbe_hw *hw = &adapter->hw;
3989
	u32 gpie = 0;
3990

3991
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
3992 3993 3994
		gpie = IXGBE_GPIE_MSIX_MODE | IXGBE_GPIE_PBA_SUPPORT |
		       IXGBE_GPIE_OCD;
		gpie |= IXGBE_GPIE_EIAME;
3995 3996 3997 3998 3999 4000 4001 4002 4003
		/*
		 * 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 已提交
4004 4005
		case ixgbe_mac_X540:
		default:
4006 4007 4008 4009 4010
			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(0), 0xFFFFFFFF);
			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(1), 0xFFFFFFFF);
			break;
		}
	} else {
4011 4012 4013 4014
		/* 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);
	}
4015

4016 4017 4018 4019 4020
	/* 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;
4021 4022 4023 4024 4025 4026 4027 4028 4029 4030 4031 4032

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

4035
	/* Enable Thermal over heat sensor interrupt */
4036 4037 4038 4039 4040 4041 4042 4043 4044 4045 4046 4047
	if (adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE) {
		switch (adapter->hw.mac.type) {
		case ixgbe_mac_82599EB:
			gpie |= IXGBE_SDP0_GPIEN;
			break;
		case ixgbe_mac_X540:
			gpie |= IXGBE_EIMS_TS;
			break;
		default:
			break;
		}
	}
4048

4049 4050
	/* Enable fan failure interrupt */
	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE)
4051 4052
		gpie |= IXGBE_SDP1_GPIEN;

4053
	if (hw->mac.type == ixgbe_mac_82599EB) {
4054 4055
		gpie |= IXGBE_SDP1_GPIEN;
		gpie |= IXGBE_SDP2_GPIEN;
4056
	}
4057 4058 4059 4060

	IXGBE_WRITE_REG(hw, IXGBE_GPIE, gpie);
}

4061
static void ixgbe_up_complete(struct ixgbe_adapter *adapter)
4062 4063 4064 4065 4066 4067 4068
{
	struct ixgbe_hw *hw = &adapter->hw;
	int err;
	u32 ctrl_ext;

	ixgbe_get_hw_control(adapter);
	ixgbe_setup_gpie(adapter);
4069

4070 4071 4072 4073 4074
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
		ixgbe_configure_msix(adapter);
	else
		ixgbe_configure_msi_and_legacy(adapter);

4075 4076 4077
	/* enable the optics for both mult-speed fiber and 82599 SFP+ fiber */
	if (hw->mac.ops.enable_tx_laser &&
	    ((hw->phy.multispeed_fiber) ||
4078
	     ((hw->mac.ops.get_media_type(hw) == ixgbe_media_type_fiber) &&
4079
	      (hw->mac.type == ixgbe_mac_82599EB))))
4080 4081
		hw->mac.ops.enable_tx_laser(hw);

4082
	clear_bit(__IXGBE_DOWN, &adapter->state);
4083 4084
	ixgbe_napi_enable_all(adapter);

4085 4086 4087 4088 4089 4090 4091 4092
	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);
	}

4093 4094
	/* clear any pending interrupts, may auto mask */
	IXGBE_READ_REG(hw, IXGBE_EICR);
4095
	ixgbe_irq_enable(adapter, true, true);
4096

4097 4098 4099 4100 4101 4102 4103
	/*
	 * 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)
4104
			e_crit(drv, "Fan has stopped, replace the adapter\n");
4105 4106
	}

4107
	/* enable transmits */
4108
	netif_tx_start_all_queues(adapter->netdev);
4109

4110 4111
	/* bring the link up in the watchdog, this could race with our first
	 * link up interrupt but shouldn't be a problem */
4112 4113
	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
	adapter->link_check_timeout = jiffies;
4114
	mod_timer(&adapter->service_timer, jiffies);
4115 4116 4117 4118 4119

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

4122 4123 4124
void ixgbe_reinit_locked(struct ixgbe_adapter *adapter)
{
	WARN_ON(in_interrupt());
4125 4126 4127
	/* put off any impending NetWatchDogTimeout */
	adapter->netdev->trans_start = jiffies;

4128
	while (test_and_set_bit(__IXGBE_RESETTING, &adapter->state))
4129
		usleep_range(1000, 2000);
4130
	ixgbe_down(adapter);
4131 4132 4133 4134 4135 4136 4137 4138
	/*
	 * 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);
4139 4140 4141 4142
	ixgbe_up(adapter);
	clear_bit(__IXGBE_RESETTING, &adapter->state);
}

4143
void ixgbe_up(struct ixgbe_adapter *adapter)
4144 4145 4146 4147
{
	/* hardware has been reset, we need to reload some things */
	ixgbe_configure(adapter);

4148
	ixgbe_up_complete(adapter);
4149 4150 4151 4152
}

void ixgbe_reset(struct ixgbe_adapter *adapter)
{
4153
	struct ixgbe_hw *hw = &adapter->hw;
4154 4155
	int err;

4156 4157 4158 4159 4160 4161 4162 4163 4164
	/* 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;

4165
	err = hw->mac.ops.init_hw(hw);
4166 4167 4168
	switch (err) {
	case 0:
	case IXGBE_ERR_SFP_NOT_PRESENT:
4169
	case IXGBE_ERR_SFP_NOT_SUPPORTED:
4170 4171
		break;
	case IXGBE_ERR_MASTER_REQUESTS_PENDING:
4172
		e_dev_err("master disable timed out\n");
4173
		break;
4174 4175
	case IXGBE_ERR_EEPROM_VERSION:
		/* We are running on a pre-production device, log a warning */
4176
		e_dev_warn("This device is a pre-production adapter/LOM. "
S
Stephen Hemminger 已提交
4177
			   "Please be aware there may be issues associated with "
4178 4179 4180 4181
			   "your hardware.  If you are experiencing problems "
			   "please contact your Intel or hardware "
			   "representative who provided you with this "
			   "hardware.\n");
4182
		break;
4183
	default:
4184
		e_dev_err("Hardware Error: %d\n", err);
4185
	}
4186

4187 4188
	clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);

4189
	/* reprogram the RAR[0] in case user changed it. */
4190
	hw->mac.ops.set_rar(hw, 0, hw->mac.addr, VMDQ_P(0), IXGBE_RAH_AV);
4191 4192 4193 4194

	/* update SAN MAC vmdq pool selection */
	if (hw->mac.san_mac_rar_index)
		hw->mac.ops.set_vmdq_san_mac(hw, VMDQ_P(0));
4195 4196 4197 4198 4199 4200
}

/**
 * ixgbe_clean_rx_ring - Free Rx Buffers per Queue
 * @rx_ring: ring to free buffers from
 **/
4201
static void ixgbe_clean_rx_ring(struct ixgbe_ring *rx_ring)
4202
{
4203
	struct device *dev = rx_ring->dev;
4204
	unsigned long size;
4205
	u16 i;
4206

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

4211
	/* Free all the Rx ring sk_buffs */
4212
	for (i = 0; i < rx_ring->count; i++) {
4213 4214 4215 4216 4217 4218 4219 4220 4221 4222 4223
		struct ixgbe_rx_buffer *rx_buffer;

		rx_buffer = &rx_ring->rx_buffer_info[i];
		if (rx_buffer->skb) {
			struct sk_buff *skb = rx_buffer->skb;
			if (IXGBE_CB(skb)->page_released) {
				dma_unmap_page(dev,
					       IXGBE_CB(skb)->dma,
					       ixgbe_rx_bufsz(rx_ring),
					       DMA_FROM_DEVICE);
				IXGBE_CB(skb)->page_released = false;
A
Alexander Duyck 已提交
4224 4225
			}
			dev_kfree_skb(skb);
4226
		}
4227 4228 4229 4230 4231 4232 4233
		rx_buffer->skb = NULL;
		if (rx_buffer->dma)
			dma_unmap_page(dev, rx_buffer->dma,
				       ixgbe_rx_pg_size(rx_ring),
				       DMA_FROM_DEVICE);
		rx_buffer->dma = 0;
		if (rx_buffer->page)
4234 4235
			__free_pages(rx_buffer->page,
				     ixgbe_rx_pg_order(rx_ring));
4236
		rx_buffer->page = NULL;
4237 4238 4239 4240 4241 4242 4243 4244
	}

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

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

4245
	rx_ring->next_to_alloc = 0;
4246 4247 4248 4249 4250 4251 4252 4253
	rx_ring->next_to_clean = 0;
	rx_ring->next_to_use = 0;
}

/**
 * ixgbe_clean_tx_ring - Free Tx Buffers
 * @tx_ring: ring to be cleaned
 **/
4254
static void ixgbe_clean_tx_ring(struct ixgbe_ring *tx_ring)
4255 4256 4257
{
	struct ixgbe_tx_buffer *tx_buffer_info;
	unsigned long size;
4258
	u16 i;
4259

4260 4261 4262
	/* ring already cleared, nothing to do */
	if (!tx_ring->tx_buffer_info)
		return;
4263

4264
	/* Free all the Tx ring sk_buffs */
4265 4266
	for (i = 0; i < tx_ring->count; i++) {
		tx_buffer_info = &tx_ring->tx_buffer_info[i];
4267
		ixgbe_unmap_and_free_tx_resource(tx_ring, tx_buffer_info);
4268 4269
	}

4270 4271
	netdev_tx_reset_queue(txring_txq(tx_ring));

4272 4273 4274 4275 4276 4277 4278 4279 4280 4281 4282
	size = sizeof(struct ixgbe_tx_buffer) * tx_ring->count;
	memset(tx_ring->tx_buffer_info, 0, size);

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

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

/**
4283
 * ixgbe_clean_all_rx_rings - Free Rx Buffers for all queues
4284 4285
 * @adapter: board private structure
 **/
4286
static void ixgbe_clean_all_rx_rings(struct ixgbe_adapter *adapter)
4287 4288 4289
{
	int i;

4290
	for (i = 0; i < adapter->num_rx_queues; i++)
4291
		ixgbe_clean_rx_ring(adapter->rx_ring[i]);
4292 4293 4294
}

/**
4295
 * ixgbe_clean_all_tx_rings - Free Tx Buffers for all queues
4296 4297
 * @adapter: board private structure
 **/
4298
static void ixgbe_clean_all_tx_rings(struct ixgbe_adapter *adapter)
4299 4300 4301
{
	int i;

4302
	for (i = 0; i < adapter->num_tx_queues; i++)
4303
		ixgbe_clean_tx_ring(adapter->tx_ring[i]);
4304 4305
}

4306 4307 4308 4309 4310 4311 4312 4313 4314 4315 4316 4317 4318 4319 4320 4321 4322
static void ixgbe_fdir_filter_exit(struct ixgbe_adapter *adapter)
{
	struct hlist_node *node, *node2;
	struct ixgbe_fdir_filter *filter;

	spin_lock(&adapter->fdir_perfect_lock);

	hlist_for_each_entry_safe(filter, node, node2,
				  &adapter->fdir_filter_list, fdir_node) {
		hlist_del(&filter->fdir_node);
		kfree(filter);
	}
	adapter->fdir_filter_count = 0;

	spin_unlock(&adapter->fdir_perfect_lock);
}

4323 4324 4325
void ixgbe_down(struct ixgbe_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
4326
	struct ixgbe_hw *hw = &adapter->hw;
4327
	u32 rxctrl;
4328
	int i;
4329 4330 4331 4332 4333

	/* signal that we are down to the interrupt handler */
	set_bit(__IXGBE_DOWN, &adapter->state);

	/* disable receives */
4334 4335
	rxctrl = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
	IXGBE_WRITE_REG(hw, IXGBE_RXCTRL, rxctrl & ~IXGBE_RXCTRL_RXEN);
4336

4337 4338 4339 4340 4341
	/* 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]);

4342
	usleep_range(10000, 20000);
4343

4344 4345
	netif_tx_stop_all_queues(netdev);

4346
	/* call carrier off first to avoid false dev_watchdog timeouts */
4347 4348 4349 4350 4351 4352 4353
	netif_carrier_off(netdev);
	netif_tx_disable(netdev);

	ixgbe_irq_disable(adapter);

	ixgbe_napi_disable_all(adapter);

4354 4355
	adapter->flags2 &= ~(IXGBE_FLAG2_FDIR_REQUIRES_REINIT |
			     IXGBE_FLAG2_RESET_REQUESTED);
4356 4357 4358 4359
	adapter->flags &= ~IXGBE_FLAG_NEED_LINK_UPDATE;

	del_timer_sync(&adapter->service_timer);

4360
	if (adapter->num_vfs) {
4361 4362
		/* Clear EITR Select mapping */
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITRSEL, 0);
4363 4364 4365

		/* Mark all the VFs as inactive */
		for (i = 0 ; i < adapter->num_vfs; i++)
4366
			adapter->vfinfo[i].clear_to_send = false;
4367 4368 4369 4370 4371 4372

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

4375 4376
	/* disable transmits in the hardware now that interrupts are off */
	for (i = 0; i < adapter->num_tx_queues; i++) {
4377
		u8 reg_idx = adapter->tx_ring[i]->reg_idx;
4378
		IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), IXGBE_TXDCTL_SWFLSH);
4379
	}
4380 4381

	/* Disable the Tx DMA engine on 82599 and X540 */
4382 4383
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
4384
	case ixgbe_mac_X540:
4385
		IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL,
4386 4387
				(IXGBE_READ_REG(hw, IXGBE_DMATXCTL) &
				 ~IXGBE_DMATXCTL_TE));
4388 4389 4390 4391
		break;
	default:
		break;
	}
4392

4393 4394
	if (!pci_channel_offline(adapter->pdev))
		ixgbe_reset(adapter);
4395 4396 4397 4398

	/* power down the optics for multispeed fiber and 82599 SFP+ fiber */
	if (hw->mac.ops.disable_tx_laser &&
	    ((hw->phy.multispeed_fiber) ||
4399
	     ((hw->mac.ops.get_media_type(hw) == ixgbe_media_type_fiber) &&
4400 4401 4402
	      (hw->mac.type == ixgbe_mac_82599EB))))
		hw->mac.ops.disable_tx_laser(hw);

4403 4404 4405
	ixgbe_clean_all_tx_rings(adapter);
	ixgbe_clean_all_rx_rings(adapter);

4406
#ifdef CONFIG_IXGBE_DCA
4407
	/* since we reset the hardware DCA settings were cleared */
4408
	ixgbe_setup_dca(adapter);
4409
#endif
4410 4411 4412 4413 4414 4415 4416 4417 4418 4419 4420
}

/**
 * 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 */
4421
	ixgbe_tx_timeout_reset(adapter);
4422 4423 4424 4425 4426 4427 4428 4429 4430 4431 4432 4433 4434 4435
}

/**
 * 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).
 **/
static int __devinit ixgbe_sw_init(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct pci_dev *pdev = adapter->pdev;
4436
	unsigned int rss;
J
Jeff Kirsher 已提交
4437
#ifdef CONFIG_IXGBE_DCB
4438 4439 4440
	int j;
	struct tc_configuration *tc;
#endif
4441

4442 4443 4444 4445 4446 4447 4448 4449
	/* 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;

4450
	/* Set capability flags */
4451
	rss = min_t(int, IXGBE_MAX_RSS_INDICES, num_online_cpus());
4452
	adapter->ring_feature[RING_F_RSS].limit = rss;
4453 4454
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
4455 4456
		if (hw->device_id == IXGBE_DEV_ID_82598AT)
			adapter->flags |= IXGBE_FLAG_FAN_FAIL_CAPABLE;
4457
		adapter->max_q_vectors = MAX_Q_VECTORS_82598;
4458
		break;
D
Don Skidmore 已提交
4459
	case ixgbe_mac_X540:
4460 4461
		adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
	case ixgbe_mac_82599EB:
4462
		adapter->max_q_vectors = MAX_Q_VECTORS_82599;
4463 4464
		adapter->flags2 |= IXGBE_FLAG2_RSC_CAPABLE;
		adapter->flags2 |= IXGBE_FLAG2_RSC_ENABLED;
4465 4466
		if (hw->device_id == IXGBE_DEV_ID_82599_T3_LOM)
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
4467 4468
		/* Flow Director hash filters enabled */
		adapter->atr_sample_rate = 20;
4469
		adapter->ring_feature[RING_F_FDIR].limit =
4470
							 IXGBE_MAX_FDIR_INDICES;
4471
		adapter->fdir_pballoc = IXGBE_FDIR_PBALLOC_64K;
4472
#ifdef IXGBE_FCOE
4473 4474
		adapter->flags |= IXGBE_FLAG_FCOE_CAPABLE;
		adapter->flags &= ~IXGBE_FLAG_FCOE_ENABLED;
4475
#ifdef CONFIG_IXGBE_DCB
4476
		/* Default traffic class to use for FCoE */
4477
		adapter->fcoe.up = IXGBE_FCOE_DEFTC;
4478
#endif
4479
#endif /* IXGBE_FCOE */
4480 4481 4482
		break;
	default:
		break;
A
Alexander Duyck 已提交
4483
	}
4484

4485 4486 4487 4488 4489
#ifdef IXGBE_FCOE
	/* FCoE support exists, always init the FCoE lock */
	spin_lock_init(&adapter->fcoe.lock);

#endif
4490 4491 4492
	/* n-tuple support exists, always init our spinlock */
	spin_lock_init(&adapter->fdir_perfect_lock);

J
Jeff Kirsher 已提交
4493
#ifdef CONFIG_IXGBE_DCB
4494 4495 4496 4497 4498 4499 4500 4501 4502 4503 4504
	switch (hw->mac.type) {
	case ixgbe_mac_X540:
		adapter->dcb_cfg.num_tcs.pg_tcs = X540_TRAFFIC_CLASS;
		adapter->dcb_cfg.num_tcs.pfc_tcs = X540_TRAFFIC_CLASS;
		break;
	default:
		adapter->dcb_cfg.num_tcs.pg_tcs = MAX_TRAFFIC_CLASS;
		adapter->dcb_cfg.num_tcs.pfc_tcs = MAX_TRAFFIC_CLASS;
		break;
	}

4505 4506 4507 4508 4509 4510 4511 4512 4513
	/* 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;
	}
4514 4515 4516 4517 4518 4519

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

4520 4521
	adapter->dcb_cfg.bw_percentage[DCB_TX_CONFIG][0] = 100;
	adapter->dcb_cfg.bw_percentage[DCB_RX_CONFIG][0] = 100;
4522
	adapter->dcb_cfg.pfc_mode_enable = false;
4523
	adapter->dcb_set_bitmap = 0x00;
4524
	adapter->dcbx_cap = DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_CEE;
4525 4526
	memcpy(&adapter->temp_dcb_cfg, &adapter->dcb_cfg,
	       sizeof(adapter->temp_dcb_cfg));
4527 4528

#endif
4529 4530

	/* default flow control settings */
4531
	hw->fc.requested_mode = ixgbe_fc_full;
D
Don Skidmore 已提交
4532
	hw->fc.current_mode = ixgbe_fc_full;	/* init for ethtool output */
4533
	ixgbe_pbthresh_setup(adapter);
4534 4535
	hw->fc.pause_time = IXGBE_DEFAULT_FCPAUSE;
	hw->fc.send_xon = true;
D
Don Skidmore 已提交
4536
	hw->fc.disable_fc_autoneg = false;
4537

4538 4539 4540 4541 4542 4543
#ifdef CONFIG_PCI_IOV
	/* assign number of SR-IOV VFs */
	if (hw->mac.type != ixgbe_mac_82598EB)
		adapter->num_vfs = (max_vfs > 63) ? 0 : max_vfs;

#endif
4544
	/* enable itr by default in dynamic mode */
4545 4546
	adapter->rx_itr_setting = 1;
	adapter->tx_itr_setting = 1;
4547 4548 4549 4550 4551

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

4552
	/* set default work limits */
4553
	adapter->tx_work_limit = IXGBE_DEFAULT_TX_WORK;
4554

4555
	/* initialize eeprom parameters */
4556
	if (ixgbe_init_eeprom_params_generic(hw)) {
4557
		e_dev_err("EEPROM initialization failed\n");
4558 4559 4560 4561 4562 4563 4564 4565 4566 4567
		return -EIO;
	}

	set_bit(__IXGBE_DOWN, &adapter->state);

	return 0;
}

/**
 * ixgbe_setup_tx_resources - allocate Tx resources (Descriptors)
4568
 * @tx_ring:    tx descriptor ring (for a specific queue) to setup
4569 4570 4571
 *
 * Return 0 on success, negative on failure
 **/
4572
int ixgbe_setup_tx_resources(struct ixgbe_ring *tx_ring)
4573
{
4574
	struct device *dev = tx_ring->dev;
4575 4576
	int orig_node = dev_to_node(dev);
	int numa_node = -1;
4577 4578
	int size;

4579
	size = sizeof(struct ixgbe_tx_buffer) * tx_ring->count;
4580 4581 4582 4583 4584

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

	tx_ring->tx_buffer_info = vzalloc_node(size, numa_node);
4585
	if (!tx_ring->tx_buffer_info)
E
Eric Dumazet 已提交
4586
		tx_ring->tx_buffer_info = vzalloc(size);
4587 4588
	if (!tx_ring->tx_buffer_info)
		goto err;
4589 4590

	/* round up to nearest 4K */
4591
	tx_ring->size = tx_ring->count * sizeof(union ixgbe_adv_tx_desc);
4592
	tx_ring->size = ALIGN(tx_ring->size, 4096);
4593

4594 4595 4596 4597 4598 4599 4600 4601 4602
	set_dev_node(dev, numa_node);
	tx_ring->desc = dma_alloc_coherent(dev,
					   tx_ring->size,
					   &tx_ring->dma,
					   GFP_KERNEL);
	set_dev_node(dev, orig_node);
	if (!tx_ring->desc)
		tx_ring->desc = dma_alloc_coherent(dev, tx_ring->size,
						   &tx_ring->dma, GFP_KERNEL);
4603 4604
	if (!tx_ring->desc)
		goto err;
4605

4606 4607
	tx_ring->next_to_use = 0;
	tx_ring->next_to_clean = 0;
4608
	return 0;
4609 4610 4611 4612

err:
	vfree(tx_ring->tx_buffer_info);
	tx_ring->tx_buffer_info = NULL;
4613
	dev_err(dev, "Unable to allocate memory for the Tx descriptor ring\n");
4614
	return -ENOMEM;
4615 4616
}

4617 4618 4619 4620 4621 4622 4623 4624 4625 4626 4627 4628 4629 4630 4631
/**
 * ixgbe_setup_all_tx_resources - allocate all queues Tx resources
 * @adapter: board private structure
 *
 * If this function returns with an error, then it's possible one or
 * more of the rings is populated (while the rest are not).  It is the
 * callers duty to clean those orphaned rings.
 *
 * Return 0 on success, negative on failure
 **/
static int ixgbe_setup_all_tx_resources(struct ixgbe_adapter *adapter)
{
	int i, err = 0;

	for (i = 0; i < adapter->num_tx_queues; i++) {
4632
		err = ixgbe_setup_tx_resources(adapter->tx_ring[i]);
4633 4634
		if (!err)
			continue;
4635

4636
		e_err(probe, "Allocation for Tx Queue %u failed\n", i);
4637
		goto err_setup_tx;
4638 4639
	}

4640 4641 4642 4643 4644
	return 0;
err_setup_tx:
	/* rewind the index freeing the rings as we go */
	while (i--)
		ixgbe_free_tx_resources(adapter->tx_ring[i]);
4645 4646 4647
	return err;
}

4648 4649
/**
 * ixgbe_setup_rx_resources - allocate Rx resources (Descriptors)
4650
 * @rx_ring:    rx descriptor ring (for a specific queue) to setup
4651 4652 4653
 *
 * Returns 0 on success, negative on failure
 **/
4654
int ixgbe_setup_rx_resources(struct ixgbe_ring *rx_ring)
4655
{
4656
	struct device *dev = rx_ring->dev;
4657 4658
	int orig_node = dev_to_node(dev);
	int numa_node = -1;
4659
	int size;
4660

4661
	size = sizeof(struct ixgbe_rx_buffer) * rx_ring->count;
4662 4663 4664 4665 4666

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

	rx_ring->rx_buffer_info = vzalloc_node(size, numa_node);
4667
	if (!rx_ring->rx_buffer_info)
E
Eric Dumazet 已提交
4668
		rx_ring->rx_buffer_info = vzalloc(size);
4669 4670
	if (!rx_ring->rx_buffer_info)
		goto err;
4671 4672

	/* Round up to nearest 4K */
4673 4674
	rx_ring->size = rx_ring->count * sizeof(union ixgbe_adv_rx_desc);
	rx_ring->size = ALIGN(rx_ring->size, 4096);
4675

4676 4677 4678 4679 4680 4681 4682 4683 4684
	set_dev_node(dev, numa_node);
	rx_ring->desc = dma_alloc_coherent(dev,
					   rx_ring->size,
					   &rx_ring->dma,
					   GFP_KERNEL);
	set_dev_node(dev, orig_node);
	if (!rx_ring->desc)
		rx_ring->desc = dma_alloc_coherent(dev, rx_ring->size,
						   &rx_ring->dma, GFP_KERNEL);
4685 4686
	if (!rx_ring->desc)
		goto err;
4687

4688 4689
	rx_ring->next_to_clean = 0;
	rx_ring->next_to_use = 0;
4690 4691

	return 0;
4692 4693 4694 4695
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");
4696
	return -ENOMEM;
4697 4698
}

4699 4700 4701 4702 4703 4704 4705 4706 4707 4708 4709 4710 4711 4712 4713
/**
 * 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++) {
4714
		err = ixgbe_setup_rx_resources(adapter->rx_ring[i]);
4715 4716
		if (!err)
			continue;
4717

4718
		e_err(probe, "Allocation for Rx Queue %u failed\n", i);
4719
		goto err_setup_rx;
4720 4721
	}

4722 4723 4724 4725 4726
#ifdef IXGBE_FCOE
	err = ixgbe_setup_fcoe_ddp_resources(adapter);
	if (!err)
#endif
		return 0;
4727 4728 4729 4730
err_setup_rx:
	/* rewind the index freeing the rings as we go */
	while (i--)
		ixgbe_free_rx_resources(adapter->rx_ring[i]);
4731 4732 4733
	return err;
}

4734 4735 4736 4737 4738 4739
/**
 * ixgbe_free_tx_resources - Free Tx Resources per Queue
 * @tx_ring: Tx descriptor ring for a specific queue
 *
 * Free all transmit software resources
 **/
4740
void ixgbe_free_tx_resources(struct ixgbe_ring *tx_ring)
4741
{
4742
	ixgbe_clean_tx_ring(tx_ring);
4743 4744 4745 4746

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

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

	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++)
4768
		if (adapter->tx_ring[i]->desc)
4769
			ixgbe_free_tx_resources(adapter->tx_ring[i]);
4770 4771 4772
}

/**
4773
 * ixgbe_free_rx_resources - Free Rx Resources
4774 4775 4776 4777
 * @rx_ring: ring to clean the resources from
 *
 * Free all receive software resources
 **/
4778
void ixgbe_free_rx_resources(struct ixgbe_ring *rx_ring)
4779
{
4780
	ixgbe_clean_rx_ring(rx_ring);
4781 4782 4783 4784

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

4785 4786 4787 4788 4789 4790
	/* 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);
4791 4792 4793 4794 4795 4796 4797 4798 4799 4800 4801 4802 4803 4804

	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;

4805 4806 4807 4808
#ifdef IXGBE_FCOE
	ixgbe_free_fcoe_ddp_resources(adapter);

#endif
4809
	for (i = 0; i < adapter->num_rx_queues; i++)
4810
		if (adapter->rx_ring[i]->desc)
4811
			ixgbe_free_rx_resources(adapter->rx_ring[i]);
4812 4813 4814 4815 4816 4817 4818 4819 4820 4821 4822 4823 4824 4825
}

/**
 * ixgbe_change_mtu - Change the Maximum Transfer Unit
 * @netdev: network interface device structure
 * @new_mtu: new value for maximum frame size
 *
 * Returns 0 on success, negative on failure
 **/
static int ixgbe_change_mtu(struct net_device *netdev, int new_mtu)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN;

4826
	/* MTU < 68 is an error and causes problems on some kernels */
4827 4828 4829 4830 4831 4832 4833 4834 4835 4836 4837
	if ((new_mtu < 68) || (max_frame > IXGBE_MAX_JUMBO_FRAME_SIZE))
		return -EINVAL;

	/*
	 * For 82599EB we cannot allow PF to change MTU greater than 1500
	 * in SR-IOV mode as it may cause buffer overruns in guest VFs that
	 * don't allocate and chain buffers correctly.
	 */
	if ((adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) &&
	    (adapter->hw.mac.type == ixgbe_mac_82599EB) &&
	    (max_frame > MAXIMUM_ETHERNET_VLAN_SIZE))
4838
			return -EINVAL;
4839

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

4842
	/* must set new MTU before calling down or up */
4843 4844
	netdev->mtu = new_mtu;

4845 4846
	if (netif_running(netdev))
		ixgbe_reinit_locked(adapter);
4847 4848 4849 4850 4851 4852 4853 4854 4855 4856 4857 4858 4859 4860 4861 4862 4863 4864 4865 4866

	return 0;
}

/**
 * ixgbe_open - Called when a network interface is made active
 * @netdev: network interface device structure
 *
 * Returns 0 on success, negative value on failure
 *
 * The open entry point is called when a network interface is made
 * active by the system (IFF_UP).  At this point all resources needed
 * for transmit and receive operations are allocated, the interrupt
 * handler is registered with the OS, the watchdog timer is started,
 * and the stack is notified that the interface is ready.
 **/
static int ixgbe_open(struct net_device *netdev)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	int err;
4867 4868 4869 4870

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

4872 4873
	netif_carrier_off(netdev);

4874 4875 4876 4877 4878 4879 4880 4881 4882 4883 4884 4885
	/* 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);

4886
	err = ixgbe_request_irq(adapter);
4887 4888 4889
	if (err)
		goto err_req_irq;

4890 4891 4892 4893 4894 4895 4896 4897 4898 4899 4900 4901 4902 4903
	/* Notify the stack of the actual queue counts. */
	err = netif_set_real_num_tx_queues(netdev,
					   adapter->num_rx_pools > 1 ? 1 :
					   adapter->num_tx_queues);
	if (err)
		goto err_set_queues;


	err = netif_set_real_num_rx_queues(netdev,
					   adapter->num_rx_pools > 1 ? 1 :
					   adapter->num_rx_queues);
	if (err)
		goto err_set_queues;

4904
	ixgbe_up_complete(adapter);
4905 4906 4907

	return 0;

4908 4909
err_set_queues:
	ixgbe_free_irq(adapter);
4910
err_req_irq:
4911
	ixgbe_free_all_rx_resources(adapter);
4912
err_setup_rx:
4913
	ixgbe_free_all_tx_resources(adapter);
4914
err_setup_tx:
4915 4916 4917 4918 4919 4920 4921 4922 4923 4924 4925 4926 4927 4928 4929 4930 4931 4932 4933 4934 4935 4936 4937
	ixgbe_reset(adapter);

	return err;
}

/**
 * ixgbe_close - Disables a network interface
 * @netdev: network interface device structure
 *
 * Returns 0, this is not allowed to fail
 *
 * The close entry point is called when an interface is de-activated
 * by the OS.  The hardware is still under the drivers control, but
 * needs to be disabled.  A global MAC reset is issued to stop the
 * hardware, and all transmit and receive resources are freed.
 **/
static int ixgbe_close(struct net_device *netdev)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

	ixgbe_down(adapter);
	ixgbe_free_irq(adapter);

4938 4939
	ixgbe_fdir_filter_exit(adapter);

4940 4941 4942
	ixgbe_free_all_tx_resources(adapter);
	ixgbe_free_all_rx_resources(adapter);

4943
	ixgbe_release_hw_control(adapter);
4944 4945 4946 4947

	return 0;
}

4948 4949 4950
#ifdef CONFIG_PM
static int ixgbe_resume(struct pci_dev *pdev)
{
4951 4952
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
4953 4954 4955 4956
	u32 err;

	pci_set_power_state(pdev, PCI_D0);
	pci_restore_state(pdev);
4957 4958 4959 4960 4961
	/*
	 * pci_restore_state clears dev->state_saved so call
	 * pci_save_state to restore it.
	 */
	pci_save_state(pdev);
4962 4963

	err = pci_enable_device_mem(pdev);
4964
	if (err) {
4965
		e_dev_err("Cannot enable PCI device from suspend\n");
4966 4967 4968 4969
		return err;
	}
	pci_set_master(pdev);

4970
	pci_wake_from_d3(pdev, false);
4971 4972 4973

	ixgbe_reset(adapter);

4974 4975
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);

4976 4977 4978
	rtnl_lock();
	err = ixgbe_init_interrupt_scheme(adapter);
	if (!err && netif_running(netdev))
4979
		err = ixgbe_open(netdev);
4980 4981 4982 4983 4984

	rtnl_unlock();

	if (err)
		return err;
4985 4986 4987 4988 4989 4990

	netif_device_attach(netdev);

	return 0;
}
#endif /* CONFIG_PM */
4991 4992

static int __ixgbe_shutdown(struct pci_dev *pdev, bool *enable_wake)
4993
{
4994 4995
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
4996 4997 4998
	struct ixgbe_hw *hw = &adapter->hw;
	u32 ctrl, fctrl;
	u32 wufc = adapter->wol;
4999 5000 5001 5002 5003 5004 5005
#ifdef CONFIG_PM
	int retval = 0;
#endif

	netif_device_detach(netdev);

	if (netif_running(netdev)) {
5006
		rtnl_lock();
5007 5008 5009 5010
		ixgbe_down(adapter);
		ixgbe_free_irq(adapter);
		ixgbe_free_all_tx_resources(adapter);
		ixgbe_free_all_rx_resources(adapter);
5011
		rtnl_unlock();
5012 5013
	}

5014 5015
	ixgbe_clear_interrupt_scheme(adapter);

5016 5017 5018 5019
#ifdef CONFIG_PM
	retval = pci_save_state(pdev);
	if (retval)
		return retval;
5020

5021
#endif
5022 5023
	if (wufc) {
		ixgbe_set_rx_mode(netdev);
5024

D
Don Skidmore 已提交
5025 5026 5027 5028 5029 5030 5031 5032 5033 5034
		/*
		 * enable the optics for both mult-speed fiber and
		 * 82599 SFP+ fiber as we can WoL.
		 */
		if (hw->mac.ops.enable_tx_laser &&
		    (hw->phy.multispeed_fiber ||
		    (hw->mac.ops.get_media_type(hw) == ixgbe_media_type_fiber &&
		     hw->mac.type == ixgbe_mac_82599EB)))
			hw->mac.ops.enable_tx_laser(hw);

5035 5036 5037 5038 5039 5040 5041 5042 5043 5044 5045 5046 5047 5048 5049 5050 5051
		/* turn on all-multi mode if wake on multicast is enabled */
		if (wufc & IXGBE_WUFC_MC) {
			fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
			fctrl |= IXGBE_FCTRL_MPE;
			IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
		}

		ctrl = IXGBE_READ_REG(hw, IXGBE_CTRL);
		ctrl |= IXGBE_CTRL_GIO_DIS;
		IXGBE_WRITE_REG(hw, IXGBE_CTRL, ctrl);

		IXGBE_WRITE_REG(hw, IXGBE_WUFC, wufc);
	} else {
		IXGBE_WRITE_REG(hw, IXGBE_WUC, 0);
		IXGBE_WRITE_REG(hw, IXGBE_WUFC, 0);
	}

5052 5053
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
5054
		pci_wake_from_d3(pdev, false);
5055 5056
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
5057
	case ixgbe_mac_X540:
5058 5059 5060 5061 5062
		pci_wake_from_d3(pdev, !!wufc);
		break;
	default:
		break;
	}
5063

5064 5065
	*enable_wake = !!wufc;

5066 5067 5068 5069
	ixgbe_release_hw_control(adapter);

	pci_disable_device(pdev);

5070 5071 5072 5073 5074 5075 5076 5077 5078 5079 5080 5081 5082 5083 5084 5085 5086 5087 5088
	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);
	}
5089 5090 5091

	return 0;
}
5092
#endif /* CONFIG_PM */
5093 5094 5095

static void ixgbe_shutdown(struct pci_dev *pdev)
{
5096 5097 5098 5099 5100 5101 5102 5103
	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);
	}
5104 5105
}

5106 5107 5108 5109 5110 5111
/**
 * ixgbe_update_stats - Update the board statistics counters.
 * @adapter: board private structure
 **/
void ixgbe_update_stats(struct ixgbe_adapter *adapter)
{
5112
	struct net_device *netdev = adapter->netdev;
5113
	struct ixgbe_hw *hw = &adapter->hw;
5114
	struct ixgbe_hw_stats *hwstats = &adapter->stats;
5115 5116
	u64 total_mpc = 0;
	u32 i, missed_rx = 0, mpc, bprc, lxon, lxoff, xon_off_tot;
5117 5118
	u64 non_eop_descs = 0, restart_queue = 0, tx_busy = 0;
	u64 alloc_rx_page_failed = 0, alloc_rx_buff_failed = 0;
5119
	u64 bytes = 0, packets = 0, hw_csum_rx_error = 0;
5120

5121 5122 5123 5124
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;

5125
	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED) {
A
Alexander Duyck 已提交
5126
		u64 rsc_count = 0;
5127 5128
		u64 rsc_flush = 0;
		for (i = 0; i < adapter->num_rx_queues; i++) {
5129 5130
			rsc_count += adapter->rx_ring[i]->rx_stats.rsc_count;
			rsc_flush += adapter->rx_ring[i]->rx_stats.rsc_flush;
5131 5132 5133
		}
		adapter->rsc_total_count = rsc_count;
		adapter->rsc_total_flush = rsc_flush;
5134 5135
	}

5136 5137 5138 5139 5140
	for (i = 0; i < adapter->num_rx_queues; i++) {
		struct ixgbe_ring *rx_ring = adapter->rx_ring[i];
		non_eop_descs += rx_ring->rx_stats.non_eop_descs;
		alloc_rx_page_failed += rx_ring->rx_stats.alloc_rx_page_failed;
		alloc_rx_buff_failed += rx_ring->rx_stats.alloc_rx_buff_failed;
5141
		hw_csum_rx_error += rx_ring->rx_stats.csum_err;
5142 5143 5144 5145 5146 5147
		bytes += rx_ring->stats.bytes;
		packets += rx_ring->stats.packets;
	}
	adapter->non_eop_descs = non_eop_descs;
	adapter->alloc_rx_page_failed = alloc_rx_page_failed;
	adapter->alloc_rx_buff_failed = alloc_rx_buff_failed;
5148
	adapter->hw_csum_rx_error = hw_csum_rx_error;
5149 5150 5151 5152 5153
	netdev->stats.rx_bytes = bytes;
	netdev->stats.rx_packets = packets;

	bytes = 0;
	packets = 0;
J
Jesse Brandeburg 已提交
5154
	/* gather some stats to the adapter struct that are per queue */
5155 5156 5157 5158 5159 5160 5161
	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;
	}
5162
	adapter->restart_queue = restart_queue;
5163 5164 5165
	adapter->tx_busy = tx_busy;
	netdev->stats.tx_bytes = bytes;
	netdev->stats.tx_packets = packets;
J
Jesse Brandeburg 已提交
5166

5167
	hwstats->crcerrs += IXGBE_READ_REG(hw, IXGBE_CRCERRS);
5168 5169

	/* 8 register reads */
5170 5171 5172 5173
	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;
5174 5175
		hwstats->mpc[i] += mpc;
		total_mpc += hwstats->mpc[i];
5176 5177
		hwstats->pxontxc[i] += IXGBE_READ_REG(hw, IXGBE_PXONTXC(i));
		hwstats->pxofftxc[i] += IXGBE_READ_REG(hw, IXGBE_PXOFFTXC(i));
5178 5179
		switch (hw->mac.type) {
		case ixgbe_mac_82598EB:
5180 5181 5182
			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));
5183 5184
			hwstats->pxonrxc[i] +=
				IXGBE_READ_REG(hw, IXGBE_PXONRXC(i));
5185 5186
			break;
		case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
5187
		case ixgbe_mac_X540:
5188 5189 5190 5191 5192
			hwstats->pxonrxc[i] +=
				IXGBE_READ_REG(hw, IXGBE_PXONRXCNT(i));
			break;
		default:
			break;
5193
		}
5194
	}
5195 5196 5197 5198 5199 5200 5201 5202 5203 5204 5205 5206 5207 5208

	/*16 register reads */
	for (i = 0; i < 16; i++) {
		hwstats->qptc[i] += IXGBE_READ_REG(hw, IXGBE_QPTC(i));
		hwstats->qprc[i] += IXGBE_READ_REG(hw, IXGBE_QPRC(i));
		if ((hw->mac.type == ixgbe_mac_82599EB) ||
		    (hw->mac.type == ixgbe_mac_X540)) {
			hwstats->qbtc[i] += IXGBE_READ_REG(hw, IXGBE_QBTC_L(i));
			IXGBE_READ_REG(hw, IXGBE_QBTC_H(i)); /* to clear */
			hwstats->qbrc[i] += IXGBE_READ_REG(hw, IXGBE_QBRC_L(i));
			IXGBE_READ_REG(hw, IXGBE_QBRC_H(i)); /* to clear */
		}
	}

5209
	hwstats->gprc += IXGBE_READ_REG(hw, IXGBE_GPRC);
5210
	/* work around hardware counting issue */
5211
	hwstats->gprc -= missed_rx;
5212

5213 5214
	ixgbe_update_xoff_received(adapter);

5215
	/* 82598 hardware only has a 32 bit counter in the high register */
5216 5217 5218 5219 5220 5221 5222
	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 已提交
5223
	case ixgbe_mac_X540:
5224 5225 5226 5227 5228 5229
		/* OS2BMC stats are X540 only*/
		hwstats->o2bgptc += IXGBE_READ_REG(hw, IXGBE_O2BGPTC);
		hwstats->o2bspc += IXGBE_READ_REG(hw, IXGBE_O2BSPC);
		hwstats->b2ospc += IXGBE_READ_REG(hw, IXGBE_B2OSPC);
		hwstats->b2ogprc += IXGBE_READ_REG(hw, IXGBE_B2OGPRC);
	case ixgbe_mac_82599EB:
5230 5231 5232
		for (i = 0; i < 16; i++)
			adapter->hw_rx_no_dma_resources +=
					     IXGBE_READ_REG(hw, IXGBE_QPRDC(i));
5233
		hwstats->gorc += IXGBE_READ_REG(hw, IXGBE_GORCL);
5234
		IXGBE_READ_REG(hw, IXGBE_GORCH); /* to clear */
5235
		hwstats->gotc += IXGBE_READ_REG(hw, IXGBE_GOTCL);
5236
		IXGBE_READ_REG(hw, IXGBE_GOTCH); /* to clear */
5237
		hwstats->tor += IXGBE_READ_REG(hw, IXGBE_TORL);
5238
		IXGBE_READ_REG(hw, IXGBE_TORH); /* to clear */
5239 5240 5241
		hwstats->lxonrxc += IXGBE_READ_REG(hw, IXGBE_LXONRXCNT);
		hwstats->fdirmatch += IXGBE_READ_REG(hw, IXGBE_FDIRMATCH);
		hwstats->fdirmiss += IXGBE_READ_REG(hw, IXGBE_FDIRMISS);
5242
#ifdef IXGBE_FCOE
5243 5244 5245 5246 5247 5248
		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);
5249
		/* Add up per cpu counters for total ddp aloc fail */
5250 5251 5252 5253 5254
		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;
5255
			for_each_possible_cpu(cpu) {
5256 5257 5258
				ddp_pool = per_cpu_ptr(fcoe->ddp_pool, cpu);
				noddp += ddp_pool->noddp;
				noddp_ext_buff += ddp_pool->noddp_ext_buff;
5259
			}
5260 5261
			hwstats->fcoe_noddp = noddp;
			hwstats->fcoe_noddp_ext_buff = noddp_ext_buff;
5262
		}
5263
#endif /* IXGBE_FCOE */
5264 5265 5266
		break;
	default:
		break;
5267
	}
5268
	bprc = IXGBE_READ_REG(hw, IXGBE_BPRC);
5269 5270
	hwstats->bprc += bprc;
	hwstats->mprc += IXGBE_READ_REG(hw, IXGBE_MPRC);
5271
	if (hw->mac.type == ixgbe_mac_82598EB)
5272 5273 5274 5275 5276 5277 5278 5279 5280
		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);
5281
	lxon = IXGBE_READ_REG(hw, IXGBE_LXONTXC);
5282
	hwstats->lxontxc += lxon;
5283
	lxoff = IXGBE_READ_REG(hw, IXGBE_LXOFFTXC);
5284 5285 5286
	hwstats->lxofftxc += lxoff;
	hwstats->gptc += IXGBE_READ_REG(hw, IXGBE_GPTC);
	hwstats->mptc += IXGBE_READ_REG(hw, IXGBE_MPTC);
5287 5288 5289 5290
	/*
	 * 82598 errata - tx of flow control packets is included in tx counters
	 */
	xon_off_tot = lxon + lxoff;
5291 5292 5293 5294 5295 5296 5297 5298 5299 5300 5301 5302 5303 5304 5305
	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);
5306 5307

	/* Fill out the OS statistics structure */
5308
	netdev->stats.multicast = hwstats->mprc;
5309 5310

	/* Rx Errors */
5311
	netdev->stats.rx_errors = hwstats->crcerrs + hwstats->rlec;
5312
	netdev->stats.rx_dropped = 0;
5313 5314
	netdev->stats.rx_length_errors = hwstats->rlec;
	netdev->stats.rx_crc_errors = hwstats->crcerrs;
5315
	netdev->stats.rx_missed_errors = total_mpc;
5316 5317 5318
}

/**
5319
 * ixgbe_fdir_reinit_subtask - worker thread to reinit FDIR filter table
5320
 * @adapter: pointer to the device adapter structure
5321
 **/
5322
static void ixgbe_fdir_reinit_subtask(struct ixgbe_adapter *adapter)
5323
{
5324
	struct ixgbe_hw *hw = &adapter->hw;
5325
	int i;
5326

5327 5328 5329 5330
	if (!(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_FDIR_REQUIRES_REINIT;
5331

5332
	/* if interface is down do nothing */
5333
	if (test_bit(__IXGBE_DOWN, &adapter->state))
5334 5335 5336 5337 5338 5339 5340 5341
		return;

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

	adapter->fdir_overflow++;

5342 5343 5344
	if (ixgbe_reinit_fdir_tables_82599(hw) == 0) {
		for (i = 0; i < adapter->num_tx_queues; i++)
			set_bit(__IXGBE_TX_FDIR_INIT_DONE,
5345
			        &(adapter->tx_ring[i]->state));
5346 5347
		/* re-enable flow director interrupts */
		IXGBE_WRITE_REG(hw, IXGBE_EIMS, IXGBE_EIMS_FLOW_DIR);
5348 5349 5350 5351 5352 5353 5354 5355
	} 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
5356
 * @adapter: pointer to the device adapter structure
5357 5358
 *
 * This function serves two purposes.  First it strobes the interrupt lines
S
Stephen Hemminger 已提交
5359
 * in order to make certain interrupts are occurring.  Secondly it sets the
5360
 * bits needed to check for TX hangs.  As a result we should immediately
S
Stephen Hemminger 已提交
5361
 * determine if a hang has occurred.
5362 5363
 */
static void ixgbe_check_hang_subtask(struct ixgbe_adapter *adapter)
5364
{
5365
	struct ixgbe_hw *hw = &adapter->hw;
5366 5367
	u64 eics = 0;
	int i;
5368

5369 5370 5371 5372
	/* If we're down or resetting, just bail */
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;
5373

5374 5375 5376 5377 5378
	/* 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]);
	}
5379

5380 5381 5382 5383 5384 5385 5386 5387
	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));
5388 5389
	} else {
		/* get one bit for every active tx/rx interrupt vector */
5390
		for (i = 0; i < adapter->num_q_vectors; i++) {
5391
			struct ixgbe_q_vector *qv = adapter->q_vector[i];
5392
			if (qv->rx.ring || qv->tx.ring)
5393 5394
				eics |= ((u64)1 << i);
		}
5395
	}
5396

5397
	/* Cause software interrupt to ensure rings are cleaned */
5398 5399
	ixgbe_irq_rearm_queues(adapter, eics);

5400 5401
}

5402
/**
5403
 * ixgbe_watchdog_update_link - update the link status
5404 5405
 * @adapter: pointer to the device adapter structure
 * @link_speed: pointer to a u32 to store the link_speed
5406
 **/
5407
static void ixgbe_watchdog_update_link(struct ixgbe_adapter *adapter)
5408 5409
{
	struct ixgbe_hw *hw = &adapter->hw;
5410 5411
	u32 link_speed = adapter->link_speed;
	bool link_up = adapter->link_up;
5412
	bool pfc_en = adapter->dcb_cfg.pfc_mode_enable;
5413

5414 5415 5416 5417 5418
	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);
5419
	} else {
5420 5421 5422
		/* always assume link is up, if no check link function */
		link_speed = IXGBE_LINK_SPEED_10GB_FULL;
		link_up = true;
5423
	}
5424 5425 5426 5427

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

5428
	if (link_up && !((adapter->flags & IXGBE_FLAG_DCB_ENABLED) && pfc_en)) {
5429
		hw->mac.ops.fc_enable(hw);
5430 5431
		ixgbe_set_rx_drop_en(adapter);
	}
5432 5433 5434 5435 5436 5437 5438 5439 5440 5441 5442

	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;
5443 5444 5445
}

/**
5446 5447
 * ixgbe_watchdog_link_is_up - update netif_carrier status and
 *                             print link up message
5448
 * @adapter: pointer to the device adapter structure
5449
 **/
5450
static void ixgbe_watchdog_link_is_up(struct ixgbe_adapter *adapter)
5451
{
5452
	struct net_device *netdev = adapter->netdev;
5453
	struct ixgbe_hw *hw = &adapter->hw;
5454 5455
	u32 link_speed = adapter->link_speed;
	bool flow_rx, flow_tx;
5456

5457 5458
	/* only continue if link was previously down */
	if (netif_carrier_ok(netdev))
5459
		return;
5460

5461
	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
5462

5463 5464 5465 5466 5467 5468 5469 5470 5471 5472 5473 5474 5475 5476 5477 5478 5479 5480 5481 5482
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB: {
		u32 frctl = IXGBE_READ_REG(hw, IXGBE_FCTRL);
		u32 rmcs = IXGBE_READ_REG(hw, IXGBE_RMCS);
		flow_rx = !!(frctl & IXGBE_FCTRL_RFCE);
		flow_tx = !!(rmcs & IXGBE_RMCS_TFCE_802_3X);
	}
		break;
	case ixgbe_mac_X540:
	case ixgbe_mac_82599EB: {
		u32 mflcn = IXGBE_READ_REG(hw, IXGBE_MFLCN);
		u32 fccfg = IXGBE_READ_REG(hw, IXGBE_FCCFG);
		flow_rx = !!(mflcn & IXGBE_MFLCN_RFCE);
		flow_tx = !!(fccfg & IXGBE_FCCFG_TFCE_802_3X);
	}
		break;
	default:
		flow_tx = false;
		flow_rx = false;
		break;
5483
	}
5484 5485 5486 5487 5488

#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_start_cyclecounter(adapter);
#endif

5489 5490 5491 5492 5493 5494 5495 5496 5497 5498 5499
	e_info(drv, "NIC Link is Up %s, Flow Control: %s\n",
	       (link_speed == IXGBE_LINK_SPEED_10GB_FULL ?
	       "10 Gbps" :
	       (link_speed == IXGBE_LINK_SPEED_1GB_FULL ?
	       "1 Gbps" :
	       (link_speed == IXGBE_LINK_SPEED_100_FULL ?
	       "100 Mbps" :
	       "unknown speed"))),
	       ((flow_rx && flow_tx) ? "RX/TX" :
	       (flow_rx ? "RX" :
	       (flow_tx ? "TX" : "None"))));
5500

5501 5502
	netif_carrier_on(netdev);
	ixgbe_check_vf_rate_limit(adapter);
5503 5504 5505

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

5508
/**
5509 5510
 * ixgbe_watchdog_link_is_down - update netif_carrier status and
 *                               print link down message
5511
 * @adapter: pointer to the adapter structure
5512
 **/
A
Alexander Duyck 已提交
5513
static void ixgbe_watchdog_link_is_down(struct ixgbe_adapter *adapter)
5514
{
5515
	struct net_device *netdev = adapter->netdev;
5516
	struct ixgbe_hw *hw = &adapter->hw;
5517

5518 5519
	adapter->link_up = false;
	adapter->link_speed = 0;
5520

5521 5522 5523
	/* only continue if link was up previously */
	if (!netif_carrier_ok(netdev))
		return;
5524

5525 5526 5527
	/* 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;
5528

5529 5530 5531 5532
#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_start_cyclecounter(adapter);
#endif

5533 5534
	e_info(drv, "NIC Link is Down\n");
	netif_carrier_off(netdev);
5535 5536 5537

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

5540 5541
/**
 * ixgbe_watchdog_flush_tx - flush queues on link down
5542
 * @adapter: pointer to the device adapter structure
5543 5544 5545
 **/
static void ixgbe_watchdog_flush_tx(struct ixgbe_adapter *adapter)
{
5546
	int i;
5547
	int some_tx_pending = 0;
5548

5549
	if (!netif_carrier_ok(adapter->netdev)) {
5550
		for (i = 0; i < adapter->num_tx_queues; i++) {
5551
			struct ixgbe_ring *tx_ring = adapter->tx_ring[i];
5552 5553 5554 5555 5556 5557 5558 5559 5560 5561 5562 5563
			if (tx_ring->next_to_use != tx_ring->next_to_clean) {
				some_tx_pending = 1;
				break;
			}
		}

		if (some_tx_pending) {
			/* We've lost link, so the controller stops DMA,
			 * but we've got queued Tx work that's never going
			 * to get done, so reset controller to flush Tx.
			 * (Do the reset outside of interrupt context).
			 */
5564
			adapter->flags2 |= IXGBE_FLAG2_RESET_REQUESTED;
5565
		}
5566 5567 5568
	}
}

5569 5570 5571 5572
static void ixgbe_spoof_check(struct ixgbe_adapter *adapter)
{
	u32 ssvpc;

5573 5574 5575
	/* 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)
5576 5577 5578 5579 5580 5581 5582 5583 5584 5585 5586
		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;

5587
	e_warn(drv, "%u Spoofed packets detected\n", ssvpc);
5588 5589
}

5590 5591
/**
 * ixgbe_watchdog_subtask - check and bring link up
5592
 * @adapter: pointer to the device adapter structure
5593 5594 5595 5596
 **/
static void ixgbe_watchdog_subtask(struct ixgbe_adapter *adapter)
{
	/* if interface is down do nothing */
5597 5598
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
	    test_bit(__IXGBE_RESETTING, &adapter->state))
5599 5600 5601 5602 5603 5604 5605 5606
		return;

	ixgbe_watchdog_update_link(adapter);

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

5608
	ixgbe_spoof_check(adapter);
5609
	ixgbe_update_stats(adapter);
5610 5611

	ixgbe_watchdog_flush_tx(adapter);
5612
}
5613

5614
/**
5615
 * ixgbe_sfp_detection_subtask - poll for SFP+ cable
5616
 * @adapter: the ixgbe adapter structure
5617
 **/
5618
static void ixgbe_sfp_detection_subtask(struct ixgbe_adapter *adapter)
5619 5620
{
	struct ixgbe_hw *hw = &adapter->hw;
5621
	s32 err;
5622

5623 5624 5625 5626
	/* 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;
5627

5628 5629 5630
	/* someone else is in init, wait until next service event */
	if (test_and_set_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
		return;
5631

5632 5633 5634
	err = hw->phy.ops.identify_sfp(hw);
	if (err == IXGBE_ERR_SFP_NOT_SUPPORTED)
		goto sfp_out;
5635

5636 5637 5638 5639
	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;
5640
	}
5641

5642 5643 5644
	/* exit on error */
	if (err)
		goto sfp_out;
5645

5646 5647 5648
	/* exit if reset not needed */
	if (!(adapter->flags2 & IXGBE_FLAG2_SFP_NEEDS_RESET))
		goto sfp_out;
5649

5650
	adapter->flags2 &= ~IXGBE_FLAG2_SFP_NEEDS_RESET;
5651

5652 5653 5654 5655 5656 5657 5658 5659 5660 5661 5662 5663 5664 5665 5666 5667 5668 5669 5670 5671 5672 5673 5674 5675 5676 5677
	/*
	 * 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);
5678
	}
5679
}
5680

5681 5682
/**
 * ixgbe_sfp_link_config_subtask - set up link SFP after module install
5683
 * @adapter: the ixgbe adapter structure
5684 5685 5686 5687 5688 5689 5690 5691 5692 5693 5694 5695 5696 5697 5698 5699 5700 5701 5702 5703 5704 5705 5706 5707 5708 5709 5710
 **/
static void ixgbe_sfp_link_config_subtask(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 autoneg;
	bool negotiation;

	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;

	autoneg = hw->phy.autoneg_advertised;
	if ((!autoneg) && (hw->mac.ops.get_link_capabilities))
		hw->mac.ops.get_link_capabilities(hw, &autoneg, &negotiation);
	if (hw->mac.ops.setup_link)
		hw->mac.ops.setup_link(hw, autoneg, negotiation, true);

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

5711 5712 5713 5714 5715 5716 5717 5718 5719 5720 5721 5722 5723 5724 5725 5726 5727 5728 5729 5730 5731 5732 5733 5734 5735 5736 5737 5738 5739 5740 5741 5742 5743 5744 5745 5746 5747 5748 5749 5750 5751 5752 5753 5754 5755
#ifdef CONFIG_PCI_IOV
static void ixgbe_check_for_bad_vf(struct ixgbe_adapter *adapter)
{
	int vf;
	struct ixgbe_hw *hw = &adapter->hw;
	struct net_device *netdev = adapter->netdev;
	u32 gpc;
	u32 ciaa, ciad;

	gpc = IXGBE_READ_REG(hw, IXGBE_TXDGPC);
	if (gpc) /* If incrementing then no need for the check below */
		return;
	/*
	 * Check to see if a bad DMA write target from an errant or
	 * malicious VF has caused a PCIe error.  If so then we can
	 * issue a VFLR to the offending VF(s) and then resume without
	 * requesting a full slot reset.
	 */

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

#endif
5756 5757 5758 5759 5760 5761 5762 5763
/**
 * ixgbe_service_timer - Timer Call-back
 * @data: pointer to adapter cast into an unsigned long
 **/
static void ixgbe_service_timer(unsigned long data)
{
	struct ixgbe_adapter *adapter = (struct ixgbe_adapter *)data;
	unsigned long next_event_offset;
5764
	bool ready = true;
5765

5766 5767 5768 5769 5770
	/* 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;
5771

5772
#ifdef CONFIG_PCI_IOV
5773 5774 5775 5776 5777
	/*
	 * don't bother with SR-IOV VF DMA hang check if there are
	 * no VFs or the link is down
	 */
	if (!adapter->num_vfs ||
5778
	    (adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE))
5779 5780 5781 5782 5783 5784 5785
		goto normal_timer_service;

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

5786
	if (adapter->timer_event_accumulator >= 100)
5787
		adapter->timer_event_accumulator = 0;
5788
	else
5789
		ready = false;
5790

5791
normal_timer_service:
5792
#endif
5793 5794 5795
	/* Reset the timer */
	mod_timer(&adapter->service_timer, next_event_offset + jiffies);

5796 5797
	if (ready)
		ixgbe_service_event_schedule(adapter);
5798 5799
}

5800 5801 5802 5803 5804 5805 5806 5807 5808 5809 5810 5811 5812 5813 5814 5815 5816 5817 5818
static void ixgbe_reset_subtask(struct ixgbe_adapter *adapter)
{
	if (!(adapter->flags2 & IXGBE_FLAG2_RESET_REQUESTED))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_RESET_REQUESTED;

	/* If we're already down or resetting, just bail */
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;

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

	ixgbe_reinit_locked(adapter);
}

5819 5820 5821 5822 5823 5824 5825 5826 5827 5828
/**
 * 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);

5829
	ixgbe_reset_subtask(adapter);
5830 5831
	ixgbe_sfp_detection_subtask(adapter);
	ixgbe_sfp_link_config_subtask(adapter);
5832
	ixgbe_check_overtemp_subtask(adapter);
5833
	ixgbe_watchdog_subtask(adapter);
5834
	ixgbe_fdir_reinit_subtask(adapter);
5835
	ixgbe_check_hang_subtask(adapter);
5836 5837 5838
#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_overflow_check(adapter);
#endif
5839 5840

	ixgbe_service_event_complete(adapter);
5841 5842
}

5843 5844
static int ixgbe_tso(struct ixgbe_ring *tx_ring,
		     struct ixgbe_tx_buffer *first,
5845
		     u8 *hdr_len)
5846
{
5847
	struct sk_buff *skb = first->skb;
5848 5849
	u32 vlan_macip_lens, type_tucmd;
	u32 mss_l4len_idx, l4len;
5850

5851 5852
	if (!skb_is_gso(skb))
		return 0;
5853

5854
	if (skb_header_cloned(skb)) {
5855
		int err = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
5856 5857
		if (err)
			return err;
5858 5859
	}

5860 5861 5862
	/* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
	type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;

5863
	if (first->protocol == __constant_htons(ETH_P_IP)) {
5864 5865 5866 5867 5868 5869 5870 5871
		struct iphdr *iph = ip_hdr(skb);
		iph->tot_len = 0;
		iph->check = 0;
		tcp_hdr(skb)->check = ~csum_tcpudp_magic(iph->saddr,
							 iph->daddr, 0,
							 IPPROTO_TCP,
							 0);
		type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
5872 5873 5874
		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
				   IXGBE_TX_FLAGS_CSUM |
				   IXGBE_TX_FLAGS_IPV4;
5875 5876 5877 5878 5879 5880
	} else if (skb_is_gso_v6(skb)) {
		ipv6_hdr(skb)->payload_len = 0;
		tcp_hdr(skb)->check =
		    ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr,
				     &ipv6_hdr(skb)->daddr,
				     0, IPPROTO_TCP, 0);
5881 5882
		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
				   IXGBE_TX_FLAGS_CSUM;
5883 5884
	}

5885
	/* compute header lengths */
5886 5887 5888
	l4len = tcp_hdrlen(skb);
	*hdr_len = skb_transport_offset(skb) + l4len;

5889 5890 5891 5892
	/* update gso size and bytecount with header size */
	first->gso_segs = skb_shinfo(skb)->gso_segs;
	first->bytecount += (first->gso_segs - 1) * *hdr_len;

5893 5894 5895 5896 5897 5898 5899 5900
	/* mss_l4len_id: use 1 as index for TSO */
	mss_l4len_idx = l4len << IXGBE_ADVTXD_L4LEN_SHIFT;
	mss_l4len_idx |= skb_shinfo(skb)->gso_size << IXGBE_ADVTXD_MSS_SHIFT;
	mss_l4len_idx |= 1 << IXGBE_ADVTXD_IDX_SHIFT;

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

	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, 0, type_tucmd,
5904
			  mss_l4len_idx);
5905 5906 5907 5908

	return 1;
}

5909 5910
static void ixgbe_tx_csum(struct ixgbe_ring *tx_ring,
			  struct ixgbe_tx_buffer *first)
5911
{
5912
	struct sk_buff *skb = first->skb;
5913 5914 5915
	u32 vlan_macip_lens = 0;
	u32 mss_l4len_idx = 0;
	u32 type_tucmd = 0;
5916

5917
	if (skb->ip_summed != CHECKSUM_PARTIAL) {
5918 5919 5920 5921 5922 5923
		if (!(first->tx_flags & IXGBE_TX_FLAGS_HW_VLAN)) {
			if (unlikely(skb->no_fcs))
				first->tx_flags |= IXGBE_TX_FLAGS_NO_IFCS;
			if (!(first->tx_flags & IXGBE_TX_FLAGS_TXSW))
				return;
		}
5924 5925
	} else {
		u8 l4_hdr = 0;
5926
		switch (first->protocol) {
5927 5928 5929 5930
		case __constant_htons(ETH_P_IP):
			vlan_macip_lens |= skb_network_header_len(skb);
			type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
			l4_hdr = ip_hdr(skb)->protocol;
5931
			break;
5932 5933 5934 5935 5936 5937 5938 5939
		case __constant_htons(ETH_P_IPV6):
			vlan_macip_lens |= skb_network_header_len(skb);
			l4_hdr = ipv6_hdr(skb)->nexthdr;
			break;
		default:
			if (unlikely(net_ratelimit())) {
				dev_warn(tx_ring->dev,
				 "partial checksum but proto=%x!\n",
5940
				 first->protocol);
5941
			}
5942 5943
			break;
		}
5944 5945

		switch (l4_hdr) {
5946
		case IPPROTO_TCP:
5947 5948 5949
			type_tucmd |= IXGBE_ADVTXD_TUCMD_L4T_TCP;
			mss_l4len_idx = tcp_hdrlen(skb) <<
					IXGBE_ADVTXD_L4LEN_SHIFT;
5950 5951
			break;
		case IPPROTO_SCTP:
5952 5953 5954 5955 5956 5957 5958 5959 5960 5961 5962 5963
			type_tucmd |= IXGBE_ADVTXD_TUCMD_L4T_SCTP;
			mss_l4len_idx = sizeof(struct sctphdr) <<
					IXGBE_ADVTXD_L4LEN_SHIFT;
			break;
		case IPPROTO_UDP:
			mss_l4len_idx = sizeof(struct udphdr) <<
					IXGBE_ADVTXD_L4LEN_SHIFT;
			break;
		default:
			if (unlikely(net_ratelimit())) {
				dev_warn(tx_ring->dev,
				 "partial checksum but l4 proto=%x!\n",
5964
				 l4_hdr);
5965
			}
5966 5967
			break;
		}
5968 5969 5970

		/* update TX checksum flag */
		first->tx_flags |= IXGBE_TX_FLAGS_CSUM;
5971 5972
	}

5973
	/* vlan_macip_lens: MACLEN, VLAN tag */
5974
	vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
5975
	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
5976

5977 5978
	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, 0,
			  type_tucmd, mss_l4len_idx);
5979 5980
}

5981
static __le32 ixgbe_tx_cmd_type(u32 tx_flags)
5982
{
5983 5984 5985
	/* set type for advanced descriptor with frame checksum insertion */
	__le32 cmd_type = cpu_to_le32(IXGBE_ADVTXD_DTYP_DATA |
				      IXGBE_ADVTXD_DCMD_DEXT);
5986

5987
	/* set HW vlan bit if vlan is present */
5988
	if (tx_flags & IXGBE_TX_FLAGS_HW_VLAN)
5989
		cmd_type |= cpu_to_le32(IXGBE_ADVTXD_DCMD_VLE);
5990

5991 5992 5993 5994 5995
#ifdef CONFIG_IXGBE_PTP
	if (tx_flags & IXGBE_TX_FLAGS_TSTAMP)
		cmd_type |= cpu_to_le32(IXGBE_ADVTXD_MAC_TSTAMP);
#endif

5996 5997
	/* set segmentation enable bits for TSO/FSO */
#ifdef IXGBE_FCOE
5998
	if (tx_flags & (IXGBE_TX_FLAGS_TSO | IXGBE_TX_FLAGS_FSO))
5999 6000 6001 6002
#else
	if (tx_flags & IXGBE_TX_FLAGS_TSO)
#endif
		cmd_type |= cpu_to_le32(IXGBE_ADVTXD_DCMD_TSE);
6003

6004 6005 6006 6007
	/* insert frame checksum */
	if (!(tx_flags & IXGBE_TX_FLAGS_NO_IFCS))
		cmd_type |= cpu_to_le32(IXGBE_ADVTXD_DCMD_IFCS);

6008 6009
	return cmd_type;
}
6010

6011 6012
static void ixgbe_tx_olinfo_status(union ixgbe_adv_tx_desc *tx_desc,
				   u32 tx_flags, unsigned int paylen)
6013
{
6014
	__le32 olinfo_status = cpu_to_le32(paylen << IXGBE_ADVTXD_PAYLEN_SHIFT);
6015

6016 6017 6018
	/* enable L4 checksum for TSO and TX checksum offload */
	if (tx_flags & IXGBE_TX_FLAGS_CSUM)
		olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_POPTS_TXSM);
6019

6020 6021 6022
	/* enble IPv4 checksum for TSO */
	if (tx_flags & IXGBE_TX_FLAGS_IPV4)
		olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_POPTS_IXSM);
6023

6024 6025 6026 6027 6028
	/* use index 1 context for TSO/FSO/FCOE */
#ifdef IXGBE_FCOE
	if (tx_flags & (IXGBE_TX_FLAGS_TSO | IXGBE_TX_FLAGS_FCOE))
#else
	if (tx_flags & IXGBE_TX_FLAGS_TSO)
6029
#endif
6030 6031
		olinfo_status |= cpu_to_le32(1 << IXGBE_ADVTXD_IDX_SHIFT);

6032 6033 6034 6035
	/*
	 * Check Context must be set if Tx switch is enabled, which it
	 * always is for case where virtual functions are running
	 */
6036 6037 6038
#ifdef IXGBE_FCOE
	if (tx_flags & (IXGBE_TX_FLAGS_TXSW | IXGBE_TX_FLAGS_FCOE))
#else
6039
	if (tx_flags & IXGBE_TX_FLAGS_TXSW)
6040
#endif
6041 6042
		olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_CC);

6043
	tx_desc->read.olinfo_status = olinfo_status;
6044
}
6045

6046 6047 6048 6049 6050 6051 6052
#define IXGBE_TXD_CMD (IXGBE_TXD_CMD_EOP | \
		       IXGBE_TXD_CMD_RS)

static void ixgbe_tx_map(struct ixgbe_ring *tx_ring,
			 struct ixgbe_tx_buffer *first,
			 const u8 hdr_len)
{
6053
	dma_addr_t dma;
6054
	struct sk_buff *skb = first->skb;
6055
	struct ixgbe_tx_buffer *tx_buffer;
6056
	union ixgbe_adv_tx_desc *tx_desc;
6057
	struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[0];
6058 6059
	unsigned int data_len = skb->data_len;
	unsigned int size = skb_headlen(skb);
6060
	unsigned int paylen = skb->len - hdr_len;
6061
	u32 tx_flags = first->tx_flags;
6062
	__le32 cmd_type;
6063 6064
	u16 i = tx_ring->next_to_use;

6065 6066 6067 6068 6069
	tx_desc = IXGBE_TX_DESC(tx_ring, i);

	ixgbe_tx_olinfo_status(tx_desc, tx_flags, paylen);
	cmd_type = ixgbe_tx_cmd_type(tx_flags);

6070 6071
#ifdef IXGBE_FCOE
	if (tx_flags & IXGBE_TX_FLAGS_FCOE) {
6072
		if (data_len < sizeof(struct fcoe_crc_eof)) {
6073 6074
			size -= sizeof(struct fcoe_crc_eof) - data_len;
			data_len = 0;
6075 6076
		} else {
			data_len -= sizeof(struct fcoe_crc_eof);
6077 6078
		}
	}
6079

6080
#endif
6081 6082
	dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
	if (dma_mapping_error(tx_ring->dev, dma))
6083
		goto dma_error;
6084

6085 6086 6087
	/* record length, and DMA address */
	dma_unmap_len_set(first, len, size);
	dma_unmap_addr_set(first, dma, dma);
6088

6089
	tx_desc->read.buffer_addr = cpu_to_le64(dma);
6090

6091
	for (;;) {
6092
		while (unlikely(size > IXGBE_MAX_DATA_PER_TXD)) {
6093 6094
			tx_desc->read.cmd_type_len =
				cmd_type | cpu_to_le32(IXGBE_MAX_DATA_PER_TXD);
6095

6096
			i++;
6097
			tx_desc++;
6098
			if (i == tx_ring->count) {
6099
				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
6100 6101
				i = 0;
			}
6102 6103 6104 6105 6106 6107

			dma += IXGBE_MAX_DATA_PER_TXD;
			size -= IXGBE_MAX_DATA_PER_TXD;

			tx_desc->read.buffer_addr = cpu_to_le64(dma);
			tx_desc->read.olinfo_status = 0;
6108
		}
6109

6110 6111
		if (likely(!data_len))
			break;
6112

6113
		tx_desc->read.cmd_type_len = cmd_type | cpu_to_le32(size);
6114

6115 6116 6117 6118 6119 6120
		i++;
		tx_desc++;
		if (i == tx_ring->count) {
			tx_desc = IXGBE_TX_DESC(tx_ring, 0);
			i = 0;
		}
6121

6122
#ifdef IXGBE_FCOE
E
Eric Dumazet 已提交
6123
		size = min_t(unsigned int, data_len, skb_frag_size(frag));
6124
#else
E
Eric Dumazet 已提交
6125
		size = skb_frag_size(frag);
6126 6127
#endif
		data_len -= size;
6128

6129 6130 6131
		dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
				       DMA_TO_DEVICE);
		if (dma_mapping_error(tx_ring->dev, dma))
6132
			goto dma_error;
6133

6134 6135 6136
		tx_buffer = &tx_ring->tx_buffer_info[i];
		dma_unmap_len_set(tx_buffer, len, size);
		dma_unmap_addr_set(tx_buffer, dma, dma);
6137

6138 6139
		tx_desc->read.buffer_addr = cpu_to_le64(dma);
		tx_desc->read.olinfo_status = 0;
6140

6141 6142
		frag++;
	}
6143

6144 6145 6146
	/* write last descriptor with RS and EOP bits */
	cmd_type |= cpu_to_le32(size) | cpu_to_le32(IXGBE_TXD_CMD);
	tx_desc->read.cmd_type_len = cmd_type;
6147

6148
	netdev_tx_sent_queue(txring_txq(tx_ring), first->bytecount);
6149

6150 6151
	/* set the timestamp */
	first->time_stamp = jiffies;
6152 6153

	/*
6154 6155 6156 6157 6158 6159
	 * 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.
6160 6161 6162
	 */
	wmb();

6163 6164 6165
	/* set next_to_watch value indicating a packet is present */
	first->next_to_watch = tx_desc;

6166 6167 6168 6169 6170 6171
	i++;
	if (i == tx_ring->count)
		i = 0;

	tx_ring->next_to_use = i;

6172
	/* notify HW of packet */
6173
	writel(i, tx_ring->tail);
6174 6175 6176

	return;
dma_error:
6177
	dev_err(tx_ring->dev, "TX DMA map failed\n");
6178 6179 6180

	/* clear dma mappings for failed tx_buffer_info map */
	for (;;) {
6181 6182 6183
		tx_buffer = &tx_ring->tx_buffer_info[i];
		ixgbe_unmap_and_free_tx_resource(tx_ring, tx_buffer);
		if (tx_buffer == first)
6184 6185 6186 6187 6188 6189 6190
			break;
		if (i == 0)
			i = tx_ring->count;
		i--;
	}

	tx_ring->next_to_use = i;
6191 6192
}

6193
static void ixgbe_atr(struct ixgbe_ring *ring,
6194
		      struct ixgbe_tx_buffer *first)
6195 6196 6197 6198 6199 6200 6201 6202 6203
{
	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;
6204
	struct tcphdr *th;
6205
	__be16 vlan_id;
6206

6207 6208 6209 6210 6211 6212
	/* 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)
6213
		return;
6214

6215
	ring->atr_count++;
6216

6217
	/* snag network header to get L4 type and address */
6218
	hdr.network = skb_network_header(first->skb);
6219 6220

	/* Currently only IPv4/IPv6 with TCP is supported */
6221
	if ((first->protocol != __constant_htons(ETH_P_IPV6) ||
6222
	     hdr.ipv6->nexthdr != IPPROTO_TCP) &&
6223
	    (first->protocol != __constant_htons(ETH_P_IP) ||
6224 6225
	     hdr.ipv4->protocol != IPPROTO_TCP))
		return;
6226

6227
	th = tcp_hdr(first->skb);
6228

6229 6230
	/* skip this packet since it is invalid or the socket is closing */
	if (!th || th->fin)
6231 6232 6233 6234 6235 6236 6237 6238 6239
		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;

6240
	vlan_id = htons(first->tx_flags >> IXGBE_TX_FLAGS_VLAN_SHIFT);
6241 6242 6243 6244 6245 6246 6247 6248 6249 6250 6251 6252 6253 6254

	/*
	 * 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
	 */
6255
	if (first->tx_flags & (IXGBE_TX_FLAGS_SW_VLAN | IXGBE_TX_FLAGS_HW_VLAN))
6256 6257
		common.port.src ^= th->dest ^ __constant_htons(ETH_P_8021Q);
	else
6258
		common.port.src ^= th->dest ^ first->protocol;
6259 6260
	common.port.dst ^= th->source;

6261
	if (first->protocol == __constant_htons(ETH_P_IP)) {
6262 6263 6264 6265 6266 6267 6268 6269 6270 6271 6272 6273 6274
		input.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_TCPV4;
		common.ip ^= hdr.ipv4->saddr ^ hdr.ipv4->daddr;
	} else {
		input.formatted.flow_type = IXGBE_ATR_FLOW_TYPE_TCPV6;
		common.ip ^= hdr.ipv6->saddr.s6_addr32[0] ^
			     hdr.ipv6->saddr.s6_addr32[1] ^
			     hdr.ipv6->saddr.s6_addr32[2] ^
			     hdr.ipv6->saddr.s6_addr32[3] ^
			     hdr.ipv6->daddr.s6_addr32[0] ^
			     hdr.ipv6->daddr.s6_addr32[1] ^
			     hdr.ipv6->daddr.s6_addr32[2] ^
			     hdr.ipv6->daddr.s6_addr32[3];
	}
6275 6276

	/* This assumes the Rx queue and Tx queue are bound to the same CPU */
6277 6278
	ixgbe_fdir_add_signature_filter_82599(&q_vector->adapter->hw,
					      input, common, ring->queue_index);
6279 6280
}

6281
static int __ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
6282
{
6283
	netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);
6284 6285 6286 6287 6288 6289 6290
	/* 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. */
6291
	if (likely(ixgbe_desc_unused(tx_ring) < size))
6292 6293 6294
		return -EBUSY;

	/* A reprieve! - use start_queue because it doesn't call schedule */
6295
	netif_start_subqueue(tx_ring->netdev, tx_ring->queue_index);
6296
	++tx_ring->tx_stats.restart_queue;
6297 6298 6299
	return 0;
}

6300
static inline int ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
6301
{
6302
	if (likely(ixgbe_desc_unused(tx_ring) >= size))
6303
		return 0;
6304
	return __ixgbe_maybe_stop_tx(tx_ring, size);
6305 6306
}

6307 6308 6309
static u16 ixgbe_select_queue(struct net_device *dev, struct sk_buff *skb)
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
6310 6311
	int txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) :
					       smp_processor_id();
6312
#ifdef IXGBE_FCOE
6313
	__be16 protocol = vlan_get_protocol(skb);
6314

6315 6316 6317
	if (((protocol == htons(ETH_P_FCOE)) ||
	    (protocol == htons(ETH_P_FIP))) &&
	    (adapter->flags & IXGBE_FLAG_FCOE_ENABLED)) {
6318 6319 6320 6321 6322 6323
		struct ixgbe_ring_feature *f;

		f = &adapter->ring_feature[RING_F_FCOE];

		while (txq >= f->indices)
			txq -= f->indices;
6324
		txq += adapter->ring_feature[RING_F_FCOE].offset;
6325

6326
		return txq;
6327 6328 6329
	}
#endif

K
Krishna Kumar 已提交
6330 6331 6332
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
		while (unlikely(txq >= dev->real_num_tx_queues))
			txq -= dev->real_num_tx_queues;
6333
		return txq;
K
Krishna Kumar 已提交
6334
	}
6335

6336 6337 6338
	return skb_tx_hash(dev, skb);
}

6339
netdev_tx_t ixgbe_xmit_frame_ring(struct sk_buff *skb,
6340 6341
			  struct ixgbe_adapter *adapter,
			  struct ixgbe_ring *tx_ring)
6342
{
6343
	struct ixgbe_tx_buffer *first;
6344
	int tso;
6345
	u32 tx_flags = 0;
6346 6347 6348 6349
#if PAGE_SIZE > IXGBE_MAX_DATA_PER_TXD
	unsigned short f;
#endif
	u16 count = TXD_USE_COUNT(skb_headlen(skb));
6350
	__be16 protocol = skb->protocol;
6351
	u8 hdr_len = 0;
6352

6353 6354
	/*
	 * need: 1 descriptor per page * PAGE_SIZE/IXGBE_MAX_DATA_PER_TXD,
6355
	 *       + 1 desc for skb_headlen/IXGBE_MAX_DATA_PER_TXD,
6356 6357 6358 6359 6360 6361 6362 6363 6364 6365 6366 6367 6368 6369 6370
	 *       + 2 desc gap to keep tail from touching head,
	 *       + 1 desc for context descriptor,
	 * otherwise try next time
	 */
#if PAGE_SIZE > IXGBE_MAX_DATA_PER_TXD
	for (f = 0; f < skb_shinfo(skb)->nr_frags; f++)
		count += TXD_USE_COUNT(skb_shinfo(skb)->frags[f].size);
#else
	count += skb_shinfo(skb)->nr_frags;
#endif
	if (ixgbe_maybe_stop_tx(tx_ring, count + 3)) {
		tx_ring->tx_stats.tx_busy++;
		return NETDEV_TX_BUSY;
	}

6371 6372 6373
	/* record the location of the first descriptor for this packet */
	first = &tx_ring->tx_buffer_info[tx_ring->next_to_use];
	first->skb = skb;
6374 6375
	first->bytecount = skb->len;
	first->gso_segs = 1;
6376

6377
	/* if we have a HW VLAN tag being added default to the HW one */
6378
	if (vlan_tx_tag_present(skb)) {
6379 6380 6381 6382 6383 6384 6385 6386 6387 6388
		tx_flags |= vlan_tx_tag_get(skb) << IXGBE_TX_FLAGS_VLAN_SHIFT;
		tx_flags |= IXGBE_TX_FLAGS_HW_VLAN;
	/* else if it is a SW VLAN check the next protocol and store the tag */
	} else if (protocol == __constant_htons(ETH_P_8021Q)) {
		struct vlan_hdr *vhdr, _vhdr;
		vhdr = skb_header_pointer(skb, ETH_HLEN, sizeof(_vhdr), &_vhdr);
		if (!vhdr)
			goto out_drop;

		protocol = vhdr->h_vlan_encapsulated_proto;
6389 6390
		tx_flags |= ntohs(vhdr->h_vlan_TCI) <<
				  IXGBE_TX_FLAGS_VLAN_SHIFT;
6391 6392 6393
		tx_flags |= IXGBE_TX_FLAGS_SW_VLAN;
	}

6394 6395
	skb_tx_timestamp(skb);

6396 6397 6398 6399 6400 6401 6402
#ifdef CONFIG_IXGBE_PTP
	if (unlikely(skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP)) {
		skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS;
		tx_flags |= IXGBE_TX_FLAGS_TSTAMP;
	}
#endif

6403 6404 6405 6406 6407 6408 6409 6410 6411
#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)
		tx_flags |= IXGBE_TX_FLAGS_TXSW;

#endif
6412
	/* DCB maps skb priorities 0-7 onto 3 bit PCP of VLAN tag. */
6413
	if ((adapter->flags & IXGBE_FLAG_DCB_ENABLED) &&
6414 6415
	    ((tx_flags & (IXGBE_TX_FLAGS_HW_VLAN | IXGBE_TX_FLAGS_SW_VLAN)) ||
	     (skb->priority != TC_PRIO_CONTROL))) {
6416
		tx_flags &= ~IXGBE_TX_FLAGS_VLAN_PRIO_MASK;
6417 6418
		tx_flags |= (skb->priority & 0x7) <<
					IXGBE_TX_FLAGS_VLAN_PRIO_SHIFT;
6419 6420 6421 6422 6423 6424 6425 6426 6427 6428
		if (tx_flags & IXGBE_TX_FLAGS_SW_VLAN) {
			struct vlan_ethhdr *vhdr;
			if (skb_header_cloned(skb) &&
			    pskb_expand_head(skb, 0, 0, GFP_ATOMIC))
				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;
6429
		}
6430
	}
6431

6432 6433 6434 6435
	/* record initial flags and protocol */
	first->tx_flags = tx_flags;
	first->protocol = protocol;

6436
#ifdef IXGBE_FCOE
6437 6438
	/* setup tx offload for FCoE */
	if ((protocol == __constant_htons(ETH_P_FCOE)) &&
6439
	    (tx_ring->netdev->features & (NETIF_F_FSO | NETIF_F_FCOE_CRC))) {
6440
		tso = ixgbe_fso(tx_ring, first, &hdr_len);
6441 6442
		if (tso < 0)
			goto out_drop;
6443

6444
		goto xmit_fcoe;
6445
	}
6446

6447
#endif /* IXGBE_FCOE */
6448
	tso = ixgbe_tso(tx_ring, first, &hdr_len);
6449
	if (tso < 0)
6450
		goto out_drop;
6451 6452
	else if (!tso)
		ixgbe_tx_csum(tx_ring, first);
6453 6454 6455

	/* add the ATR filter if ATR is on */
	if (test_bit(__IXGBE_TX_FDIR_INIT_DONE, &tx_ring->state))
6456
		ixgbe_atr(tx_ring, first);
6457 6458 6459 6460

#ifdef IXGBE_FCOE
xmit_fcoe:
#endif /* IXGBE_FCOE */
6461
	ixgbe_tx_map(tx_ring, first, hdr_len);
6462 6463

	ixgbe_maybe_stop_tx(tx_ring, DESC_NEEDED);
6464 6465

	return NETDEV_TX_OK;
6466 6467

out_drop:
6468 6469 6470
	dev_kfree_skb_any(first->skb);
	first->skb = NULL;

6471
	return NETDEV_TX_OK;
6472 6473
}

6474 6475
static netdev_tx_t ixgbe_xmit_frame(struct sk_buff *skb,
				    struct net_device *netdev)
6476 6477 6478 6479
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_ring *tx_ring;

6480 6481 6482 6483
	/*
	 * The minimum packet size for olinfo paylen is 17 so pad the skb
	 * in order to meet this minimum size requirement.
	 */
6484 6485
	if (unlikely(skb->len < 17)) {
		if (skb_pad(skb, 17 - skb->len))
6486 6487 6488 6489
			return NETDEV_TX_OK;
		skb->len = 17;
	}

6490
	tx_ring = adapter->tx_ring[skb->queue_mapping];
6491
	return ixgbe_xmit_frame_ring(skb, adapter, tx_ring);
6492 6493
}

6494 6495 6496 6497 6498 6499 6500 6501 6502 6503
/**
 * 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);
6504
	struct ixgbe_hw *hw = &adapter->hw;
6505 6506 6507 6508 6509 6510
	struct sockaddr *addr = p;

	if (!is_valid_ether_addr(addr->sa_data))
		return -EADDRNOTAVAIL;

	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
6511
	memcpy(hw->mac.addr, addr->sa_data, netdev->addr_len);
6512

6513
	hw->mac.ops.set_rar(hw, 0, hw->mac.addr, VMDQ_P(0), IXGBE_RAH_AV);
6514 6515 6516 6517

	return 0;
}

6518 6519 6520 6521 6522 6523 6524 6525 6526 6527 6528 6529 6530 6531 6532 6533 6534 6535 6536 6537 6538 6539 6540 6541 6542 6543 6544 6545 6546 6547 6548
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);

6549 6550 6551 6552 6553 6554 6555 6556
	switch (cmd) {
#ifdef CONFIG_IXGBE_PTP
	case SIOCSHWTSTAMP:
		return ixgbe_ptp_hwtstamp_ioctl(adapter, req, cmd);
#endif
	default:
		return mdio_mii_ioctl(&adapter->hw.phy.mdio, if_mii(req), cmd);
	}
6557 6558
}

6559 6560
/**
 * ixgbe_add_sanmac_netdev - Add the SAN MAC address to the corresponding
6561
 * netdev->dev_addrs
6562 6563 6564 6565 6566 6567 6568 6569
 * @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);
6570
	struct ixgbe_hw *hw = &adapter->hw;
6571

6572
	if (is_valid_ether_addr(hw->mac.san_addr)) {
6573
		rtnl_lock();
6574
		err = dev_addr_add(dev, hw->mac.san_addr, NETDEV_HW_ADDR_T_SAN);
6575
		rtnl_unlock();
6576 6577 6578

		/* update SAN MAC vmdq pool selection */
		hw->mac.ops.set_vmdq_san_mac(hw, VMDQ_P(0));
6579 6580 6581 6582 6583 6584
	}
	return err;
}

/**
 * ixgbe_del_sanmac_netdev - Removes the SAN MAC address to the corresponding
6585
 * netdev->dev_addrs
6586 6587 6588 6589 6590 6591 6592 6593 6594 6595 6596 6597 6598 6599 6600 6601 6602 6603
 * @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;
}

6604 6605 6606 6607 6608 6609 6610 6611 6612
#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);
6613
	int i;
6614

6615 6616 6617 6618
	/* if interface is down do nothing */
	if (test_bit(__IXGBE_DOWN, &adapter->state))
		return;

6619
	adapter->flags |= IXGBE_FLAG_IN_NETPOLL;
6620
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
6621 6622
		for (i = 0; i < adapter->num_q_vectors; i++)
			ixgbe_msix_clean_rings(0, adapter->q_vector[i]);
6623 6624 6625
	} else {
		ixgbe_intr(adapter->pdev->irq, netdev);
	}
6626 6627 6628
	adapter->flags &= ~IXGBE_FLAG_IN_NETPOLL;
}

A
Alexander Duyck 已提交
6629
#endif
E
Eric Dumazet 已提交
6630 6631 6632 6633 6634 6635
static struct rtnl_link_stats64 *ixgbe_get_stats64(struct net_device *netdev,
						   struct rtnl_link_stats64 *stats)
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	int i;

E
Eric Dumazet 已提交
6636
	rcu_read_lock();
E
Eric Dumazet 已提交
6637
	for (i = 0; i < adapter->num_rx_queues; i++) {
E
Eric Dumazet 已提交
6638
		struct ixgbe_ring *ring = ACCESS_ONCE(adapter->rx_ring[i]);
E
Eric Dumazet 已提交
6639 6640 6641
		u64 bytes, packets;
		unsigned int start;

E
Eric Dumazet 已提交
6642 6643 6644 6645 6646 6647 6648 6649 6650
		if (ring) {
			do {
				start = u64_stats_fetch_begin_bh(&ring->syncp);
				packets = ring->stats.packets;
				bytes   = ring->stats.bytes;
			} while (u64_stats_fetch_retry_bh(&ring->syncp, start));
			stats->rx_packets += packets;
			stats->rx_bytes   += bytes;
		}
E
Eric Dumazet 已提交
6651
	}
E
Eric Dumazet 已提交
6652 6653 6654 6655 6656 6657 6658 6659 6660 6661 6662 6663 6664 6665 6666 6667

	for (i = 0; i < adapter->num_tx_queues; i++) {
		struct ixgbe_ring *ring = ACCESS_ONCE(adapter->tx_ring[i]);
		u64 bytes, packets;
		unsigned int start;

		if (ring) {
			do {
				start = u64_stats_fetch_begin_bh(&ring->syncp);
				packets = ring->stats.packets;
				bytes   = ring->stats.bytes;
			} while (u64_stats_fetch_retry_bh(&ring->syncp, start));
			stats->tx_packets += packets;
			stats->tx_bytes   += bytes;
		}
	}
E
Eric Dumazet 已提交
6668
	rcu_read_unlock();
E
Eric Dumazet 已提交
6669 6670 6671 6672 6673 6674 6675 6676 6677
	/* following stats updated by ixgbe_watchdog_task() */
	stats->multicast	= netdev->stats.multicast;
	stats->rx_errors	= netdev->stats.rx_errors;
	stats->rx_length_errors	= netdev->stats.rx_length_errors;
	stats->rx_crc_errors	= netdev->stats.rx_crc_errors;
	stats->rx_missed_errors	= netdev->stats.rx_missed_errors;
	return stats;
}

6678
#ifdef CONFIG_IXGBE_DCB
6679 6680 6681
/**
 * ixgbe_validate_rtr - verify 802.1Qp to Rx packet buffer mapping is valid.
 * @adapter: pointer to ixgbe_adapter
6682 6683 6684 6685 6686 6687 6688 6689 6690 6691 6692 6693 6694 6695 6696 6697 6698 6699 6700 6701 6702 6703 6704 6705 6706 6707 6708 6709 6710 6711 6712 6713 6714 6715
 * @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;
}

6716 6717 6718 6719 6720 6721 6722 6723 6724 6725 6726 6727 6728 6729 6730 6731 6732 6733 6734 6735 6736 6737 6738 6739 6740
/**
 * 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);
	}
}

6741 6742
/**
 * ixgbe_setup_tc - configure net_device for multiple traffic classes
6743 6744 6745 6746 6747 6748 6749 6750 6751 6752
 *
 * @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;

	/* Hardware supports up to 8 traffic classes */
6753
	if (tc > adapter->dcb_cfg.num_tcs.pg_tcs ||
A
Alexander Duyck 已提交
6754 6755
	    (hw->mac.type == ixgbe_mac_82598EB &&
	     tc < MAX_TRAFFIC_CLASS))
6756 6757 6758
		return -EINVAL;

	/* Hardware has to reinitialize queues and interrupts to
S
Stephen Hemminger 已提交
6759
	 * match packet buffer alignment. Unfortunately, the
6760 6761 6762 6763 6764 6765
	 * hardware is not flexible enough to do this dynamically.
	 */
	if (netif_running(dev))
		ixgbe_close(dev);
	ixgbe_clear_interrupt_scheme(adapter);

6766
	if (tc) {
6767
		netdev_set_num_tc(dev, tc);
6768 6769
		ixgbe_set_prio_tc_map(adapter);

6770 6771
		adapter->flags |= IXGBE_FLAG_DCB_ENABLED;

6772 6773
		if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
			adapter->last_lfc_mode = adapter->hw.fc.requested_mode;
6774
			adapter->hw.fc.requested_mode = ixgbe_fc_none;
6775
		}
6776
	} else {
6777
		netdev_reset_tc(dev);
6778

6779 6780
		if (adapter->hw.mac.type == ixgbe_mac_82598EB)
			adapter->hw.fc.requested_mode = adapter->last_lfc_mode;
6781 6782 6783 6784 6785 6786 6787

		adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;

		adapter->temp_dcb_cfg.pfc_mode_enable = false;
		adapter->dcb_cfg.pfc_mode_enable = false;
	}

6788 6789 6790 6791 6792 6793 6794
	ixgbe_init_interrupt_scheme(adapter);
	ixgbe_validate_rtr(adapter, tc);
	if (netif_running(dev))
		ixgbe_open(dev);

	return 0;
}
E
Eric Dumazet 已提交
6795

6796
#endif /* CONFIG_IXGBE_DCB */
6797 6798 6799 6800 6801 6802 6803 6804 6805 6806
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);
}

6807
static netdev_features_t ixgbe_fix_features(struct net_device *netdev,
6808
					    netdev_features_t features)
6809 6810 6811 6812
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

	/* If Rx checksum is disabled, then RSC/LRO should also be disabled */
6813 6814
	if (!(features & NETIF_F_RXCSUM))
		features &= ~NETIF_F_LRO;
6815

6816 6817 6818
	/* Turn off LRO if not RSC capable */
	if (!(adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE))
		features &= ~NETIF_F_LRO;
6819

6820
	return features;
6821 6822
}

6823
static int ixgbe_set_features(struct net_device *netdev,
6824
			      netdev_features_t features)
6825 6826
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
6827
	netdev_features_t changed = netdev->features ^ features;
6828 6829 6830
	bool need_reset = false;

	/* Make sure RSC matches LRO, reset if change */
6831 6832
	if (!(features & NETIF_F_LRO)) {
		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
6833
			need_reset = true;
6834 6835 6836 6837 6838 6839 6840 6841 6842 6843
		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");
6844 6845 6846 6847 6848 6849 6850
		}
	}

	/*
	 * Check if Flow Director n-tuple support was enabled or disabled.  If
	 * the state changed, we need to reset.
	 */
6851 6852
	switch (features & NETIF_F_NTUPLE) {
	case NETIF_F_NTUPLE:
6853
		/* turn off ATR, enable perfect filters and reset */
6854 6855 6856
		if (!(adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE))
			need_reset = true;

6857 6858
		adapter->flags &= ~IXGBE_FLAG_FDIR_HASH_CAPABLE;
		adapter->flags |= IXGBE_FLAG_FDIR_PERFECT_CAPABLE;
6859 6860 6861 6862 6863 6864 6865 6866 6867 6868 6869 6870 6871 6872 6873 6874 6875 6876 6877 6878 6879 6880 6881 6882 6883 6884
		break;
	default:
		/* turn off perfect filters, enable ATR and reset */
		if (adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE)
			need_reset = true;

		adapter->flags &= ~IXGBE_FLAG_FDIR_PERFECT_CAPABLE;

		/* We cannot enable ATR if SR-IOV is enabled */
		if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
			break;

		/* We cannot enable ATR if we have 2 or more traffic classes */
		if (netdev_get_num_tc(netdev) > 1)
			break;

		/* We cannot enable ATR if RSS is disabled */
		if (adapter->ring_feature[RING_F_RSS].limit <= 1)
			break;

		/* A sample rate of 0 indicates ATR disabled */
		if (!adapter->atr_sample_rate)
			break;

		adapter->flags |= IXGBE_FLAG_FDIR_HASH_CAPABLE;
		break;
6885 6886
	}

6887 6888 6889 6890 6891
	if (features & NETIF_F_HW_VLAN_RX)
		ixgbe_vlan_strip_enable(adapter);
	else
		ixgbe_vlan_strip_disable(adapter);

B
Ben Greear 已提交
6892 6893 6894
	if (changed & NETIF_F_RXALL)
		need_reset = true;

6895
	netdev->features = features;
6896 6897 6898 6899 6900 6901
	if (need_reset)
		ixgbe_do_reset(netdev);

	return 0;
}

6902
static int ixgbe_ndo_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
J
John Fastabend 已提交
6903
			     struct net_device *dev,
6904
			     const unsigned char *addr,
J
John Fastabend 已提交
6905 6906 6907
			     u16 flags)
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
6908 6909 6910 6911
	int err;

	if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
		return -EOPNOTSUPP;
J
John Fastabend 已提交
6912 6913 6914 6915 6916 6917 6918

	if (ndm->ndm_state & NUD_PERMANENT) {
		pr_info("%s: FDB only supports static addresses\n",
			ixgbe_driver_name);
		return -EINVAL;
	}

6919 6920 6921 6922
	if (is_unicast_ether_addr(addr)) {
		u32 rar_uc_entries = IXGBE_MAX_PF_MACVLANS;

		if (netdev_uc_count(dev) < rar_uc_entries)
J
John Fastabend 已提交
6923 6924
			err = dev_uc_add_excl(dev, addr);
		else
6925 6926 6927 6928 6929
			err = -ENOMEM;
	} else if (is_multicast_ether_addr(addr)) {
		err = dev_mc_add_excl(dev, addr);
	} else {
		err = -EINVAL;
J
John Fastabend 已提交
6930 6931 6932 6933 6934 6935 6936 6937 6938 6939 6940
	}

	/* Only return duplicate errors if NLM_F_EXCL is set */
	if (err == -EEXIST && !(flags & NLM_F_EXCL))
		err = 0;

	return err;
}

static int ixgbe_ndo_fdb_del(struct ndmsg *ndm,
			     struct net_device *dev,
6941
			     const unsigned char *addr)
J
John Fastabend 已提交
6942 6943 6944 6945 6946 6947 6948 6949 6950 6951 6952 6953 6954 6955 6956 6957 6958 6959 6960 6961 6962 6963 6964 6965 6966 6967 6968 6969 6970 6971 6972 6973 6974 6975 6976
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
	int err = -EOPNOTSUPP;

	if (ndm->ndm_state & NUD_PERMANENT) {
		pr_info("%s: FDB only supports static addresses\n",
			ixgbe_driver_name);
		return -EINVAL;
	}

	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
		if (is_unicast_ether_addr(addr))
			err = dev_uc_del(dev, addr);
		else if (is_multicast_ether_addr(addr))
			err = dev_mc_del(dev, addr);
		else
			err = -EINVAL;
	}

	return err;
}

static int ixgbe_ndo_fdb_dump(struct sk_buff *skb,
			      struct netlink_callback *cb,
			      struct net_device *dev,
			      int idx)
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);

	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
		idx = ndo_dflt_fdb_dump(skb, cb, dev, idx);

	return idx;
}

6977
static const struct net_device_ops ixgbe_netdev_ops = {
6978
	.ndo_open		= ixgbe_open,
6979
	.ndo_stop		= ixgbe_close,
6980
	.ndo_start_xmit		= ixgbe_xmit_frame,
6981
	.ndo_select_queue	= ixgbe_select_queue,
A
Alexander Duyck 已提交
6982
	.ndo_set_rx_mode	= ixgbe_set_rx_mode,
6983 6984 6985 6986 6987 6988
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_set_mac_address	= ixgbe_set_mac,
	.ndo_change_mtu		= ixgbe_change_mtu,
	.ndo_tx_timeout		= ixgbe_tx_timeout,
	.ndo_vlan_rx_add_vid	= ixgbe_vlan_rx_add_vid,
	.ndo_vlan_rx_kill_vid	= ixgbe_vlan_rx_kill_vid,
6989
	.ndo_do_ioctl		= ixgbe_ioctl,
6990 6991 6992
	.ndo_set_vf_mac		= ixgbe_ndo_set_vf_mac,
	.ndo_set_vf_vlan	= ixgbe_ndo_set_vf_vlan,
	.ndo_set_vf_tx_rate	= ixgbe_ndo_set_vf_bw,
A
Alexander Duyck 已提交
6993
	.ndo_set_vf_spoofchk	= ixgbe_ndo_set_vf_spoofchk,
6994
	.ndo_get_vf_config	= ixgbe_ndo_get_vf_config,
E
Eric Dumazet 已提交
6995
	.ndo_get_stats64	= ixgbe_get_stats64,
6996
#ifdef CONFIG_IXGBE_DCB
J
John Fastabend 已提交
6997
	.ndo_setup_tc		= ixgbe_setup_tc,
6998
#endif
6999 7000 7001
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= ixgbe_netpoll,
#endif
7002 7003
#ifdef IXGBE_FCOE
	.ndo_fcoe_ddp_setup = ixgbe_fcoe_ddp_get,
7004
	.ndo_fcoe_ddp_target = ixgbe_fcoe_ddp_target,
7005
	.ndo_fcoe_ddp_done = ixgbe_fcoe_ddp_put,
7006 7007
	.ndo_fcoe_enable = ixgbe_fcoe_enable,
	.ndo_fcoe_disable = ixgbe_fcoe_disable,
7008
	.ndo_fcoe_get_wwn = ixgbe_fcoe_get_wwn,
7009
	.ndo_fcoe_get_hbainfo = ixgbe_fcoe_get_hbainfo,
7010
#endif /* IXGBE_FCOE */
7011 7012
	.ndo_set_features = ixgbe_set_features,
	.ndo_fix_features = ixgbe_fix_features,
J
John Fastabend 已提交
7013 7014 7015
	.ndo_fdb_add		= ixgbe_ndo_fdb_add,
	.ndo_fdb_del		= ixgbe_ndo_fdb_del,
	.ndo_fdb_dump		= ixgbe_ndo_fdb_dump,
7016 7017
};

7018 7019 7020 7021 7022 7023 7024 7025 7026 7027 7028 7029 7030 7031 7032 7033 7034 7035 7036 7037 7038 7039 7040 7041 7042 7043
/**
 * ixgbe_wol_supported - Check whether device supports WoL
 * @hw: hw specific details
 * @device_id: the device ID
 * @subdev_id: the subsystem device ID
 *
 * This function is used by probe and ethtool to determine
 * which devices have WoL support
 *
 **/
int ixgbe_wol_supported(struct ixgbe_adapter *adapter, u16 device_id,
			u16 subdevice_id)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u16 wol_cap = adapter->eeprom_cap & IXGBE_DEVICE_CAPS_WOL_MASK;
	int is_wol_supported = 0;

	switch (device_id) {
	case IXGBE_DEV_ID_82599_SFP:
		/* Only these subdevices could supports WOL */
		switch (subdevice_id) {
		case IXGBE_SUBDEV_ID_82599_560FLR:
			/* only support first port */
			if (hw->bus.func != 0)
				break;
		case IXGBE_SUBDEV_ID_82599_SFP:
7044
		case IXGBE_SUBDEV_ID_82599_RNDC:
7045 7046 7047 7048 7049 7050 7051 7052 7053 7054 7055 7056 7057
			is_wol_supported = 1;
			break;
		}
		break;
	case IXGBE_DEV_ID_82599_COMBO_BACKPLANE:
		/* All except this subdevice support WOL */
		if (subdevice_id != IXGBE_SUBDEV_ID_82599_KX4_KR_MEZZ)
			is_wol_supported = 1;
		break;
	case IXGBE_DEV_ID_82599_KX4:
		is_wol_supported = 1;
		break;
	case IXGBE_DEV_ID_X540T:
7058
	case IXGBE_DEV_ID_X540T1:
7059 7060 7061 7062 7063 7064 7065 7066 7067 7068 7069 7070
		/* check eeprom to see if enabled wol */
		if ((wol_cap == IXGBE_DEVICE_CAPS_WOL_PORT0_1) ||
		    ((wol_cap == IXGBE_DEVICE_CAPS_WOL_PORT0) &&
		     (hw->bus.func == 0))) {
			is_wol_supported = 1;
		}
		break;
	}

	return is_wol_supported;
}

7071 7072 7073 7074 7075 7076 7077 7078 7079 7080 7081 7082
/**
 * 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.
 **/
static int __devinit ixgbe_probe(struct pci_dev *pdev,
7083
				 const struct pci_device_id *ent)
7084 7085 7086 7087 7088 7089 7090
{
	struct net_device *netdev;
	struct ixgbe_adapter *adapter = NULL;
	struct ixgbe_hw *hw;
	const struct ixgbe_info *ii = ixgbe_info_tbl[ent->driver_data];
	static int cards_found;
	int i, err, pci_using_dac;
7091
	u8 part_str[IXGBE_PBANUM_LENGTH];
7092
	unsigned int indices = num_possible_cpus();
7093
	unsigned int dcb_max = 0;
7094 7095 7096
#ifdef IXGBE_FCOE
	u16 device_caps;
#endif
7097
	u32 eec;
7098

7099 7100 7101 7102 7103 7104 7105 7106 7107
	/* 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;
	}

7108
	err = pci_enable_device_mem(pdev);
7109 7110 7111
	if (err)
		return err;

7112 7113
	if (!dma_set_mask(&pdev->dev, DMA_BIT_MASK(64)) &&
	    !dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(64))) {
7114 7115
		pci_using_dac = 1;
	} else {
7116
		err = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32));
7117
		if (err) {
7118 7119
			err = dma_set_coherent_mask(&pdev->dev,
						    DMA_BIT_MASK(32));
7120
			if (err) {
7121 7122
				dev_err(&pdev->dev,
					"No usable DMA configuration, aborting\n");
7123 7124 7125 7126 7127 7128
				goto err_dma;
			}
		}
		pci_using_dac = 0;
	}

7129
	err = pci_request_selected_regions(pdev, pci_select_bars(pdev,
7130
					   IORESOURCE_MEM), ixgbe_driver_name);
7131
	if (err) {
7132 7133
		dev_err(&pdev->dev,
			"pci_request_selected_regions failed 0x%x\n", err);
7134 7135 7136
		goto err_pci_reg;
	}

7137
	pci_enable_pcie_error_reporting(pdev);
7138

7139
	pci_set_master(pdev);
7140
	pci_save_state(pdev);
7141

7142
#ifdef CONFIG_IXGBE_DCB
7143 7144 7145 7146 7147 7148
	if (ii->mac == ixgbe_mac_82598EB)
		dcb_max = min_t(unsigned int, indices * MAX_TRAFFIC_CLASS,
				IXGBE_MAX_RSS_INDICES);
	else
		dcb_max = min_t(unsigned int, indices * MAX_TRAFFIC_CLASS,
				IXGBE_MAX_FDIR_INDICES);
7149 7150
#endif

7151 7152 7153 7154 7155
	if (ii->mac == ixgbe_mac_82598EB)
		indices = min_t(unsigned int, indices, IXGBE_MAX_RSS_INDICES);
	else
		indices = min_t(unsigned int, indices, IXGBE_MAX_FDIR_INDICES);

7156
#ifdef IXGBE_FCOE
7157 7158 7159
	indices += min_t(unsigned int, num_possible_cpus(),
			 IXGBE_MAX_FCOE_INDICES);
#endif
7160
	indices = max_t(unsigned int, dcb_max, indices);
7161
	netdev = alloc_etherdev_mq(sizeof(struct ixgbe_adapter), indices);
7162 7163 7164 7165 7166 7167 7168 7169
	if (!netdev) {
		err = -ENOMEM;
		goto err_alloc_etherdev;
	}

	SET_NETDEV_DEV(netdev, &pdev->dev);

	adapter = netdev_priv(netdev);
7170
	pci_set_drvdata(pdev, adapter);
7171 7172 7173 7174 7175

	adapter->netdev = netdev;
	adapter->pdev = pdev;
	hw = &adapter->hw;
	hw->back = adapter;
7176
	adapter->msg_enable = netif_msg_init(debug, DEFAULT_MSG_ENABLE);
7177

7178
	hw->hw_addr = ioremap(pci_resource_start(pdev, 0),
7179
			      pci_resource_len(pdev, 0));
7180 7181 7182 7183 7184
	if (!hw->hw_addr) {
		err = -EIO;
		goto err_ioremap;
	}

7185
	netdev->netdev_ops = &ixgbe_netdev_ops;
7186 7187
	ixgbe_set_ethtool_ops(netdev);
	netdev->watchdog_timeo = 5 * HZ;
7188
	strncpy(netdev->name, pci_name(pdev), sizeof(netdev->name) - 1);
7189 7190 7191 7192 7193

	adapter->bd_number = cards_found;

	/* Setup hw api */
	memcpy(&hw->mac.ops, ii->mac_ops, sizeof(hw->mac.ops));
7194
	hw->mac.type  = ii->mac;
7195

7196 7197 7198 7199 7200 7201 7202 7203 7204
	/* EEPROM */
	memcpy(&hw->eeprom.ops, ii->eeprom_ops, sizeof(hw->eeprom.ops));
	eec = IXGBE_READ_REG(hw, IXGBE_EEC);
	/* If EEPROM is valid (bit 8 = 1), use default otherwise use bit bang */
	if (!(eec & (1 << 8)))
		hw->eeprom.ops.read = &ixgbe_read_eeprom_bit_bang_generic;

	/* PHY */
	memcpy(&hw->phy.ops, ii->phy_ops, sizeof(hw->phy.ops));
D
Donald Skidmore 已提交
7205
	hw->phy.sfp_type = ixgbe_sfp_type_unknown;
7206 7207 7208 7209 7210 7211 7212
	/* 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 已提交
7213

7214
	ii->get_invariants(hw);
7215 7216 7217 7218 7219 7220

	/* setup the private structure */
	err = ixgbe_sw_init(adapter);
	if (err)
		goto err_sw_init;

7221
	/* Make it possible the adapter to be woken up via WOL */
D
Don Skidmore 已提交
7222 7223 7224
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
7225
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
D
Don Skidmore 已提交
7226 7227 7228 7229
		break;
	default:
		break;
	}
7230

7231 7232 7233 7234 7235 7236 7237
	/*
	 * 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)
7238
			e_crit(probe, "Fan has stopped, replace the adapter\n");
7239 7240
	}

7241 7242 7243
	if (allow_unsupported_sfp)
		hw->allow_unsupported_sfp = allow_unsupported_sfp;

7244
	/* reset_hw fills in the perm_addr as well */
7245
	hw->phy.reset_if_overtemp = true;
7246
	err = hw->mac.ops.reset_hw(hw);
7247
	hw->phy.reset_if_overtemp = false;
7248 7249 7250 7251
	if (err == IXGBE_ERR_SFP_NOT_PRESENT &&
	    hw->mac.type == ixgbe_mac_82598EB) {
		err = 0;
	} else if (err == IXGBE_ERR_SFP_NOT_SUPPORTED) {
7252
		e_dev_err("failed to load because an unsupported SFP+ "
7253 7254 7255
			  "module type was detected.\n");
		e_dev_err("Reload the driver after installing a supported "
			  "module.\n");
7256 7257
		goto err_sw_init;
	} else if (err) {
7258
		e_dev_err("HW Init failed: %d\n", err);
7259 7260 7261
		goto err_sw_init;
	}

7262 7263
#ifdef CONFIG_PCI_IOV
	ixgbe_enable_sriov(adapter, ii);
7264

7265
#endif
7266
	netdev->features = NETIF_F_SG |
7267
			   NETIF_F_IP_CSUM |
7268
			   NETIF_F_IPV6_CSUM |
7269 7270
			   NETIF_F_HW_VLAN_TX |
			   NETIF_F_HW_VLAN_RX |
7271 7272 7273 7274 7275
			   NETIF_F_HW_VLAN_FILTER |
			   NETIF_F_TSO |
			   NETIF_F_TSO6 |
			   NETIF_F_RXHASH |
			   NETIF_F_RXCSUM;
7276

7277
	netdev->hw_features = netdev->features;
7278

7279 7280 7281
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
7282
		netdev->features |= NETIF_F_SCTP_CSUM;
7283 7284
		netdev->hw_features |= NETIF_F_SCTP_CSUM |
				       NETIF_F_NTUPLE;
7285 7286 7287 7288
		break;
	default:
		break;
	}
7289

B
Ben Greear 已提交
7290 7291
	netdev->hw_features |= NETIF_F_RXALL;

7292 7293
	netdev->vlan_features |= NETIF_F_TSO;
	netdev->vlan_features |= NETIF_F_TSO6;
7294
	netdev->vlan_features |= NETIF_F_IP_CSUM;
7295
	netdev->vlan_features |= NETIF_F_IPV6_CSUM;
7296 7297
	netdev->vlan_features |= NETIF_F_SG;

7298
	netdev->priv_flags |= IFF_UNICAST_FLT;
7299
	netdev->priv_flags |= IFF_SUPP_NOFCS;
7300

J
Jeff Kirsher 已提交
7301
#ifdef CONFIG_IXGBE_DCB
7302 7303 7304
	netdev->dcbnl_ops = &dcbnl_ops;
#endif

7305
#ifdef IXGBE_FCOE
7306
	if (adapter->flags & IXGBE_FLAG_FCOE_CAPABLE) {
7307 7308
		if (hw->mac.ops.get_device_caps) {
			hw->mac.ops.get_device_caps(hw, &device_caps);
7309 7310
			if (device_caps & IXGBE_DEVICE_CAPS_FCOE_OFFLOADS)
				adapter->flags &= ~IXGBE_FLAG_FCOE_CAPABLE;
7311
		}
7312 7313 7314

		adapter->ring_feature[RING_F_FCOE].limit = IXGBE_FCRETA_SIZE;

7315 7316 7317
		netdev->features |= NETIF_F_FSO |
				    NETIF_F_FCOE_CRC;

7318 7319 7320
		netdev->vlan_features |= NETIF_F_FSO |
					 NETIF_F_FCOE_CRC |
					 NETIF_F_FCOE_MTU;
7321
	}
7322
#endif /* IXGBE_FCOE */
7323
	if (pci_using_dac) {
7324
		netdev->features |= NETIF_F_HIGHDMA;
7325 7326
		netdev->vlan_features |= NETIF_F_HIGHDMA;
	}
7327

7328 7329
	if (adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE)
		netdev->hw_features |= NETIF_F_LRO;
7330
	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
A
Alexander Duyck 已提交
7331 7332
		netdev->features |= NETIF_F_LRO;

7333
	/* make sure the EEPROM is good */
7334
	if (hw->eeprom.ops.validate_checksum(hw, NULL) < 0) {
7335
		e_dev_err("The EEPROM Checksum Is Not Valid\n");
7336
		err = -EIO;
7337
		goto err_sw_init;
7338 7339 7340 7341 7342
	}

	memcpy(netdev->dev_addr, hw->mac.perm_addr, netdev->addr_len);
	memcpy(netdev->perm_addr, hw->mac.perm_addr, netdev->addr_len);

7343
	if (ixgbe_validate_mac_addr(netdev->perm_addr)) {
7344
		e_dev_err("invalid MAC address\n");
7345
		err = -EIO;
7346
		goto err_sw_init;
7347 7348
	}

7349
	setup_timer(&adapter->service_timer, &ixgbe_service_timer,
A
Alexander Duyck 已提交
7350
		    (unsigned long) adapter);
7351

7352 7353
	INIT_WORK(&adapter->service_task, ixgbe_service_task);
	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
7354

7355 7356 7357
	err = ixgbe_init_interrupt_scheme(adapter);
	if (err)
		goto err_sw_init;
7358

7359
	/* WOL not supported for all devices */
E
Emil Tantilov 已提交
7360
	adapter->wol = 0;
7361 7362
	hw->eeprom.ops.read(hw, 0x2c, &adapter->eeprom_cap);
	if (ixgbe_wol_supported(adapter, pdev->device, pdev->subsystem_device))
7363
		adapter->wol = IXGBE_WUFC_MAG;
E
Emil Tantilov 已提交
7364

7365 7366
	device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);

7367 7368 7369 7370
#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_init(adapter);
#endif /* CONFIG_IXGBE_PTP*/

7371 7372 7373 7374
	/* save off EEPROM version number */
	hw->eeprom.ops.read(hw, 0x2e, &adapter->eeprom_verh);
	hw->eeprom.ops.read(hw, 0x2d, &adapter->eeprom_verl);

7375 7376 7377
	/* pick up the PCI bus settings for reporting later */
	hw->mac.ops.get_bus_info(hw);

7378
	/* print bus type/speed/width info */
7379
	e_dev_info("(PCI Express:%s:%s) %pM\n",
7380 7381
		   (hw->bus.speed == ixgbe_bus_speed_5000 ? "5.0GT/s" :
		    hw->bus.speed == ixgbe_bus_speed_2500 ? "2.5GT/s" :
7382 7383 7384 7385 7386 7387
		    "Unknown"),
		   (hw->bus.width == ixgbe_bus_width_pcie_x8 ? "Width x8" :
		    hw->bus.width == ixgbe_bus_width_pcie_x4 ? "Width x4" :
		    hw->bus.width == ixgbe_bus_width_pcie_x1 ? "Width x1" :
		    "Unknown"),
		   netdev->dev_addr);
7388 7389 7390

	err = ixgbe_read_pba_string_generic(hw, part_str, IXGBE_PBANUM_LENGTH);
	if (err)
7391
		strncpy(part_str, "Unknown", IXGBE_PBANUM_LENGTH);
7392
	if (ixgbe_is_sfp(hw) && hw->phy.sfp_type != ixgbe_sfp_type_not_present)
7393
		e_dev_info("MAC: %d, PHY: %d, SFP+: %d, PBA No: %s\n",
7394
			   hw->mac.type, hw->phy.type, hw->phy.sfp_type,
7395
		           part_str);
7396
	else
7397 7398
		e_dev_info("MAC: %d, PHY: %d, PBA No: %s\n",
			   hw->mac.type, hw->phy.type, part_str);
7399

7400
	if (hw->bus.width <= ixgbe_bus_width_pcie_x4) {
7401 7402 7403 7404
		e_dev_warn("PCI-Express bandwidth available for this card is "
			   "not sufficient for optimal performance.\n");
		e_dev_warn("For optimal performance a x8 PCI-Express slot "
			   "is required.\n");
7405 7406
	}

7407
	/* reset the hardware with the new settings */
7408 7409 7410
	err = hw->mac.ops.start_hw(hw);
	if (err == IXGBE_ERR_EEPROM_VERSION) {
		/* We are running on a pre-production device, log a warning */
7411 7412 7413 7414 7415 7416
		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");
7417
	}
7418 7419 7420 7421 7422
	strcpy(netdev->name, "eth%d");
	err = register_netdev(netdev);
	if (err)
		goto err_register;

7423 7424 7425 7426 7427 7428 7429
	/* power down the optics for multispeed fiber and 82599 SFP+ fiber */
	if (hw->mac.ops.disable_tx_laser &&
	    ((hw->phy.multispeed_fiber) ||
	     ((hw->mac.ops.get_media_type(hw) == ixgbe_media_type_fiber) &&
	      (hw->mac.type == ixgbe_mac_82599EB))))
		hw->mac.ops.disable_tx_laser(hw);

7430 7431 7432
	/* carrier off reporting is important to ethtool even BEFORE open */
	netif_carrier_off(netdev);

7433
#ifdef CONFIG_IXGBE_DCA
7434
	if (dca_add_requester(&pdev->dev) == 0) {
7435 7436 7437 7438
		adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
		ixgbe_setup_dca(adapter);
	}
#endif
7439
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
7440
		e_info(probe, "IOV is enabled with %d VFs\n", adapter->num_vfs);
7441 7442 7443 7444
		for (i = 0; i < adapter->num_vfs; i++)
			ixgbe_vf_configuration(pdev, (i | 0x10000000));
	}

7445 7446 7447
	/* firmware requires driver version to be 0xFFFFFFFF
	 * since os does not support feature
	 */
E
Emil Tantilov 已提交
7448
	if (hw->mac.ops.set_fw_drv_ver)
7449 7450
		hw->mac.ops.set_fw_drv_ver(hw, 0xFF, 0xFF, 0xFF,
					   0xFF);
E
Emil Tantilov 已提交
7451

7452 7453
	/* add san mac addr to netdev */
	ixgbe_add_sanmac_netdev(netdev);
7454

7455
	e_dev_info("%s\n", ixgbe_default_device_descr);
7456
	cards_found++;
7457

7458
#ifdef CONFIG_IXGBE_HWMON
7459 7460
	if (ixgbe_sysfs_init(adapter))
		e_err(probe, "failed to allocate sysfs resources\n");
7461
#endif /* CONFIG_IXGBE_HWMON */
7462

C
Catherine Sullivan 已提交
7463 7464 7465 7466
#ifdef CONFIG_DEBUG_FS
	ixgbe_dbg_adapter_init(adapter);
#endif /* CONFIG_DEBUG_FS */

7467 7468 7469
	return 0;

err_register:
7470
	ixgbe_release_hw_control(adapter);
7471
	ixgbe_clear_interrupt_scheme(adapter);
7472
err_sw_init:
7473
	ixgbe_disable_sriov(adapter);
7474
	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
7475 7476 7477 7478
	iounmap(hw->hw_addr);
err_ioremap:
	free_netdev(netdev);
err_alloc_etherdev:
7479 7480
	pci_release_selected_regions(pdev,
				     pci_select_bars(pdev, IORESOURCE_MEM));
7481 7482 7483 7484 7485 7486 7487 7488 7489 7490 7491 7492 7493 7494 7495 7496 7497
err_pci_reg:
err_dma:
	pci_disable_device(pdev);
	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.
 **/
static void __devexit ixgbe_remove(struct pci_dev *pdev)
{
7498 7499
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
7500

C
Catherine Sullivan 已提交
7501 7502 7503 7504
#ifdef CONFIG_DEBUG_FS
	ixgbe_dbg_adapter_exit(adapter);
#endif /*CONFIG_DEBUG_FS */

7505
	set_bit(__IXGBE_DOWN, &adapter->state);
7506
	cancel_work_sync(&adapter->service_task);
7507

7508 7509 7510 7511
#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_stop(adapter);
#endif

7512
#ifdef CONFIG_IXGBE_DCA
7513 7514 7515 7516 7517 7518 7519
	if (adapter->flags & IXGBE_FLAG_DCA_ENABLED) {
		adapter->flags &= ~IXGBE_FLAG_DCA_ENABLED;
		dca_remove_requester(&pdev->dev);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DCA_CTRL, 1);
	}

#endif
7520
#ifdef CONFIG_IXGBE_HWMON
7521
	ixgbe_sysfs_exit(adapter);
7522
#endif /* CONFIG_IXGBE_HWMON */
7523

7524 7525 7526
	/* remove the added san mac */
	ixgbe_del_sanmac_netdev(netdev);

D
Donald Skidmore 已提交
7527 7528
	if (netdev->reg_state == NETREG_REGISTERED)
		unregister_netdev(netdev);
7529

7530
	ixgbe_disable_sriov(adapter);
7531

7532
	ixgbe_clear_interrupt_scheme(adapter);
7533

7534
	ixgbe_release_hw_control(adapter);
7535

7536 7537 7538 7539 7540
#ifdef CONFIG_DCB
	kfree(adapter->ixgbe_ieee_pfc);
	kfree(adapter->ixgbe_ieee_ets);

#endif
7541
	iounmap(adapter->hw.hw_addr);
7542
	pci_release_selected_regions(pdev, pci_select_bars(pdev,
7543
				     IORESOURCE_MEM));
7544

7545
	e_dev_info("complete\n");
7546

7547 7548
	free_netdev(netdev);

7549
	pci_disable_pcie_error_reporting(pdev);
7550

7551 7552 7553 7554 7555 7556 7557 7558 7559 7560 7561 7562
	pci_disable_device(pdev);
}

/**
 * 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,
7563
						pci_channel_state_t state)
7564
{
7565 7566
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
7567

7568 7569 7570 7571 7572 7573 7574 7575 7576 7577 7578
#ifdef CONFIG_PCI_IOV
	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;
7579
	while (bdev && (pci_pcie_type(bdev) != PCI_EXP_TYPE_ROOT_PORT))
7580 7581 7582 7583 7584 7585 7586 7587 7588 7589 7590 7591 7592 7593 7594 7595 7596 7597 7598 7599 7600 7601 7602 7603 7604 7605 7606 7607 7608 7609 7610 7611 7612 7613 7614 7615 7616 7617 7618 7619 7620
		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;

	pci_read_config_dword(bdev, pos + PCI_ERR_HEADER_LOG, &dw0);
	pci_read_config_dword(bdev, pos + PCI_ERR_HEADER_LOG + 4, &dw1);
	pci_read_config_dword(bdev, pos + PCI_ERR_HEADER_LOG + 8, &dw2);
	pci_read_config_dword(bdev, pos + PCI_ERR_HEADER_LOG + 12, &dw3);

	req_id = dw1 >> 16;
	/* On the 82599 if bit 7 of the requestor ID is set then it's a VF */
	if (!(req_id & 0x0080))
		goto skip_bad_vf_detection;

	pf_func = req_id & 0x01;
	if ((pf_func & 1) == (pdev->devfn & 1)) {
		unsigned int device_id;

		vf = (req_id & 0x7F) >> 1;
		e_dev_err("VF %d has caused a PCIe error\n", vf);
		e_dev_err("TLP: dw0: %8.8x\tdw1: %8.8x\tdw2: "
				"%8.8x\tdw3: %8.8x\n",
		dw0, dw1, dw2, dw3);
		switch (adapter->hw.mac.type) {
		case ixgbe_mac_82599EB:
			device_id = IXGBE_82599_VF_DEVICE_ID;
			break;
		case ixgbe_mac_X540:
			device_id = IXGBE_X540_VF_DEVICE_ID;
			break;
		default:
			device_id = 0;
			break;
		}

		/* Find the pci device of the offending VF */
J
Jon Mason 已提交
7621
		vfdev = pci_get_device(PCI_VENDOR_ID_INTEL, device_id, NULL);
7622 7623 7624
		while (vfdev) {
			if (vfdev->devfn == (req_id & 0xFF))
				break;
J
Jon Mason 已提交
7625
			vfdev = pci_get_device(PCI_VENDOR_ID_INTEL,
7626 7627 7628 7629 7630 7631 7632 7633 7634 7635 7636 7637 7638 7639 7640 7641 7642 7643 7644 7645 7646 7647 7648 7649 7650 7651 7652
					       device_id, vfdev);
		}
		/*
		 * There's a slim chance the VF could have been hot plugged,
		 * so if it is no longer present we don't need to issue the
		 * VFLR.  Just clean up the AER in that case.
		 */
		if (vfdev) {
			e_dev_err("Issuing VFLR to VF %d\n", vf);
			pci_write_config_dword(vfdev, 0xA8, 0x00008000);
		}

		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 */
7653 7654
	netif_device_detach(netdev);

7655 7656 7657
	if (state == pci_channel_io_perm_failure)
		return PCI_ERS_RESULT_DISCONNECT;

7658 7659 7660 7661
	if (netif_running(netdev))
		ixgbe_down(adapter);
	pci_disable_device(pdev);

7662
	/* Request a slot reset. */
7663 7664 7665 7666 7667 7668 7669 7670 7671 7672 7673
	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)
{
7674
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
7675 7676
	pci_ers_result_t result;
	int err;
7677

7678
	if (pci_enable_device_mem(pdev)) {
7679
		e_err(probe, "Cannot re-enable PCI device after reset.\n");
7680 7681 7682 7683
		result = PCI_ERS_RESULT_DISCONNECT;
	} else {
		pci_set_master(pdev);
		pci_restore_state(pdev);
7684
		pci_save_state(pdev);
7685

7686
		pci_wake_from_d3(pdev, false);
7687

7688
		ixgbe_reset(adapter);
7689
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
7690 7691 7692 7693 7694
		result = PCI_ERS_RESULT_RECOVERED;
	}

	err = pci_cleanup_aer_uncorrect_error_status(pdev);
	if (err) {
7695 7696
		e_dev_err("pci_cleanup_aer_uncorrect_error_status "
			  "failed 0x%0x\n", err);
7697 7698
		/* non-fatal, continue */
	}
7699

7700
	return result;
7701 7702 7703 7704 7705 7706 7707 7708 7709 7710 7711
}

/**
 * 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)
{
7712 7713
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
7714

7715 7716 7717 7718 7719 7720 7721 7722
#ifdef CONFIG_PCI_IOV
	if (adapter->vferr_refcount) {
		e_info(drv, "Resuming after VF err\n");
		adapter->vferr_refcount--;
		return;
	}

#endif
7723 7724
	if (netif_running(netdev))
		ixgbe_up(adapter);
7725 7726 7727 7728

	netif_device_attach(netdev);
}

7729
static const struct pci_error_handlers ixgbe_err_handler = {
7730 7731 7732 7733 7734 7735 7736 7737 7738 7739 7740 7741 7742 7743 7744 7745 7746 7747 7748 7749 7750 7751 7752 7753 7754 7755 7756
	.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,
	.remove   = __devexit_p(ixgbe_remove),
#ifdef CONFIG_PM
	.suspend  = ixgbe_suspend,
	.resume   = ixgbe_resume,
#endif
	.shutdown = ixgbe_shutdown,
	.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;
7757
	pr_info("%s - version %s\n", ixgbe_driver_string, ixgbe_driver_version);
7758
	pr_info("%s\n", ixgbe_copyright);
7759

C
Catherine Sullivan 已提交
7760 7761 7762 7763
#ifdef CONFIG_DEBUG_FS
	ixgbe_dbg_init();
#endif /* CONFIG_DEBUG_FS */

7764
#ifdef CONFIG_IXGBE_DCA
7765 7766
	dca_register_notify(&dca_notifier);
#endif
7767

7768 7769 7770
	ret = pci_register_driver(&ixgbe_driver);
	return ret;
}
7771

7772 7773 7774 7775 7776 7777 7778 7779 7780 7781
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)
{
7782
#ifdef CONFIG_IXGBE_DCA
7783 7784
	dca_unregister_notify(&dca_notifier);
#endif
7785
	pci_unregister_driver(&ixgbe_driver);
C
Catherine Sullivan 已提交
7786 7787 7788 7789 7790

#ifdef CONFIG_DEBUG_FS
	ixgbe_dbg_exit();
#endif /* CONFIG_DEBUG_FS */

E
Eric Dumazet 已提交
7791
	rcu_barrier(); /* Wait for completion of call_rcu()'s */
7792
}
7793

7794
#ifdef CONFIG_IXGBE_DCA
7795
static int ixgbe_notify_dca(struct notifier_block *nb, unsigned long event,
7796
			    void *p)
7797 7798 7799 7800
{
	int ret_val;

	ret_val = driver_for_each_device(&ixgbe_driver.driver, NULL, &event,
7801
					 __ixgbe_notify_dca);
7802 7803 7804

	return ret_val ? NOTIFY_BAD : NOTIFY_DONE;
}
7805

7806
#endif /* CONFIG_IXGBE_DCA */
7807

7808 7809 7810
module_exit(ixgbe_exit_module);

/* ixgbe_main.c */