ixgbe_main.c 210.6 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 118 119 120 121
	/* required last entry */
	{0, }
};
MODULE_DEVICE_TABLE(pci, ixgbe_pci_tbl);

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

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

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

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

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

154 155 156 157 158 159 160 161 162 163 164
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 已提交
165
	/* flush memory to make sure state is correct before next watchdog */
166 167 168 169
	smp_mb__before_clear_bit();
	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
}

170 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
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:
275
		pr_info("%-15s %08x\n", reginfo->name,
276 277 278 279 280 281
			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);
282
		pr_err("%-15s", rname);
283
		for (j = 0; j < 8; j++)
284 285
			pr_cont(" %08x", regs[i*8+j]);
		pr_cont("\n");
286 287 288 289 290 291 292 293 294 295 296 297 298 299
	}

}

/*
 * 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;
300
	struct ixgbe_tx_buffer *tx_buffer;
301 302 303 304 305 306 307 308 309 310 311 312 313 314
	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");
315
		pr_info("Device Name     state            "
316
			"trans_start      last_rx\n");
317 318 319 320 321
		pr_info("%-15s %016lX %016lX %016lX\n",
			netdev->name,
			netdev->state,
			netdev->trans_start,
			netdev->last_rx);
322 323 324 325
	}

	/* Print Registers */
	dev_info(&adapter->pdev->dev, "Register Dump\n");
326
	pr_info(" Register Name   Value\n");
327 328 329 330 331 332 333 334 335 336
	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");
337
	pr_info("Queue [NTU] [NTC] [bi(ntc)->dma  ] leng ntw timestamp\n");
338 339
	for (n = 0; n < adapter->num_tx_queues; n++) {
		tx_ring = adapter->tx_ring[n];
340
		tx_buffer = &tx_ring->tx_buffer_info[tx_ring->next_to_clean];
341
		pr_info(" %5d %5X %5X %016llX %04X %p %016llX\n",
342
			   n, tx_ring->next_to_use, tx_ring->next_to_clean,
343 344 345 346
			   (u64)dma_unmap_addr(tx_buffer, dma),
			   dma_unmap_len(tx_buffer, len),
			   tx_buffer->next_to_watch,
			   (u64)tx_buffer->time_stamp);
347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367
	}

	/* 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];
368 369 370 371
		pr_info("------------------------------------\n");
		pr_info("TX QUEUE INDEX = %d\n", tx_ring->queue_index);
		pr_info("------------------------------------\n");
		pr_info("T [desc]     [address 63:0  ] "
372 373 374 375
			"[PlPOIdStDDt Ln] [bi->dma       ] "
			"leng  ntw timestamp        bi->skb\n");

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

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

	/* Print RX Rings Summary */
rx_ring_summary:
	dev_info(&adapter->pdev->dev, "RX Rings Summary\n");
411
	pr_info("Queue [NTU] [NTC]\n");
412 413
	for (n = 0; n < adapter->num_rx_queues; n++) {
		rx_ring = adapter->rx_ring[n];
414 415
		pr_info("%5d %5X %5X\n",
			n, rx_ring->next_to_use, rx_ring->next_to_clean);
416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445
	}

	/* 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];
446 447 448 449
		pr_info("------------------------------------\n");
		pr_info("RX QUEUE INDEX = %d\n", rx_ring->queue_index);
		pr_info("------------------------------------\n");
		pr_info("R  [desc]      [ PktBuf     A0] "
450 451
			"[  HeadBuf   DD] [bi->dma       ] [bi->skb] "
			"<-- Adv Rx Read format\n");
452
		pr_info("RWB[desc]      [PcsmIpSHl PtRs] "
453 454 455 456 457
			"[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];
458
			rx_desc = IXGBE_RX_DESC(rx_ring, i);
459 460 461 462
			u0 = (struct my_u0 *)rx_desc;
			staterr = le32_to_cpu(rx_desc->wb.upper.status_error);
			if (staterr & IXGBE_RXD_STAT_DD) {
				/* Descriptor Done */
463
				pr_info("RWB[0x%03X]     %016llX "
464 465 466 467 468
					"%016llX ---------------- %p", i,
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
					rx_buffer_info->skb);
			} else {
469
				pr_info("R  [0x%03X]     %016llX "
470 471 472 473 474 475
					"%016llX %016llX %p", i,
					le64_to_cpu(u0->a),
					le64_to_cpu(u0->b),
					(u64)rx_buffer_info->dma,
					rx_buffer_info->skb);

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

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

		}
	}

exit:
	return;
}

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

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

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

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

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

592 593
void ixgbe_unmap_and_free_tx_resource(struct ixgbe_ring *ring,
				      struct ixgbe_tx_buffer *tx_buffer)
594
{
595 596 597
	if (tx_buffer->skb) {
		dev_kfree_skb_any(tx_buffer->skb);
		if (dma_unmap_len(tx_buffer, len))
598
			dma_unmap_single(ring->dev,
599 600 601 602 603 604 605 606
					 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);
607
	}
608 609 610 611
	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 */
612 613
}

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

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

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

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

	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);
656
		return;
657
	}
658 659 660 661 662 663

	/* 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));
664
			break;
665 666
		default:
			xoff[i] = IXGBE_READ_REG(hw, IXGBE_PXOFFRXCNT(i));
667
		}
668 669 670 671 672 673
		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];
674
		u8 tc = tx_ring->dcb_tc;
675 676 677

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

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

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

691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707
	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 已提交
708
	clear_check_for_tx_hang(tx_ring);
709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730

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

733
	return ret;
734 735
}

736 737 738 739 740 741 742 743 744 745 746 747 748
/**
 * 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);
	}
}
749

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

858 859 860 861 862 863 864 865 866 867 868 869 870 871
	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)),
872 873
			tx_ring->next_to_use, i,
			tx_ring->tx_buffer_info[i].time_stamp, jiffies);
874 875 876 877 878 879 880

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

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

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

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

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

907
	return !!budget;
908 909
}

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

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

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

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

953 954 955

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

	/*
	 * 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);
973 974 975 976 977
}

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

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

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

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

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

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

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

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

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

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

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

1019 1020
	switch (event) {
	case DCA_PROVIDER_ADD:
1021 1022 1023
		/* if we're already enabled, don't do it again */
		if (adapter->flags & IXGBE_FLAG_DCA_ENABLED)
			break;
1024
		if (dca_add_requester(dev) == 0) {
1025
			adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038
			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;
	}

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

1153 1154 1155 1156 1157 1158 1159 1160 1161
	/* 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)) {
1162
		__free_pages(page, ixgbe_rx_pg_order(rx_ring));
1163
		bi->page = NULL;
1164 1165 1166 1167 1168

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

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

1172 1173 1174
	return true;
}

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

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

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

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

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

1204 1205
		rx_desc++;
		bi++;
1206
		i++;
1207
		if (unlikely(!i)) {
1208
			rx_desc = IXGBE_RX_DESC(rx_ring, 0);
1209 1210 1211 1212 1213 1214
			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;
1215 1216 1217

		cleaned_count--;
	} while (cleaned_count);
1218

1219 1220
	i += rx_ring->count;

1221
	if (rx_ring->next_to_use != i)
1222
		ixgbe_release_rx_desc(rx_ring, i);
1223 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
/**
 * 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;
1286
#ifdef IXGBE_FCOE
1287 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
	} 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;
}

A
Alexander Duyck 已提交
1323 1324 1325
static void ixgbe_get_rsc_cnt(struct ixgbe_ring *rx_ring,
			      union ixgbe_adv_rx_desc *rx_desc,
			      struct sk_buff *skb)
1326
{
A
Alexander Duyck 已提交
1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343
	__le32 rsc_enabled;
	u32 rsc_cnt;

	if (!ring_is_rsc_enabled(rx_ring))
		return;

	rsc_enabled = rx_desc->wb.lower.lo_dword.data &
		      cpu_to_le32(IXGBE_RXDADV_RSCCNT_MASK);

	/* If this is an RSC frame rsc_cnt should be non-zero */
	if (!rsc_enabled)
		return;

	rsc_cnt = le32_to_cpu(rsc_enabled);
	rsc_cnt >>= IXGBE_RXDADV_RSCCNT_SHIFT;

	IXGBE_CB(skb)->append_cnt += rsc_cnt - 1;
1344
}
1345

1346 1347 1348
static void ixgbe_set_rsc_gso_size(struct ixgbe_ring *ring,
				   struct sk_buff *skb)
{
1349
	u16 hdr_len = skb_headlen(skb);
1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371

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

1372 1373 1374 1375 1376
/**
 * 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 已提交
1377
 *
1378 1379 1380
 * 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 已提交
1381
 **/
1382 1383 1384
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 已提交
1385
{
1386 1387
	struct net_device *dev = rx_ring->netdev;

1388 1389 1390
	ixgbe_update_rsc_stats(rx_ring, skb);

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

1392 1393
	ixgbe_rx_checksum(rx_ring, rx_desc, skb);

1394
#ifdef CONFIG_IXGBE_PTP
1395
	ixgbe_ptp_rx_hwtstamp(rx_ring->q_vector, rx_desc, skb);
1396 1397
#endif

1398 1399
	if ((dev->features & NETIF_F_HW_VLAN_RX) &&
	    ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_VP)) {
1400 1401
		u16 vid = le16_to_cpu(rx_desc->wb.upper.vlan);
		__vlan_hwaccel_put_tag(skb, vid);
A
Alexander Duyck 已提交
1402 1403
	}

1404
	skb_record_rx_queue(skb, rx_ring->queue_index);
1405

1406
	skb->protocol = eth_type_trans(skb, dev);
A
Alexander Duyck 已提交
1407 1408
}

1409 1410
static void ixgbe_rx_skb(struct ixgbe_q_vector *q_vector,
			 struct sk_buff *skb)
1411
{
1412 1413 1414 1415 1416 1417
	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);
1418
}
1419

1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459
/**
 * 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));

	if (likely(ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP)))
		return false;

	/* append_cnt indicates packet is RSC, if so fetch nextp */
	if (IXGBE_CB(skb)->append_cnt) {
		ntc = le32_to_cpu(rx_desc->wb.upper.status_error);
		ntc &= IXGBE_RXDADV_NEXTP_MASK;
		ntc >>= IXGBE_RXDADV_NEXTP_SHIFT;
	}

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

1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489
/**
 * 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;
}

1490 1491 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 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536
/**
 * 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 skb_frag_struct *frag = &skb_shinfo(skb)->frags[0];
	struct net_device *netdev = rx_ring->netdev;
	unsigned char *va;
	unsigned int pull_len;

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

	/*
	 * 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.
	 */
	pull_len = skb_frag_size(frag);
1537 1538
	if (pull_len > IXGBE_RX_HDR_SIZE)
		pull_len = ixgbe_get_headlen(va, IXGBE_RX_HDR_SIZE);
1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559

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

	/*
	 * if we sucked the frag empty then we should free it,
	 * if there are other frags here something is screwed up in hardware
	 */
	if (skb_frag_size(frag) == 0) {
		BUG_ON(skb_shinfo(skb)->nr_frags != 1);
		skb_shinfo(skb)->nr_frags = 0;
		__skb_frag_unref(frag);
		skb->truesize -= ixgbe_rx_bufsz(rx_ring);
	}

1560 1561 1562 1563 1564 1565
#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
1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582
	/* 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
 *
1583
 * Synchronizes page for reuse by the adapter
1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599
 **/
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;
1600
	new_buff->page_offset = old_buff->page_offset;
1601 1602 1603

	/* sync the buffer for use by the device */
	dma_sync_single_range_for_device(rx_ring->dev, new_buff->dma,
1604 1605
					 new_buff->page_offset,
					 ixgbe_rx_bufsz(rx_ring),
1606 1607 1608 1609 1610 1611 1612 1613 1614 1615
					 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
 *
1616 1617 1618 1619 1620 1621 1622
 * 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.
1623
 **/
1624
static bool ixgbe_add_rx_frag(struct ixgbe_ring *rx_ring,
1625
			      struct ixgbe_rx_buffer *rx_buffer,
1626 1627
			      union ixgbe_adv_rx_desc *rx_desc,
			      struct sk_buff *skb)
1628
{
1629 1630
	struct page *page = rx_buffer->page;
	unsigned int size = le16_to_cpu(rx_desc->wb.upper.length);
1631
#if (PAGE_SIZE < 8192)
1632
	unsigned int truesize = ixgbe_rx_bufsz(rx_ring);
1633 1634 1635 1636 1637
#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
1638 1639 1640 1641

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

1642 1643 1644 1645 1646 1647 1648
	/* 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))
1649 1650 1651 1652 1653
		return false;

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

1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666
	/*
	 * 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;

1667 1668
	/* bump ref count on page before it is given to the stack */
	get_page(page);
1669
#endif
1670 1671

	return true;
1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686
}

/**
 * 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
 **/
1687
static bool ixgbe_clean_rx_irq(struct ixgbe_q_vector *q_vector,
1688
			       struct ixgbe_ring *rx_ring,
1689
			       int budget)
1690
{
1691
	unsigned int total_rx_bytes = 0, total_rx_packets = 0;
B
Ben Greear 已提交
1692
#ifdef IXGBE_FCOE
1693
	struct ixgbe_adapter *adapter = q_vector->adapter;
1694 1695
	int ddp_bytes = 0;
#endif /* IXGBE_FCOE */
1696
	u16 cleaned_count = ixgbe_desc_unused(rx_ring);
1697

1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716
	do {
		struct ixgbe_rx_buffer *rx_buffer;
		union ixgbe_adv_rx_desc *rx_desc;
		struct sk_buff *skb;
		struct page *page;
		u16 ntc;

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

		ntc = rx_ring->next_to_clean;
		rx_desc = IXGBE_RX_DESC(rx_ring, ntc);
		rx_buffer = &rx_ring->rx_buffer_info[ntc];

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

1718 1719 1720 1721 1722 1723
		/*
		 * 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();
1724

1725 1726
		page = rx_buffer->page;
		prefetchw(page);
1727

1728
		skb = rx_buffer->skb;
1729

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

1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745
			/* 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++;
				break;
1746 1747
			}

1748 1749 1750 1751 1752 1753
			/*
			 * 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);
A
Alexander Duyck 已提交
1754 1755 1756 1757

			/*
			 * Delay unmapping of the first packet. It carries the
			 * header information, HW may still access the header
1758 1759
			 * after the writeback.  Only unmap it when EOP is
			 * reached
A
Alexander Duyck 已提交
1760
			 */
1761 1762 1763 1764
			if (likely(ixgbe_test_staterr(rx_desc,
						      IXGBE_RXD_STAT_EOP)))
				goto dma_sync;

1765
			IXGBE_CB(skb)->dma = rx_buffer->dma;
1766
		} else {
1767 1768 1769 1770
			if (ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP))
				ixgbe_dma_sync_frag(rx_ring, skb);

dma_sync:
1771 1772 1773 1774 1775 1776
			/* 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);
1777 1778
		}

1779
		/* pull page into skb */
1780
		if (ixgbe_add_rx_frag(rx_ring, rx_buffer, rx_desc, skb)) {
1781 1782 1783 1784 1785 1786 1787 1788 1789 1790
			/* 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);
1791 1792
		}

1793 1794 1795 1796
		/* clear contents of buffer_info */
		rx_buffer->skb = NULL;
		rx_buffer->dma = 0;
		rx_buffer->page = NULL;
A
Alexander Duyck 已提交
1797

1798
		ixgbe_get_rsc_cnt(rx_ring, rx_desc, skb);
1799 1800

		cleaned_count++;
A
Alexander Duyck 已提交
1801

1802 1803 1804
		/* place incomplete frames back on ring for completion */
		if (ixgbe_is_non_eop(rx_ring, rx_desc, skb))
			continue;
1805

1806 1807 1808
		/* verify the packet layout is correct */
		if (ixgbe_cleanup_headers(rx_ring, rx_desc, skb))
			continue;
1809

1810 1811 1812 1813
		/* probably a little skewed due to removing CRC */
		total_rx_bytes += skb->len;
		total_rx_packets++;

1814 1815 1816
		/* populate checksum, timestamp, VLAN, and protocol */
		ixgbe_process_skb_fields(rx_ring, rx_desc, skb);

1817 1818
#ifdef IXGBE_FCOE
		/* if ddp, not passing to ULD unless for FCP_RSP or error */
1819
		if (ixgbe_rx_is_fcoe(rx_ring, rx_desc)) {
1820
			ddp_bytes = ixgbe_fcoe_ddp(adapter, rx_desc, skb);
1821 1822
			if (!ddp_bytes) {
				dev_kfree_skb_any(skb);
1823
				continue;
1824
			}
1825
		}
1826

1827
#endif /* IXGBE_FCOE */
1828
		ixgbe_rx_skb(q_vector, skb);
1829

1830
		/* update budget accounting */
1831
		budget--;
1832
	} while (likely(budget));
1833

1834 1835 1836 1837 1838
#ifdef IXGBE_FCOE
	/* include DDPed FCoE data */
	if (ddp_bytes > 0) {
		unsigned int mss;

1839
		mss = rx_ring->netdev->mtu - sizeof(struct fcoe_hdr) -
1840 1841 1842 1843 1844 1845 1846 1847
			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);
	}

1848
#endif /* IXGBE_FCOE */
1849 1850 1851 1852
	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);
1853 1854
	q_vector->rx.total_packets += total_rx_packets;
	q_vector->rx.total_bytes += total_rx_bytes;
1855

1856 1857 1858
	if (cleaned_count)
		ixgbe_alloc_rx_buffers(rx_ring, cleaned_count);

1859
	return !!budget;
1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870
}

/**
 * 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)
{
1871
	struct ixgbe_q_vector *q_vector;
1872
	int v_idx;
1873
	u32 mask;
1874

1875 1876 1877 1878 1879 1880
	/* 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);
	}

1881 1882
	/*
	 * Populate the IVAR table and set the ITR values to the
1883 1884
	 * corresponding register.
	 */
1885
	for (v_idx = 0; v_idx < adapter->num_q_vectors; v_idx++) {
1886
		struct ixgbe_ring *ring;
1887
		q_vector = adapter->q_vector[v_idx];
1888

1889
		ixgbe_for_each_ring(ring, q_vector->rx)
1890 1891
			ixgbe_set_ivar(adapter, 0, ring->reg_idx, v_idx);

1892
		ixgbe_for_each_ring(ring, q_vector->tx)
1893 1894
			ixgbe_set_ivar(adapter, 1, ring->reg_idx, v_idx);

1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907
		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;
		}
1908

1909
		ixgbe_write_eitr(q_vector);
1910 1911
	}

1912 1913
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
1914
		ixgbe_set_ivar(adapter, -1, IXGBE_IVAR_OTHER_CAUSES_INDEX,
1915
			       v_idx);
1916 1917
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
1918
	case ixgbe_mac_X540:
1919
		ixgbe_set_ivar(adapter, -1, 1, v_idx);
1920 1921 1922 1923
		break;
	default:
		break;
	}
1924 1925
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITR(v_idx), 1950);

1926
	/* set up to autoclear timer, and the vectors */
1927
	mask = IXGBE_EIMS_ENABLE_MASK;
1928 1929 1930 1931
	mask &= ~(IXGBE_EIMS_OTHER |
		  IXGBE_EIMS_MAILBOX |
		  IXGBE_EIMS_LSC);

1932
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIAC, mask);
1933 1934
}

1935 1936 1937 1938 1939 1940 1941 1942 1943
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
1944 1945
 * @q_vector: structure containing interrupt and ring information
 * @ring_container: structure containing ring performance data
1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956
 *
 *      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)
 **/
1957 1958
static void ixgbe_update_itr(struct ixgbe_q_vector *q_vector,
			     struct ixgbe_ring_container *ring_container)
1959
{
1960 1961 1962
	int bytes = ring_container->total_bytes;
	int packets = ring_container->total_packets;
	u32 timepassed_us;
1963
	u64 bytes_perint;
1964
	u8 itr_setting = ring_container->itr;
1965 1966

	if (packets == 0)
1967
		return;
1968 1969

	/* simple throttlerate management
1970 1971 1972
	 *   0-10MB/s   lowest (100000 ints/s)
	 *  10-20MB/s   low    (20000 ints/s)
	 *  20-1249MB/s bulk   (8000 ints/s)
1973 1974
	 */
	/* what was last interrupt timeslice? */
1975
	timepassed_us = q_vector->itr >> 2;
1976 1977 1978 1979
	bytes_perint = bytes / timepassed_us; /* bytes/usec */

	switch (itr_setting) {
	case lowest_latency:
1980
		if (bytes_perint > 10)
1981
			itr_setting = low_latency;
1982 1983
		break;
	case low_latency:
1984
		if (bytes_perint > 20)
1985
			itr_setting = bulk_latency;
1986
		else if (bytes_perint <= 10)
1987
			itr_setting = lowest_latency;
1988 1989
		break;
	case bulk_latency:
1990
		if (bytes_perint <= 20)
1991
			itr_setting = low_latency;
1992 1993 1994
		break;
	}

1995 1996 1997 1998 1999 2000
	/* 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;
2001 2002
}

2003 2004
/**
 * ixgbe_write_eitr - write EITR register in hardware specific way
2005
 * @q_vector: structure containing interrupt and ring information
2006 2007 2008 2009 2010
 *
 * 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.
 */
2011
void ixgbe_write_eitr(struct ixgbe_q_vector *q_vector)
2012
{
2013
	struct ixgbe_adapter *adapter = q_vector->adapter;
2014
	struct ixgbe_hw *hw = &adapter->hw;
2015
	int v_idx = q_vector->v_idx;
2016
	u32 itr_reg = q_vector->itr & IXGBE_MAX_EITR;
2017

2018 2019
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
2020 2021
		/* must write high and low 16 bits to reset counter */
		itr_reg |= (itr_reg << 16);
2022 2023
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2024
	case ixgbe_mac_X540:
2025 2026 2027 2028 2029
		/*
		 * set the WDIS bit to not clear the timer bits and cause an
		 * immediate assertion of the interrupt
		 */
		itr_reg |= IXGBE_EITR_CNT_WDIS;
2030 2031 2032
		break;
	default:
		break;
2033 2034 2035 2036
	}
	IXGBE_WRITE_REG(hw, IXGBE_EITR(v_idx), itr_reg);
}

2037
static void ixgbe_set_itr(struct ixgbe_q_vector *q_vector)
2038
{
2039
	u32 new_itr = q_vector->itr;
2040
	u8 current_itr;
2041

2042 2043
	ixgbe_update_itr(q_vector, &q_vector->tx);
	ixgbe_update_itr(q_vector, &q_vector->rx);
2044

2045
	current_itr = max(q_vector->rx.itr, q_vector->tx.itr);
2046 2047 2048 2049

	switch (current_itr) {
	/* counts and packets in update_itr are dependent on these numbers */
	case lowest_latency:
2050
		new_itr = IXGBE_100K_ITR;
2051 2052
		break;
	case low_latency:
2053
		new_itr = IXGBE_20K_ITR;
2054 2055
		break;
	case bulk_latency:
2056
		new_itr = IXGBE_8K_ITR;
2057
		break;
2058 2059
	default:
		break;
2060 2061
	}

2062
	if (new_itr != q_vector->itr) {
2063
		/* do an exponential smoothing */
2064 2065
		new_itr = (10 * new_itr * q_vector->itr) /
			  ((9 * new_itr) + q_vector->itr);
2066

2067
		/* save the algorithm value here */
2068
		q_vector->itr = new_itr;
2069 2070

		ixgbe_write_eitr(q_vector);
2071 2072 2073
	}
}

2074
/**
2075
 * ixgbe_check_overtemp_subtask - check for over temperature
2076
 * @adapter: pointer to adapter
2077
 **/
2078
static void ixgbe_check_overtemp_subtask(struct ixgbe_adapter *adapter)
2079 2080 2081 2082
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 eicr = adapter->interrupt_event;

2083
	if (test_bit(__IXGBE_DOWN, &adapter->state))
2084 2085
		return;

2086 2087 2088 2089 2090 2091
	if (!(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE) &&
	    !(adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_EVENT))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_TEMP_SENSOR_EVENT;

2092
	switch (hw->device_id) {
2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107
	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;
2108 2109 2110

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

2111 2112 2113 2114 2115 2116 2117 2118 2119
			if (link_up)
				return;
		}

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

		break;
2120 2121
	default:
		if (!(eicr & IXGBE_EICR_GPI_SDP0))
2122
			return;
2123
		break;
2124
	}
2125 2126 2127 2128
	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");
2129 2130

	adapter->interrupt_event = 0;
2131 2132
}

2133 2134 2135 2136 2137 2138
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)) {
2139
		e_crit(probe, "Fan has stopped, replace the adapter\n");
2140 2141 2142 2143
		/* write to clear the interrupt */
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1);
	}
}
2144

2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177
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");
}

2178 2179 2180 2181
static void ixgbe_check_sfp_event(struct ixgbe_adapter *adapter, u32 eicr)
{
	struct ixgbe_hw *hw = &adapter->hw;

2182 2183 2184
	if (eicr & IXGBE_EICR_GPI_SDP2) {
		/* Clear the interrupt */
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP2);
2185 2186 2187 2188
		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
			adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
			ixgbe_service_event_schedule(adapter);
		}
2189 2190
	}

2191 2192 2193
	if (eicr & IXGBE_EICR_GPI_SDP1) {
		/* Clear the interrupt */
		IXGBE_WRITE_REG(hw, IXGBE_EICR, IXGBE_EICR_GPI_SDP1);
2194 2195 2196 2197
		if (!test_bit(__IXGBE_DOWN, &adapter->state)) {
			adapter->flags |= IXGBE_FLAG_NEED_LINK_CONFIG;
			ixgbe_service_event_schedule(adapter);
		}
2198 2199 2200
	}
}

2201 2202 2203 2204 2205 2206 2207 2208 2209
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);
2210
		IXGBE_WRITE_FLUSH(hw);
2211
		ixgbe_service_event_schedule(adapter);
2212 2213 2214
	}
}

2215 2216 2217 2218
static inline void ixgbe_irq_enable_queues(struct ixgbe_adapter *adapter,
					   u64 qmask)
{
	u32 mask;
2219
	struct ixgbe_hw *hw = &adapter->hw;
2220

2221 2222
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
2223
		mask = (IXGBE_EIMS_RTX_QUEUE & qmask);
2224 2225 2226
		IXGBE_WRITE_REG(hw, IXGBE_EIMS, mask);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2227
	case ixgbe_mac_X540:
2228
		mask = (qmask & 0xFFFFFFFF);
2229 2230
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(0), mask);
2231
		mask = (qmask >> 32);
2232 2233 2234 2235 2236
		if (mask)
			IXGBE_WRITE_REG(hw, IXGBE_EIMS_EX(1), mask);
		break;
	default:
		break;
2237 2238 2239 2240 2241
	}
	/* skip the flush */
}

static inline void ixgbe_irq_disable_queues(struct ixgbe_adapter *adapter,
2242
					    u64 qmask)
2243 2244
{
	u32 mask;
2245
	struct ixgbe_hw *hw = &adapter->hw;
2246

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

2267
/**
2268 2269
 * ixgbe_irq_enable - Enable default interrupt generation settings
 * @adapter: board private structure
2270
 **/
2271 2272
static inline void ixgbe_irq_enable(struct ixgbe_adapter *adapter, bool queues,
				    bool flush)
2273
{
2274
	u32 mask = (IXGBE_EIMS_ENABLE_MASK & ~IXGBE_EIMS_RTX_QUEUE);
2275

2276 2277 2278
	/* don't reenable LSC while waiting for link */
	if (adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE)
		mask &= ~IXGBE_EIMS_LSC;
2279

2280
	if (adapter->flags2 & IXGBE_FLAG2_TEMP_SENSOR_CAPABLE)
2281 2282 2283 2284 2285 2286 2287 2288 2289 2290
		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;
		}
2291 2292 2293 2294 2295 2296
	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;
2297 2298
	case ixgbe_mac_X540:
		mask |= IXGBE_EIMS_ECC;
2299 2300 2301 2302
		mask |= IXGBE_EIMS_MAILBOX;
		break;
	default:
		break;
2303
	}
2304 2305 2306
	if ((adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) &&
	    !(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
		mask |= IXGBE_EIMS_FLOW_DIR;
2307

2308 2309 2310 2311 2312
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMS, mask);
	if (queues)
		ixgbe_irq_enable_queues(adapter, ~0);
	if (flush)
		IXGBE_WRITE_FLUSH(&adapter->hw);
2313 2314
}

2315
static irqreturn_t ixgbe_msix_other(int irq, void *data)
2316
{
2317
	struct ixgbe_adapter *adapter = data;
2318
	struct ixgbe_hw *hw = &adapter->hw;
2319
	u32 eicr;
2320

2321 2322 2323 2324 2325 2326 2327 2328
	/*
	 * 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);
2329

2330 2331
	if (eicr & IXGBE_EICR_LSC)
		ixgbe_check_lsc(adapter);
2332

2333 2334
	if (eicr & IXGBE_EICR_MAILBOX)
		ixgbe_msg_task(adapter);
2335

2336 2337
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2338
	case ixgbe_mac_X540:
2339 2340 2341
		if (eicr & IXGBE_EICR_ECC)
			e_info(link, "Received unrecoverable ECC Err, please "
			       "reboot\n");
2342 2343
		/* Handle Flow Director Full threshold interrupt */
		if (eicr & IXGBE_EICR_FLOW_DIR) {
2344
			int reinit_count = 0;
2345 2346
			int i;
			for (i = 0; i < adapter->num_tx_queues; i++) {
2347
				struct ixgbe_ring *ring = adapter->tx_ring[i];
A
Alexander Duyck 已提交
2348
				if (test_and_clear_bit(__IXGBE_TX_FDIR_INIT_DONE,
2349 2350 2351 2352 2353 2354 2355 2356
						       &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);
2357 2358
			}
		}
2359
		ixgbe_check_sfp_event(adapter, eicr);
2360
		ixgbe_check_overtemp_event(adapter, eicr);
2361 2362 2363
		break;
	default:
		break;
2364
	}
2365

2366
	ixgbe_check_fan_failure(adapter, eicr);
2367 2368 2369
#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_check_pps_event(adapter, eicr);
#endif
2370

2371
	/* re-enable the original interrupt state, no lsc, no queues */
2372
	if (!test_bit(__IXGBE_DOWN, &adapter->state))
2373
		ixgbe_irq_enable(adapter, false, false);
2374

2375
	return IRQ_HANDLED;
2376
}
2377

2378
static irqreturn_t ixgbe_msix_clean_rings(int irq, void *data)
2379
{
2380
	struct ixgbe_q_vector *q_vector = data;
2381

2382
	/* EIAM disabled interrupts (on this vector) for us */
2383

2384 2385
	if (q_vector->rx.ring || q_vector->tx.ring)
		napi_schedule(&q_vector->napi);
2386

2387
	return IRQ_HANDLED;
2388 2389
}

2390 2391 2392 2393 2394 2395 2396
/**
 * 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
 **/
2397
int ixgbe_poll(struct napi_struct *napi, int budget)
2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438
{
	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;
}

2439 2440 2441 2442 2443 2444 2445 2446 2447 2448
/**
 * 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;
2449
	int vector, err;
2450
	int ri = 0, ti = 0;
2451

2452
	for (vector = 0; vector < adapter->num_q_vectors; vector++) {
2453
		struct ixgbe_q_vector *q_vector = adapter->q_vector[vector];
2454
		struct msix_entry *entry = &adapter->msix_entries[vector];
R
Robert Olsson 已提交
2455

2456
		if (q_vector->tx.ring && q_vector->rx.ring) {
2457
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2458 2459 2460
				 "%s-%s-%d", netdev->name, "TxRx", ri++);
			ti++;
		} else if (q_vector->rx.ring) {
2461
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2462 2463
				 "%s-%s-%d", netdev->name, "rx", ri++);
		} else if (q_vector->tx.ring) {
2464
			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
2465
				 "%s-%s-%d", netdev->name, "tx", ti++);
2466 2467 2468
		} else {
			/* skip this unused q_vector */
			continue;
2469
		}
2470 2471
		err = request_irq(entry->vector, &ixgbe_msix_clean_rings, 0,
				  q_vector->name, q_vector);
2472
		if (err) {
2473
			e_err(probe, "request_irq failed for MSIX interrupt "
2474
			      "Error: %d\n", err);
2475
			goto free_queue_irqs;
2476
		}
2477 2478 2479 2480
		/* 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,
2481
					      &q_vector->affinity_mask);
2482
		}
2483 2484
	}

2485
	err = request_irq(adapter->msix_entries[vector].vector,
2486
			  ixgbe_msix_other, 0, netdev->name, adapter);
2487
	if (err) {
2488
		e_err(probe, "request_irq for msix_other failed: %d\n", err);
2489
		goto free_queue_irqs;
2490 2491 2492 2493
	}

	return 0;

2494
free_queue_irqs:
2495 2496 2497 2498 2499 2500 2501
	while (vector) {
		vector--;
		irq_set_affinity_hint(adapter->msix_entries[vector].vector,
				      NULL);
		free_irq(adapter->msix_entries[vector].vector,
			 adapter->q_vector[vector]);
	}
2502 2503
	adapter->flags &= ~IXGBE_FLAG_MSIX_ENABLED;
	pci_disable_msix(adapter->pdev);
2504 2505 2506 2507 2508 2509
	kfree(adapter->msix_entries);
	adapter->msix_entries = NULL;
	return err;
}

/**
2510
 * ixgbe_intr - legacy mode Interrupt Handler
2511 2512 2513 2514 2515
 * @irq: interrupt number
 * @data: pointer to a network interface device structure
 **/
static irqreturn_t ixgbe_intr(int irq, void *data)
{
2516
	struct ixgbe_adapter *adapter = data;
2517
	struct ixgbe_hw *hw = &adapter->hw;
2518
	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
2519 2520
	u32 eicr;

2521
	/*
2522
	 * Workaround for silicon errata #26 on 82598.  Mask the interrupt
2523 2524 2525 2526
	 * before the read of EICR.
	 */
	IXGBE_WRITE_REG(hw, IXGBE_EIMC, IXGBE_IRQ_CLEAR_MASK);

2527
	/* for NAPI, using EIAM to auto-mask tx/rx interrupt bits on read
S
Stephen Hemminger 已提交
2528
	 * therefore no explicit interrupt disable is necessary */
2529
	eicr = IXGBE_READ_REG(hw, IXGBE_EICR);
2530
	if (!eicr) {
2531 2532
		/*
		 * shared interrupt alert!
2533
		 * make sure interrupts are enabled because the read will
2534 2535 2536 2537 2538 2539
		 * 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);
2540
		return IRQ_NONE;	/* Not our interrupt */
2541
	}
2542

2543 2544
	if (eicr & IXGBE_EICR_LSC)
		ixgbe_check_lsc(adapter);
2545

2546 2547
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
2548
		ixgbe_check_sfp_event(adapter, eicr);
2549 2550 2551 2552 2553
		/* Fall through */
	case ixgbe_mac_X540:
		if (eicr & IXGBE_EICR_ECC)
			e_info(link, "Received unrecoverable ECC err, please "
				     "reboot\n");
2554
		ixgbe_check_overtemp_event(adapter, eicr);
2555 2556 2557 2558
		break;
	default:
		break;
	}
2559

2560
	ixgbe_check_fan_failure(adapter, eicr);
2561 2562 2563
#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_check_pps_event(adapter, eicr);
#endif
2564

2565 2566
	/* would disable interrupts here but EIAM disabled it */
	napi_schedule(&q_vector->napi);
2567

2568 2569 2570 2571 2572 2573 2574
	/*
	 * 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);

2575 2576 2577 2578 2579 2580 2581 2582 2583 2584
	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.
 **/
2585
static int ixgbe_request_irq(struct ixgbe_adapter *adapter)
2586 2587
{
	struct net_device *netdev = adapter->netdev;
2588
	int err;
2589

2590
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
2591
		err = ixgbe_request_msix_irqs(adapter);
2592
	else if (adapter->flags & IXGBE_FLAG_MSI_ENABLED)
2593
		err = request_irq(adapter->pdev->irq, ixgbe_intr, 0,
2594
				  netdev->name, adapter);
2595
	else
2596
		err = request_irq(adapter->pdev->irq, ixgbe_intr, IRQF_SHARED,
2597
				  netdev->name, adapter);
2598

2599
	if (err)
2600
		e_err(probe, "request_irq failed, Error %d\n", err);
2601 2602 2603 2604 2605 2606

	return err;
}

static void ixgbe_free_irq(struct ixgbe_adapter *adapter)
{
2607
	int vector;
2608

2609 2610 2611 2612
	if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED)) {
		free_irq(adapter->pdev->irq, adapter);
		return;
	}
2613

2614 2615 2616
	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];
2617

2618 2619 2620
		/* free only the irqs that were actually requested */
		if (!q_vector->rx.ring && !q_vector->tx.ring)
			continue;
2621

2622 2623 2624 2625
		/* clear the affinity_mask in the IRQ descriptor */
		irq_set_affinity_hint(entry->vector, NULL);

		free_irq(entry->vector, q_vector);
2626
	}
2627 2628

	free_irq(adapter->msix_entries[vector++].vector, adapter);
2629 2630
}

2631 2632 2633 2634 2635 2636
/**
 * ixgbe_irq_disable - Mask off interrupt generation on the NIC
 * @adapter: board private structure
 **/
static inline void ixgbe_irq_disable(struct ixgbe_adapter *adapter)
{
2637 2638
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82598EB:
2639
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, ~0);
2640 2641
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
2642
	case ixgbe_mac_X540:
2643 2644
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFF0000);
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(0), ~0);
2645
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC_EX(1), ~0);
2646 2647 2648
		break;
	default:
		break;
2649 2650 2651
	}
	IXGBE_WRITE_FLUSH(&adapter->hw);
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
2652 2653 2654 2655 2656 2657
		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);
2658 2659 2660 2661 2662
	} else {
		synchronize_irq(adapter->pdev->irq);
	}
}

2663 2664 2665 2666 2667 2668
/**
 * ixgbe_configure_msi_and_legacy - Initialize PIN (INTA...) and MSI interrupts
 *
 **/
static void ixgbe_configure_msi_and_legacy(struct ixgbe_adapter *adapter)
{
2669
	struct ixgbe_q_vector *q_vector = adapter->q_vector[0];
2670

2671 2672 2673 2674 2675 2676 2677
	/* 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);
2678

2679 2680
	ixgbe_set_ivar(adapter, 0, 0, 0);
	ixgbe_set_ivar(adapter, 1, 0, 0);
2681

2682
	e_info(hw, "Legacy interrupt IVAR setup done\n");
2683 2684
}

2685 2686 2687 2688 2689 2690 2691
/**
 * 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.
 **/
2692 2693
void ixgbe_configure_tx_ring(struct ixgbe_adapter *adapter,
			     struct ixgbe_ring *ring)
2694 2695 2696
{
	struct ixgbe_hw *hw = &adapter->hw;
	u64 tdba = ring->dma;
2697
	int wait_loop = 10;
2698
	u32 txdctl = IXGBE_TXDCTL_ENABLE;
2699
	u8 reg_idx = ring->reg_idx;
2700

2701
	/* disable queue to avoid issues while updating state */
2702
	IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), 0);
2703 2704
	IXGBE_WRITE_FLUSH(hw);

2705
	IXGBE_WRITE_REG(hw, IXGBE_TDBAL(reg_idx),
2706
			(tdba & DMA_BIT_MASK(32)));
2707 2708 2709 2710 2711
	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);
2712
	ring->tail = hw->hw_addr + IXGBE_TDT(reg_idx);
2713

2714 2715 2716 2717 2718 2719 2720 2721
	/*
	 * 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.
	 */
2722
	if (!ring->q_vector || (ring->q_vector->itr < 8))
2723 2724 2725 2726
		txdctl |= (1 << 16);	/* WTHRESH = 1 */
	else
		txdctl |= (8 << 16);	/* WTHRESH = 8 */

2727 2728 2729 2730
	/*
	 * Setting PTHRESH to 32 both improves performance
	 * and avoids a TX hang with DFP enabled
	 */
2731 2732
	txdctl |= (1 << 8) |	/* HTHRESH = 1 */
		   32;		/* PTHRESH = 32 */
2733 2734

	/* reinitialize flowdirector state */
2735
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
2736 2737 2738 2739 2740 2741
		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;
	}
2742

2743 2744
	clear_bit(__IXGBE_HANG_CHECK_ARMED, &ring->state);

2745 2746 2747 2748 2749 2750 2751 2752 2753 2754
	/* 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 {
2755
		usleep_range(1000, 2000);
2756 2757 2758 2759
		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);
2760 2761
}

2762 2763 2764
static void ixgbe_setup_mtqc(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
2765
	u32 rttdcs, mtqc;
2766
	u8 tcs = netdev_get_num_tc(adapter->netdev);
2767 2768 2769 2770 2771 2772 2773 2774 2775 2776

	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 */
2777 2778 2779 2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790 2791
	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;
2792
		else
2793 2794
			mtqc = IXGBE_MTQC_64Q_1PB;
	}
2795

2796
	IXGBE_WRITE_REG(hw, IXGBE_MTQC, mtqc);
2797

2798 2799 2800 2801 2802
	/* 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);
2803 2804 2805 2806 2807 2808 2809
	}

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

2810
/**
2811
 * ixgbe_configure_tx - Configure 8259x Transmit Unit after Reset
2812 2813 2814 2815 2816 2817
 * @adapter: board private structure
 *
 * Configure the Tx unit of the MAC after a reset.
 **/
static void ixgbe_configure_tx(struct ixgbe_adapter *adapter)
{
2818 2819
	struct ixgbe_hw *hw = &adapter->hw;
	u32 dmatxctl;
2820
	u32 i;
2821

2822 2823 2824 2825 2826 2827 2828 2829 2830
	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);
	}

2831
	/* Setup the HW Tx Head and Tail descriptor pointers */
2832 2833
	for (i = 0; i < adapter->num_tx_queues; i++)
		ixgbe_configure_tx_ring(adapter, adapter->tx_ring[i]);
2834 2835
}

2836 2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 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
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]);
	}
}

2891
#define IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT 2
2892

2893
static void ixgbe_configure_srrctl(struct ixgbe_adapter *adapter,
2894
				   struct ixgbe_ring *rx_ring)
2895
{
2896
	struct ixgbe_hw *hw = &adapter->hw;
2897
	u32 srrctl;
2898
	u8 reg_idx = rx_ring->reg_idx;
2899

2900 2901
	if (hw->mac.type == ixgbe_mac_82598EB) {
		u16 mask = adapter->ring_feature[RING_F_RSS].mask;
2902

2903 2904 2905 2906 2907 2908
		/*
		 * if VMDq is not active we must program one srrctl register
		 * per RSS queue since we have enabled RDRXCTL.MVMEN
		 */
		reg_idx &= mask;
	}
2909

2910 2911
	/* configure header buffer length, needed for RSC */
	srrctl = IXGBE_RX_HDR_SIZE << IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT;
2912

2913
	/* configure the packet buffer length */
2914
	srrctl |= ixgbe_rx_bufsz(rx_ring) >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
2915 2916

	/* configure descriptor type */
2917
	srrctl |= IXGBE_SRRCTL_DESCTYPE_ADV_ONEBUF;
2918

2919
	IXGBE_WRITE_REG(hw, IXGBE_SRRCTL(reg_idx), srrctl);
2920
}
2921

2922
static void ixgbe_setup_mrqc(struct ixgbe_adapter *adapter)
2923
{
2924 2925
	struct ixgbe_hw *hw = &adapter->hw;
	static const u32 seed[10] = { 0xE291D73D, 0x1805EC6C, 0x2A94B30D,
2926 2927
			  0xA54F2BEC, 0xEA49AF7C, 0xE214AD3D, 0xB855AABE,
			  0x6A3E67EA, 0x14364D17, 0x3BED200D};
2928 2929 2930
	u32 mrqc = 0, reta = 0;
	u32 rxcsum;
	int i, j;
2931 2932 2933 2934 2935 2936 2937 2938 2939
	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;
2940

2941 2942 2943 2944 2945 2946
	/* 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++) {
2947
		if (j == rss_i)
2948 2949 2950 2951 2952 2953 2954
			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);
	}
2955

2956 2957 2958 2959 2960
	/* 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);

2961
	if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
2962
		if (adapter->ring_feature[RING_F_RSS].mask)
2963
			mrqc = IXGBE_MRQC_RSSEN;
2964
	} else {
2965 2966 2967 2968 2969 2970 2971 2972 2973
		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;
2974
			else
2975 2976 2977
				mrqc = IXGBE_MRQC_VMDQRSS64EN;
		} else {
			if (tcs > 4)
2978
				mrqc = IXGBE_MRQC_RTRSS8TCEN;
2979 2980 2981 2982
			else if (tcs > 1)
				mrqc = IXGBE_MRQC_RTRSS4TCEN;
			else
				mrqc = IXGBE_MRQC_RSSEN;
2983
		}
2984 2985
	}

2986
	/* Perform hash on these packet types */
2987 2988 2989 2990
	mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4 |
		IXGBE_MRQC_RSS_FIELD_IPV4_TCP |
		IXGBE_MRQC_RSS_FIELD_IPV6 |
		IXGBE_MRQC_RSS_FIELD_IPV6_TCP;
2991

2992 2993 2994 2995 2996
	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;

2997
	IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
2998 2999
}

3000 3001 3002 3003 3004
/**
 * ixgbe_configure_rscctl - enable RSC for the indicated ring
 * @adapter:    address of board private structure
 * @index:      index of ring to set
 **/
3005
static void ixgbe_configure_rscctl(struct ixgbe_adapter *adapter,
3006
				   struct ixgbe_ring *ring)
3007 3008 3009
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 rscctrl;
3010
	u8 reg_idx = ring->reg_idx;
3011

A
Alexander Duyck 已提交
3012
	if (!ring_is_rsc_enabled(ring))
3013
		return;
3014

3015
	rscctrl = IXGBE_READ_REG(hw, IXGBE_RSCCTL(reg_idx));
3016 3017 3018 3019
	rscctrl |= IXGBE_RSCCTL_RSCEN;
	/*
	 * we must limit the number of descriptors so that the
	 * total size of max desc * buf_len is not greater
3020
	 * than 65536
3021
	 */
3022
	rscctrl |= IXGBE_RSCCTL_MAXDESC_16;
3023
	IXGBE_WRITE_REG(hw, IXGBE_RSCCTL(reg_idx), rscctrl);
3024 3025
}

3026 3027 3028 3029 3030 3031 3032
#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;
3033
	u8 reg_idx = ring->reg_idx;
3034 3035 3036 3037 3038 3039 3040

	/* 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 {
3041
		usleep_range(1000, 2000);
3042 3043 3044 3045 3046 3047 3048 3049 3050
		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);
	}
}

3051 3052 3053 3054 3055 3056 3057 3058 3059 3060 3061 3062 3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073 3074 3075 3076 3077 3078 3079 3080
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);
	}
}

3081 3082
void ixgbe_configure_rx_ring(struct ixgbe_adapter *adapter,
			     struct ixgbe_ring *ring)
3083 3084 3085
{
	struct ixgbe_hw *hw = &adapter->hw;
	u64 rdba = ring->dma;
3086
	u32 rxdctl;
3087
	u8 reg_idx = ring->reg_idx;
3088

3089 3090
	/* disable queue to avoid issues while updating state */
	rxdctl = IXGBE_READ_REG(hw, IXGBE_RXDCTL(reg_idx));
3091
	ixgbe_disable_rx_queue(adapter, ring);
3092

3093 3094 3095 3096 3097 3098
	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);
3099
	ring->tail = hw->hw_addr + IXGBE_RDT(reg_idx);
3100 3101 3102 3103

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

3104 3105 3106 3107 3108 3109 3110 3111
	/* 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);
	}

3112 3113 3114 3115 3116 3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128
	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);
3129
	ixgbe_alloc_rx_buffers(ring, ixgbe_desc_unused(ring));
3130 3131
}

3132 3133 3134
static void ixgbe_setup_psrtype(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3135
	int rss_i = adapter->ring_feature[RING_F_RSS].indices;
3136 3137 3138 3139
	int p;

	/* PSRTYPE must be initialized in non 82598 adapters */
	u32 psrtype = IXGBE_PSRTYPE_TCPHDR |
3140 3141
		      IXGBE_PSRTYPE_UDPHDR |
		      IXGBE_PSRTYPE_IPV4HDR |
3142
		      IXGBE_PSRTYPE_L2HDR |
3143
		      IXGBE_PSRTYPE_IPV6HDR;
3144 3145 3146 3147

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

3148 3149 3150 3151
	if (rss_i > 3)
		psrtype |= 2 << 29;
	else if (rss_i > 1)
		psrtype |= 1 << 29;
3152 3153

	for (p = 0; p < adapter->num_rx_pools; p++)
3154
		IXGBE_WRITE_REG(hw, IXGBE_PSRTYPE(VMDQ_P(p)),
3155 3156 3157
				psrtype);
}

3158 3159 3160 3161
static void ixgbe_configure_virtualization(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
	u32 reg_offset, vf_shift;
3162
	u32 gcr_ext, vmdctl;
3163
	int i;
3164 3165 3166 3167 3168

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

	vmdctl = IXGBE_READ_REG(hw, IXGBE_VT_CTL);
3169 3170
	vmdctl |= IXGBE_VMD_CTL_VMDQ_EN;
	vmdctl &= ~IXGBE_VT_CTL_POOL_MASK;
3171
	vmdctl |= VMDQ_P(0) << IXGBE_VT_CTL_POOL_SHIFT;
3172 3173
	vmdctl |= IXGBE_VT_CTL_REPLEN;
	IXGBE_WRITE_REG(hw, IXGBE_VT_CTL, vmdctl);
3174

3175 3176
	vf_shift = VMDQ_P(0) % 32;
	reg_offset = (VMDQ_P(0) >= 32) ? 1 : 0;
3177 3178

	/* Enable only the PF's pool for Tx/Rx */
3179 3180 3181 3182
	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);
3183 3184 3185
	IXGBE_WRITE_REG(hw, IXGBE_PFDTXGSWC, IXGBE_PFDTXGSWC_VT_LBEN);

	/* Map PF MAC address in RAR Entry 0 to first pool following VFs */
3186
	hw->mac.ops.set_vmdq(hw, 0, VMDQ_P(0));
3187 3188 3189 3190 3191

	/*
	 * Set up VF register offsets for selected VT Mode,
	 * i.e. 32 or 64 VFs for SR-IOV
	 */
3192 3193 3194 3195 3196 3197 3198 3199 3200 3201 3202 3203
	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;
	}

3204 3205 3206 3207
	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);
3208

3209
	/* Enable MAC Anti-Spoofing */
3210
	hw->mac.ops.set_mac_anti_spoofing(hw, (adapter->num_vfs != 0),
3211
					  adapter->num_vfs);
3212 3213 3214 3215 3216
	/* 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);
	}
3217 3218
}

3219
static void ixgbe_set_rx_buffer_len(struct ixgbe_adapter *adapter)
3220 3221 3222 3223
{
	struct ixgbe_hw *hw = &adapter->hw;
	struct net_device *netdev = adapter->netdev;
	int max_frame = netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
3224 3225 3226
	struct ixgbe_ring *rx_ring;
	int i;
	u32 mhadd, hlreg0;
3227

3228
#ifdef IXGBE_FCOE
3229 3230 3231 3232
	/* 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;
3233

3234 3235 3236 3237 3238 3239 3240 3241 3242
#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);
	}

3243 3244 3245
	/* MHADD will allow an extra 4 bytes past for vlan tagged frames */
	max_frame += VLAN_HLEN;

3246 3247 3248 3249
	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);
3250

3251 3252 3253 3254
	/*
	 * Setup the HW Rx Head and Tail Descriptor Pointers and
	 * the Base and Length of the Rx Descriptor Ring
	 */
3255
	for (i = 0; i < adapter->num_rx_queues; i++) {
3256
		rx_ring = adapter->rx_ring[i];
A
Alexander Duyck 已提交
3257 3258
		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
			set_ring_rsc_enabled(rx_ring);
3259
		else
A
Alexander Duyck 已提交
3260
			clear_ring_rsc_enabled(rx_ring);
3261 3262 3263
	}
}

3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282 3283
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 已提交
3284
	case ixgbe_mac_X540:
3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297 3298 3299 3300
		/* 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);
}

3301 3302 3303 3304 3305 3306 3307 3308 3309 3310 3311 3312 3313 3314 3315 3316 3317
/**
 * 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);
3318
	ixgbe_setup_rdrxctl(adapter);
3319

3320
	/* Program registers for the distribution of queues */
3321 3322
	ixgbe_setup_mrqc(adapter);

3323 3324 3325 3326 3327 3328 3329
	/* 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
	 */
3330 3331
	for (i = 0; i < adapter->num_rx_queues; i++)
		ixgbe_configure_rx_ring(adapter, adapter->rx_ring[i]);
3332

3333 3334 3335 3336 3337 3338 3339
	/* 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);
3340 3341
}

3342
static int ixgbe_vlan_rx_add_vid(struct net_device *netdev, u16 vid)
3343 3344 3345 3346 3347
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

	/* add VID to filter table */
3348
	hw->mac.ops.set_vfta(&adapter->hw, vid, VMDQ_P(0), true);
3349
	set_bit(vid, adapter->active_vlans);
3350 3351

	return 0;
3352 3353
}

3354
static int ixgbe_vlan_rx_kill_vid(struct net_device *netdev, u16 vid)
3355 3356 3357 3358 3359
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;

	/* remove VID from filter table */
3360
	hw->mac.ops.set_vfta(&adapter->hw, vid, VMDQ_P(0), false);
3361
	clear_bit(vid, adapter->active_vlans);
3362 3363

	return 0;
3364 3365
}

3366 3367 3368 3369 3370 3371 3372
/**
 * 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;
3373 3374 3375 3376 3377 3378 3379 3380 3381 3382 3383 3384 3385 3386 3387 3388 3389 3390 3391 3392 3393 3394 3395 3396 3397 3398 3399 3400 3401 3402
	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;
3403 3404 3405 3406
	int i, j;

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
3407 3408
		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
		vlnctrl &= ~IXGBE_VLNCTRL_VME;
3409 3410 3411
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3412
	case ixgbe_mac_X540:
3413 3414 3415 3416 3417 3418 3419 3420 3421 3422 3423 3424 3425
		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;
	}
}

/**
3426
 * ixgbe_vlan_strip_enable - helper to enable hw vlan stripping
3427 3428
 * @adapter: driver data
 */
3429
static void ixgbe_vlan_strip_enable(struct ixgbe_adapter *adapter)
3430 3431
{
	struct ixgbe_hw *hw = &adapter->hw;
3432
	u32 vlnctrl;
3433 3434 3435 3436
	int i, j;

	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
3437 3438
		vlnctrl = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
		vlnctrl |= IXGBE_VLNCTRL_VME;
3439 3440 3441
		IXGBE_WRITE_REG(hw, IXGBE_VLNCTRL, vlnctrl);
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
3442
	case ixgbe_mac_X540:
3443 3444 3445 3446 3447 3448 3449 3450 3451 3452 3453 3454
		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;
	}
}

3455 3456
static void ixgbe_restore_vlan(struct ixgbe_adapter *adapter)
{
3457
	u16 vid;
3458

3459 3460 3461 3462
	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);
3463 3464
}

3465 3466 3467 3468 3469 3470 3471 3472 3473 3474 3475 3476 3477
/**
 * 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;
3478
	unsigned int rar_entries = hw->mac.num_rar_entries - 1;
3479 3480
	int count = 0;

3481 3482 3483 3484
	/* In SR-IOV mode significantly less RAR entries are available */
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
		rar_entries = IXGBE_MAX_PF_MACVLANS - 1;

3485 3486 3487 3488
	/* return ENOMEM indicating insufficient memory for addresses */
	if (netdev_uc_count(netdev) > rar_entries)
		return -ENOMEM;

3489
	if (!netdev_uc_empty(netdev)) {
3490 3491 3492 3493 3494 3495 3496 3497 3498
		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,
3499
					    VMDQ_P(0), IXGBE_RAH_AV);
3500 3501 3502 3503 3504 3505 3506 3507 3508 3509
			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;
}

3510
/**
3511
 * ixgbe_set_rx_mode - Unicast, Multicast and Promiscuous mode set
3512 3513
 * @netdev: network interface device structure
 *
3514 3515 3516 3517
 * 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.
3518
 **/
3519
void ixgbe_set_rx_mode(struct net_device *netdev)
3520 3521 3522
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_hw *hw = &adapter->hw;
3523 3524
	u32 fctrl, vmolr = IXGBE_VMOLR_BAM | IXGBE_VMOLR_AUPE;
	int count;
3525 3526 3527 3528 3529

	/* Check for Promiscuous and All Multicast modes */

	fctrl = IXGBE_READ_REG(hw, IXGBE_FCTRL);

3530
	/* set all bits that we expect to always be set */
B
Ben Greear 已提交
3531
	fctrl &= ~IXGBE_FCTRL_SBP; /* disable store-bad-packets */
3532 3533 3534 3535
	fctrl |= IXGBE_FCTRL_BAM;
	fctrl |= IXGBE_FCTRL_DPF; /* discard pause frames when FC enabled */
	fctrl |= IXGBE_FCTRL_PMCF;

3536 3537 3538
	/* clear the bits we are changing the status of */
	fctrl &= ~(IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);

3539
	if (netdev->flags & IFF_PROMISC) {
3540
		hw->addr_ctrl.user_set_promisc = true;
3541
		fctrl |= (IXGBE_FCTRL_UPE | IXGBE_FCTRL_MPE);
3542
		vmolr |= (IXGBE_VMOLR_ROPE | IXGBE_VMOLR_MPE);
3543 3544
		/* don't hardware filter vlans in promisc mode */
		ixgbe_vlan_filter_disable(adapter);
3545
	} else {
3546 3547
		if (netdev->flags & IFF_ALLMULTI) {
			fctrl |= IXGBE_FCTRL_MPE;
3548 3549 3550 3551
			vmolr |= IXGBE_VMOLR_MPE;
		} else {
			/*
			 * Write addresses to the MTA, if the attempt fails
L
Lucas De Marchi 已提交
3552
			 * then we should just turn on promiscuous mode so
3553 3554 3555 3556
			 * that we can at least receive multicast traffic
			 */
			hw->mac.ops.update_mc_addr_list(hw, netdev);
			vmolr |= IXGBE_VMOLR_ROMPE;
3557
		}
3558
		ixgbe_vlan_filter_enable(adapter);
3559
		hw->addr_ctrl.user_set_promisc = false;
3560 3561 3562 3563 3564 3565 3566 3567 3568 3569 3570
	}

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

3573
	if (adapter->num_vfs)
3574
		ixgbe_restore_vf_multicasts(adapter);
3575 3576 3577

	if (hw->mac.type != ixgbe_mac_82598EB) {
		vmolr |= IXGBE_READ_REG(hw, IXGBE_VMOLR(VMDQ_P(0))) &
3578 3579
			 ~(IXGBE_VMOLR_MPE | IXGBE_VMOLR_ROMPE |
			   IXGBE_VMOLR_ROPE);
3580
		IXGBE_WRITE_REG(hw, IXGBE_VMOLR(VMDQ_P(0)), vmolr);
3581 3582
	}

B
Ben Greear 已提交
3583 3584 3585 3586 3587 3588 3589 3590 3591 3592 3593 3594
	/* 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 */
	}

3595
	IXGBE_WRITE_REG(hw, IXGBE_FCTRL, fctrl);
3596 3597 3598 3599 3600

	if (netdev->features & NETIF_F_HW_VLAN_RX)
		ixgbe_vlan_strip_enable(adapter);
	else
		ixgbe_vlan_strip_disable(adapter);
3601 3602
}

3603 3604 3605 3606
static void ixgbe_napi_enable_all(struct ixgbe_adapter *adapter)
{
	int q_idx;

3607 3608
	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++)
		napi_enable(&adapter->q_vector[q_idx]->napi);
3609 3610 3611 3612 3613 3614
}

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

3615 3616
	for (q_idx = 0; q_idx < adapter->num_q_vectors; q_idx++)
		napi_disable(&adapter->q_vector[q_idx]->napi);
3617 3618
}

J
Jeff Kirsher 已提交
3619
#ifdef CONFIG_IXGBE_DCB
3620
/**
3621 3622 3623 3624 3625 3626 3627 3628 3629 3630
 * 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;
3631
	int max_frame = adapter->netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
3632

3633 3634 3635 3636 3637 3638 3639 3640 3641
	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);

3642
	hw->mac.ops.set_vfta(&adapter->hw, 0, 0, true);
3643

3644
#ifdef IXGBE_FCOE
3645 3646
	if (adapter->netdev->features & NETIF_F_FCOE_MTU)
		max_frame = max(max_frame, IXGBE_FCOE_JUMBO_FRAME_SIZE);
3647
#endif
3648 3649 3650

	/* reconfigure the hardware */
	if (adapter->dcbx_cap & DCB_CAP_DCBX_VER_CEE) {
3651 3652 3653 3654 3655
		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);
3656 3657 3658 3659 3660 3661 3662
	} 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);
3663
	}
3664 3665 3666

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

3670 3671 3672 3673
		while (rss_i) {
			msb++;
			rss_i >>= 1;
		}
3674

3675 3676
		/* write msb to all 8 TCs in one write */
		IXGBE_WRITE_REG(hw, IXGBE_RQTC, msb * 0x11111111);
3677
	}
3678
}
3679 3680 3681 3682 3683
#endif

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

3684
/**
3685 3686 3687
 * ixgbe_hpbthresh - calculate high water mark for flow control
 *
 * @adapter: board private structure to calculate for
3688
 * @pb: packet buffer to calculate
3689 3690 3691 3692 3693 3694 3695 3696 3697 3698 3699 3700 3701
 */
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 */
3702 3703 3704 3705
	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;
3706 3707 3708 3709 3710 3711 3712 3713 3714 3715 3716 3717 3718 3719 3720 3721 3722 3723 3724 3725 3726 3727 3728 3729 3730 3731 3732 3733 3734 3735 3736 3737 3738 3739 3740 3741

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

3742
/**
3743 3744 3745
 * ixgbe_lpbthresh - calculate low water mark for for flow control
 *
 * @adapter: board private structure to calculate for
3746
 * @pb: packet buffer to calculate
3747 3748 3749 3750 3751 3752 3753 3754 3755 3756 3757 3758 3759 3760 3761 3762 3763 3764 3765 3766 3767 3768 3769 3770 3771 3772 3773 3774 3775 3776 3777 3778 3779 3780 3781 3782 3783 3784 3785 3786 3787 3788 3789 3790 3791 3792 3793 3794
 */
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;
	}
}

3795 3796 3797
static void ixgbe_configure_pb(struct ixgbe_adapter *adapter)
{
	struct ixgbe_hw *hw = &adapter->hw;
3798 3799
	int hdrm;
	u8 tc = netdev_get_num_tc(adapter->netdev);
3800 3801 3802

	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE ||
	    adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE)
3803 3804 3805
		hdrm = 32 << adapter->fdir_pballoc;
	else
		hdrm = 0;
3806

3807
	hw->mac.ops.set_rxpba(hw, tc, hdrm, PBA_STRATEGY_EQUAL);
3808
	ixgbe_pbthresh_setup(adapter);
3809 3810
}

3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823 3824
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,
3825 3826 3827 3828 3829
				&filter->filter,
				filter->sw_idx,
				(filter->action == IXGBE_FDIR_DROP_QUEUE) ?
				IXGBE_FDIR_DROP_QUEUE :
				adapter->rx_ring[filter->action]->reg_idx);
3830 3831 3832 3833 3834
	}

	spin_unlock(&adapter->fdir_perfect_lock);
}

3835 3836
static void ixgbe_configure(struct ixgbe_adapter *adapter)
{
3837 3838
	struct ixgbe_hw *hw = &adapter->hw;

3839
	ixgbe_configure_pb(adapter);
J
Jeff Kirsher 已提交
3840
#ifdef CONFIG_IXGBE_DCB
3841
	ixgbe_configure_dcb(adapter);
3842
#endif
3843

3844
	ixgbe_set_rx_mode(adapter->netdev);
3845 3846
	ixgbe_restore_vlan(adapter);

3847 3848 3849 3850 3851 3852 3853 3854 3855
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
		hw->mac.ops.disable_rx_buff(hw);
		break;
	default:
		break;
	}

3856
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
3857 3858
		ixgbe_init_fdir_signature_82599(&adapter->hw,
						adapter->fdir_pballoc);
3859 3860 3861 3862
	} else if (adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE) {
		ixgbe_init_fdir_perfect_82599(&adapter->hw,
					      adapter->fdir_pballoc);
		ixgbe_fdir_filter_restore(adapter);
3863
	}
3864

3865 3866 3867 3868 3869 3870 3871 3872 3873
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
		hw->mac.ops.enable_rx_buff(hw);
		break;
	default:
		break;
	}

3874
	ixgbe_configure_virtualization(adapter);
3875

3876 3877 3878 3879 3880
#ifdef IXGBE_FCOE
	/* configure FCoE L2 filters, redirection table, and Rx control */
	ixgbe_configure_fcoe(adapter);

#endif /* IXGBE_FCOE */
3881 3882 3883 3884
	ixgbe_configure_tx(adapter);
	ixgbe_configure_rx(adapter);
}

3885 3886 3887 3888 3889 3890 3891
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:
3892 3893 3894 3895
	case ixgbe_phy_sfp_passive_tyco:
	case ixgbe_phy_sfp_passive_unknown:
	case ixgbe_phy_sfp_active_unknown:
	case ixgbe_phy_sfp_ftl_active:
3896
		return true;
3897 3898 3899
	case ixgbe_phy_nl:
		if (hw->mac.type == ixgbe_mac_82598EB)
			return true;
3900 3901 3902 3903 3904
	default:
		return false;
	}
}

3905
/**
3906 3907 3908 3909 3910
 * ixgbe_sfp_link_config - set up SFP+ link
 * @adapter: pointer to private adapter struct
 **/
static void ixgbe_sfp_link_config(struct ixgbe_adapter *adapter)
{
3911
	/*
S
Stephen Hemminger 已提交
3912
	 * We are assuming the worst case scenario here, and that
3913 3914 3915 3916 3917 3918
	 * 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;
3919

3920
	adapter->flags2 |= IXGBE_FLAG2_SFP_NEEDS_RESET;
3921 3922 3923 3924
}

/**
 * ixgbe_non_sfp_link_config - set up non-SFP+ link
3925 3926 3927 3928
 * @hw: pointer to private hardware struct
 *
 * Returns 0 on success, negative on failure
 **/
3929
static int ixgbe_non_sfp_link_config(struct ixgbe_hw *hw)
3930 3931
{
	u32 autoneg;
3932
	bool negotiation, link_up = false;
3933 3934 3935 3936 3937 3938 3939 3940
	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;

3941 3942
	autoneg = hw->phy.autoneg_advertised;
	if ((!autoneg) && (hw->mac.ops.get_link_capabilities))
3943 3944
		ret = hw->mac.ops.get_link_capabilities(hw, &autoneg,
							&negotiation);
3945 3946 3947
	if (ret)
		goto link_cfg_out;

3948 3949
	if (hw->mac.ops.setup_link)
		ret = hw->mac.ops.setup_link(hw, autoneg, negotiation, link_up);
3950 3951 3952 3953
link_cfg_out:
	return ret;
}

3954
static void ixgbe_setup_gpie(struct ixgbe_adapter *adapter)
3955 3956
{
	struct ixgbe_hw *hw = &adapter->hw;
3957
	u32 gpie = 0;
3958

3959
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
3960 3961 3962
		gpie = IXGBE_GPIE_MSIX_MODE | IXGBE_GPIE_PBA_SUPPORT |
		       IXGBE_GPIE_OCD;
		gpie |= IXGBE_GPIE_EIAME;
3963 3964 3965 3966 3967 3968 3969 3970 3971
		/*
		 * 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 已提交
3972 3973
		case ixgbe_mac_X540:
		default:
3974 3975 3976 3977 3978
			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(0), 0xFFFFFFFF);
			IXGBE_WRITE_REG(hw, IXGBE_EIAM_EX(1), 0xFFFFFFFF);
			break;
		}
	} else {
3979 3980 3981 3982
		/* 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);
	}
3983

3984 3985 3986 3987 3988
	/* 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;
3989 3990 3991 3992 3993 3994 3995 3996 3997 3998 3999 4000

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

4003
	/* Enable Thermal over heat sensor interrupt */
4004 4005 4006 4007 4008 4009 4010 4011 4012 4013 4014 4015
	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;
		}
	}
4016

4017 4018
	/* Enable fan failure interrupt */
	if (adapter->flags & IXGBE_FLAG_FAN_FAIL_CAPABLE)
4019 4020
		gpie |= IXGBE_SDP1_GPIEN;

4021
	if (hw->mac.type == ixgbe_mac_82599EB) {
4022 4023
		gpie |= IXGBE_SDP1_GPIEN;
		gpie |= IXGBE_SDP2_GPIEN;
4024
	}
4025 4026 4027 4028

	IXGBE_WRITE_REG(hw, IXGBE_GPIE, gpie);
}

4029
static void ixgbe_up_complete(struct ixgbe_adapter *adapter)
4030 4031 4032 4033 4034 4035 4036
{
	struct ixgbe_hw *hw = &adapter->hw;
	int err;
	u32 ctrl_ext;

	ixgbe_get_hw_control(adapter);
	ixgbe_setup_gpie(adapter);
4037

4038 4039 4040 4041 4042
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
		ixgbe_configure_msix(adapter);
	else
		ixgbe_configure_msi_and_legacy(adapter);

4043 4044 4045
	/* enable the optics for both mult-speed fiber and 82599 SFP+ fiber */
	if (hw->mac.ops.enable_tx_laser &&
	    ((hw->phy.multispeed_fiber) ||
4046
	     ((hw->mac.ops.get_media_type(hw) == ixgbe_media_type_fiber) &&
4047
	      (hw->mac.type == ixgbe_mac_82599EB))))
4048 4049
		hw->mac.ops.enable_tx_laser(hw);

4050
	clear_bit(__IXGBE_DOWN, &adapter->state);
4051 4052
	ixgbe_napi_enable_all(adapter);

4053 4054 4055 4056 4057 4058 4059 4060
	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);
	}

4061 4062
	/* clear any pending interrupts, may auto mask */
	IXGBE_READ_REG(hw, IXGBE_EICR);
4063
	ixgbe_irq_enable(adapter, true, true);
4064

4065 4066 4067 4068 4069 4070 4071
	/*
	 * 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)
4072
			e_crit(drv, "Fan has stopped, replace the adapter\n");
4073 4074
	}

4075
	/* enable transmits */
4076
	netif_tx_start_all_queues(adapter->netdev);
4077

4078 4079
	/* bring the link up in the watchdog, this could race with our first
	 * link up interrupt but shouldn't be a problem */
4080 4081
	adapter->flags |= IXGBE_FLAG_NEED_LINK_UPDATE;
	adapter->link_check_timeout = jiffies;
4082
	mod_timer(&adapter->service_timer, jiffies);
4083 4084 4085 4086 4087

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

4090 4091 4092
void ixgbe_reinit_locked(struct ixgbe_adapter *adapter)
{
	WARN_ON(in_interrupt());
4093 4094 4095
	/* put off any impending NetWatchDogTimeout */
	adapter->netdev->trans_start = jiffies;

4096
	while (test_and_set_bit(__IXGBE_RESETTING, &adapter->state))
4097
		usleep_range(1000, 2000);
4098
	ixgbe_down(adapter);
4099 4100 4101 4102 4103 4104 4105 4106
	/*
	 * 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);
4107 4108 4109 4110
	ixgbe_up(adapter);
	clear_bit(__IXGBE_RESETTING, &adapter->state);
}

4111
void ixgbe_up(struct ixgbe_adapter *adapter)
4112 4113 4114 4115
{
	/* hardware has been reset, we need to reload some things */
	ixgbe_configure(adapter);

4116
	ixgbe_up_complete(adapter);
4117 4118 4119 4120
}

void ixgbe_reset(struct ixgbe_adapter *adapter)
{
4121
	struct ixgbe_hw *hw = &adapter->hw;
4122 4123
	int err;

4124 4125 4126 4127 4128 4129 4130 4131 4132
	/* 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;

4133
	err = hw->mac.ops.init_hw(hw);
4134 4135 4136
	switch (err) {
	case 0:
	case IXGBE_ERR_SFP_NOT_PRESENT:
4137
	case IXGBE_ERR_SFP_NOT_SUPPORTED:
4138 4139
		break;
	case IXGBE_ERR_MASTER_REQUESTS_PENDING:
4140
		e_dev_err("master disable timed out\n");
4141
		break;
4142 4143
	case IXGBE_ERR_EEPROM_VERSION:
		/* We are running on a pre-production device, log a warning */
4144
		e_dev_warn("This device is a pre-production adapter/LOM. "
S
Stephen Hemminger 已提交
4145
			   "Please be aware there may be issues associated with "
4146 4147 4148 4149
			   "your hardware.  If you are experiencing problems "
			   "please contact your Intel or hardware "
			   "representative who provided you with this "
			   "hardware.\n");
4150
		break;
4151
	default:
4152
		e_dev_err("Hardware Error: %d\n", err);
4153
	}
4154

4155 4156
	clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);

4157
	/* reprogram the RAR[0] in case user changed it. */
4158
	hw->mac.ops.set_rar(hw, 0, hw->mac.addr, VMDQ_P(0), IXGBE_RAH_AV);
4159 4160 4161 4162

	/* update SAN MAC vmdq pool selection */
	if (hw->mac.san_mac_rar_index)
		hw->mac.ops.set_vmdq_san_mac(hw, VMDQ_P(0));
4163 4164 4165 4166 4167 4168
}

/**
 * ixgbe_clean_rx_ring - Free Rx Buffers per Queue
 * @rx_ring: ring to free buffers from
 **/
4169
static void ixgbe_clean_rx_ring(struct ixgbe_ring *rx_ring)
4170
{
4171
	struct device *dev = rx_ring->dev;
4172
	unsigned long size;
4173
	u16 i;
4174

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

4179
	/* Free all the Rx ring sk_buffs */
4180
	for (i = 0; i < rx_ring->count; i++) {
4181 4182 4183 4184 4185 4186 4187 4188 4189 4190 4191
		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 已提交
4192 4193
			}
			dev_kfree_skb(skb);
4194
		}
4195 4196 4197 4198 4199 4200 4201
		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)
4202 4203
			__free_pages(rx_buffer->page,
				     ixgbe_rx_pg_order(rx_ring));
4204
		rx_buffer->page = NULL;
4205 4206 4207 4208 4209 4210 4211 4212
	}

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

4213
	rx_ring->next_to_alloc = 0;
4214 4215 4216 4217 4218 4219 4220 4221
	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
 **/
4222
static void ixgbe_clean_tx_ring(struct ixgbe_ring *tx_ring)
4223 4224 4225
{
	struct ixgbe_tx_buffer *tx_buffer_info;
	unsigned long size;
4226
	u16 i;
4227

4228 4229 4230
	/* ring already cleared, nothing to do */
	if (!tx_ring->tx_buffer_info)
		return;
4231

4232
	/* Free all the Tx ring sk_buffs */
4233 4234
	for (i = 0; i < tx_ring->count; i++) {
		tx_buffer_info = &tx_ring->tx_buffer_info[i];
4235
		ixgbe_unmap_and_free_tx_resource(tx_ring, tx_buffer_info);
4236 4237
	}

4238 4239
	netdev_tx_reset_queue(txring_txq(tx_ring));

4240 4241 4242 4243 4244 4245 4246 4247 4248 4249 4250
	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;
}

/**
4251
 * ixgbe_clean_all_rx_rings - Free Rx Buffers for all queues
4252 4253
 * @adapter: board private structure
 **/
4254
static void ixgbe_clean_all_rx_rings(struct ixgbe_adapter *adapter)
4255 4256 4257
{
	int i;

4258
	for (i = 0; i < adapter->num_rx_queues; i++)
4259
		ixgbe_clean_rx_ring(adapter->rx_ring[i]);
4260 4261 4262
}

/**
4263
 * ixgbe_clean_all_tx_rings - Free Tx Buffers for all queues
4264 4265
 * @adapter: board private structure
 **/
4266
static void ixgbe_clean_all_tx_rings(struct ixgbe_adapter *adapter)
4267 4268 4269
{
	int i;

4270
	for (i = 0; i < adapter->num_tx_queues; i++)
4271
		ixgbe_clean_tx_ring(adapter->tx_ring[i]);
4272 4273
}

4274 4275 4276 4277 4278 4279 4280 4281 4282 4283 4284 4285 4286 4287 4288 4289 4290
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);
}

4291 4292 4293
void ixgbe_down(struct ixgbe_adapter *adapter)
{
	struct net_device *netdev = adapter->netdev;
4294
	struct ixgbe_hw *hw = &adapter->hw;
4295
	u32 rxctrl;
4296
	int i;
4297 4298 4299 4300 4301

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

	/* disable receives */
4302 4303
	rxctrl = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
	IXGBE_WRITE_REG(hw, IXGBE_RXCTRL, rxctrl & ~IXGBE_RXCTRL_RXEN);
4304

4305 4306 4307 4308 4309
	/* 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]);

4310
	usleep_range(10000, 20000);
4311

4312 4313
	netif_tx_stop_all_queues(netdev);

4314
	/* call carrier off first to avoid false dev_watchdog timeouts */
4315 4316 4317 4318 4319 4320 4321
	netif_carrier_off(netdev);
	netif_tx_disable(netdev);

	ixgbe_irq_disable(adapter);

	ixgbe_napi_disable_all(adapter);

4322 4323
	adapter->flags2 &= ~(IXGBE_FLAG2_FDIR_REQUIRES_REINIT |
			     IXGBE_FLAG2_RESET_REQUESTED);
4324 4325 4326 4327
	adapter->flags &= ~IXGBE_FLAG_NEED_LINK_UPDATE;

	del_timer_sync(&adapter->service_timer);

4328
	if (adapter->num_vfs) {
4329 4330
		/* Clear EITR Select mapping */
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EITRSEL, 0);
4331 4332 4333

		/* Mark all the VFs as inactive */
		for (i = 0 ; i < adapter->num_vfs; i++)
4334
			adapter->vfinfo[i].clear_to_send = false;
4335 4336 4337 4338 4339 4340

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

4343 4344
	/* disable transmits in the hardware now that interrupts are off */
	for (i = 0; i < adapter->num_tx_queues; i++) {
4345
		u8 reg_idx = adapter->tx_ring[i]->reg_idx;
4346
		IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(reg_idx), IXGBE_TXDCTL_SWFLSH);
4347
	}
4348 4349

	/* Disable the Tx DMA engine on 82599 and X540 */
4350 4351
	switch (hw->mac.type) {
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
4352
	case ixgbe_mac_X540:
4353
		IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL,
4354 4355
				(IXGBE_READ_REG(hw, IXGBE_DMATXCTL) &
				 ~IXGBE_DMATXCTL_TE));
4356 4357 4358 4359
		break;
	default:
		break;
	}
4360

4361 4362
	if (!pci_channel_offline(adapter->pdev))
		ixgbe_reset(adapter);
4363 4364 4365 4366

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

4371 4372 4373
	ixgbe_clean_all_tx_rings(adapter);
	ixgbe_clean_all_rx_rings(adapter);

4374
#ifdef CONFIG_IXGBE_DCA
4375
	/* since we reset the hardware DCA settings were cleared */
4376
	ixgbe_setup_dca(adapter);
4377
#endif
4378 4379 4380 4381 4382 4383 4384 4385 4386 4387 4388
}

/**
 * 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 */
4389
	ixgbe_tx_timeout_reset(adapter);
4390 4391 4392 4393 4394 4395 4396 4397 4398 4399 4400 4401 4402 4403
}

/**
 * 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;
4404
	unsigned int rss;
J
Jeff Kirsher 已提交
4405
#ifdef CONFIG_IXGBE_DCB
4406 4407 4408
	int j;
	struct tc_configuration *tc;
#endif
4409

4410 4411 4412 4413 4414 4415 4416 4417
	/* 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;

4418
	/* Set capability flags */
4419
	rss = min_t(int, IXGBE_MAX_RSS_INDICES, num_online_cpus());
4420
	adapter->ring_feature[RING_F_RSS].limit = rss;
4421 4422
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
4423 4424
		if (hw->device_id == IXGBE_DEV_ID_82598AT)
			adapter->flags |= IXGBE_FLAG_FAN_FAIL_CAPABLE;
4425
		adapter->max_q_vectors = MAX_Q_VECTORS_82598;
4426
		break;
D
Don Skidmore 已提交
4427
	case ixgbe_mac_X540:
4428 4429
		adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
	case ixgbe_mac_82599EB:
4430
		adapter->max_q_vectors = MAX_Q_VECTORS_82599;
4431 4432
		adapter->flags2 |= IXGBE_FLAG2_RSC_CAPABLE;
		adapter->flags2 |= IXGBE_FLAG2_RSC_ENABLED;
4433 4434
		if (hw->device_id == IXGBE_DEV_ID_82599_T3_LOM)
			adapter->flags2 |= IXGBE_FLAG2_TEMP_SENSOR_CAPABLE;
4435 4436
		/* Flow Director hash filters enabled */
		adapter->atr_sample_rate = 20;
4437
		adapter->ring_feature[RING_F_FDIR].limit =
4438
							 IXGBE_MAX_FDIR_INDICES;
4439
		adapter->fdir_pballoc = IXGBE_FDIR_PBALLOC_64K;
4440
#ifdef IXGBE_FCOE
4441 4442
		adapter->flags |= IXGBE_FLAG_FCOE_CAPABLE;
		adapter->flags &= ~IXGBE_FLAG_FCOE_ENABLED;
4443
#ifdef CONFIG_IXGBE_DCB
4444
		/* Default traffic class to use for FCoE */
4445
		adapter->fcoe.up = IXGBE_FCOE_DEFTC;
4446
#endif
4447
#endif /* IXGBE_FCOE */
4448 4449 4450
		break;
	default:
		break;
A
Alexander Duyck 已提交
4451
	}
4452

4453 4454 4455 4456 4457
#ifdef IXGBE_FCOE
	/* FCoE support exists, always init the FCoE lock */
	spin_lock_init(&adapter->fcoe.lock);

#endif
4458 4459 4460
	/* n-tuple support exists, always init our spinlock */
	spin_lock_init(&adapter->fdir_perfect_lock);

J
Jeff Kirsher 已提交
4461
#ifdef CONFIG_IXGBE_DCB
4462 4463 4464 4465 4466 4467 4468 4469 4470 4471 4472
	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;
	}

4473 4474 4475 4476 4477 4478 4479 4480 4481
	/* 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;
	}
4482 4483 4484 4485 4486 4487

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

4488 4489
	adapter->dcb_cfg.bw_percentage[DCB_TX_CONFIG][0] = 100;
	adapter->dcb_cfg.bw_percentage[DCB_RX_CONFIG][0] = 100;
4490
	adapter->dcb_cfg.pfc_mode_enable = false;
4491
	adapter->dcb_set_bitmap = 0x00;
4492
	adapter->dcbx_cap = DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_CEE;
4493 4494
	memcpy(&adapter->temp_dcb_cfg, &adapter->dcb_cfg,
	       sizeof(adapter->temp_dcb_cfg));
4495 4496

#endif
4497 4498

	/* default flow control settings */
4499
	hw->fc.requested_mode = ixgbe_fc_full;
D
Don Skidmore 已提交
4500
	hw->fc.current_mode = ixgbe_fc_full;	/* init for ethtool output */
4501
	ixgbe_pbthresh_setup(adapter);
4502 4503
	hw->fc.pause_time = IXGBE_DEFAULT_FCPAUSE;
	hw->fc.send_xon = true;
D
Don Skidmore 已提交
4504
	hw->fc.disable_fc_autoneg = false;
4505

4506 4507 4508 4509 4510 4511
#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
4512
	/* enable itr by default in dynamic mode */
4513 4514
	adapter->rx_itr_setting = 1;
	adapter->tx_itr_setting = 1;
4515 4516 4517 4518 4519

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

4520
	/* set default work limits */
4521
	adapter->tx_work_limit = IXGBE_DEFAULT_TX_WORK;
4522

4523
	/* initialize eeprom parameters */
4524
	if (ixgbe_init_eeprom_params_generic(hw)) {
4525
		e_dev_err("EEPROM initialization failed\n");
4526 4527 4528 4529 4530 4531 4532 4533 4534 4535
		return -EIO;
	}

	set_bit(__IXGBE_DOWN, &adapter->state);

	return 0;
}

/**
 * ixgbe_setup_tx_resources - allocate Tx resources (Descriptors)
4536
 * @tx_ring:    tx descriptor ring (for a specific queue) to setup
4537 4538 4539
 *
 * Return 0 on success, negative on failure
 **/
4540
int ixgbe_setup_tx_resources(struct ixgbe_ring *tx_ring)
4541
{
4542
	struct device *dev = tx_ring->dev;
4543 4544
	int orig_node = dev_to_node(dev);
	int numa_node = -1;
4545 4546
	int size;

4547
	size = sizeof(struct ixgbe_tx_buffer) * tx_ring->count;
4548 4549 4550 4551 4552

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

	tx_ring->tx_buffer_info = vzalloc_node(size, numa_node);
4553
	if (!tx_ring->tx_buffer_info)
E
Eric Dumazet 已提交
4554
		tx_ring->tx_buffer_info = vzalloc(size);
4555 4556
	if (!tx_ring->tx_buffer_info)
		goto err;
4557 4558

	/* round up to nearest 4K */
4559
	tx_ring->size = tx_ring->count * sizeof(union ixgbe_adv_tx_desc);
4560
	tx_ring->size = ALIGN(tx_ring->size, 4096);
4561

4562 4563 4564 4565 4566 4567 4568 4569 4570
	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);
4571 4572
	if (!tx_ring->desc)
		goto err;
4573

4574 4575
	tx_ring->next_to_use = 0;
	tx_ring->next_to_clean = 0;
4576
	return 0;
4577 4578 4579 4580

err:
	vfree(tx_ring->tx_buffer_info);
	tx_ring->tx_buffer_info = NULL;
4581
	dev_err(dev, "Unable to allocate memory for the Tx descriptor ring\n");
4582
	return -ENOMEM;
4583 4584
}

4585 4586 4587 4588 4589 4590 4591 4592 4593 4594 4595 4596 4597 4598 4599
/**
 * 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++) {
4600
		err = ixgbe_setup_tx_resources(adapter->tx_ring[i]);
4601 4602
		if (!err)
			continue;
4603

4604
		e_err(probe, "Allocation for Tx Queue %u failed\n", i);
4605
		goto err_setup_tx;
4606 4607
	}

4608 4609 4610 4611 4612
	return 0;
err_setup_tx:
	/* rewind the index freeing the rings as we go */
	while (i--)
		ixgbe_free_tx_resources(adapter->tx_ring[i]);
4613 4614 4615
	return err;
}

4616 4617
/**
 * ixgbe_setup_rx_resources - allocate Rx resources (Descriptors)
4618
 * @rx_ring:    rx descriptor ring (for a specific queue) to setup
4619 4620 4621
 *
 * Returns 0 on success, negative on failure
 **/
4622
int ixgbe_setup_rx_resources(struct ixgbe_ring *rx_ring)
4623
{
4624
	struct device *dev = rx_ring->dev;
4625 4626
	int orig_node = dev_to_node(dev);
	int numa_node = -1;
4627
	int size;
4628

4629
	size = sizeof(struct ixgbe_rx_buffer) * rx_ring->count;
4630 4631 4632 4633 4634

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

	rx_ring->rx_buffer_info = vzalloc_node(size, numa_node);
4635
	if (!rx_ring->rx_buffer_info)
E
Eric Dumazet 已提交
4636
		rx_ring->rx_buffer_info = vzalloc(size);
4637 4638
	if (!rx_ring->rx_buffer_info)
		goto err;
4639 4640

	/* Round up to nearest 4K */
4641 4642
	rx_ring->size = rx_ring->count * sizeof(union ixgbe_adv_rx_desc);
	rx_ring->size = ALIGN(rx_ring->size, 4096);
4643

4644 4645 4646 4647 4648 4649 4650 4651 4652
	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);
4653 4654
	if (!rx_ring->desc)
		goto err;
4655

4656 4657
	rx_ring->next_to_clean = 0;
	rx_ring->next_to_use = 0;
4658 4659

	return 0;
4660 4661 4662 4663
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");
4664
	return -ENOMEM;
4665 4666
}

4667 4668 4669 4670 4671 4672 4673 4674 4675 4676 4677 4678 4679 4680 4681
/**
 * 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++) {
4682
		err = ixgbe_setup_rx_resources(adapter->rx_ring[i]);
4683 4684
		if (!err)
			continue;
4685

4686
		e_err(probe, "Allocation for Rx Queue %u failed\n", i);
4687
		goto err_setup_rx;
4688 4689
	}

4690 4691 4692 4693 4694
#ifdef IXGBE_FCOE
	err = ixgbe_setup_fcoe_ddp_resources(adapter);
	if (!err)
#endif
		return 0;
4695 4696 4697 4698
err_setup_rx:
	/* rewind the index freeing the rings as we go */
	while (i--)
		ixgbe_free_rx_resources(adapter->rx_ring[i]);
4699 4700 4701
	return err;
}

4702 4703 4704 4705 4706 4707
/**
 * ixgbe_free_tx_resources - Free Tx Resources per Queue
 * @tx_ring: Tx descriptor ring for a specific queue
 *
 * Free all transmit software resources
 **/
4708
void ixgbe_free_tx_resources(struct ixgbe_ring *tx_ring)
4709
{
4710
	ixgbe_clean_tx_ring(tx_ring);
4711 4712 4713 4714

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

4715 4716 4717 4718 4719 4720
	/* 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);
4721 4722 4723 4724 4725 4726 4727 4728 4729 4730 4731 4732 4733 4734 4735

	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++)
4736
		if (adapter->tx_ring[i]->desc)
4737
			ixgbe_free_tx_resources(adapter->tx_ring[i]);
4738 4739 4740
}

/**
4741
 * ixgbe_free_rx_resources - Free Rx Resources
4742 4743 4744 4745
 * @rx_ring: ring to clean the resources from
 *
 * Free all receive software resources
 **/
4746
void ixgbe_free_rx_resources(struct ixgbe_ring *rx_ring)
4747
{
4748
	ixgbe_clean_rx_ring(rx_ring);
4749 4750 4751 4752

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

4753 4754 4755 4756 4757 4758
	/* 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);
4759 4760 4761 4762 4763 4764 4765 4766 4767 4768 4769 4770 4771 4772

	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;

4773 4774 4775 4776
#ifdef IXGBE_FCOE
	ixgbe_free_fcoe_ddp_resources(adapter);

#endif
4777
	for (i = 0; i < adapter->num_rx_queues; i++)
4778
		if (adapter->rx_ring[i]->desc)
4779
			ixgbe_free_rx_resources(adapter->rx_ring[i]);
4780 4781 4782 4783 4784 4785 4786 4787 4788 4789 4790 4791 4792 4793
}

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

4794
	/* MTU < 68 is an error and causes problems on some kernels */
4795 4796 4797 4798 4799 4800 4801 4802 4803 4804 4805
	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))
4806
			return -EINVAL;
4807

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

4810
	/* must set new MTU before calling down or up */
4811 4812
	netdev->mtu = new_mtu;

4813 4814
	if (netif_running(netdev))
		ixgbe_reinit_locked(adapter);
4815 4816 4817 4818 4819 4820 4821 4822 4823 4824 4825 4826 4827 4828 4829 4830 4831 4832 4833 4834

	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;
4835 4836 4837 4838

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

4840 4841
	netif_carrier_off(netdev);

4842 4843 4844 4845 4846 4847 4848 4849 4850 4851 4852 4853
	/* 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);

4854
	err = ixgbe_request_irq(adapter);
4855 4856 4857
	if (err)
		goto err_req_irq;

4858 4859 4860 4861 4862 4863 4864 4865 4866 4867 4868 4869 4870 4871
	/* 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;

4872
	ixgbe_up_complete(adapter);
4873 4874 4875

	return 0;

4876 4877
err_set_queues:
	ixgbe_free_irq(adapter);
4878
err_req_irq:
4879
	ixgbe_free_all_rx_resources(adapter);
4880
err_setup_rx:
4881
	ixgbe_free_all_tx_resources(adapter);
4882
err_setup_tx:
4883 4884 4885 4886 4887 4888 4889 4890 4891 4892 4893 4894 4895 4896 4897 4898 4899 4900 4901 4902 4903 4904 4905
	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);

4906 4907
	ixgbe_fdir_filter_exit(adapter);

4908 4909 4910
	ixgbe_free_all_tx_resources(adapter);
	ixgbe_free_all_rx_resources(adapter);

4911
	ixgbe_release_hw_control(adapter);
4912 4913 4914 4915

	return 0;
}

4916 4917 4918
#ifdef CONFIG_PM
static int ixgbe_resume(struct pci_dev *pdev)
{
4919 4920
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
4921 4922 4923 4924
	u32 err;

	pci_set_power_state(pdev, PCI_D0);
	pci_restore_state(pdev);
4925 4926 4927 4928 4929
	/*
	 * pci_restore_state clears dev->state_saved so call
	 * pci_save_state to restore it.
	 */
	pci_save_state(pdev);
4930 4931

	err = pci_enable_device_mem(pdev);
4932
	if (err) {
4933
		e_dev_err("Cannot enable PCI device from suspend\n");
4934 4935 4936 4937
		return err;
	}
	pci_set_master(pdev);

4938
	pci_wake_from_d3(pdev, false);
4939 4940 4941

	ixgbe_reset(adapter);

4942 4943
	IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);

4944 4945 4946
	rtnl_lock();
	err = ixgbe_init_interrupt_scheme(adapter);
	if (!err && netif_running(netdev))
4947
		err = ixgbe_open(netdev);
4948 4949 4950 4951 4952

	rtnl_unlock();

	if (err)
		return err;
4953 4954 4955 4956 4957 4958

	netif_device_attach(netdev);

	return 0;
}
#endif /* CONFIG_PM */
4959 4960

static int __ixgbe_shutdown(struct pci_dev *pdev, bool *enable_wake)
4961
{
4962 4963
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
4964 4965 4966
	struct ixgbe_hw *hw = &adapter->hw;
	u32 ctrl, fctrl;
	u32 wufc = adapter->wol;
4967 4968 4969 4970 4971 4972 4973
#ifdef CONFIG_PM
	int retval = 0;
#endif

	netif_device_detach(netdev);

	if (netif_running(netdev)) {
4974
		rtnl_lock();
4975 4976 4977 4978
		ixgbe_down(adapter);
		ixgbe_free_irq(adapter);
		ixgbe_free_all_tx_resources(adapter);
		ixgbe_free_all_rx_resources(adapter);
4979
		rtnl_unlock();
4980 4981
	}

4982 4983
	ixgbe_clear_interrupt_scheme(adapter);

4984 4985 4986 4987
#ifdef CONFIG_PM
	retval = pci_save_state(pdev);
	if (retval)
		return retval;
4988

4989
#endif
4990 4991
	if (wufc) {
		ixgbe_set_rx_mode(netdev);
4992

D
Don Skidmore 已提交
4993 4994 4995 4996 4997 4998 4999 5000 5001 5002
		/*
		 * 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);

5003 5004 5005 5006 5007 5008 5009 5010 5011 5012 5013 5014 5015 5016 5017 5018 5019
		/* 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);
	}

5020 5021
	switch (hw->mac.type) {
	case ixgbe_mac_82598EB:
5022
		pci_wake_from_d3(pdev, false);
5023 5024
		break;
	case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
5025
	case ixgbe_mac_X540:
5026 5027 5028 5029 5030
		pci_wake_from_d3(pdev, !!wufc);
		break;
	default:
		break;
	}
5031

5032 5033
	*enable_wake = !!wufc;

5034 5035 5036 5037
	ixgbe_release_hw_control(adapter);

	pci_disable_device(pdev);

5038 5039 5040 5041 5042 5043 5044 5045 5046 5047 5048 5049 5050 5051 5052 5053 5054 5055 5056
	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);
	}
5057 5058 5059

	return 0;
}
5060
#endif /* CONFIG_PM */
5061 5062 5063

static void ixgbe_shutdown(struct pci_dev *pdev)
{
5064 5065 5066 5067 5068 5069 5070 5071
	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);
	}
5072 5073
}

5074 5075 5076 5077 5078 5079
/**
 * ixgbe_update_stats - Update the board statistics counters.
 * @adapter: board private structure
 **/
void ixgbe_update_stats(struct ixgbe_adapter *adapter)
{
5080
	struct net_device *netdev = adapter->netdev;
5081
	struct ixgbe_hw *hw = &adapter->hw;
5082
	struct ixgbe_hw_stats *hwstats = &adapter->stats;
5083 5084
	u64 total_mpc = 0;
	u32 i, missed_rx = 0, mpc, bprc, lxon, lxoff, xon_off_tot;
5085 5086
	u64 non_eop_descs = 0, restart_queue = 0, tx_busy = 0;
	u64 alloc_rx_page_failed = 0, alloc_rx_buff_failed = 0;
5087
	u64 bytes = 0, packets = 0, hw_csum_rx_error = 0;
5088

5089 5090 5091 5092
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
	    test_bit(__IXGBE_RESETTING, &adapter->state))
		return;

5093
	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED) {
A
Alexander Duyck 已提交
5094
		u64 rsc_count = 0;
5095 5096
		u64 rsc_flush = 0;
		for (i = 0; i < adapter->num_rx_queues; i++) {
5097 5098
			rsc_count += adapter->rx_ring[i]->rx_stats.rsc_count;
			rsc_flush += adapter->rx_ring[i]->rx_stats.rsc_flush;
5099 5100 5101
		}
		adapter->rsc_total_count = rsc_count;
		adapter->rsc_total_flush = rsc_flush;
5102 5103
	}

5104 5105 5106 5107 5108
	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;
5109
		hw_csum_rx_error += rx_ring->rx_stats.csum_err;
5110 5111 5112 5113 5114 5115
		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;
5116
	adapter->hw_csum_rx_error = hw_csum_rx_error;
5117 5118 5119 5120 5121
	netdev->stats.rx_bytes = bytes;
	netdev->stats.rx_packets = packets;

	bytes = 0;
	packets = 0;
J
Jesse Brandeburg 已提交
5122
	/* gather some stats to the adapter struct that are per queue */
5123 5124 5125 5126 5127 5128 5129
	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;
	}
5130
	adapter->restart_queue = restart_queue;
5131 5132 5133
	adapter->tx_busy = tx_busy;
	netdev->stats.tx_bytes = bytes;
	netdev->stats.tx_packets = packets;
J
Jesse Brandeburg 已提交
5134

5135
	hwstats->crcerrs += IXGBE_READ_REG(hw, IXGBE_CRCERRS);
5136 5137

	/* 8 register reads */
5138 5139 5140 5141
	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;
5142 5143
		hwstats->mpc[i] += mpc;
		total_mpc += hwstats->mpc[i];
5144 5145
		hwstats->pxontxc[i] += IXGBE_READ_REG(hw, IXGBE_PXONTXC(i));
		hwstats->pxofftxc[i] += IXGBE_READ_REG(hw, IXGBE_PXOFFTXC(i));
5146 5147
		switch (hw->mac.type) {
		case ixgbe_mac_82598EB:
5148 5149 5150
			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));
5151 5152
			hwstats->pxonrxc[i] +=
				IXGBE_READ_REG(hw, IXGBE_PXONRXC(i));
5153 5154
			break;
		case ixgbe_mac_82599EB:
D
Don Skidmore 已提交
5155
		case ixgbe_mac_X540:
5156 5157 5158 5159 5160
			hwstats->pxonrxc[i] +=
				IXGBE_READ_REG(hw, IXGBE_PXONRXCNT(i));
			break;
		default:
			break;
5161
		}
5162
	}
5163 5164 5165 5166 5167 5168 5169 5170 5171 5172 5173 5174 5175 5176

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

5177
	hwstats->gprc += IXGBE_READ_REG(hw, IXGBE_GPRC);
5178
	/* work around hardware counting issue */
5179
	hwstats->gprc -= missed_rx;
5180

5181 5182
	ixgbe_update_xoff_received(adapter);

5183
	/* 82598 hardware only has a 32 bit counter in the high register */
5184 5185 5186 5187 5188 5189 5190
	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 已提交
5191
	case ixgbe_mac_X540:
5192 5193 5194 5195 5196 5197
		/* 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:
5198 5199 5200
		for (i = 0; i < 16; i++)
			adapter->hw_rx_no_dma_resources +=
					     IXGBE_READ_REG(hw, IXGBE_QPRDC(i));
5201
		hwstats->gorc += IXGBE_READ_REG(hw, IXGBE_GORCL);
5202
		IXGBE_READ_REG(hw, IXGBE_GORCH); /* to clear */
5203
		hwstats->gotc += IXGBE_READ_REG(hw, IXGBE_GOTCL);
5204
		IXGBE_READ_REG(hw, IXGBE_GOTCH); /* to clear */
5205
		hwstats->tor += IXGBE_READ_REG(hw, IXGBE_TORL);
5206
		IXGBE_READ_REG(hw, IXGBE_TORH); /* to clear */
5207 5208 5209
		hwstats->lxonrxc += IXGBE_READ_REG(hw, IXGBE_LXONRXCNT);
		hwstats->fdirmatch += IXGBE_READ_REG(hw, IXGBE_FDIRMATCH);
		hwstats->fdirmiss += IXGBE_READ_REG(hw, IXGBE_FDIRMISS);
5210
#ifdef IXGBE_FCOE
5211 5212 5213 5214 5215 5216
		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);
5217
		/* Add up per cpu counters for total ddp aloc fail */
5218 5219 5220 5221 5222
		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;
5223
			for_each_possible_cpu(cpu) {
5224 5225 5226
				ddp_pool = per_cpu_ptr(fcoe->ddp_pool, cpu);
				noddp += ddp_pool->noddp;
				noddp_ext_buff += ddp_pool->noddp_ext_buff;
5227
			}
5228 5229
			hwstats->fcoe_noddp = noddp;
			hwstats->fcoe_noddp_ext_buff = noddp_ext_buff;
5230
		}
5231
#endif /* IXGBE_FCOE */
5232 5233 5234
		break;
	default:
		break;
5235
	}
5236
	bprc = IXGBE_READ_REG(hw, IXGBE_BPRC);
5237 5238
	hwstats->bprc += bprc;
	hwstats->mprc += IXGBE_READ_REG(hw, IXGBE_MPRC);
5239
	if (hw->mac.type == ixgbe_mac_82598EB)
5240 5241 5242 5243 5244 5245 5246 5247 5248
		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);
5249
	lxon = IXGBE_READ_REG(hw, IXGBE_LXONTXC);
5250
	hwstats->lxontxc += lxon;
5251
	lxoff = IXGBE_READ_REG(hw, IXGBE_LXOFFTXC);
5252 5253 5254
	hwstats->lxofftxc += lxoff;
	hwstats->gptc += IXGBE_READ_REG(hw, IXGBE_GPTC);
	hwstats->mptc += IXGBE_READ_REG(hw, IXGBE_MPTC);
5255 5256 5257 5258
	/*
	 * 82598 errata - tx of flow control packets is included in tx counters
	 */
	xon_off_tot = lxon + lxoff;
5259 5260 5261 5262 5263 5264 5265 5266 5267 5268 5269 5270 5271 5272 5273
	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);
5274 5275

	/* Fill out the OS statistics structure */
5276
	netdev->stats.multicast = hwstats->mprc;
5277 5278

	/* Rx Errors */
5279
	netdev->stats.rx_errors = hwstats->crcerrs + hwstats->rlec;
5280
	netdev->stats.rx_dropped = 0;
5281 5282
	netdev->stats.rx_length_errors = hwstats->rlec;
	netdev->stats.rx_crc_errors = hwstats->crcerrs;
5283
	netdev->stats.rx_missed_errors = total_mpc;
5284 5285 5286
}

/**
5287
 * ixgbe_fdir_reinit_subtask - worker thread to reinit FDIR filter table
5288
 * @adapter: pointer to the device adapter structure
5289
 **/
5290
static void ixgbe_fdir_reinit_subtask(struct ixgbe_adapter *adapter)
5291
{
5292
	struct ixgbe_hw *hw = &adapter->hw;
5293
	int i;
5294

5295 5296 5297 5298
	if (!(adapter->flags2 & IXGBE_FLAG2_FDIR_REQUIRES_REINIT))
		return;

	adapter->flags2 &= ~IXGBE_FLAG2_FDIR_REQUIRES_REINIT;
5299

5300
	/* if interface is down do nothing */
5301
	if (test_bit(__IXGBE_DOWN, &adapter->state))
5302 5303 5304 5305 5306 5307 5308 5309
		return;

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

	adapter->fdir_overflow++;

5310 5311 5312
	if (ixgbe_reinit_fdir_tables_82599(hw) == 0) {
		for (i = 0; i < adapter->num_tx_queues; i++)
			set_bit(__IXGBE_TX_FDIR_INIT_DONE,
5313
			        &(adapter->tx_ring[i]->state));
5314 5315
		/* re-enable flow director interrupts */
		IXGBE_WRITE_REG(hw, IXGBE_EIMS, IXGBE_EIMS_FLOW_DIR);
5316 5317 5318 5319 5320 5321 5322 5323
	} 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
5324
 * @adapter: pointer to the device adapter structure
5325 5326
 *
 * This function serves two purposes.  First it strobes the interrupt lines
S
Stephen Hemminger 已提交
5327
 * in order to make certain interrupts are occurring.  Secondly it sets the
5328
 * bits needed to check for TX hangs.  As a result we should immediately
S
Stephen Hemminger 已提交
5329
 * determine if a hang has occurred.
5330 5331
 */
static void ixgbe_check_hang_subtask(struct ixgbe_adapter *adapter)
5332
{
5333
	struct ixgbe_hw *hw = &adapter->hw;
5334 5335
	u64 eics = 0;
	int i;
5336

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

5342 5343 5344 5345 5346
	/* 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]);
	}
5347

5348 5349 5350 5351 5352 5353 5354 5355
	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));
5356 5357
	} else {
		/* get one bit for every active tx/rx interrupt vector */
5358
		for (i = 0; i < adapter->num_q_vectors; i++) {
5359
			struct ixgbe_q_vector *qv = adapter->q_vector[i];
5360
			if (qv->rx.ring || qv->tx.ring)
5361 5362
				eics |= ((u64)1 << i);
		}
5363
	}
5364

5365
	/* Cause software interrupt to ensure rings are cleaned */
5366 5367
	ixgbe_irq_rearm_queues(adapter, eics);

5368 5369
}

5370
/**
5371
 * ixgbe_watchdog_update_link - update the link status
5372 5373
 * @adapter: pointer to the device adapter structure
 * @link_speed: pointer to a u32 to store the link_speed
5374
 **/
5375
static void ixgbe_watchdog_update_link(struct ixgbe_adapter *adapter)
5376 5377
{
	struct ixgbe_hw *hw = &adapter->hw;
5378 5379
	u32 link_speed = adapter->link_speed;
	bool link_up = adapter->link_up;
5380
	bool pfc_en = adapter->dcb_cfg.pfc_mode_enable;
5381

5382 5383 5384 5385 5386
	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);
5387
	} else {
5388 5389 5390
		/* always assume link is up, if no check link function */
		link_speed = IXGBE_LINK_SPEED_10GB_FULL;
		link_up = true;
5391
	}
5392 5393 5394 5395

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

5396
	if (link_up && !((adapter->flags & IXGBE_FLAG_DCB_ENABLED) && pfc_en)) {
5397
		hw->mac.ops.fc_enable(hw);
5398 5399
		ixgbe_set_rx_drop_en(adapter);
	}
5400 5401 5402 5403 5404 5405 5406 5407 5408 5409 5410

	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;
5411 5412 5413
}

/**
5414 5415
 * ixgbe_watchdog_link_is_up - update netif_carrier status and
 *                             print link up message
5416
 * @adapter: pointer to the device adapter structure
5417
 **/
5418
static void ixgbe_watchdog_link_is_up(struct ixgbe_adapter *adapter)
5419
{
5420
	struct net_device *netdev = adapter->netdev;
5421
	struct ixgbe_hw *hw = &adapter->hw;
5422 5423
	u32 link_speed = adapter->link_speed;
	bool flow_rx, flow_tx;
5424

5425 5426
	/* only continue if link was previously down */
	if (netif_carrier_ok(netdev))
5427
		return;
5428

5429
	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
5430

5431 5432 5433 5434 5435 5436 5437 5438 5439 5440 5441 5442 5443 5444 5445 5446 5447 5448 5449 5450
	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;
5451
	}
5452 5453 5454 5455 5456

#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_start_cyclecounter(adapter);
#endif

5457 5458 5459 5460 5461 5462 5463 5464 5465 5466 5467
	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"))));
5468

5469 5470
	netif_carrier_on(netdev);
	ixgbe_check_vf_rate_limit(adapter);
5471 5472 5473

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

5476
/**
5477 5478
 * ixgbe_watchdog_link_is_down - update netif_carrier status and
 *                               print link down message
5479
 * @adapter: pointer to the adapter structure
5480
 **/
A
Alexander Duyck 已提交
5481
static void ixgbe_watchdog_link_is_down(struct ixgbe_adapter *adapter)
5482
{
5483
	struct net_device *netdev = adapter->netdev;
5484
	struct ixgbe_hw *hw = &adapter->hw;
5485

5486 5487
	adapter->link_up = false;
	adapter->link_speed = 0;
5488

5489 5490 5491
	/* only continue if link was up previously */
	if (!netif_carrier_ok(netdev))
		return;
5492

5493 5494 5495
	/* 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;
5496

5497 5498 5499 5500
#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_start_cyclecounter(adapter);
#endif

5501 5502
	e_info(drv, "NIC Link is Down\n");
	netif_carrier_off(netdev);
5503 5504 5505

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

5508 5509
/**
 * ixgbe_watchdog_flush_tx - flush queues on link down
5510
 * @adapter: pointer to the device adapter structure
5511 5512 5513
 **/
static void ixgbe_watchdog_flush_tx(struct ixgbe_adapter *adapter)
{
5514
	int i;
5515
	int some_tx_pending = 0;
5516

5517
	if (!netif_carrier_ok(adapter->netdev)) {
5518
		for (i = 0; i < adapter->num_tx_queues; i++) {
5519
			struct ixgbe_ring *tx_ring = adapter->tx_ring[i];
5520 5521 5522 5523 5524 5525 5526 5527 5528 5529 5530 5531
			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).
			 */
5532
			adapter->flags2 |= IXGBE_FLAG2_RESET_REQUESTED;
5533
		}
5534 5535 5536
	}
}

5537 5538 5539 5540 5541 5542 5543 5544 5545 5546 5547 5548 5549 5550 5551 5552 5553 5554 5555 5556
static void ixgbe_spoof_check(struct ixgbe_adapter *adapter)
{
	u32 ssvpc;

	/* Do not perform spoof check for 82598 */
	if (adapter->hw.mac.type == ixgbe_mac_82598EB)
		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;

	e_warn(drv, "%d Spoofed packets detected\n", ssvpc);
}

5557 5558
/**
 * ixgbe_watchdog_subtask - check and bring link up
5559
 * @adapter: pointer to the device adapter structure
5560 5561 5562 5563
 **/
static void ixgbe_watchdog_subtask(struct ixgbe_adapter *adapter)
{
	/* if interface is down do nothing */
5564 5565
	if (test_bit(__IXGBE_DOWN, &adapter->state) ||
	    test_bit(__IXGBE_RESETTING, &adapter->state))
5566 5567 5568 5569 5570 5571 5572 5573
		return;

	ixgbe_watchdog_update_link(adapter);

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

5575
	ixgbe_spoof_check(adapter);
5576
	ixgbe_update_stats(adapter);
5577 5578

	ixgbe_watchdog_flush_tx(adapter);
5579
}
5580

5581
/**
5582
 * ixgbe_sfp_detection_subtask - poll for SFP+ cable
5583
 * @adapter: the ixgbe adapter structure
5584
 **/
5585
static void ixgbe_sfp_detection_subtask(struct ixgbe_adapter *adapter)
5586 5587
{
	struct ixgbe_hw *hw = &adapter->hw;
5588
	s32 err;
5589

5590 5591 5592 5593
	/* 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;
5594

5595 5596 5597
	/* someone else is in init, wait until next service event */
	if (test_and_set_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
		return;
5598

5599 5600 5601
	err = hw->phy.ops.identify_sfp(hw);
	if (err == IXGBE_ERR_SFP_NOT_SUPPORTED)
		goto sfp_out;
5602

5603 5604 5605 5606
	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;
5607
	}
5608

5609 5610 5611
	/* exit on error */
	if (err)
		goto sfp_out;
5612

5613 5614 5615
	/* exit if reset not needed */
	if (!(adapter->flags2 & IXGBE_FLAG2_SFP_NEEDS_RESET))
		goto sfp_out;
5616

5617
	adapter->flags2 &= ~IXGBE_FLAG2_SFP_NEEDS_RESET;
5618

5619 5620 5621 5622 5623 5624 5625 5626 5627 5628 5629 5630 5631 5632 5633 5634 5635 5636 5637 5638 5639 5640 5641 5642 5643 5644
	/*
	 * 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);
5645
	}
5646
}
5647

5648 5649
/**
 * ixgbe_sfp_link_config_subtask - set up link SFP after module install
5650
 * @adapter: the ixgbe adapter structure
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
 **/
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);
}

5678 5679 5680 5681 5682 5683 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 5711 5712 5713 5714 5715 5716 5717 5718 5719 5720 5721 5722
#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
5723 5724 5725 5726 5727 5728 5729 5730
/**
 * 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;
5731
	bool ready = true;
5732

5733 5734 5735 5736 5737
	/* 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;
5738

5739
#ifdef CONFIG_PCI_IOV
5740 5741 5742 5743 5744
	/*
	 * don't bother with SR-IOV VF DMA hang check if there are
	 * no VFs or the link is down
	 */
	if (!adapter->num_vfs ||
5745
	    (adapter->flags & IXGBE_FLAG_NEED_LINK_UPDATE))
5746 5747 5748 5749 5750 5751 5752
		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++;

5753
	if (adapter->timer_event_accumulator >= 100)
5754
		adapter->timer_event_accumulator = 0;
5755
	else
5756
		ready = false;
5757

5758
normal_timer_service:
5759
#endif
5760 5761 5762
	/* Reset the timer */
	mod_timer(&adapter->service_timer, next_event_offset + jiffies);

5763 5764
	if (ready)
		ixgbe_service_event_schedule(adapter);
5765 5766
}

5767 5768 5769 5770 5771 5772 5773 5774 5775 5776 5777 5778 5779 5780 5781 5782 5783 5784 5785
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);
}

5786 5787 5788 5789 5790 5791 5792 5793 5794 5795
/**
 * 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);

5796
	ixgbe_reset_subtask(adapter);
5797 5798
	ixgbe_sfp_detection_subtask(adapter);
	ixgbe_sfp_link_config_subtask(adapter);
5799
	ixgbe_check_overtemp_subtask(adapter);
5800
	ixgbe_watchdog_subtask(adapter);
5801
	ixgbe_fdir_reinit_subtask(adapter);
5802
	ixgbe_check_hang_subtask(adapter);
5803 5804 5805
#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_overflow_check(adapter);
#endif
5806 5807

	ixgbe_service_event_complete(adapter);
5808 5809
}

5810 5811
static int ixgbe_tso(struct ixgbe_ring *tx_ring,
		     struct ixgbe_tx_buffer *first,
5812
		     u8 *hdr_len)
5813
{
5814
	struct sk_buff *skb = first->skb;
5815 5816
	u32 vlan_macip_lens, type_tucmd;
	u32 mss_l4len_idx, l4len;
5817

5818 5819
	if (!skb_is_gso(skb))
		return 0;
5820

5821
	if (skb_header_cloned(skb)) {
5822
		int err = pskb_expand_head(skb, 0, 0, GFP_ATOMIC);
5823 5824
		if (err)
			return err;
5825 5826
	}

5827 5828 5829
	/* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
	type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;

5830
	if (first->protocol == __constant_htons(ETH_P_IP)) {
5831 5832 5833 5834 5835 5836 5837 5838
		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;
5839 5840 5841
		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
				   IXGBE_TX_FLAGS_CSUM |
				   IXGBE_TX_FLAGS_IPV4;
5842 5843 5844 5845 5846 5847
	} 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);
5848 5849
		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
				   IXGBE_TX_FLAGS_CSUM;
5850 5851
	}

5852
	/* compute header lengths */
5853 5854 5855
	l4len = tcp_hdrlen(skb);
	*hdr_len = skb_transport_offset(skb) + l4len;

5856 5857 5858 5859
	/* update gso size and bytecount with header size */
	first->gso_segs = skb_shinfo(skb)->gso_segs;
	first->bytecount += (first->gso_segs - 1) * *hdr_len;

5860 5861 5862 5863 5864 5865 5866 5867
	/* 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;
5868
	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
5869 5870

	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, 0, type_tucmd,
5871
			  mss_l4len_idx);
5872 5873 5874 5875

	return 1;
}

5876 5877
static void ixgbe_tx_csum(struct ixgbe_ring *tx_ring,
			  struct ixgbe_tx_buffer *first)
5878
{
5879
	struct sk_buff *skb = first->skb;
5880 5881 5882
	u32 vlan_macip_lens = 0;
	u32 mss_l4len_idx = 0;
	u32 type_tucmd = 0;
5883

5884
	if (skb->ip_summed != CHECKSUM_PARTIAL) {
5885 5886 5887
		if (!(first->tx_flags & IXGBE_TX_FLAGS_HW_VLAN) &&
		    !(first->tx_flags & IXGBE_TX_FLAGS_TXSW))
			return;
5888 5889
	} else {
		u8 l4_hdr = 0;
5890
		switch (first->protocol) {
5891 5892 5893 5894
		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;
5895
			break;
5896 5897 5898 5899 5900 5901 5902 5903
		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",
5904
				 first->protocol);
5905
			}
5906 5907
			break;
		}
5908 5909

		switch (l4_hdr) {
5910
		case IPPROTO_TCP:
5911 5912 5913
			type_tucmd |= IXGBE_ADVTXD_TUCMD_L4T_TCP;
			mss_l4len_idx = tcp_hdrlen(skb) <<
					IXGBE_ADVTXD_L4LEN_SHIFT;
5914 5915
			break;
		case IPPROTO_SCTP:
5916 5917 5918 5919 5920 5921 5922 5923 5924 5925 5926 5927
			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",
5928
				 l4_hdr);
5929
			}
5930 5931
			break;
		}
5932 5933 5934

		/* update TX checksum flag */
		first->tx_flags |= IXGBE_TX_FLAGS_CSUM;
5935 5936
	}

5937
	/* vlan_macip_lens: MACLEN, VLAN tag */
5938
	vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
5939
	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
5940

5941 5942
	ixgbe_tx_ctxtdesc(tx_ring, vlan_macip_lens, 0,
			  type_tucmd, mss_l4len_idx);
5943 5944
}

5945
static __le32 ixgbe_tx_cmd_type(u32 tx_flags)
5946
{
5947 5948 5949 5950
	/* set type for advanced descriptor with frame checksum insertion */
	__le32 cmd_type = cpu_to_le32(IXGBE_ADVTXD_DTYP_DATA |
				      IXGBE_ADVTXD_DCMD_IFCS |
				      IXGBE_ADVTXD_DCMD_DEXT);
5951

5952
	/* set HW vlan bit if vlan is present */
5953
	if (tx_flags & IXGBE_TX_FLAGS_HW_VLAN)
5954
		cmd_type |= cpu_to_le32(IXGBE_ADVTXD_DCMD_VLE);
5955

5956 5957 5958 5959 5960
#ifdef CONFIG_IXGBE_PTP
	if (tx_flags & IXGBE_TX_FLAGS_TSTAMP)
		cmd_type |= cpu_to_le32(IXGBE_ADVTXD_MAC_TSTAMP);
#endif

5961 5962
	/* set segmentation enable bits for TSO/FSO */
#ifdef IXGBE_FCOE
5963
	if (tx_flags & (IXGBE_TX_FLAGS_TSO | IXGBE_TX_FLAGS_FSO))
5964 5965 5966 5967
#else
	if (tx_flags & IXGBE_TX_FLAGS_TSO)
#endif
		cmd_type |= cpu_to_le32(IXGBE_ADVTXD_DCMD_TSE);
5968

5969 5970
	return cmd_type;
}
5971

5972 5973
static void ixgbe_tx_olinfo_status(union ixgbe_adv_tx_desc *tx_desc,
				   u32 tx_flags, unsigned int paylen)
5974
{
5975
	__le32 olinfo_status = cpu_to_le32(paylen << IXGBE_ADVTXD_PAYLEN_SHIFT);
5976

5977 5978 5979
	/* 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);
5980

5981 5982 5983
	/* enble IPv4 checksum for TSO */
	if (tx_flags & IXGBE_TX_FLAGS_IPV4)
		olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_POPTS_IXSM);
5984

5985 5986 5987 5988 5989
	/* 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)
5990
#endif
5991 5992
		olinfo_status |= cpu_to_le32(1 << IXGBE_ADVTXD_IDX_SHIFT);

5993 5994 5995 5996
	/*
	 * Check Context must be set if Tx switch is enabled, which it
	 * always is for case where virtual functions are running
	 */
5997 5998 5999
#ifdef IXGBE_FCOE
	if (tx_flags & (IXGBE_TX_FLAGS_TXSW | IXGBE_TX_FLAGS_FCOE))
#else
6000
	if (tx_flags & IXGBE_TX_FLAGS_TXSW)
6001
#endif
6002 6003
		olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_CC);

6004
	tx_desc->read.olinfo_status = olinfo_status;
6005
}
6006

6007 6008 6009 6010 6011 6012 6013
#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)
{
6014
	dma_addr_t dma;
6015
	struct sk_buff *skb = first->skb;
6016
	struct ixgbe_tx_buffer *tx_buffer;
6017
	union ixgbe_adv_tx_desc *tx_desc;
6018
	struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[0];
6019 6020
	unsigned int data_len = skb->data_len;
	unsigned int size = skb_headlen(skb);
6021
	unsigned int paylen = skb->len - hdr_len;
6022
	u32 tx_flags = first->tx_flags;
6023
	__le32 cmd_type;
6024 6025
	u16 i = tx_ring->next_to_use;

6026 6027 6028 6029 6030
	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);

6031 6032
#ifdef IXGBE_FCOE
	if (tx_flags & IXGBE_TX_FLAGS_FCOE) {
6033
		if (data_len < sizeof(struct fcoe_crc_eof)) {
6034 6035
			size -= sizeof(struct fcoe_crc_eof) - data_len;
			data_len = 0;
6036 6037
		} else {
			data_len -= sizeof(struct fcoe_crc_eof);
6038 6039
		}
	}
6040

6041
#endif
6042 6043
	dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
	if (dma_mapping_error(tx_ring->dev, dma))
6044
		goto dma_error;
6045

6046 6047 6048
	/* record length, and DMA address */
	dma_unmap_len_set(first, len, size);
	dma_unmap_addr_set(first, dma, dma);
6049

6050
	tx_desc->read.buffer_addr = cpu_to_le64(dma);
6051

6052
	for (;;) {
6053
		while (unlikely(size > IXGBE_MAX_DATA_PER_TXD)) {
6054 6055
			tx_desc->read.cmd_type_len =
				cmd_type | cpu_to_le32(IXGBE_MAX_DATA_PER_TXD);
6056

6057
			i++;
6058
			tx_desc++;
6059
			if (i == tx_ring->count) {
6060
				tx_desc = IXGBE_TX_DESC(tx_ring, 0);
6061 6062
				i = 0;
			}
6063 6064 6065 6066 6067 6068

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

6071 6072
		if (likely(!data_len))
			break;
6073

6074 6075
		if (unlikely(skb->no_fcs))
			cmd_type &= ~(cpu_to_le32(IXGBE_ADVTXD_DCMD_IFCS));
6076
		tx_desc->read.cmd_type_len = cmd_type | cpu_to_le32(size);
6077

6078 6079 6080 6081 6082 6083
		i++;
		tx_desc++;
		if (i == tx_ring->count) {
			tx_desc = IXGBE_TX_DESC(tx_ring, 0);
			i = 0;
		}
6084

6085
#ifdef IXGBE_FCOE
E
Eric Dumazet 已提交
6086
		size = min_t(unsigned int, data_len, skb_frag_size(frag));
6087
#else
E
Eric Dumazet 已提交
6088
		size = skb_frag_size(frag);
6089 6090
#endif
		data_len -= size;
6091

6092 6093 6094
		dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
				       DMA_TO_DEVICE);
		if (dma_mapping_error(tx_ring->dev, dma))
6095
			goto dma_error;
6096

6097 6098 6099
		tx_buffer = &tx_ring->tx_buffer_info[i];
		dma_unmap_len_set(tx_buffer, len, size);
		dma_unmap_addr_set(tx_buffer, dma, dma);
6100

6101 6102
		tx_desc->read.buffer_addr = cpu_to_le64(dma);
		tx_desc->read.olinfo_status = 0;
6103

6104 6105
		frag++;
	}
6106

6107 6108 6109
	/* 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;
6110

6111
	netdev_tx_sent_queue(txring_txq(tx_ring), first->bytecount);
6112

6113 6114
	/* set the timestamp */
	first->time_stamp = jiffies;
6115 6116

	/*
6117 6118 6119 6120 6121 6122
	 * 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.
6123 6124 6125
	 */
	wmb();

6126 6127 6128
	/* set next_to_watch value indicating a packet is present */
	first->next_to_watch = tx_desc;

6129 6130 6131 6132 6133 6134
	i++;
	if (i == tx_ring->count)
		i = 0;

	tx_ring->next_to_use = i;

6135
	/* notify HW of packet */
6136
	writel(i, tx_ring->tail);
6137 6138 6139

	return;
dma_error:
6140
	dev_err(tx_ring->dev, "TX DMA map failed\n");
6141 6142 6143

	/* clear dma mappings for failed tx_buffer_info map */
	for (;;) {
6144 6145 6146
		tx_buffer = &tx_ring->tx_buffer_info[i];
		ixgbe_unmap_and_free_tx_resource(tx_ring, tx_buffer);
		if (tx_buffer == first)
6147 6148 6149 6150 6151 6152 6153
			break;
		if (i == 0)
			i = tx_ring->count;
		i--;
	}

	tx_ring->next_to_use = i;
6154 6155
}

6156
static void ixgbe_atr(struct ixgbe_ring *ring,
6157
		      struct ixgbe_tx_buffer *first)
6158 6159 6160 6161 6162 6163 6164 6165 6166
{
	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;
6167
	struct tcphdr *th;
6168
	__be16 vlan_id;
6169

6170 6171 6172 6173 6174 6175
	/* 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)
6176
		return;
6177

6178
	ring->atr_count++;
6179

6180
	/* snag network header to get L4 type and address */
6181
	hdr.network = skb_network_header(first->skb);
6182 6183

	/* Currently only IPv4/IPv6 with TCP is supported */
6184
	if ((first->protocol != __constant_htons(ETH_P_IPV6) ||
6185
	     hdr.ipv6->nexthdr != IPPROTO_TCP) &&
6186
	    (first->protocol != __constant_htons(ETH_P_IP) ||
6187 6188
	     hdr.ipv4->protocol != IPPROTO_TCP))
		return;
6189

6190
	th = tcp_hdr(first->skb);
6191

6192 6193
	/* skip this packet since it is invalid or the socket is closing */
	if (!th || th->fin)
6194 6195 6196 6197 6198 6199 6200 6201 6202
		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;

6203
	vlan_id = htons(first->tx_flags >> IXGBE_TX_FLAGS_VLAN_SHIFT);
6204 6205 6206 6207 6208 6209 6210 6211 6212 6213 6214 6215 6216 6217

	/*
	 * 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
	 */
6218
	if (first->tx_flags & (IXGBE_TX_FLAGS_SW_VLAN | IXGBE_TX_FLAGS_HW_VLAN))
6219 6220
		common.port.src ^= th->dest ^ __constant_htons(ETH_P_8021Q);
	else
6221
		common.port.src ^= th->dest ^ first->protocol;
6222 6223
	common.port.dst ^= th->source;

6224
	if (first->protocol == __constant_htons(ETH_P_IP)) {
6225 6226 6227 6228 6229 6230 6231 6232 6233 6234 6235 6236 6237
		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];
	}
6238 6239

	/* This assumes the Rx queue and Tx queue are bound to the same CPU */
6240 6241
	ixgbe_fdir_add_signature_filter_82599(&q_vector->adapter->hw,
					      input, common, ring->queue_index);
6242 6243
}

6244
static int __ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
6245
{
6246
	netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);
6247 6248 6249 6250 6251 6252 6253
	/* 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. */
6254
	if (likely(ixgbe_desc_unused(tx_ring) < size))
6255 6256 6257
		return -EBUSY;

	/* A reprieve! - use start_queue because it doesn't call schedule */
6258
	netif_start_subqueue(tx_ring->netdev, tx_ring->queue_index);
6259
	++tx_ring->tx_stats.restart_queue;
6260 6261 6262
	return 0;
}

6263
static inline int ixgbe_maybe_stop_tx(struct ixgbe_ring *tx_ring, u16 size)
6264
{
6265
	if (likely(ixgbe_desc_unused(tx_ring) >= size))
6266
		return 0;
6267
	return __ixgbe_maybe_stop_tx(tx_ring, size);
6268 6269
}

6270 6271 6272
static u16 ixgbe_select_queue(struct net_device *dev, struct sk_buff *skb)
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
6273 6274
	int txq = skb_rx_queue_recorded(skb) ? skb_get_rx_queue(skb) :
					       smp_processor_id();
6275
#ifdef IXGBE_FCOE
6276
	__be16 protocol = vlan_get_protocol(skb);
6277

6278 6279 6280
	if (((protocol == htons(ETH_P_FCOE)) ||
	    (protocol == htons(ETH_P_FIP))) &&
	    (adapter->flags & IXGBE_FLAG_FCOE_ENABLED)) {
6281 6282 6283 6284 6285 6286
		struct ixgbe_ring_feature *f;

		f = &adapter->ring_feature[RING_F_FCOE];

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

6289
		return txq;
6290 6291 6292
	}
#endif

K
Krishna Kumar 已提交
6293 6294 6295
	if (adapter->flags & IXGBE_FLAG_FDIR_HASH_CAPABLE) {
		while (unlikely(txq >= dev->real_num_tx_queues))
			txq -= dev->real_num_tx_queues;
6296
		return txq;
K
Krishna Kumar 已提交
6297
	}
6298

6299 6300 6301
	return skb_tx_hash(dev, skb);
}

6302
netdev_tx_t ixgbe_xmit_frame_ring(struct sk_buff *skb,
6303 6304
			  struct ixgbe_adapter *adapter,
			  struct ixgbe_ring *tx_ring)
6305
{
6306
	struct ixgbe_tx_buffer *first;
6307
	int tso;
6308
	u32 tx_flags = 0;
6309 6310 6311 6312
#if PAGE_SIZE > IXGBE_MAX_DATA_PER_TXD
	unsigned short f;
#endif
	u16 count = TXD_USE_COUNT(skb_headlen(skb));
6313
	__be16 protocol = skb->protocol;
6314
	u8 hdr_len = 0;
6315

6316 6317
	/*
	 * need: 1 descriptor per page * PAGE_SIZE/IXGBE_MAX_DATA_PER_TXD,
6318
	 *       + 1 desc for skb_headlen/IXGBE_MAX_DATA_PER_TXD,
6319 6320 6321 6322 6323 6324 6325 6326 6327 6328 6329 6330 6331 6332 6333
	 *       + 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;
	}

6334 6335 6336
	/* record the location of the first descriptor for this packet */
	first = &tx_ring->tx_buffer_info[tx_ring->next_to_use];
	first->skb = skb;
6337 6338
	first->bytecount = skb->len;
	first->gso_segs = 1;
6339

6340
	/* if we have a HW VLAN tag being added default to the HW one */
6341
	if (vlan_tx_tag_present(skb)) {
6342 6343 6344 6345 6346 6347 6348 6349 6350 6351
		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;
6352 6353
		tx_flags |= ntohs(vhdr->h_vlan_TCI) <<
				  IXGBE_TX_FLAGS_VLAN_SHIFT;
6354 6355 6356
		tx_flags |= IXGBE_TX_FLAGS_SW_VLAN;
	}

6357 6358
	skb_tx_timestamp(skb);

6359 6360 6361 6362 6363 6364 6365
#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

6366 6367 6368 6369 6370 6371 6372 6373 6374
#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
6375
	/* DCB maps skb priorities 0-7 onto 3 bit PCP of VLAN tag. */
6376
	if ((adapter->flags & IXGBE_FLAG_DCB_ENABLED) &&
6377 6378
	    ((tx_flags & (IXGBE_TX_FLAGS_HW_VLAN | IXGBE_TX_FLAGS_SW_VLAN)) ||
	     (skb->priority != TC_PRIO_CONTROL))) {
6379
		tx_flags &= ~IXGBE_TX_FLAGS_VLAN_PRIO_MASK;
6380 6381
		tx_flags |= (skb->priority & 0x7) <<
					IXGBE_TX_FLAGS_VLAN_PRIO_SHIFT;
6382 6383 6384 6385 6386 6387 6388 6389 6390 6391
		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;
6392
		}
6393
	}
6394

6395 6396 6397 6398
	/* record initial flags and protocol */
	first->tx_flags = tx_flags;
	first->protocol = protocol;

6399
#ifdef IXGBE_FCOE
6400 6401
	/* setup tx offload for FCoE */
	if ((protocol == __constant_htons(ETH_P_FCOE)) &&
6402
	    (tx_ring->netdev->features & (NETIF_F_FSO | NETIF_F_FCOE_CRC))) {
6403
		tso = ixgbe_fso(tx_ring, first, &hdr_len);
6404 6405
		if (tso < 0)
			goto out_drop;
6406

6407
		goto xmit_fcoe;
6408
	}
6409

6410
#endif /* IXGBE_FCOE */
6411
	tso = ixgbe_tso(tx_ring, first, &hdr_len);
6412
	if (tso < 0)
6413
		goto out_drop;
6414 6415
	else if (!tso)
		ixgbe_tx_csum(tx_ring, first);
6416 6417 6418

	/* add the ATR filter if ATR is on */
	if (test_bit(__IXGBE_TX_FDIR_INIT_DONE, &tx_ring->state))
6419
		ixgbe_atr(tx_ring, first);
6420 6421 6422 6423

#ifdef IXGBE_FCOE
xmit_fcoe:
#endif /* IXGBE_FCOE */
6424
	ixgbe_tx_map(tx_ring, first, hdr_len);
6425 6426

	ixgbe_maybe_stop_tx(tx_ring, DESC_NEEDED);
6427 6428

	return NETDEV_TX_OK;
6429 6430

out_drop:
6431 6432 6433
	dev_kfree_skb_any(first->skb);
	first->skb = NULL;

6434
	return NETDEV_TX_OK;
6435 6436
}

6437 6438
static netdev_tx_t ixgbe_xmit_frame(struct sk_buff *skb,
				    struct net_device *netdev)
6439 6440 6441 6442
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
	struct ixgbe_ring *tx_ring;

6443 6444 6445 6446
	/*
	 * The minimum packet size for olinfo paylen is 17 so pad the skb
	 * in order to meet this minimum size requirement.
	 */
6447 6448
	if (unlikely(skb->len < 17)) {
		if (skb_pad(skb, 17 - skb->len))
6449 6450 6451 6452
			return NETDEV_TX_OK;
		skb->len = 17;
	}

6453
	tx_ring = adapter->tx_ring[skb->queue_mapping];
6454
	return ixgbe_xmit_frame_ring(skb, adapter, tx_ring);
6455 6456
}

6457 6458 6459 6460 6461 6462 6463 6464 6465 6466
/**
 * 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);
6467
	struct ixgbe_hw *hw = &adapter->hw;
6468 6469 6470 6471 6472 6473
	struct sockaddr *addr = p;

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

	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
6474
	memcpy(hw->mac.addr, addr->sa_data, netdev->addr_len);
6475

6476
	hw->mac.ops.set_rar(hw, 0, hw->mac.addr, VMDQ_P(0), IXGBE_RAH_AV);
6477 6478 6479 6480

	return 0;
}

6481 6482 6483 6484 6485 6486 6487 6488 6489 6490 6491 6492 6493 6494 6495 6496 6497 6498 6499 6500 6501 6502 6503 6504 6505 6506 6507 6508 6509 6510 6511
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);

6512 6513 6514 6515 6516 6517 6518 6519
	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);
	}
6520 6521
}

6522 6523
/**
 * ixgbe_add_sanmac_netdev - Add the SAN MAC address to the corresponding
6524
 * netdev->dev_addrs
6525 6526 6527 6528 6529 6530 6531 6532
 * @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);
6533
	struct ixgbe_hw *hw = &adapter->hw;
6534

6535
	if (is_valid_ether_addr(hw->mac.san_addr)) {
6536
		rtnl_lock();
6537
		err = dev_addr_add(dev, hw->mac.san_addr, NETDEV_HW_ADDR_T_SAN);
6538
		rtnl_unlock();
6539 6540 6541

		/* update SAN MAC vmdq pool selection */
		hw->mac.ops.set_vmdq_san_mac(hw, VMDQ_P(0));
6542 6543 6544 6545 6546 6547
	}
	return err;
}

/**
 * ixgbe_del_sanmac_netdev - Removes the SAN MAC address to the corresponding
6548
 * netdev->dev_addrs
6549 6550 6551 6552 6553 6554 6555 6556 6557 6558 6559 6560 6561 6562 6563 6564 6565 6566
 * @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;
}

6567 6568 6569 6570 6571 6572 6573 6574 6575
#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);
6576
	int i;
6577

6578 6579 6580 6581
	/* if interface is down do nothing */
	if (test_bit(__IXGBE_DOWN, &adapter->state))
		return;

6582
	adapter->flags |= IXGBE_FLAG_IN_NETPOLL;
6583
	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
6584 6585
		for (i = 0; i < adapter->num_q_vectors; i++)
			ixgbe_msix_clean_rings(0, adapter->q_vector[i]);
6586 6587 6588
	} else {
		ixgbe_intr(adapter->pdev->irq, netdev);
	}
6589 6590 6591
	adapter->flags &= ~IXGBE_FLAG_IN_NETPOLL;
}

A
Alexander Duyck 已提交
6592
#endif
E
Eric Dumazet 已提交
6593 6594 6595 6596 6597 6598
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 已提交
6599
	rcu_read_lock();
E
Eric Dumazet 已提交
6600
	for (i = 0; i < adapter->num_rx_queues; i++) {
E
Eric Dumazet 已提交
6601
		struct ixgbe_ring *ring = ACCESS_ONCE(adapter->rx_ring[i]);
E
Eric Dumazet 已提交
6602 6603 6604
		u64 bytes, packets;
		unsigned int start;

E
Eric Dumazet 已提交
6605 6606 6607 6608 6609 6610 6611 6612 6613
		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 已提交
6614
	}
E
Eric Dumazet 已提交
6615 6616 6617 6618 6619 6620 6621 6622 6623 6624 6625 6626 6627 6628 6629 6630

	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 已提交
6631
	rcu_read_unlock();
E
Eric Dumazet 已提交
6632 6633 6634 6635 6636 6637 6638 6639 6640
	/* 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;
}

6641
#ifdef CONFIG_IXGBE_DCB
6642 6643 6644
/**
 * ixgbe_validate_rtr - verify 802.1Qp to Rx packet buffer mapping is valid.
 * @adapter: pointer to ixgbe_adapter
6645 6646 6647 6648 6649 6650 6651 6652 6653 6654 6655 6656 6657 6658 6659 6660 6661 6662 6663 6664 6665 6666 6667 6668 6669 6670 6671 6672 6673 6674 6675 6676 6677 6678
 * @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;
}

6679 6680 6681 6682 6683 6684 6685 6686 6687 6688 6689 6690 6691 6692 6693 6694 6695 6696 6697 6698 6699 6700 6701 6702 6703
/**
 * 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);
	}
}

6704 6705
/**
 * ixgbe_setup_tc - configure net_device for multiple traffic classes
6706 6707 6708 6709 6710 6711 6712 6713 6714 6715
 *
 * @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 */
6716
	if (tc > adapter->dcb_cfg.num_tcs.pg_tcs ||
A
Alexander Duyck 已提交
6717 6718
	    (hw->mac.type == ixgbe_mac_82598EB &&
	     tc < MAX_TRAFFIC_CLASS))
6719 6720 6721
		return -EINVAL;

	/* Hardware has to reinitialize queues and interrupts to
S
Stephen Hemminger 已提交
6722
	 * match packet buffer alignment. Unfortunately, the
6723 6724 6725 6726 6727 6728
	 * hardware is not flexible enough to do this dynamically.
	 */
	if (netif_running(dev))
		ixgbe_close(dev);
	ixgbe_clear_interrupt_scheme(adapter);

6729
	if (tc) {
6730
		netdev_set_num_tc(dev, tc);
6731 6732
		ixgbe_set_prio_tc_map(adapter);

6733 6734
		adapter->flags |= IXGBE_FLAG_DCB_ENABLED;

6735 6736
		if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
			adapter->last_lfc_mode = adapter->hw.fc.requested_mode;
6737
			adapter->hw.fc.requested_mode = ixgbe_fc_none;
6738
		}
6739
	} else {
6740
		netdev_reset_tc(dev);
6741

6742 6743
		if (adapter->hw.mac.type == ixgbe_mac_82598EB)
			adapter->hw.fc.requested_mode = adapter->last_lfc_mode;
6744 6745 6746 6747 6748 6749 6750

		adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;

		adapter->temp_dcb_cfg.pfc_mode_enable = false;
		adapter->dcb_cfg.pfc_mode_enable = false;
	}

6751 6752 6753 6754 6755 6756 6757
	ixgbe_init_interrupt_scheme(adapter);
	ixgbe_validate_rtr(adapter, tc);
	if (netif_running(dev))
		ixgbe_open(dev);

	return 0;
}
E
Eric Dumazet 已提交
6758

6759
#endif /* CONFIG_IXGBE_DCB */
6760 6761 6762 6763 6764 6765 6766 6767 6768 6769
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);
}

6770
static netdev_features_t ixgbe_fix_features(struct net_device *netdev,
6771
					    netdev_features_t features)
6772 6773 6774 6775
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);

	/* If Rx checksum is disabled, then RSC/LRO should also be disabled */
6776 6777
	if (!(features & NETIF_F_RXCSUM))
		features &= ~NETIF_F_LRO;
6778

6779 6780 6781
	/* Turn off LRO if not RSC capable */
	if (!(adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE))
		features &= ~NETIF_F_LRO;
6782

6783
	return features;
6784 6785
}

6786
static int ixgbe_set_features(struct net_device *netdev,
6787
			      netdev_features_t features)
6788 6789
{
	struct ixgbe_adapter *adapter = netdev_priv(netdev);
6790
	netdev_features_t changed = netdev->features ^ features;
6791 6792 6793
	bool need_reset = false;

	/* Make sure RSC matches LRO, reset if change */
6794 6795
	if (!(features & NETIF_F_LRO)) {
		if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
6796
			need_reset = true;
6797 6798 6799 6800 6801 6802 6803 6804 6805 6806
		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");
6807 6808 6809 6810 6811 6812 6813
		}
	}

	/*
	 * Check if Flow Director n-tuple support was enabled or disabled.  If
	 * the state changed, we need to reset.
	 */
6814 6815
	switch (features & NETIF_F_NTUPLE) {
	case NETIF_F_NTUPLE:
6816
		/* turn off ATR, enable perfect filters and reset */
6817 6818 6819
		if (!(adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE))
			need_reset = true;

6820 6821
		adapter->flags &= ~IXGBE_FLAG_FDIR_HASH_CAPABLE;
		adapter->flags |= IXGBE_FLAG_FDIR_PERFECT_CAPABLE;
6822 6823 6824 6825 6826 6827 6828 6829 6830 6831 6832 6833 6834 6835 6836 6837 6838 6839 6840 6841 6842 6843 6844 6845 6846 6847
		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;
6848 6849
	}

6850 6851 6852 6853 6854
	if (features & NETIF_F_HW_VLAN_RX)
		ixgbe_vlan_strip_enable(adapter);
	else
		ixgbe_vlan_strip_disable(adapter);

B
Ben Greear 已提交
6855 6856 6857
	if (changed & NETIF_F_RXALL)
		need_reset = true;

6858
	netdev->features = features;
6859 6860 6861 6862 6863 6864
	if (need_reset)
		ixgbe_do_reset(netdev);

	return 0;
}

J
John Fastabend 已提交
6865 6866 6867 6868 6869 6870
static int ixgbe_ndo_fdb_add(struct ndmsg *ndm,
			     struct net_device *dev,
			     unsigned char *addr,
			     u16 flags)
{
	struct ixgbe_adapter *adapter = netdev_priv(dev);
6871 6872 6873 6874
	int err;

	if (!(adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
		return -EOPNOTSUPP;
J
John Fastabend 已提交
6875 6876 6877 6878 6879 6880 6881

	if (ndm->ndm_state & NUD_PERMANENT) {
		pr_info("%s: FDB only supports static addresses\n",
			ixgbe_driver_name);
		return -EINVAL;
	}

6882 6883 6884 6885
	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 已提交
6886 6887
			err = dev_uc_add_excl(dev, addr);
		else
6888 6889 6890 6891 6892
			err = -ENOMEM;
	} else if (is_multicast_ether_addr(addr)) {
		err = dev_mc_add_excl(dev, addr);
	} else {
		err = -EINVAL;
J
John Fastabend 已提交
6893 6894 6895 6896 6897 6898 6899 6900 6901 6902 6903 6904 6905 6906 6907 6908 6909 6910 6911 6912 6913 6914 6915 6916 6917 6918 6919 6920 6921 6922 6923 6924 6925 6926 6927 6928 6929 6930 6931 6932 6933 6934 6935 6936 6937 6938 6939
	}

	/* 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,
			     unsigned char *addr)
{
	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;
}

6940
static const struct net_device_ops ixgbe_netdev_ops = {
6941
	.ndo_open		= ixgbe_open,
6942
	.ndo_stop		= ixgbe_close,
6943
	.ndo_start_xmit		= ixgbe_xmit_frame,
6944
	.ndo_select_queue	= ixgbe_select_queue,
A
Alexander Duyck 已提交
6945
	.ndo_set_rx_mode	= ixgbe_set_rx_mode,
6946 6947 6948 6949 6950 6951
	.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,
6952
	.ndo_do_ioctl		= ixgbe_ioctl,
6953 6954 6955
	.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 已提交
6956
	.ndo_set_vf_spoofchk	= ixgbe_ndo_set_vf_spoofchk,
6957
	.ndo_get_vf_config	= ixgbe_ndo_get_vf_config,
E
Eric Dumazet 已提交
6958
	.ndo_get_stats64	= ixgbe_get_stats64,
6959
#ifdef CONFIG_IXGBE_DCB
J
John Fastabend 已提交
6960
	.ndo_setup_tc		= ixgbe_setup_tc,
6961
#endif
6962 6963 6964
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= ixgbe_netpoll,
#endif
6965 6966
#ifdef IXGBE_FCOE
	.ndo_fcoe_ddp_setup = ixgbe_fcoe_ddp_get,
6967
	.ndo_fcoe_ddp_target = ixgbe_fcoe_ddp_target,
6968
	.ndo_fcoe_ddp_done = ixgbe_fcoe_ddp_put,
6969 6970
	.ndo_fcoe_enable = ixgbe_fcoe_enable,
	.ndo_fcoe_disable = ixgbe_fcoe_disable,
6971
	.ndo_fcoe_get_wwn = ixgbe_fcoe_get_wwn,
6972
	.ndo_fcoe_get_hbainfo = ixgbe_fcoe_get_hbainfo,
6973
#endif /* IXGBE_FCOE */
6974 6975
	.ndo_set_features = ixgbe_set_features,
	.ndo_fix_features = ixgbe_fix_features,
J
John Fastabend 已提交
6976 6977 6978
	.ndo_fdb_add		= ixgbe_ndo_fdb_add,
	.ndo_fdb_del		= ixgbe_ndo_fdb_del,
	.ndo_fdb_dump		= ixgbe_ndo_fdb_dump,
6979 6980
};

6981 6982 6983 6984 6985 6986 6987 6988 6989 6990 6991 6992 6993 6994 6995 6996 6997 6998 6999 7000 7001 7002 7003 7004 7005 7006
/**
 * 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:
7007
		case IXGBE_SUBDEV_ID_82599_RNDC:
7008 7009 7010 7011 7012 7013 7014 7015 7016 7017 7018 7019 7020 7021 7022 7023 7024 7025 7026 7027 7028 7029 7030 7031 7032
			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:
		/* 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;
}

7033 7034 7035 7036 7037 7038 7039 7040 7041 7042 7043 7044
/**
 * 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,
7045
				 const struct pci_device_id *ent)
7046 7047 7048 7049 7050 7051 7052
{
	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;
7053
	u8 part_str[IXGBE_PBANUM_LENGTH];
7054
	unsigned int indices = num_possible_cpus();
7055
	unsigned int dcb_max = 0;
7056 7057 7058
#ifdef IXGBE_FCOE
	u16 device_caps;
#endif
7059
	u32 eec;
7060

7061 7062 7063 7064 7065 7066 7067 7068 7069
	/* 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;
	}

7070
	err = pci_enable_device_mem(pdev);
7071 7072 7073
	if (err)
		return err;

7074 7075
	if (!dma_set_mask(&pdev->dev, DMA_BIT_MASK(64)) &&
	    !dma_set_coherent_mask(&pdev->dev, DMA_BIT_MASK(64))) {
7076 7077
		pci_using_dac = 1;
	} else {
7078
		err = dma_set_mask(&pdev->dev, DMA_BIT_MASK(32));
7079
		if (err) {
7080 7081
			err = dma_set_coherent_mask(&pdev->dev,
						    DMA_BIT_MASK(32));
7082
			if (err) {
7083 7084
				dev_err(&pdev->dev,
					"No usable DMA configuration, aborting\n");
7085 7086 7087 7088 7089 7090
				goto err_dma;
			}
		}
		pci_using_dac = 0;
	}

7091
	err = pci_request_selected_regions(pdev, pci_select_bars(pdev,
7092
					   IORESOURCE_MEM), ixgbe_driver_name);
7093
	if (err) {
7094 7095
		dev_err(&pdev->dev,
			"pci_request_selected_regions failed 0x%x\n", err);
7096 7097 7098
		goto err_pci_reg;
	}

7099
	pci_enable_pcie_error_reporting(pdev);
7100

7101
	pci_set_master(pdev);
7102
	pci_save_state(pdev);
7103

7104
#ifdef CONFIG_IXGBE_DCB
7105 7106 7107 7108 7109 7110
	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);
7111 7112
#endif

7113 7114 7115 7116 7117
	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);

7118
#ifdef IXGBE_FCOE
7119 7120 7121
	indices += min_t(unsigned int, num_possible_cpus(),
			 IXGBE_MAX_FCOE_INDICES);
#endif
7122
	indices = max_t(unsigned int, dcb_max, indices);
7123
	netdev = alloc_etherdev_mq(sizeof(struct ixgbe_adapter), indices);
7124 7125 7126 7127 7128 7129 7130 7131
	if (!netdev) {
		err = -ENOMEM;
		goto err_alloc_etherdev;
	}

	SET_NETDEV_DEV(netdev, &pdev->dev);

	adapter = netdev_priv(netdev);
7132
	pci_set_drvdata(pdev, adapter);
7133 7134 7135 7136 7137

	adapter->netdev = netdev;
	adapter->pdev = pdev;
	hw = &adapter->hw;
	hw->back = adapter;
7138
	adapter->msg_enable = netif_msg_init(debug, DEFAULT_MSG_ENABLE);
7139

7140
	hw->hw_addr = ioremap(pci_resource_start(pdev, 0),
7141
			      pci_resource_len(pdev, 0));
7142 7143 7144 7145 7146 7147 7148 7149 7150 7151
	if (!hw->hw_addr) {
		err = -EIO;
		goto err_ioremap;
	}

	for (i = 1; i <= 5; i++) {
		if (pci_resource_len(pdev, i) == 0)
			continue;
	}

7152
	netdev->netdev_ops = &ixgbe_netdev_ops;
7153 7154
	ixgbe_set_ethtool_ops(netdev);
	netdev->watchdog_timeo = 5 * HZ;
7155
	strncpy(netdev->name, pci_name(pdev), sizeof(netdev->name) - 1);
7156 7157 7158 7159 7160

	adapter->bd_number = cards_found;

	/* Setup hw api */
	memcpy(&hw->mac.ops, ii->mac_ops, sizeof(hw->mac.ops));
7161
	hw->mac.type  = ii->mac;
7162

7163 7164 7165 7166 7167 7168 7169 7170 7171
	/* 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 已提交
7172
	hw->phy.sfp_type = ixgbe_sfp_type_unknown;
7173 7174 7175 7176 7177 7178 7179
	/* 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 已提交
7180

7181
	ii->get_invariants(hw);
7182 7183 7184 7185 7186 7187

	/* setup the private structure */
	err = ixgbe_sw_init(adapter);
	if (err)
		goto err_sw_init;

7188
	/* Make it possible the adapter to be woken up via WOL */
D
Don Skidmore 已提交
7189 7190 7191
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
7192
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
D
Don Skidmore 已提交
7193 7194 7195 7196
		break;
	default:
		break;
	}
7197

7198 7199 7200 7201 7202 7203 7204
	/*
	 * 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)
7205
			e_crit(probe, "Fan has stopped, replace the adapter\n");
7206 7207
	}

7208 7209 7210
	if (allow_unsupported_sfp)
		hw->allow_unsupported_sfp = allow_unsupported_sfp;

7211
	/* reset_hw fills in the perm_addr as well */
7212
	hw->phy.reset_if_overtemp = true;
7213
	err = hw->mac.ops.reset_hw(hw);
7214
	hw->phy.reset_if_overtemp = false;
7215 7216 7217 7218
	if (err == IXGBE_ERR_SFP_NOT_PRESENT &&
	    hw->mac.type == ixgbe_mac_82598EB) {
		err = 0;
	} else if (err == IXGBE_ERR_SFP_NOT_SUPPORTED) {
7219
		e_dev_err("failed to load because an unsupported SFP+ "
7220 7221 7222
			  "module type was detected.\n");
		e_dev_err("Reload the driver after installing a supported "
			  "module.\n");
7223 7224
		goto err_sw_init;
	} else if (err) {
7225
		e_dev_err("HW Init failed: %d\n", err);
7226 7227 7228
		goto err_sw_init;
	}

7229 7230
#ifdef CONFIG_PCI_IOV
	ixgbe_enable_sriov(adapter, ii);
7231

7232
#endif
7233
	netdev->features = NETIF_F_SG |
7234
			   NETIF_F_IP_CSUM |
7235
			   NETIF_F_IPV6_CSUM |
7236 7237
			   NETIF_F_HW_VLAN_TX |
			   NETIF_F_HW_VLAN_RX |
7238 7239 7240 7241 7242
			   NETIF_F_HW_VLAN_FILTER |
			   NETIF_F_TSO |
			   NETIF_F_TSO6 |
			   NETIF_F_RXHASH |
			   NETIF_F_RXCSUM;
7243

7244
	netdev->hw_features = netdev->features;
7245

7246 7247 7248
	switch (adapter->hw.mac.type) {
	case ixgbe_mac_82599EB:
	case ixgbe_mac_X540:
7249
		netdev->features |= NETIF_F_SCTP_CSUM;
7250 7251
		netdev->hw_features |= NETIF_F_SCTP_CSUM |
				       NETIF_F_NTUPLE;
7252 7253 7254 7255
		break;
	default:
		break;
	}
7256

B
Ben Greear 已提交
7257 7258
	netdev->hw_features |= NETIF_F_RXALL;

7259 7260
	netdev->vlan_features |= NETIF_F_TSO;
	netdev->vlan_features |= NETIF_F_TSO6;
7261
	netdev->vlan_features |= NETIF_F_IP_CSUM;
7262
	netdev->vlan_features |= NETIF_F_IPV6_CSUM;
7263 7264
	netdev->vlan_features |= NETIF_F_SG;

7265
	netdev->priv_flags |= IFF_UNICAST_FLT;
7266
	netdev->priv_flags |= IFF_SUPP_NOFCS;
7267

J
Jeff Kirsher 已提交
7268
#ifdef CONFIG_IXGBE_DCB
7269 7270 7271
	netdev->dcbnl_ops = &dcbnl_ops;
#endif

7272
#ifdef IXGBE_FCOE
7273
	if (adapter->flags & IXGBE_FLAG_FCOE_CAPABLE) {
7274 7275
		if (hw->mac.ops.get_device_caps) {
			hw->mac.ops.get_device_caps(hw, &device_caps);
7276 7277
			if (device_caps & IXGBE_DEVICE_CAPS_FCOE_OFFLOADS)
				adapter->flags &= ~IXGBE_FLAG_FCOE_CAPABLE;
7278
		}
7279 7280 7281

		adapter->ring_feature[RING_F_FCOE].limit = IXGBE_FCRETA_SIZE;

7282 7283 7284
		netdev->features |= NETIF_F_FSO |
				    NETIF_F_FCOE_CRC;

7285 7286 7287
		netdev->vlan_features |= NETIF_F_FSO |
					 NETIF_F_FCOE_CRC |
					 NETIF_F_FCOE_MTU;
7288
	}
7289
#endif /* IXGBE_FCOE */
7290
	if (pci_using_dac) {
7291
		netdev->features |= NETIF_F_HIGHDMA;
7292 7293
		netdev->vlan_features |= NETIF_F_HIGHDMA;
	}
7294

7295 7296
	if (adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE)
		netdev->hw_features |= NETIF_F_LRO;
7297
	if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)
A
Alexander Duyck 已提交
7298 7299
		netdev->features |= NETIF_F_LRO;

7300
	/* make sure the EEPROM is good */
7301
	if (hw->eeprom.ops.validate_checksum(hw, NULL) < 0) {
7302
		e_dev_err("The EEPROM Checksum Is Not Valid\n");
7303
		err = -EIO;
7304
		goto err_sw_init;
7305 7306 7307 7308 7309
	}

	memcpy(netdev->dev_addr, hw->mac.perm_addr, netdev->addr_len);
	memcpy(netdev->perm_addr, hw->mac.perm_addr, netdev->addr_len);

7310
	if (ixgbe_validate_mac_addr(netdev->perm_addr)) {
7311
		e_dev_err("invalid MAC address\n");
7312
		err = -EIO;
7313
		goto err_sw_init;
7314 7315
	}

7316
	setup_timer(&adapter->service_timer, &ixgbe_service_timer,
A
Alexander Duyck 已提交
7317
		    (unsigned long) adapter);
7318

7319 7320
	INIT_WORK(&adapter->service_task, ixgbe_service_task);
	clear_bit(__IXGBE_SERVICE_SCHED, &adapter->state);
7321

7322 7323 7324
	err = ixgbe_init_interrupt_scheme(adapter);
	if (err)
		goto err_sw_init;
7325

7326
	/* WOL not supported for all devices */
E
Emil Tantilov 已提交
7327
	adapter->wol = 0;
7328 7329
	hw->eeprom.ops.read(hw, 0x2c, &adapter->eeprom_cap);
	if (ixgbe_wol_supported(adapter, pdev->device, pdev->subsystem_device))
7330
		adapter->wol = IXGBE_WUFC_MAG;
E
Emil Tantilov 已提交
7331

7332 7333
	device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);

7334 7335 7336 7337
#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_init(adapter);
#endif /* CONFIG_IXGBE_PTP*/

7338 7339 7340 7341
	/* save off EEPROM version number */
	hw->eeprom.ops.read(hw, 0x2e, &adapter->eeprom_verh);
	hw->eeprom.ops.read(hw, 0x2d, &adapter->eeprom_verl);

7342 7343 7344
	/* pick up the PCI bus settings for reporting later */
	hw->mac.ops.get_bus_info(hw);

7345
	/* print bus type/speed/width info */
7346
	e_dev_info("(PCI Express:%s:%s) %pM\n",
7347 7348
		   (hw->bus.speed == ixgbe_bus_speed_5000 ? "5.0GT/s" :
		    hw->bus.speed == ixgbe_bus_speed_2500 ? "2.5GT/s" :
7349 7350 7351 7352 7353 7354
		    "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);
7355 7356 7357

	err = ixgbe_read_pba_string_generic(hw, part_str, IXGBE_PBANUM_LENGTH);
	if (err)
7358
		strncpy(part_str, "Unknown", IXGBE_PBANUM_LENGTH);
7359
	if (ixgbe_is_sfp(hw) && hw->phy.sfp_type != ixgbe_sfp_type_not_present)
7360
		e_dev_info("MAC: %d, PHY: %d, SFP+: %d, PBA No: %s\n",
7361
			   hw->mac.type, hw->phy.type, hw->phy.sfp_type,
7362
		           part_str);
7363
	else
7364 7365
		e_dev_info("MAC: %d, PHY: %d, PBA No: %s\n",
			   hw->mac.type, hw->phy.type, part_str);
7366

7367
	if (hw->bus.width <= ixgbe_bus_width_pcie_x4) {
7368 7369 7370 7371
		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");
7372 7373
	}

7374
	/* reset the hardware with the new settings */
7375 7376 7377
	err = hw->mac.ops.start_hw(hw);
	if (err == IXGBE_ERR_EEPROM_VERSION) {
		/* We are running on a pre-production device, log a warning */
7378 7379 7380 7381 7382 7383
		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");
7384
	}
7385 7386 7387 7388 7389
	strcpy(netdev->name, "eth%d");
	err = register_netdev(netdev);
	if (err)
		goto err_register;

7390 7391 7392 7393 7394 7395 7396
	/* 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);

7397 7398 7399
	/* carrier off reporting is important to ethtool even BEFORE open */
	netif_carrier_off(netdev);

7400
#ifdef CONFIG_IXGBE_DCA
7401
	if (dca_add_requester(&pdev->dev) == 0) {
7402 7403 7404 7405
		adapter->flags |= IXGBE_FLAG_DCA_ENABLED;
		ixgbe_setup_dca(adapter);
	}
#endif
7406
	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
7407
		e_info(probe, "IOV is enabled with %d VFs\n", adapter->num_vfs);
7408 7409 7410 7411
		for (i = 0; i < adapter->num_vfs; i++)
			ixgbe_vf_configuration(pdev, (i | 0x10000000));
	}

7412 7413 7414
	/* firmware requires driver version to be 0xFFFFFFFF
	 * since os does not support feature
	 */
E
Emil Tantilov 已提交
7415
	if (hw->mac.ops.set_fw_drv_ver)
7416 7417
		hw->mac.ops.set_fw_drv_ver(hw, 0xFF, 0xFF, 0xFF,
					   0xFF);
E
Emil Tantilov 已提交
7418

7419 7420
	/* add san mac addr to netdev */
	ixgbe_add_sanmac_netdev(netdev);
7421

7422
	e_dev_info("%s\n", ixgbe_default_device_descr);
7423
	cards_found++;
7424

7425
#ifdef CONFIG_IXGBE_HWMON
7426 7427
	if (ixgbe_sysfs_init(adapter))
		e_err(probe, "failed to allocate sysfs resources\n");
7428
#endif /* CONFIG_IXGBE_HWMON */
7429

7430 7431 7432
	return 0;

err_register:
7433
	ixgbe_release_hw_control(adapter);
7434
	ixgbe_clear_interrupt_scheme(adapter);
7435
err_sw_init:
7436
	ixgbe_disable_sriov(adapter);
7437
	adapter->flags2 &= ~IXGBE_FLAG2_SEARCH_FOR_SFP;
7438 7439 7440 7441
	iounmap(hw->hw_addr);
err_ioremap:
	free_netdev(netdev);
err_alloc_etherdev:
7442 7443
	pci_release_selected_regions(pdev,
				     pci_select_bars(pdev, IORESOURCE_MEM));
7444 7445 7446 7447 7448 7449 7450 7451 7452 7453 7454 7455 7456 7457 7458 7459 7460
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)
{
7461 7462
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
7463 7464

	set_bit(__IXGBE_DOWN, &adapter->state);
7465
	cancel_work_sync(&adapter->service_task);
7466

7467 7468 7469 7470
#ifdef CONFIG_IXGBE_PTP
	ixgbe_ptp_stop(adapter);
#endif

7471
#ifdef CONFIG_IXGBE_DCA
7472 7473 7474 7475 7476 7477 7478
	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
7479
#ifdef CONFIG_IXGBE_HWMON
7480
	ixgbe_sysfs_exit(adapter);
7481
#endif /* CONFIG_IXGBE_HWMON */
7482

7483 7484 7485
	/* remove the added san mac */
	ixgbe_del_sanmac_netdev(netdev);

D
Donald Skidmore 已提交
7486 7487
	if (netdev->reg_state == NETREG_REGISTERED)
		unregister_netdev(netdev);
7488

7489
	ixgbe_disable_sriov(adapter);
7490

7491
	ixgbe_clear_interrupt_scheme(adapter);
7492

7493
	ixgbe_release_hw_control(adapter);
7494

7495 7496 7497 7498 7499
#ifdef CONFIG_DCB
	kfree(adapter->ixgbe_ieee_pfc);
	kfree(adapter->ixgbe_ieee_ets);

#endif
7500
	iounmap(adapter->hw.hw_addr);
7501
	pci_release_selected_regions(pdev, pci_select_bars(pdev,
7502
				     IORESOURCE_MEM));
7503

7504
	e_dev_info("complete\n");
7505

7506 7507
	free_netdev(netdev);

7508
	pci_disable_pcie_error_reporting(pdev);
7509

7510 7511 7512 7513 7514 7515 7516 7517 7518 7519 7520 7521
	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,
7522
						pci_channel_state_t state)
7523
{
7524 7525
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
7526

7527 7528 7529 7530 7531 7532 7533 7534 7535 7536 7537 7538 7539 7540 7541 7542 7543 7544 7545 7546 7547 7548 7549 7550 7551 7552 7553 7554 7555 7556 7557 7558 7559 7560 7561 7562 7563 7564 7565 7566 7567 7568 7569 7570 7571 7572 7573 7574 7575 7576 7577 7578 7579
#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;
	while (bdev && (bdev->pcie_type != PCI_EXP_TYPE_ROOT_PORT))
		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 已提交
7580
		vfdev = pci_get_device(PCI_VENDOR_ID_INTEL, device_id, NULL);
7581 7582 7583
		while (vfdev) {
			if (vfdev->devfn == (req_id & 0xFF))
				break;
J
Jon Mason 已提交
7584
			vfdev = pci_get_device(PCI_VENDOR_ID_INTEL,
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
					       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 */
7612 7613
	netif_device_detach(netdev);

7614 7615 7616
	if (state == pci_channel_io_perm_failure)
		return PCI_ERS_RESULT_DISCONNECT;

7617 7618 7619 7620
	if (netif_running(netdev))
		ixgbe_down(adapter);
	pci_disable_device(pdev);

7621
	/* Request a slot reset. */
7622 7623 7624 7625 7626 7627 7628 7629 7630 7631 7632
	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)
{
7633
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
7634 7635
	pci_ers_result_t result;
	int err;
7636

7637
	if (pci_enable_device_mem(pdev)) {
7638
		e_err(probe, "Cannot re-enable PCI device after reset.\n");
7639 7640 7641 7642
		result = PCI_ERS_RESULT_DISCONNECT;
	} else {
		pci_set_master(pdev);
		pci_restore_state(pdev);
7643
		pci_save_state(pdev);
7644

7645
		pci_wake_from_d3(pdev, false);
7646

7647
		ixgbe_reset(adapter);
7648
		IXGBE_WRITE_REG(&adapter->hw, IXGBE_WUS, ~0);
7649 7650 7651 7652 7653
		result = PCI_ERS_RESULT_RECOVERED;
	}

	err = pci_cleanup_aer_uncorrect_error_status(pdev);
	if (err) {
7654 7655
		e_dev_err("pci_cleanup_aer_uncorrect_error_status "
			  "failed 0x%0x\n", err);
7656 7657
		/* non-fatal, continue */
	}
7658

7659
	return result;
7660 7661 7662 7663 7664 7665 7666 7667 7668 7669 7670
}

/**
 * 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)
{
7671 7672
	struct ixgbe_adapter *adapter = pci_get_drvdata(pdev);
	struct net_device *netdev = adapter->netdev;
7673

7674 7675 7676 7677 7678 7679 7680 7681
#ifdef CONFIG_PCI_IOV
	if (adapter->vferr_refcount) {
		e_info(drv, "Resuming after VF err\n");
		adapter->vferr_refcount--;
		return;
	}

#endif
7682 7683
	if (netif_running(netdev))
		ixgbe_up(adapter);
7684 7685 7686 7687 7688 7689 7690 7691 7692 7693 7694 7695 7696 7697 7698 7699 7700 7701 7702 7703 7704 7705 7706 7707 7708 7709 7710 7711 7712 7713 7714 7715

	netif_device_attach(netdev);
}

static struct pci_error_handlers ixgbe_err_handler = {
	.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;
7716
	pr_info("%s - version %s\n", ixgbe_driver_string, ixgbe_driver_version);
7717
	pr_info("%s\n", ixgbe_copyright);
7718

7719
#ifdef CONFIG_IXGBE_DCA
7720 7721
	dca_register_notify(&dca_notifier);
#endif
7722

7723 7724 7725
	ret = pci_register_driver(&ixgbe_driver);
	return ret;
}
7726

7727 7728 7729 7730 7731 7732 7733 7734 7735 7736
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)
{
7737
#ifdef CONFIG_IXGBE_DCA
7738 7739
	dca_unregister_notify(&dca_notifier);
#endif
7740
	pci_unregister_driver(&ixgbe_driver);
E
Eric Dumazet 已提交
7741
	rcu_barrier(); /* Wait for completion of call_rcu()'s */
7742
}
7743

7744
#ifdef CONFIG_IXGBE_DCA
7745
static int ixgbe_notify_dca(struct notifier_block *nb, unsigned long event,
7746
			    void *p)
7747 7748 7749 7750
{
	int ret_val;

	ret_val = driver_for_each_device(&ixgbe_driver.driver, NULL, &event,
7751
					 __ixgbe_notify_dca);
7752 7753 7754

	return ret_val ? NOTIFY_BAD : NOTIFY_DONE;
}
7755

7756
#endif /* CONFIG_IXGBE_DCA */
7757

7758 7759 7760
module_exit(ixgbe_exit_module);

/* ixgbe_main.c */