Linux Audio

Check our new training course

Loading...
v6.8
   1// SPDX-License-Identifier: GPL-2.0
   2/* Copyright(c) 1999 - 2018 Intel Corporation. */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
   3
   4/******************************************************************************
   5 Copyright (c)2006 - 2007 Myricom, Inc. for some LRO specific code
   6******************************************************************************/
   7
   8#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
   9
  10#include <linux/types.h>
  11#include <linux/bitops.h>
  12#include <linux/module.h>
  13#include <linux/pci.h>
  14#include <linux/netdevice.h>
  15#include <linux/vmalloc.h>
  16#include <linux/string.h>
  17#include <linux/in.h>
  18#include <linux/ip.h>
  19#include <linux/tcp.h>
  20#include <linux/sctp.h>
  21#include <linux/ipv6.h>
  22#include <linux/slab.h>
  23#include <net/checksum.h>
  24#include <net/ip6_checksum.h>
  25#include <linux/ethtool.h>
  26#include <linux/if.h>
  27#include <linux/if_vlan.h>
  28#include <linux/prefetch.h>
  29#include <net/mpls.h>
  30#include <linux/bpf.h>
  31#include <linux/bpf_trace.h>
  32#include <linux/atomic.h>
  33#include <net/xfrm.h>
  34
  35#include "ixgbevf.h"
  36
  37const char ixgbevf_driver_name[] = "ixgbevf";
  38static const char ixgbevf_driver_string[] =
  39	"Intel(R) 10 Gigabit PCI Express Virtual Function Network Driver";
  40
 
 
  41static char ixgbevf_copyright[] =
  42	"Copyright (c) 2009 - 2018 Intel Corporation.";
  43
  44static const struct ixgbevf_info *ixgbevf_info_tbl[] = {
  45	[board_82599_vf]	= &ixgbevf_82599_vf_info,
  46	[board_82599_vf_hv]	= &ixgbevf_82599_vf_hv_info,
  47	[board_X540_vf]		= &ixgbevf_X540_vf_info,
  48	[board_X540_vf_hv]	= &ixgbevf_X540_vf_hv_info,
  49	[board_X550_vf]		= &ixgbevf_X550_vf_info,
  50	[board_X550_vf_hv]	= &ixgbevf_X550_vf_hv_info,
  51	[board_X550EM_x_vf]	= &ixgbevf_X550EM_x_vf_info,
  52	[board_X550EM_x_vf_hv]	= &ixgbevf_X550EM_x_vf_hv_info,
  53	[board_x550em_a_vf]	= &ixgbevf_x550em_a_vf_info,
  54};
  55
  56/* ixgbevf_pci_tbl - PCI Device ID Table
  57 *
  58 * Wildcard entries (PCI_ANY_ID) should come last
  59 * Last entry must be all 0s
  60 *
  61 * { Vendor ID, Device ID, SubVendor ID, SubDevice ID,
  62 *   Class, Class Mask, private data (not used) }
  63 */
  64static const struct pci_device_id ixgbevf_pci_tbl[] = {
  65	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_VF), board_82599_vf },
  66	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_VF_HV), board_82599_vf_hv },
  67	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X540_VF), board_X540_vf },
  68	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X540_VF_HV), board_X540_vf_hv },
  69	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550_VF), board_X550_vf },
  70	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550_VF_HV), board_X550_vf_hv },
  71	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_VF), board_X550EM_x_vf },
  72	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_VF_HV), board_X550EM_x_vf_hv},
  73	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_A_VF), board_x550em_a_vf },
  74	/* required last entry */
  75	{0, }
  76};
  77MODULE_DEVICE_TABLE(pci, ixgbevf_pci_tbl);
  78
  79MODULE_AUTHOR("Intel Corporation, <linux.nics@intel.com>");
  80MODULE_DESCRIPTION("Intel(R) 10 Gigabit Virtual Function Network Driver");
  81MODULE_LICENSE("GPL v2");
 
  82
  83#define DEFAULT_MSG_ENABLE (NETIF_MSG_DRV|NETIF_MSG_PROBE|NETIF_MSG_LINK)
  84static int debug = -1;
  85module_param(debug, int, 0);
  86MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)");
  87
  88static struct workqueue_struct *ixgbevf_wq;
  89
  90static void ixgbevf_service_event_schedule(struct ixgbevf_adapter *adapter)
  91{
  92	if (!test_bit(__IXGBEVF_DOWN, &adapter->state) &&
  93	    !test_bit(__IXGBEVF_REMOVING, &adapter->state) &&
  94	    !test_and_set_bit(__IXGBEVF_SERVICE_SCHED, &adapter->state))
  95		queue_work(ixgbevf_wq, &adapter->service_task);
  96}
  97
  98static void ixgbevf_service_event_complete(struct ixgbevf_adapter *adapter)
  99{
 100	BUG_ON(!test_bit(__IXGBEVF_SERVICE_SCHED, &adapter->state));
 101
 102	/* flush memory to make sure state is correct before next watchdog */
 103	smp_mb__before_atomic();
 104	clear_bit(__IXGBEVF_SERVICE_SCHED, &adapter->state);
 105}
 106
 107/* forward decls */
 108static void ixgbevf_queue_reset_subtask(struct ixgbevf_adapter *adapter);
 109static void ixgbevf_set_itr(struct ixgbevf_q_vector *q_vector);
 110static void ixgbevf_free_all_rx_resources(struct ixgbevf_adapter *adapter);
 111static bool ixgbevf_can_reuse_rx_page(struct ixgbevf_rx_buffer *rx_buffer);
 112static void ixgbevf_reuse_rx_page(struct ixgbevf_ring *rx_ring,
 113				  struct ixgbevf_rx_buffer *old_buff);
 114
 115static void ixgbevf_remove_adapter(struct ixgbe_hw *hw)
 116{
 117	struct ixgbevf_adapter *adapter = hw->back;
 118
 119	if (!hw->hw_addr)
 120		return;
 121	hw->hw_addr = NULL;
 122	dev_err(&adapter->pdev->dev, "Adapter removed\n");
 123	if (test_bit(__IXGBEVF_SERVICE_INITED, &adapter->state))
 124		ixgbevf_service_event_schedule(adapter);
 125}
 126
 127static void ixgbevf_check_remove(struct ixgbe_hw *hw, u32 reg)
 128{
 129	u32 value;
 130
 131	/* The following check not only optimizes a bit by not
 132	 * performing a read on the status register when the
 133	 * register just read was a status register read that
 134	 * returned IXGBE_FAILED_READ_REG. It also blocks any
 135	 * potential recursion.
 136	 */
 137	if (reg == IXGBE_VFSTATUS) {
 138		ixgbevf_remove_adapter(hw);
 139		return;
 140	}
 141	value = ixgbevf_read_reg(hw, IXGBE_VFSTATUS);
 142	if (value == IXGBE_FAILED_READ_REG)
 143		ixgbevf_remove_adapter(hw);
 144}
 145
 146u32 ixgbevf_read_reg(struct ixgbe_hw *hw, u32 reg)
 147{
 148	u8 __iomem *reg_addr = READ_ONCE(hw->hw_addr);
 149	u32 value;
 150
 151	if (IXGBE_REMOVED(reg_addr))
 152		return IXGBE_FAILED_READ_REG;
 153	value = readl(reg_addr + reg);
 154	if (unlikely(value == IXGBE_FAILED_READ_REG))
 155		ixgbevf_check_remove(hw, reg);
 156	return value;
 157}
 158
 159/**
 160 * ixgbevf_set_ivar - set IVAR registers - maps interrupt causes to vectors
 161 * @adapter: pointer to adapter struct
 162 * @direction: 0 for Rx, 1 for Tx, -1 for other causes
 163 * @queue: queue to map the corresponding interrupt to
 164 * @msix_vector: the vector to map to the corresponding queue
 165 **/
 166static void ixgbevf_set_ivar(struct ixgbevf_adapter *adapter, s8 direction,
 167			     u8 queue, u8 msix_vector)
 168{
 169	u32 ivar, index;
 170	struct ixgbe_hw *hw = &adapter->hw;
 171
 172	if (direction == -1) {
 173		/* other causes */
 174		msix_vector |= IXGBE_IVAR_ALLOC_VAL;
 175		ivar = IXGBE_READ_REG(hw, IXGBE_VTIVAR_MISC);
 176		ivar &= ~0xFF;
 177		ivar |= msix_vector;
 178		IXGBE_WRITE_REG(hw, IXGBE_VTIVAR_MISC, ivar);
 179	} else {
 180		/* Tx or Rx causes */
 181		msix_vector |= IXGBE_IVAR_ALLOC_VAL;
 182		index = ((16 * (queue & 1)) + (8 * direction));
 183		ivar = IXGBE_READ_REG(hw, IXGBE_VTIVAR(queue >> 1));
 184		ivar &= ~(0xFF << index);
 185		ivar |= (msix_vector << index);
 186		IXGBE_WRITE_REG(hw, IXGBE_VTIVAR(queue >> 1), ivar);
 187	}
 188}
 189
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 190static u64 ixgbevf_get_tx_completed(struct ixgbevf_ring *ring)
 191{
 192	return ring->stats.packets;
 193}
 194
 195static u32 ixgbevf_get_tx_pending(struct ixgbevf_ring *ring)
 196{
 197	struct ixgbevf_adapter *adapter = netdev_priv(ring->netdev);
 198	struct ixgbe_hw *hw = &adapter->hw;
 199
 200	u32 head = IXGBE_READ_REG(hw, IXGBE_VFTDH(ring->reg_idx));
 201	u32 tail = IXGBE_READ_REG(hw, IXGBE_VFTDT(ring->reg_idx));
 202
 203	if (head != tail)
 204		return (head < tail) ?
 205			tail - head : (tail + ring->count - head);
 206
 207	return 0;
 208}
 209
 210static inline bool ixgbevf_check_tx_hang(struct ixgbevf_ring *tx_ring)
 211{
 212	u32 tx_done = ixgbevf_get_tx_completed(tx_ring);
 213	u32 tx_done_old = tx_ring->tx_stats.tx_done_old;
 214	u32 tx_pending = ixgbevf_get_tx_pending(tx_ring);
 215
 216	clear_check_for_tx_hang(tx_ring);
 217
 218	/* Check for a hung queue, but be thorough. This verifies
 219	 * that a transmit has been completed since the previous
 220	 * check AND there is at least one packet pending. The
 221	 * ARMED bit is set to indicate a potential hang.
 222	 */
 223	if ((tx_done_old == tx_done) && tx_pending) {
 224		/* make sure it is true for two checks in a row */
 225		return test_and_set_bit(__IXGBEVF_HANG_CHECK_ARMED,
 226					&tx_ring->state);
 227	}
 228	/* reset the countdown */
 229	clear_bit(__IXGBEVF_HANG_CHECK_ARMED, &tx_ring->state);
 230
 231	/* update completed stats and continue */
 232	tx_ring->tx_stats.tx_done_old = tx_done;
 233
 234	return false;
 235}
 236
 237static void ixgbevf_tx_timeout_reset(struct ixgbevf_adapter *adapter)
 238{
 239	/* Do the reset outside of interrupt context */
 240	if (!test_bit(__IXGBEVF_DOWN, &adapter->state)) {
 241		set_bit(__IXGBEVF_RESET_REQUESTED, &adapter->state);
 242		ixgbevf_service_event_schedule(adapter);
 243	}
 244}
 245
 246/**
 247 * ixgbevf_tx_timeout - Respond to a Tx Hang
 248 * @netdev: network interface device structure
 249 * @txqueue: transmit queue hanging (unused)
 250 **/
 251static void ixgbevf_tx_timeout(struct net_device *netdev, unsigned int __always_unused txqueue)
 252{
 253	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 254
 255	ixgbevf_tx_timeout_reset(adapter);
 256}
 257
 258/**
 259 * ixgbevf_clean_tx_irq - Reclaim resources after transmit completes
 260 * @q_vector: board private structure
 261 * @tx_ring: tx ring to clean
 262 * @napi_budget: Used to determine if we are in netpoll
 263 **/
 264static bool ixgbevf_clean_tx_irq(struct ixgbevf_q_vector *q_vector,
 265				 struct ixgbevf_ring *tx_ring, int napi_budget)
 266{
 267	struct ixgbevf_adapter *adapter = q_vector->adapter;
 268	struct ixgbevf_tx_buffer *tx_buffer;
 269	union ixgbe_adv_tx_desc *tx_desc;
 270	unsigned int total_bytes = 0, total_packets = 0, total_ipsec = 0;
 271	unsigned int budget = tx_ring->count / 2;
 272	unsigned int i = tx_ring->next_to_clean;
 273
 274	if (test_bit(__IXGBEVF_DOWN, &adapter->state))
 275		return true;
 276
 277	tx_buffer = &tx_ring->tx_buffer_info[i];
 278	tx_desc = IXGBEVF_TX_DESC(tx_ring, i);
 279	i -= tx_ring->count;
 280
 281	do {
 282		union ixgbe_adv_tx_desc *eop_desc = tx_buffer->next_to_watch;
 283
 284		/* if next_to_watch is not set then there is no work pending */
 285		if (!eop_desc)
 286			break;
 287
 288		/* prevent any other reads prior to eop_desc */
 289		smp_rmb();
 290
 291		/* if DD is not set pending work has not been completed */
 292		if (!(eop_desc->wb.status & cpu_to_le32(IXGBE_TXD_STAT_DD)))
 293			break;
 294
 295		/* clear next_to_watch to prevent false hangs */
 296		tx_buffer->next_to_watch = NULL;
 297
 298		/* update the statistics for this packet */
 299		total_bytes += tx_buffer->bytecount;
 300		total_packets += tx_buffer->gso_segs;
 301		if (tx_buffer->tx_flags & IXGBE_TX_FLAGS_IPSEC)
 302			total_ipsec++;
 303
 304		/* free the skb */
 305		if (ring_is_xdp(tx_ring))
 306			page_frag_free(tx_buffer->data);
 307		else
 308			napi_consume_skb(tx_buffer->skb, napi_budget);
 309
 310		/* unmap skb header data */
 311		dma_unmap_single(tx_ring->dev,
 312				 dma_unmap_addr(tx_buffer, dma),
 313				 dma_unmap_len(tx_buffer, len),
 314				 DMA_TO_DEVICE);
 315
 316		/* clear tx_buffer data */
 
 317		dma_unmap_len_set(tx_buffer, len, 0);
 318
 319		/* unmap remaining buffers */
 320		while (tx_desc != eop_desc) {
 321			tx_buffer++;
 322			tx_desc++;
 323			i++;
 324			if (unlikely(!i)) {
 325				i -= tx_ring->count;
 326				tx_buffer = tx_ring->tx_buffer_info;
 327				tx_desc = IXGBEVF_TX_DESC(tx_ring, 0);
 328			}
 329
 330			/* unmap any remaining paged data */
 331			if (dma_unmap_len(tx_buffer, len)) {
 332				dma_unmap_page(tx_ring->dev,
 333					       dma_unmap_addr(tx_buffer, dma),
 334					       dma_unmap_len(tx_buffer, len),
 335					       DMA_TO_DEVICE);
 336				dma_unmap_len_set(tx_buffer, len, 0);
 337			}
 338		}
 339
 340		/* move us one more past the eop_desc for start of next pkt */
 341		tx_buffer++;
 342		tx_desc++;
 343		i++;
 344		if (unlikely(!i)) {
 345			i -= tx_ring->count;
 346			tx_buffer = tx_ring->tx_buffer_info;
 347			tx_desc = IXGBEVF_TX_DESC(tx_ring, 0);
 348		}
 349
 350		/* issue prefetch for next Tx descriptor */
 351		prefetch(tx_desc);
 352
 353		/* update budget accounting */
 354		budget--;
 355	} while (likely(budget));
 356
 357	i += tx_ring->count;
 358	tx_ring->next_to_clean = i;
 359	u64_stats_update_begin(&tx_ring->syncp);
 360	tx_ring->stats.bytes += total_bytes;
 361	tx_ring->stats.packets += total_packets;
 362	u64_stats_update_end(&tx_ring->syncp);
 363	q_vector->tx.total_bytes += total_bytes;
 364	q_vector->tx.total_packets += total_packets;
 365	adapter->tx_ipsec += total_ipsec;
 366
 367	if (check_for_tx_hang(tx_ring) && ixgbevf_check_tx_hang(tx_ring)) {
 368		struct ixgbe_hw *hw = &adapter->hw;
 369		union ixgbe_adv_tx_desc *eop_desc;
 370
 371		eop_desc = tx_ring->tx_buffer_info[i].next_to_watch;
 372
 373		pr_err("Detected Tx Unit Hang%s\n"
 374		       "  Tx Queue             <%d>\n"
 375		       "  TDH, TDT             <%x>, <%x>\n"
 376		       "  next_to_use          <%x>\n"
 377		       "  next_to_clean        <%x>\n"
 378		       "tx_buffer_info[next_to_clean]\n"
 379		       "  next_to_watch        <%p>\n"
 380		       "  eop_desc->wb.status  <%x>\n"
 381		       "  time_stamp           <%lx>\n"
 382		       "  jiffies              <%lx>\n",
 383		       ring_is_xdp(tx_ring) ? " XDP" : "",
 384		       tx_ring->queue_index,
 385		       IXGBE_READ_REG(hw, IXGBE_VFTDH(tx_ring->reg_idx)),
 386		       IXGBE_READ_REG(hw, IXGBE_VFTDT(tx_ring->reg_idx)),
 387		       tx_ring->next_to_use, i,
 388		       eop_desc, (eop_desc ? eop_desc->wb.status : 0),
 389		       tx_ring->tx_buffer_info[i].time_stamp, jiffies);
 390
 391		if (!ring_is_xdp(tx_ring))
 392			netif_stop_subqueue(tx_ring->netdev,
 393					    tx_ring->queue_index);
 394
 395		/* schedule immediate reset if we believe we hung */
 396		ixgbevf_tx_timeout_reset(adapter);
 397
 398		return true;
 399	}
 400
 401	if (ring_is_xdp(tx_ring))
 402		return !!budget;
 403
 404#define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
 405	if (unlikely(total_packets && netif_carrier_ok(tx_ring->netdev) &&
 406		     (ixgbevf_desc_unused(tx_ring) >= TX_WAKE_THRESHOLD))) {
 407		/* Make sure that anybody stopping the queue after this
 408		 * sees the new next_to_clean.
 409		 */
 410		smp_mb();
 411
 412		if (__netif_subqueue_stopped(tx_ring->netdev,
 413					     tx_ring->queue_index) &&
 414		    !test_bit(__IXGBEVF_DOWN, &adapter->state)) {
 415			netif_wake_subqueue(tx_ring->netdev,
 416					    tx_ring->queue_index);
 417			++tx_ring->tx_stats.restart_queue;
 418		}
 419	}
 420
 421	return !!budget;
 422}
 423
 424/**
 425 * ixgbevf_rx_skb - Helper function to determine proper Rx method
 426 * @q_vector: structure containing interrupt and ring information
 427 * @skb: packet to send up
 428 **/
 429static void ixgbevf_rx_skb(struct ixgbevf_q_vector *q_vector,
 430			   struct sk_buff *skb)
 431{
 
 
 
 
 
 
 
 
 
 
 432	napi_gro_receive(&q_vector->napi, skb);
 433}
 434
 435#define IXGBE_RSS_L4_TYPES_MASK \
 436	((1ul << IXGBE_RXDADV_RSSTYPE_IPV4_TCP) | \
 437	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV4_UDP) | \
 438	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV6_TCP) | \
 439	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV6_UDP))
 440
 441static inline void ixgbevf_rx_hash(struct ixgbevf_ring *ring,
 442				   union ixgbe_adv_rx_desc *rx_desc,
 443				   struct sk_buff *skb)
 444{
 445	u16 rss_type;
 446
 447	if (!(ring->netdev->features & NETIF_F_RXHASH))
 448		return;
 449
 450	rss_type = le16_to_cpu(rx_desc->wb.lower.lo_dword.hs_rss.pkt_info) &
 451		   IXGBE_RXDADV_RSSTYPE_MASK;
 452
 453	if (!rss_type)
 454		return;
 455
 456	skb_set_hash(skb, le32_to_cpu(rx_desc->wb.lower.hi_dword.rss),
 457		     (IXGBE_RSS_L4_TYPES_MASK & (1ul << rss_type)) ?
 458		     PKT_HASH_TYPE_L4 : PKT_HASH_TYPE_L3);
 459}
 460
 461/**
 462 * ixgbevf_rx_checksum - indicate in skb if hw indicated a good cksum
 463 * @ring: structure containig ring specific data
 464 * @rx_desc: current Rx descriptor being processed
 465 * @skb: skb currently being received and modified
 466 **/
 467static inline void ixgbevf_rx_checksum(struct ixgbevf_ring *ring,
 468				       union ixgbe_adv_rx_desc *rx_desc,
 469				       struct sk_buff *skb)
 470{
 471	skb_checksum_none_assert(skb);
 472
 473	/* Rx csum disabled */
 474	if (!(ring->netdev->features & NETIF_F_RXCSUM))
 475		return;
 476
 477	/* if IP and error */
 478	if (ixgbevf_test_staterr(rx_desc, IXGBE_RXD_STAT_IPCS) &&
 479	    ixgbevf_test_staterr(rx_desc, IXGBE_RXDADV_ERR_IPE)) {
 480		ring->rx_stats.csum_err++;
 481		return;
 482	}
 483
 484	if (!ixgbevf_test_staterr(rx_desc, IXGBE_RXD_STAT_L4CS))
 485		return;
 486
 487	if (ixgbevf_test_staterr(rx_desc, IXGBE_RXDADV_ERR_TCPE)) {
 488		ring->rx_stats.csum_err++;
 489		return;
 490	}
 491
 492	/* It must be a TCP or UDP packet with a valid checksum */
 493	skb->ip_summed = CHECKSUM_UNNECESSARY;
 494}
 495
 496/**
 497 * ixgbevf_process_skb_fields - Populate skb header fields from Rx descriptor
 498 * @rx_ring: rx descriptor ring packet is being transacted on
 499 * @rx_desc: pointer to the EOP Rx descriptor
 500 * @skb: pointer to current skb being populated
 501 *
 502 * This function checks the ring, descriptor, and packet information in
 503 * order to populate the checksum, VLAN, protocol, and other fields within
 504 * the skb.
 505 **/
 506static void ixgbevf_process_skb_fields(struct ixgbevf_ring *rx_ring,
 507				       union ixgbe_adv_rx_desc *rx_desc,
 508				       struct sk_buff *skb)
 509{
 510	ixgbevf_rx_hash(rx_ring, rx_desc, skb);
 511	ixgbevf_rx_checksum(rx_ring, rx_desc, skb);
 512
 513	if (ixgbevf_test_staterr(rx_desc, IXGBE_RXD_STAT_VP)) {
 514		u16 vid = le16_to_cpu(rx_desc->wb.upper.vlan);
 515		unsigned long *active_vlans = netdev_priv(rx_ring->netdev);
 516
 517		if (test_bit(vid & VLAN_VID_MASK, active_vlans))
 518			__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vid);
 519	}
 520
 521	if (ixgbevf_test_staterr(rx_desc, IXGBE_RXDADV_STAT_SECP))
 522		ixgbevf_ipsec_rx(rx_ring, rx_desc, skb);
 523
 524	skb->protocol = eth_type_trans(skb, rx_ring->netdev);
 525}
 526
 527static
 528struct ixgbevf_rx_buffer *ixgbevf_get_rx_buffer(struct ixgbevf_ring *rx_ring,
 529						const unsigned int size)
 530{
 531	struct ixgbevf_rx_buffer *rx_buffer;
 532
 533	rx_buffer = &rx_ring->rx_buffer_info[rx_ring->next_to_clean];
 534	prefetchw(rx_buffer->page);
 535
 536	/* we are reusing so sync this buffer for CPU use */
 537	dma_sync_single_range_for_cpu(rx_ring->dev,
 538				      rx_buffer->dma,
 539				      rx_buffer->page_offset,
 540				      size,
 541				      DMA_FROM_DEVICE);
 542
 543	rx_buffer->pagecnt_bias--;
 544
 545	return rx_buffer;
 546}
 547
 548static void ixgbevf_put_rx_buffer(struct ixgbevf_ring *rx_ring,
 549				  struct ixgbevf_rx_buffer *rx_buffer,
 550				  struct sk_buff *skb)
 551{
 552	if (ixgbevf_can_reuse_rx_page(rx_buffer)) {
 553		/* hand second half of page back to the ring */
 554		ixgbevf_reuse_rx_page(rx_ring, rx_buffer);
 555	} else {
 556		if (IS_ERR(skb))
 557			/* We are not reusing the buffer so unmap it and free
 558			 * any references we are holding to it
 559			 */
 560			dma_unmap_page_attrs(rx_ring->dev, rx_buffer->dma,
 561					     ixgbevf_rx_pg_size(rx_ring),
 562					     DMA_FROM_DEVICE,
 563					     IXGBEVF_RX_DMA_ATTR);
 564		__page_frag_cache_drain(rx_buffer->page,
 565					rx_buffer->pagecnt_bias);
 566	}
 567
 568	/* clear contents of rx_buffer */
 569	rx_buffer->page = NULL;
 570}
 571
 572/**
 573 * ixgbevf_is_non_eop - process handling of non-EOP buffers
 574 * @rx_ring: Rx ring being processed
 575 * @rx_desc: Rx descriptor for current buffer
 
 576 *
 577 * This function updates next to clean.  If the buffer is an EOP buffer
 578 * this function exits returning false, otherwise it will place the
 579 * sk_buff in the next buffer to be chained and return true indicating
 580 * that this is in fact a non-EOP buffer.
 581 **/
 582static bool ixgbevf_is_non_eop(struct ixgbevf_ring *rx_ring,
 583			       union ixgbe_adv_rx_desc *rx_desc)
 584{
 585	u32 ntc = rx_ring->next_to_clean + 1;
 586
 587	/* fetch, update, and store next to clean */
 588	ntc = (ntc < rx_ring->count) ? ntc : 0;
 589	rx_ring->next_to_clean = ntc;
 590
 591	prefetch(IXGBEVF_RX_DESC(rx_ring, ntc));
 592
 593	if (likely(ixgbevf_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP)))
 594		return false;
 595
 596	return true;
 597}
 598
 599static inline unsigned int ixgbevf_rx_offset(struct ixgbevf_ring *rx_ring)
 600{
 601	return ring_uses_build_skb(rx_ring) ? IXGBEVF_SKB_PAD : 0;
 602}
 603
 604static bool ixgbevf_alloc_mapped_page(struct ixgbevf_ring *rx_ring,
 605				      struct ixgbevf_rx_buffer *bi)
 606{
 607	struct page *page = bi->page;
 608	dma_addr_t dma;
 609
 610	/* since we are recycling buffers we should seldom need to alloc */
 611	if (likely(page))
 612		return true;
 613
 614	/* alloc new page for storage */
 615	page = dev_alloc_pages(ixgbevf_rx_pg_order(rx_ring));
 616	if (unlikely(!page)) {
 617		rx_ring->rx_stats.alloc_rx_page_failed++;
 618		return false;
 619	}
 620
 621	/* map page for use */
 622	dma = dma_map_page_attrs(rx_ring->dev, page, 0,
 623				 ixgbevf_rx_pg_size(rx_ring),
 624				 DMA_FROM_DEVICE, IXGBEVF_RX_DMA_ATTR);
 625
 626	/* if mapping failed free memory back to system since
 627	 * there isn't much point in holding memory we can't use
 628	 */
 629	if (dma_mapping_error(rx_ring->dev, dma)) {
 630		__free_pages(page, ixgbevf_rx_pg_order(rx_ring));
 631
 632		rx_ring->rx_stats.alloc_rx_page_failed++;
 633		return false;
 634	}
 635
 636	bi->dma = dma;
 637	bi->page = page;
 638	bi->page_offset = ixgbevf_rx_offset(rx_ring);
 639	bi->pagecnt_bias = 1;
 640	rx_ring->rx_stats.alloc_rx_page++;
 641
 642	return true;
 643}
 644
 645/**
 646 * ixgbevf_alloc_rx_buffers - Replace used receive buffers; packet split
 647 * @rx_ring: rx descriptor ring (for a specific queue) to setup buffers on
 648 * @cleaned_count: number of buffers to replace
 649 **/
 650static void ixgbevf_alloc_rx_buffers(struct ixgbevf_ring *rx_ring,
 651				     u16 cleaned_count)
 652{
 653	union ixgbe_adv_rx_desc *rx_desc;
 654	struct ixgbevf_rx_buffer *bi;
 655	unsigned int i = rx_ring->next_to_use;
 656
 657	/* nothing to do or no valid netdev defined */
 658	if (!cleaned_count || !rx_ring->netdev)
 659		return;
 660
 661	rx_desc = IXGBEVF_RX_DESC(rx_ring, i);
 662	bi = &rx_ring->rx_buffer_info[i];
 663	i -= rx_ring->count;
 664
 665	do {
 666		if (!ixgbevf_alloc_mapped_page(rx_ring, bi))
 667			break;
 668
 669		/* sync the buffer for use by the device */
 670		dma_sync_single_range_for_device(rx_ring->dev, bi->dma,
 671						 bi->page_offset,
 672						 ixgbevf_rx_bufsz(rx_ring),
 673						 DMA_FROM_DEVICE);
 674
 675		/* Refresh the desc even if pkt_addr didn't change
 676		 * because each write-back erases this info.
 677		 */
 678		rx_desc->read.pkt_addr = cpu_to_le64(bi->dma + bi->page_offset);
 679
 680		rx_desc++;
 681		bi++;
 682		i++;
 683		if (unlikely(!i)) {
 684			rx_desc = IXGBEVF_RX_DESC(rx_ring, 0);
 685			bi = rx_ring->rx_buffer_info;
 686			i -= rx_ring->count;
 687		}
 688
 689		/* clear the length for the next_to_use descriptor */
 690		rx_desc->wb.upper.length = 0;
 691
 692		cleaned_count--;
 693	} while (cleaned_count);
 694
 695	i += rx_ring->count;
 696
 697	if (rx_ring->next_to_use != i) {
 698		/* record the next descriptor to use */
 699		rx_ring->next_to_use = i;
 700
 701		/* update next to alloc since we have filled the ring */
 702		rx_ring->next_to_alloc = i;
 703
 704		/* Force memory writes to complete before letting h/w
 705		 * know there are new descriptors to fetch.  (Only
 706		 * applicable for weak-ordered memory model archs,
 707		 * such as IA-64).
 708		 */
 709		wmb();
 710		ixgbevf_write_tail(rx_ring, i);
 711	}
 712}
 713
 714/**
 715 * ixgbevf_cleanup_headers - Correct corrupted or empty headers
 716 * @rx_ring: rx descriptor ring packet is being transacted on
 717 * @rx_desc: pointer to the EOP Rx descriptor
 718 * @skb: pointer to current skb being fixed
 719 *
 720 * Check for corrupted packet headers caused by senders on the local L2
 721 * embedded NIC switch not setting up their Tx Descriptors right.  These
 722 * should be very rare.
 723 *
 724 * Also address the case where we are pulling data in on pages only
 725 * and as such no data is present in the skb header.
 726 *
 727 * In addition if skb is not at least 60 bytes we need to pad it so that
 728 * it is large enough to qualify as a valid Ethernet frame.
 729 *
 730 * Returns true if an error was encountered and skb was freed.
 731 **/
 732static bool ixgbevf_cleanup_headers(struct ixgbevf_ring *rx_ring,
 733				    union ixgbe_adv_rx_desc *rx_desc,
 734				    struct sk_buff *skb)
 735{
 736	/* XDP packets use error pointer so abort at this point */
 737	if (IS_ERR(skb))
 738		return true;
 739
 740	/* verify that the packet does not have any known errors */
 741	if (unlikely(ixgbevf_test_staterr(rx_desc,
 742					  IXGBE_RXDADV_ERR_FRAME_ERR_MASK))) {
 743		struct net_device *netdev = rx_ring->netdev;
 744
 745		if (!(netdev->features & NETIF_F_RXALL)) {
 746			dev_kfree_skb_any(skb);
 747			return true;
 748		}
 749	}
 750
 751	/* if eth_skb_pad returns an error the skb was freed */
 752	if (eth_skb_pad(skb))
 753		return true;
 754
 755	return false;
 756}
 757
 758/**
 759 * ixgbevf_reuse_rx_page - page flip buffer and store it back on the ring
 760 * @rx_ring: rx descriptor ring to store buffers on
 761 * @old_buff: donor buffer to have page reused
 762 *
 763 * Synchronizes page for reuse by the adapter
 764 **/
 765static void ixgbevf_reuse_rx_page(struct ixgbevf_ring *rx_ring,
 766				  struct ixgbevf_rx_buffer *old_buff)
 767{
 768	struct ixgbevf_rx_buffer *new_buff;
 769	u16 nta = rx_ring->next_to_alloc;
 770
 771	new_buff = &rx_ring->rx_buffer_info[nta];
 772
 773	/* update, and store next to alloc */
 774	nta++;
 775	rx_ring->next_to_alloc = (nta < rx_ring->count) ? nta : 0;
 776
 777	/* transfer page from old buffer to new buffer */
 778	new_buff->page = old_buff->page;
 779	new_buff->dma = old_buff->dma;
 780	new_buff->page_offset = old_buff->page_offset;
 781	new_buff->pagecnt_bias = old_buff->pagecnt_bias;
 
 
 
 
 
 782}
 783
 784static bool ixgbevf_can_reuse_rx_page(struct ixgbevf_rx_buffer *rx_buffer)
 785{
 786	unsigned int pagecnt_bias = rx_buffer->pagecnt_bias;
 787	struct page *page = rx_buffer->page;
 788
 789	/* avoid re-using remote and pfmemalloc pages */
 790	if (!dev_page_is_reusable(page))
 791		return false;
 792
 793#if (PAGE_SIZE < 8192)
 794	/* if we are only owner of page we can reuse it */
 795	if (unlikely((page_ref_count(page) - pagecnt_bias) > 1))
 796		return false;
 797#else
 798#define IXGBEVF_LAST_OFFSET \
 799	(SKB_WITH_OVERHEAD(PAGE_SIZE) - IXGBEVF_RXBUFFER_2048)
 800
 801	if (rx_buffer->page_offset > IXGBEVF_LAST_OFFSET)
 802		return false;
 803
 804#endif
 805
 806	/* If we have drained the page fragment pool we need to update
 807	 * the pagecnt_bias and page count so that we fully restock the
 808	 * number of references the driver holds.
 809	 */
 810	if (unlikely(!pagecnt_bias)) {
 811		page_ref_add(page, USHRT_MAX);
 812		rx_buffer->pagecnt_bias = USHRT_MAX;
 813	}
 814
 815	return true;
 816}
 817
 818/**
 819 * ixgbevf_add_rx_frag - Add contents of Rx buffer to sk_buff
 820 * @rx_ring: rx descriptor ring to transact packets on
 821 * @rx_buffer: buffer containing page to add
 
 822 * @skb: sk_buff to place the data into
 823 * @size: size of buffer to be added
 824 *
 825 * This function will add the data contained in rx_buffer->page to the skb.
 
 
 
 
 
 
 826 **/
 827static void ixgbevf_add_rx_frag(struct ixgbevf_ring *rx_ring,
 828				struct ixgbevf_rx_buffer *rx_buffer,
 829				struct sk_buff *skb,
 830				unsigned int size)
 831{
 
 
 
 832#if (PAGE_SIZE < 8192)
 833	unsigned int truesize = ixgbevf_rx_pg_size(rx_ring) / 2;
 834#else
 835	unsigned int truesize = ring_uses_build_skb(rx_ring) ?
 836				SKB_DATA_ALIGN(IXGBEVF_SKB_PAD + size) :
 837				SKB_DATA_ALIGN(size);
 838#endif
 839	skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, rx_buffer->page,
 840			rx_buffer->page_offset, size, truesize);
 841#if (PAGE_SIZE < 8192)
 842	rx_buffer->page_offset ^= truesize;
 843#else
 844	rx_buffer->page_offset += truesize;
 845#endif
 846}
 847
 848static
 849struct sk_buff *ixgbevf_construct_skb(struct ixgbevf_ring *rx_ring,
 850				      struct ixgbevf_rx_buffer *rx_buffer,
 851				      struct xdp_buff *xdp,
 852				      union ixgbe_adv_rx_desc *rx_desc)
 853{
 854	unsigned int size = xdp->data_end - xdp->data;
 855#if (PAGE_SIZE < 8192)
 856	unsigned int truesize = ixgbevf_rx_pg_size(rx_ring) / 2;
 857#else
 858	unsigned int truesize = SKB_DATA_ALIGN(xdp->data_end -
 859					       xdp->data_hard_start);
 860#endif
 861	unsigned int headlen;
 862	struct sk_buff *skb;
 863
 864	/* prefetch first cache line of first page */
 865	net_prefetch(xdp->data);
 866
 867	/* Note, we get here by enabling legacy-rx via:
 868	 *
 869	 *    ethtool --set-priv-flags <dev> legacy-rx on
 870	 *
 871	 * In this mode, we currently get 0 extra XDP headroom as
 872	 * opposed to having legacy-rx off, where we process XDP
 873	 * packets going to stack via ixgbevf_build_skb().
 874	 *
 875	 * For ixgbevf_construct_skb() mode it means that the
 876	 * xdp->data_meta will always point to xdp->data, since
 877	 * the helper cannot expand the head. Should this ever
 878	 * changed in future for legacy-rx mode on, then lets also
 879	 * add xdp->data_meta handling here.
 880	 */
 881
 882	/* allocate a skb to store the frags */
 883	skb = napi_alloc_skb(&rx_ring->q_vector->napi, IXGBEVF_RX_HDR_SIZE);
 884	if (unlikely(!skb))
 885		return NULL;
 886
 887	/* Determine available headroom for copy */
 888	headlen = size;
 889	if (headlen > IXGBEVF_RX_HDR_SIZE)
 890		headlen = eth_get_headlen(skb->dev, xdp->data,
 891					  IXGBEVF_RX_HDR_SIZE);
 892
 893	/* align pull length to size of long to optimize memcpy performance */
 894	memcpy(__skb_put(skb, headlen), xdp->data,
 895	       ALIGN(headlen, sizeof(long)));
 896
 897	/* update all of the pointers */
 898	size -= headlen;
 899	if (size) {
 900		skb_add_rx_frag(skb, 0, rx_buffer->page,
 901				(xdp->data + headlen) -
 902					page_address(rx_buffer->page),
 903				size, truesize);
 904#if (PAGE_SIZE < 8192)
 905		rx_buffer->page_offset ^= truesize;
 906#else
 907		rx_buffer->page_offset += truesize;
 908#endif
 909	} else {
 910		rx_buffer->pagecnt_bias++;
 911	}
 912
 913	return skb;
 914}
 
 915
 916static inline void ixgbevf_irq_enable_queues(struct ixgbevf_adapter *adapter,
 917					     u32 qmask)
 918{
 919	struct ixgbe_hw *hw = &adapter->hw;
 920
 921	IXGBE_WRITE_REG(hw, IXGBE_VTEIMS, qmask);
 922}
 923
 924static struct sk_buff *ixgbevf_build_skb(struct ixgbevf_ring *rx_ring,
 925					 struct ixgbevf_rx_buffer *rx_buffer,
 926					 struct xdp_buff *xdp,
 927					 union ixgbe_adv_rx_desc *rx_desc)
 928{
 929	unsigned int metasize = xdp->data - xdp->data_meta;
 930#if (PAGE_SIZE < 8192)
 931	unsigned int truesize = ixgbevf_rx_pg_size(rx_ring) / 2;
 932#else
 933	unsigned int truesize = SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) +
 934				SKB_DATA_ALIGN(xdp->data_end -
 935					       xdp->data_hard_start);
 936#endif
 937	struct sk_buff *skb;
 938
 939	/* Prefetch first cache line of first page. If xdp->data_meta
 940	 * is unused, this points to xdp->data, otherwise, we likely
 941	 * have a consumer accessing first few bytes of meta data,
 942	 * and then actual data.
 943	 */
 944	net_prefetch(xdp->data_meta);
 945
 946	/* build an skb around the page buffer */
 947	skb = napi_build_skb(xdp->data_hard_start, truesize);
 948	if (unlikely(!skb))
 949		return NULL;
 950
 951	/* update pointers within the skb to store the data */
 952	skb_reserve(skb, xdp->data - xdp->data_hard_start);
 953	__skb_put(skb, xdp->data_end - xdp->data);
 954	if (metasize)
 955		skb_metadata_set(skb, metasize);
 956
 957	/* update buffer offset */
 958#if (PAGE_SIZE < 8192)
 959	rx_buffer->page_offset ^= truesize;
 960#else
 
 961	rx_buffer->page_offset += truesize;
 962#endif
 963
 964	return skb;
 965}
 966
 967#define IXGBEVF_XDP_PASS 0
 968#define IXGBEVF_XDP_CONSUMED 1
 969#define IXGBEVF_XDP_TX 2
 970
 971static int ixgbevf_xmit_xdp_ring(struct ixgbevf_ring *ring,
 972				 struct xdp_buff *xdp)
 973{
 974	struct ixgbevf_tx_buffer *tx_buffer;
 975	union ixgbe_adv_tx_desc *tx_desc;
 976	u32 len, cmd_type;
 977	dma_addr_t dma;
 978	u16 i;
 979
 980	len = xdp->data_end - xdp->data;
 981
 982	if (unlikely(!ixgbevf_desc_unused(ring)))
 983		return IXGBEVF_XDP_CONSUMED;
 984
 985	dma = dma_map_single(ring->dev, xdp->data, len, DMA_TO_DEVICE);
 986	if (dma_mapping_error(ring->dev, dma))
 987		return IXGBEVF_XDP_CONSUMED;
 988
 989	/* record the location of the first descriptor for this packet */
 990	i = ring->next_to_use;
 991	tx_buffer = &ring->tx_buffer_info[i];
 992
 993	dma_unmap_len_set(tx_buffer, len, len);
 994	dma_unmap_addr_set(tx_buffer, dma, dma);
 995	tx_buffer->data = xdp->data;
 996	tx_buffer->bytecount = len;
 997	tx_buffer->gso_segs = 1;
 998	tx_buffer->protocol = 0;
 999
1000	/* Populate minimal context descriptor that will provide for the
1001	 * fact that we are expected to process Ethernet frames.
 
1002	 */
1003	if (!test_bit(__IXGBEVF_TX_XDP_RING_PRIMED, &ring->state)) {
1004		struct ixgbe_adv_tx_context_desc *context_desc;
1005
1006		set_bit(__IXGBEVF_TX_XDP_RING_PRIMED, &ring->state);
1007
1008		context_desc = IXGBEVF_TX_CTXTDESC(ring, 0);
1009		context_desc->vlan_macip_lens	=
1010			cpu_to_le32(ETH_HLEN << IXGBE_ADVTXD_MACLEN_SHIFT);
1011		context_desc->fceof_saidx	= 0;
1012		context_desc->type_tucmd_mlhl	=
1013			cpu_to_le32(IXGBE_TXD_CMD_DEXT |
1014				    IXGBE_ADVTXD_DTYP_CTXT);
1015		context_desc->mss_l4len_idx	= 0;
1016
1017		i = 1;
1018	}
1019
1020	/* put descriptor type bits */
1021	cmd_type = IXGBE_ADVTXD_DTYP_DATA |
1022		   IXGBE_ADVTXD_DCMD_DEXT |
1023		   IXGBE_ADVTXD_DCMD_IFCS;
1024	cmd_type |= len | IXGBE_TXD_CMD;
1025
1026	tx_desc = IXGBEVF_TX_DESC(ring, i);
1027	tx_desc->read.buffer_addr = cpu_to_le64(dma);
1028
1029	tx_desc->read.cmd_type_len = cpu_to_le32(cmd_type);
1030	tx_desc->read.olinfo_status =
1031			cpu_to_le32((len << IXGBE_ADVTXD_PAYLEN_SHIFT) |
1032				    IXGBE_ADVTXD_CC);
1033
1034	/* Avoid any potential race with cleanup */
1035	smp_wmb();
1036
1037	/* set next_to_watch value indicating a packet is present */
1038	i++;
1039	if (i == ring->count)
1040		i = 0;
 
 
1041
1042	tx_buffer->next_to_watch = tx_desc;
1043	ring->next_to_use = i;
 
1044
1045	return IXGBEVF_XDP_TX;
1046}
 
 
 
 
 
 
 
1047
1048static struct sk_buff *ixgbevf_run_xdp(struct ixgbevf_adapter *adapter,
1049				       struct ixgbevf_ring  *rx_ring,
1050				       struct xdp_buff *xdp)
1051{
1052	int result = IXGBEVF_XDP_PASS;
1053	struct ixgbevf_ring *xdp_ring;
1054	struct bpf_prog *xdp_prog;
1055	u32 act;
1056
1057	xdp_prog = READ_ONCE(rx_ring->xdp_prog);
 
 
 
 
 
1058
1059	if (!xdp_prog)
1060		goto xdp_out;
 
 
 
 
1061
1062	act = bpf_prog_run_xdp(xdp_prog, xdp);
1063	switch (act) {
1064	case XDP_PASS:
1065		break;
1066	case XDP_TX:
1067		xdp_ring = adapter->xdp_ring[rx_ring->queue_index];
1068		result = ixgbevf_xmit_xdp_ring(xdp_ring, xdp);
1069		if (result == IXGBEVF_XDP_CONSUMED)
1070			goto out_failure;
1071		break;
1072	default:
1073		bpf_warn_invalid_xdp_action(rx_ring->netdev, xdp_prog, act);
1074		fallthrough;
1075	case XDP_ABORTED:
1076out_failure:
1077		trace_xdp_exception(rx_ring->netdev, xdp_prog, act);
1078		fallthrough; /* handle aborts by dropping packet */
1079	case XDP_DROP:
1080		result = IXGBEVF_XDP_CONSUMED;
1081		break;
1082	}
1083xdp_out:
1084	return ERR_PTR(-result);
1085}
1086
1087static unsigned int ixgbevf_rx_frame_truesize(struct ixgbevf_ring *rx_ring,
1088					      unsigned int size)
1089{
1090	unsigned int truesize;
1091
1092#if (PAGE_SIZE < 8192)
1093	truesize = ixgbevf_rx_pg_size(rx_ring) / 2; /* Must be power-of-2 */
1094#else
1095	truesize = ring_uses_build_skb(rx_ring) ?
1096		SKB_DATA_ALIGN(IXGBEVF_SKB_PAD + size) +
1097		SKB_DATA_ALIGN(sizeof(struct skb_shared_info)) :
1098		SKB_DATA_ALIGN(size);
1099#endif
1100	return truesize;
1101}
1102
1103static void ixgbevf_rx_buffer_flip(struct ixgbevf_ring *rx_ring,
1104				   struct ixgbevf_rx_buffer *rx_buffer,
1105				   unsigned int size)
1106{
1107	unsigned int truesize = ixgbevf_rx_frame_truesize(rx_ring, size);
1108
1109#if (PAGE_SIZE < 8192)
1110	rx_buffer->page_offset ^= truesize;
1111#else
1112	rx_buffer->page_offset += truesize;
1113#endif
1114}
1115
1116static int ixgbevf_clean_rx_irq(struct ixgbevf_q_vector *q_vector,
1117				struct ixgbevf_ring *rx_ring,
1118				int budget)
1119{
1120	unsigned int total_rx_bytes = 0, total_rx_packets = 0, frame_sz = 0;
1121	struct ixgbevf_adapter *adapter = q_vector->adapter;
1122	u16 cleaned_count = ixgbevf_desc_unused(rx_ring);
1123	struct sk_buff *skb = rx_ring->skb;
1124	bool xdp_xmit = false;
1125	struct xdp_buff xdp;
1126
1127	/* Frame size depend on rx_ring setup when PAGE_SIZE=4K */
1128#if (PAGE_SIZE < 8192)
1129	frame_sz = ixgbevf_rx_frame_truesize(rx_ring, 0);
1130#endif
1131	xdp_init_buff(&xdp, frame_sz, &rx_ring->xdp_rxq);
1132
1133	while (likely(total_rx_packets < budget)) {
1134		struct ixgbevf_rx_buffer *rx_buffer;
1135		union ixgbe_adv_rx_desc *rx_desc;
1136		unsigned int size;
1137
1138		/* return some buffers to hardware, one at a time is too slow */
1139		if (cleaned_count >= IXGBEVF_RX_BUFFER_WRITE) {
1140			ixgbevf_alloc_rx_buffers(rx_ring, cleaned_count);
1141			cleaned_count = 0;
1142		}
1143
1144		rx_desc = IXGBEVF_RX_DESC(rx_ring, rx_ring->next_to_clean);
1145		size = le16_to_cpu(rx_desc->wb.upper.length);
1146		if (!size)
1147			break;
1148
1149		/* This memory barrier is needed to keep us from reading
1150		 * any other fields out of the rx_desc until we know the
1151		 * RXD_STAT_DD bit is set
1152		 */
1153		rmb();
1154
1155		rx_buffer = ixgbevf_get_rx_buffer(rx_ring, size);
1156
1157		/* retrieve a buffer from the ring */
1158		if (!skb) {
1159			unsigned int offset = ixgbevf_rx_offset(rx_ring);
1160			unsigned char *hard_start;
1161
1162			hard_start = page_address(rx_buffer->page) +
1163				     rx_buffer->page_offset - offset;
1164			xdp_prepare_buff(&xdp, hard_start, offset, size, true);
1165#if (PAGE_SIZE > 4096)
1166			/* At larger PAGE_SIZE, frame_sz depend on len size */
1167			xdp.frame_sz = ixgbevf_rx_frame_truesize(rx_ring, size);
1168#endif
1169			skb = ixgbevf_run_xdp(adapter, rx_ring, &xdp);
1170		}
1171
1172		if (IS_ERR(skb)) {
1173			if (PTR_ERR(skb) == -IXGBEVF_XDP_TX) {
1174				xdp_xmit = true;
1175				ixgbevf_rx_buffer_flip(rx_ring, rx_buffer,
1176						       size);
1177			} else {
1178				rx_buffer->pagecnt_bias++;
1179			}
1180			total_rx_packets++;
1181			total_rx_bytes += size;
1182		} else if (skb) {
1183			ixgbevf_add_rx_frag(rx_ring, rx_buffer, skb, size);
1184		} else if (ring_uses_build_skb(rx_ring)) {
1185			skb = ixgbevf_build_skb(rx_ring, rx_buffer,
1186						&xdp, rx_desc);
1187		} else {
1188			skb = ixgbevf_construct_skb(rx_ring, rx_buffer,
1189						    &xdp, rx_desc);
1190		}
1191
1192		/* exit if we failed to retrieve a buffer */
1193		if (!skb) {
1194			rx_ring->rx_stats.alloc_rx_buff_failed++;
1195			rx_buffer->pagecnt_bias++;
1196			break;
1197		}
1198
1199		ixgbevf_put_rx_buffer(rx_ring, rx_buffer, skb);
1200		cleaned_count++;
1201
1202		/* fetch next buffer in frame if non-eop */
1203		if (ixgbevf_is_non_eop(rx_ring, rx_desc))
1204			continue;
1205
1206		/* verify the packet layout is correct */
1207		if (ixgbevf_cleanup_headers(rx_ring, rx_desc, skb)) {
1208			skb = NULL;
1209			continue;
1210		}
1211
1212		/* probably a little skewed due to removing CRC */
1213		total_rx_bytes += skb->len;
1214
1215		/* Workaround hardware that can't do proper VEPA multicast
1216		 * source pruning.
1217		 */
1218		if ((skb->pkt_type == PACKET_BROADCAST ||
1219		     skb->pkt_type == PACKET_MULTICAST) &&
1220		    ether_addr_equal(rx_ring->netdev->dev_addr,
1221				     eth_hdr(skb)->h_source)) {
1222			dev_kfree_skb_irq(skb);
1223			continue;
1224		}
1225
1226		/* populate checksum, VLAN, and protocol */
1227		ixgbevf_process_skb_fields(rx_ring, rx_desc, skb);
1228
1229		ixgbevf_rx_skb(q_vector, skb);
1230
1231		/* reset skb pointer */
1232		skb = NULL;
1233
1234		/* update budget accounting */
1235		total_rx_packets++;
1236	}
1237
1238	/* place incomplete frames back on ring for completion */
1239	rx_ring->skb = skb;
1240
1241	if (xdp_xmit) {
1242		struct ixgbevf_ring *xdp_ring =
1243			adapter->xdp_ring[rx_ring->queue_index];
1244
1245		/* Force memory writes to complete before letting h/w
1246		 * know there are new descriptors to fetch.
1247		 */
1248		wmb();
1249		ixgbevf_write_tail(xdp_ring, xdp_ring->next_to_use);
1250	}
1251
1252	u64_stats_update_begin(&rx_ring->syncp);
1253	rx_ring->stats.packets += total_rx_packets;
1254	rx_ring->stats.bytes += total_rx_bytes;
1255	u64_stats_update_end(&rx_ring->syncp);
1256	q_vector->rx.total_packets += total_rx_packets;
1257	q_vector->rx.total_bytes += total_rx_bytes;
1258
1259	return total_rx_packets;
1260}
1261
1262/**
1263 * ixgbevf_poll - NAPI polling calback
1264 * @napi: napi struct with our devices info in it
1265 * @budget: amount of work driver is allowed to do this pass, in packets
1266 *
1267 * This function will clean more than one or more rings associated with a
1268 * q_vector.
1269 **/
1270static int ixgbevf_poll(struct napi_struct *napi, int budget)
1271{
1272	struct ixgbevf_q_vector *q_vector =
1273		container_of(napi, struct ixgbevf_q_vector, napi);
1274	struct ixgbevf_adapter *adapter = q_vector->adapter;
1275	struct ixgbevf_ring *ring;
1276	int per_ring_budget, work_done = 0;
1277	bool clean_complete = true;
1278
1279	ixgbevf_for_each_ring(ring, q_vector->tx) {
1280		if (!ixgbevf_clean_tx_irq(q_vector, ring, budget))
1281			clean_complete = false;
1282	}
1283
1284	if (budget <= 0)
1285		return budget;
 
 
 
 
1286
1287	/* attempt to distribute budget to each queue fairly, but don't allow
1288	 * the budget to go below 1 because we'll exit polling
1289	 */
1290	if (q_vector->rx.count > 1)
1291		per_ring_budget = max(budget/q_vector->rx.count, 1);
1292	else
1293		per_ring_budget = budget;
1294
1295	ixgbevf_for_each_ring(ring, q_vector->rx) {
1296		int cleaned = ixgbevf_clean_rx_irq(q_vector, ring,
1297						   per_ring_budget);
1298		work_done += cleaned;
1299		if (cleaned >= per_ring_budget)
1300			clean_complete = false;
1301	}
1302
 
 
 
 
1303	/* If all work not completed, return budget and keep polling */
1304	if (!clean_complete)
1305		return budget;
 
 
 
 
 
 
 
 
1306
1307	/* Exit the polling mode, but don't re-enable interrupts if stack might
1308	 * poll us due to busy-polling
1309	 */
1310	if (likely(napi_complete_done(napi, work_done))) {
1311		if (adapter->rx_itr_setting == 1)
1312			ixgbevf_set_itr(q_vector);
1313		if (!test_bit(__IXGBEVF_DOWN, &adapter->state) &&
1314		    !test_bit(__IXGBEVF_REMOVING, &adapter->state))
1315			ixgbevf_irq_enable_queues(adapter,
1316						  BIT(q_vector->v_idx));
1317	}
1318
1319	return min(work_done, budget - 1);
1320}
1321
1322/**
1323 * ixgbevf_write_eitr - write VTEITR register in hardware specific way
1324 * @q_vector: structure containing interrupt and ring information
1325 **/
1326void ixgbevf_write_eitr(struct ixgbevf_q_vector *q_vector)
1327{
1328	struct ixgbevf_adapter *adapter = q_vector->adapter;
1329	struct ixgbe_hw *hw = &adapter->hw;
1330	int v_idx = q_vector->v_idx;
1331	u32 itr_reg = q_vector->itr & IXGBE_MAX_EITR;
1332
1333	/* set the WDIS bit to not clear the timer bits and cause an
1334	 * immediate assertion of the interrupt
1335	 */
1336	itr_reg |= IXGBE_EITR_CNT_WDIS;
1337
1338	IXGBE_WRITE_REG(hw, IXGBE_VTEITR(v_idx), itr_reg);
1339}
1340
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1341/**
1342 * ixgbevf_configure_msix - Configure MSI-X hardware
1343 * @adapter: board private structure
1344 *
1345 * ixgbevf_configure_msix sets up the hardware to properly generate MSI-X
1346 * interrupts.
1347 **/
1348static void ixgbevf_configure_msix(struct ixgbevf_adapter *adapter)
1349{
1350	struct ixgbevf_q_vector *q_vector;
1351	int q_vectors, v_idx;
1352
1353	q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
1354	adapter->eims_enable_mask = 0;
1355
1356	/* Populate the IVAR table and set the ITR values to the
1357	 * corresponding register.
1358	 */
1359	for (v_idx = 0; v_idx < q_vectors; v_idx++) {
1360		struct ixgbevf_ring *ring;
1361
1362		q_vector = adapter->q_vector[v_idx];
1363
1364		ixgbevf_for_each_ring(ring, q_vector->rx)
1365			ixgbevf_set_ivar(adapter, 0, ring->reg_idx, v_idx);
1366
1367		ixgbevf_for_each_ring(ring, q_vector->tx)
1368			ixgbevf_set_ivar(adapter, 1, ring->reg_idx, v_idx);
1369
1370		if (q_vector->tx.ring && !q_vector->rx.ring) {
1371			/* Tx only vector */
1372			if (adapter->tx_itr_setting == 1)
1373				q_vector->itr = IXGBE_12K_ITR;
1374			else
1375				q_vector->itr = adapter->tx_itr_setting;
1376		} else {
1377			/* Rx or Rx/Tx vector */
1378			if (adapter->rx_itr_setting == 1)
1379				q_vector->itr = IXGBE_20K_ITR;
1380			else
1381				q_vector->itr = adapter->rx_itr_setting;
1382		}
1383
1384		/* add q_vector eims value to global eims_enable_mask */
1385		adapter->eims_enable_mask |= BIT(v_idx);
1386
1387		ixgbevf_write_eitr(q_vector);
1388	}
1389
1390	ixgbevf_set_ivar(adapter, -1, 1, v_idx);
1391	/* setup eims_other and add value to global eims_enable_mask */
1392	adapter->eims_other = BIT(v_idx);
1393	adapter->eims_enable_mask |= adapter->eims_other;
1394}
1395
1396enum latency_range {
1397	lowest_latency = 0,
1398	low_latency = 1,
1399	bulk_latency = 2,
1400	latency_invalid = 255
1401};
1402
1403/**
1404 * ixgbevf_update_itr - update the dynamic ITR value based on statistics
1405 * @q_vector: structure containing interrupt and ring information
1406 * @ring_container: structure containing ring performance data
1407 *
1408 * Stores a new ITR value based on packets and byte
1409 * counts during the last interrupt.  The advantage of per interrupt
1410 * computation is faster updates and more accurate ITR for the current
1411 * traffic pattern.  Constants in this function were computed
1412 * based on theoretical maximum wire speed and thresholds were set based
1413 * on testing data as well as attempting to minimize response time
1414 * while increasing bulk throughput.
1415 **/
1416static void ixgbevf_update_itr(struct ixgbevf_q_vector *q_vector,
1417			       struct ixgbevf_ring_container *ring_container)
1418{
1419	int bytes = ring_container->total_bytes;
1420	int packets = ring_container->total_packets;
1421	u32 timepassed_us;
1422	u64 bytes_perint;
1423	u8 itr_setting = ring_container->itr;
1424
1425	if (packets == 0)
1426		return;
1427
1428	/* simple throttle rate management
1429	 *    0-20MB/s lowest (100000 ints/s)
1430	 *   20-100MB/s low   (20000 ints/s)
1431	 *  100-1249MB/s bulk (12000 ints/s)
1432	 */
1433	/* what was last interrupt timeslice? */
1434	timepassed_us = q_vector->itr >> 2;
1435	if (timepassed_us == 0)
1436		return;
1437
1438	bytes_perint = bytes / timepassed_us; /* bytes/usec */
1439
1440	switch (itr_setting) {
1441	case lowest_latency:
1442		if (bytes_perint > 10)
1443			itr_setting = low_latency;
1444		break;
1445	case low_latency:
1446		if (bytes_perint > 20)
1447			itr_setting = bulk_latency;
1448		else if (bytes_perint <= 10)
1449			itr_setting = lowest_latency;
1450		break;
1451	case bulk_latency:
1452		if (bytes_perint <= 20)
1453			itr_setting = low_latency;
1454		break;
1455	}
1456
1457	/* clear work counters since we have the values we need */
1458	ring_container->total_bytes = 0;
1459	ring_container->total_packets = 0;
1460
1461	/* write updated itr to ring container */
1462	ring_container->itr = itr_setting;
1463}
1464
1465static void ixgbevf_set_itr(struct ixgbevf_q_vector *q_vector)
1466{
1467	u32 new_itr = q_vector->itr;
1468	u8 current_itr;
1469
1470	ixgbevf_update_itr(q_vector, &q_vector->tx);
1471	ixgbevf_update_itr(q_vector, &q_vector->rx);
1472
1473	current_itr = max(q_vector->rx.itr, q_vector->tx.itr);
1474
1475	switch (current_itr) {
1476	/* counts and packets in update_itr are dependent on these numbers */
1477	case lowest_latency:
1478		new_itr = IXGBE_100K_ITR;
1479		break;
1480	case low_latency:
1481		new_itr = IXGBE_20K_ITR;
1482		break;
1483	case bulk_latency:
1484		new_itr = IXGBE_12K_ITR;
1485		break;
1486	default:
1487		break;
1488	}
1489
1490	if (new_itr != q_vector->itr) {
1491		/* do an exponential smoothing */
1492		new_itr = (10 * new_itr * q_vector->itr) /
1493			  ((9 * new_itr) + q_vector->itr);
1494
1495		/* save the algorithm value here */
1496		q_vector->itr = new_itr;
1497
1498		ixgbevf_write_eitr(q_vector);
1499	}
1500}
1501
1502static irqreturn_t ixgbevf_msix_other(int irq, void *data)
1503{
1504	struct ixgbevf_adapter *adapter = data;
1505	struct ixgbe_hw *hw = &adapter->hw;
1506
1507	hw->mac.get_link_status = 1;
1508
1509	ixgbevf_service_event_schedule(adapter);
1510
1511	IXGBE_WRITE_REG(hw, IXGBE_VTEIMS, adapter->eims_other);
1512
1513	return IRQ_HANDLED;
1514}
1515
1516/**
1517 * ixgbevf_msix_clean_rings - single unshared vector rx clean (all queues)
1518 * @irq: unused
1519 * @data: pointer to our q_vector struct for this interrupt vector
1520 **/
1521static irqreturn_t ixgbevf_msix_clean_rings(int irq, void *data)
1522{
1523	struct ixgbevf_q_vector *q_vector = data;
1524
1525	/* EIAM disabled interrupts (on this vector) for us */
1526	if (q_vector->rx.ring || q_vector->tx.ring)
1527		napi_schedule_irqoff(&q_vector->napi);
1528
1529	return IRQ_HANDLED;
1530}
1531
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1532/**
1533 * ixgbevf_request_msix_irqs - Initialize MSI-X interrupts
1534 * @adapter: board private structure
1535 *
1536 * ixgbevf_request_msix_irqs allocates MSI-X vectors and requests
1537 * interrupts from the kernel.
1538 **/
1539static int ixgbevf_request_msix_irqs(struct ixgbevf_adapter *adapter)
1540{
1541	struct net_device *netdev = adapter->netdev;
1542	int q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
1543	unsigned int ri = 0, ti = 0;
1544	int vector, err;
 
1545
1546	for (vector = 0; vector < q_vectors; vector++) {
1547		struct ixgbevf_q_vector *q_vector = adapter->q_vector[vector];
1548		struct msix_entry *entry = &adapter->msix_entries[vector];
1549
1550		if (q_vector->tx.ring && q_vector->rx.ring) {
1551			snprintf(q_vector->name, sizeof(q_vector->name),
1552				 "%s-TxRx-%u", netdev->name, ri++);
1553			ti++;
1554		} else if (q_vector->rx.ring) {
1555			snprintf(q_vector->name, sizeof(q_vector->name),
1556				 "%s-rx-%u", netdev->name, ri++);
1557		} else if (q_vector->tx.ring) {
1558			snprintf(q_vector->name, sizeof(q_vector->name),
1559				 "%s-tx-%u", netdev->name, ti++);
1560		} else {
1561			/* skip this unused q_vector */
1562			continue;
1563		}
1564		err = request_irq(entry->vector, &ixgbevf_msix_clean_rings, 0,
1565				  q_vector->name, q_vector);
1566		if (err) {
1567			hw_dbg(&adapter->hw,
1568			       "request_irq failed for MSIX interrupt Error: %d\n",
1569			       err);
1570			goto free_queue_irqs;
1571		}
1572	}
1573
1574	err = request_irq(adapter->msix_entries[vector].vector,
1575			  &ixgbevf_msix_other, 0, netdev->name, adapter);
1576	if (err) {
1577		hw_dbg(&adapter->hw, "request_irq for msix_other failed: %d\n",
1578		       err);
1579		goto free_queue_irqs;
1580	}
1581
1582	return 0;
1583
1584free_queue_irqs:
1585	while (vector) {
1586		vector--;
1587		free_irq(adapter->msix_entries[vector].vector,
1588			 adapter->q_vector[vector]);
1589	}
1590	/* This failure is non-recoverable - it indicates the system is
1591	 * out of MSIX vector resources and the VF driver cannot run
1592	 * without them.  Set the number of msix vectors to zero
1593	 * indicating that not enough can be allocated.  The error
1594	 * will be returned to the user indicating device open failed.
1595	 * Any further attempts to force the driver to open will also
1596	 * fail.  The only way to recover is to unload the driver and
1597	 * reload it again.  If the system has recovered some MSIX
1598	 * vectors then it may succeed.
1599	 */
1600	adapter->num_msix_vectors = 0;
1601	return err;
1602}
1603
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1604/**
1605 * ixgbevf_request_irq - initialize interrupts
1606 * @adapter: board private structure
1607 *
1608 * Attempts to configure interrupts using the best available
1609 * capabilities of the hardware and kernel.
1610 **/
1611static int ixgbevf_request_irq(struct ixgbevf_adapter *adapter)
1612{
1613	int err = ixgbevf_request_msix_irqs(adapter);
1614
1615	if (err)
1616		hw_dbg(&adapter->hw, "request_irq failed, Error %d\n", err);
1617
1618	return err;
1619}
1620
1621static void ixgbevf_free_irq(struct ixgbevf_adapter *adapter)
1622{
1623	int i, q_vectors;
1624
1625	if (!adapter->msix_entries)
1626		return;
1627
1628	q_vectors = adapter->num_msix_vectors;
1629	i = q_vectors - 1;
1630
1631	free_irq(adapter->msix_entries[i].vector, adapter);
1632	i--;
1633
1634	for (; i >= 0; i--) {
1635		/* free only the irqs that were actually requested */
1636		if (!adapter->q_vector[i]->rx.ring &&
1637		    !adapter->q_vector[i]->tx.ring)
1638			continue;
1639
1640		free_irq(adapter->msix_entries[i].vector,
1641			 adapter->q_vector[i]);
1642	}
 
 
1643}
1644
1645/**
1646 * ixgbevf_irq_disable - Mask off interrupt generation on the NIC
1647 * @adapter: board private structure
1648 **/
1649static inline void ixgbevf_irq_disable(struct ixgbevf_adapter *adapter)
1650{
1651	struct ixgbe_hw *hw = &adapter->hw;
1652	int i;
1653
1654	IXGBE_WRITE_REG(hw, IXGBE_VTEIAM, 0);
1655	IXGBE_WRITE_REG(hw, IXGBE_VTEIMC, ~0);
1656	IXGBE_WRITE_REG(hw, IXGBE_VTEIAC, 0);
1657
1658	IXGBE_WRITE_FLUSH(hw);
1659
1660	for (i = 0; i < adapter->num_msix_vectors; i++)
1661		synchronize_irq(adapter->msix_entries[i].vector);
1662}
1663
1664/**
1665 * ixgbevf_irq_enable - Enable default interrupt generation settings
1666 * @adapter: board private structure
1667 **/
1668static inline void ixgbevf_irq_enable(struct ixgbevf_adapter *adapter)
1669{
1670	struct ixgbe_hw *hw = &adapter->hw;
1671
1672	IXGBE_WRITE_REG(hw, IXGBE_VTEIAM, adapter->eims_enable_mask);
1673	IXGBE_WRITE_REG(hw, IXGBE_VTEIAC, adapter->eims_enable_mask);
1674	IXGBE_WRITE_REG(hw, IXGBE_VTEIMS, adapter->eims_enable_mask);
1675}
1676
1677/**
1678 * ixgbevf_configure_tx_ring - Configure 82599 VF Tx ring after Reset
1679 * @adapter: board private structure
1680 * @ring: structure containing ring specific data
1681 *
1682 * Configure the Tx descriptor ring after a reset.
1683 **/
1684static void ixgbevf_configure_tx_ring(struct ixgbevf_adapter *adapter,
1685				      struct ixgbevf_ring *ring)
1686{
1687	struct ixgbe_hw *hw = &adapter->hw;
1688	u64 tdba = ring->dma;
1689	int wait_loop = 10;
1690	u32 txdctl = IXGBE_TXDCTL_ENABLE;
1691	u8 reg_idx = ring->reg_idx;
1692
1693	/* disable queue to avoid issues while updating state */
1694	IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(reg_idx), IXGBE_TXDCTL_SWFLSH);
1695	IXGBE_WRITE_FLUSH(hw);
1696
1697	IXGBE_WRITE_REG(hw, IXGBE_VFTDBAL(reg_idx), tdba & DMA_BIT_MASK(32));
1698	IXGBE_WRITE_REG(hw, IXGBE_VFTDBAH(reg_idx), tdba >> 32);
1699	IXGBE_WRITE_REG(hw, IXGBE_VFTDLEN(reg_idx),
1700			ring->count * sizeof(union ixgbe_adv_tx_desc));
1701
1702	/* disable head writeback */
1703	IXGBE_WRITE_REG(hw, IXGBE_VFTDWBAH(reg_idx), 0);
1704	IXGBE_WRITE_REG(hw, IXGBE_VFTDWBAL(reg_idx), 0);
1705
1706	/* enable relaxed ordering */
1707	IXGBE_WRITE_REG(hw, IXGBE_VFDCA_TXCTRL(reg_idx),
1708			(IXGBE_DCA_TXCTRL_DESC_RRO_EN |
1709			 IXGBE_DCA_TXCTRL_DATA_RRO_EN));
1710
1711	/* reset head and tail pointers */
1712	IXGBE_WRITE_REG(hw, IXGBE_VFTDH(reg_idx), 0);
1713	IXGBE_WRITE_REG(hw, IXGBE_VFTDT(reg_idx), 0);
1714	ring->tail = adapter->io_addr + IXGBE_VFTDT(reg_idx);
1715
1716	/* reset ntu and ntc to place SW in sync with hardwdare */
1717	ring->next_to_clean = 0;
1718	ring->next_to_use = 0;
1719
1720	/* In order to avoid issues WTHRESH + PTHRESH should always be equal
1721	 * to or less than the number of on chip descriptors, which is
1722	 * currently 40.
1723	 */
1724	txdctl |= (8 << 16);    /* WTHRESH = 8 */
1725
1726	/* Setting PTHRESH to 32 both improves performance */
1727	txdctl |= (1u << 8) |    /* HTHRESH = 1 */
1728		   32;           /* PTHRESH = 32 */
1729
1730	/* reinitialize tx_buffer_info */
1731	memset(ring->tx_buffer_info, 0,
1732	       sizeof(struct ixgbevf_tx_buffer) * ring->count);
1733
1734	clear_bit(__IXGBEVF_HANG_CHECK_ARMED, &ring->state);
1735	clear_bit(__IXGBEVF_TX_XDP_RING_PRIMED, &ring->state);
1736
1737	IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(reg_idx), txdctl);
1738
1739	/* poll to verify queue is enabled */
1740	do {
1741		usleep_range(1000, 2000);
1742		txdctl = IXGBE_READ_REG(hw, IXGBE_VFTXDCTL(reg_idx));
1743	}  while (--wait_loop && !(txdctl & IXGBE_TXDCTL_ENABLE));
1744	if (!wait_loop)
1745		hw_dbg(hw, "Could not enable Tx Queue %d\n", reg_idx);
1746}
1747
1748/**
1749 * ixgbevf_configure_tx - Configure 82599 VF Transmit Unit after Reset
1750 * @adapter: board private structure
1751 *
1752 * Configure the Tx unit of the MAC after a reset.
1753 **/
1754static void ixgbevf_configure_tx(struct ixgbevf_adapter *adapter)
1755{
1756	u32 i;
1757
1758	/* Setup the HW Tx Head and Tail descriptor pointers */
1759	for (i = 0; i < adapter->num_tx_queues; i++)
1760		ixgbevf_configure_tx_ring(adapter, adapter->tx_ring[i]);
1761	for (i = 0; i < adapter->num_xdp_queues; i++)
1762		ixgbevf_configure_tx_ring(adapter, adapter->xdp_ring[i]);
1763}
1764
1765#define IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT	2
1766
1767static void ixgbevf_configure_srrctl(struct ixgbevf_adapter *adapter,
1768				     struct ixgbevf_ring *ring, int index)
1769{
1770	struct ixgbe_hw *hw = &adapter->hw;
1771	u32 srrctl;
1772
1773	srrctl = IXGBE_SRRCTL_DROP_EN;
1774
1775	srrctl |= IXGBEVF_RX_HDR_SIZE << IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT;
1776	if (ring_uses_large_buffer(ring))
1777		srrctl |= IXGBEVF_RXBUFFER_3072 >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
1778	else
1779		srrctl |= IXGBEVF_RXBUFFER_2048 >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
1780	srrctl |= IXGBE_SRRCTL_DESCTYPE_ADV_ONEBUF;
1781
1782	IXGBE_WRITE_REG(hw, IXGBE_VFSRRCTL(index), srrctl);
1783}
1784
1785static void ixgbevf_setup_psrtype(struct ixgbevf_adapter *adapter)
1786{
1787	struct ixgbe_hw *hw = &adapter->hw;
1788
1789	/* PSRTYPE must be initialized in 82599 */
1790	u32 psrtype = IXGBE_PSRTYPE_TCPHDR | IXGBE_PSRTYPE_UDPHDR |
1791		      IXGBE_PSRTYPE_IPV4HDR | IXGBE_PSRTYPE_IPV6HDR |
1792		      IXGBE_PSRTYPE_L2HDR;
1793
1794	if (adapter->num_rx_queues > 1)
1795		psrtype |= BIT(29);
1796
1797	IXGBE_WRITE_REG(hw, IXGBE_VFPSRTYPE, psrtype);
1798}
1799
1800#define IXGBEVF_MAX_RX_DESC_POLL 10
1801static void ixgbevf_disable_rx_queue(struct ixgbevf_adapter *adapter,
1802				     struct ixgbevf_ring *ring)
1803{
1804	struct ixgbe_hw *hw = &adapter->hw;
1805	int wait_loop = IXGBEVF_MAX_RX_DESC_POLL;
1806	u32 rxdctl;
1807	u8 reg_idx = ring->reg_idx;
1808
1809	if (IXGBE_REMOVED(hw->hw_addr))
1810		return;
1811	rxdctl = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(reg_idx));
1812	rxdctl &= ~IXGBE_RXDCTL_ENABLE;
1813
1814	/* write value back with RXDCTL.ENABLE bit cleared */
1815	IXGBE_WRITE_REG(hw, IXGBE_VFRXDCTL(reg_idx), rxdctl);
1816
1817	/* the hardware may take up to 100us to really disable the Rx queue */
1818	do {
1819		udelay(10);
1820		rxdctl = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(reg_idx));
1821	} while (--wait_loop && (rxdctl & IXGBE_RXDCTL_ENABLE));
1822
1823	if (!wait_loop)
1824		pr_err("RXDCTL.ENABLE queue %d not cleared while polling\n",
1825		       reg_idx);
1826}
1827
1828static void ixgbevf_rx_desc_queue_enable(struct ixgbevf_adapter *adapter,
1829					 struct ixgbevf_ring *ring)
1830{
1831	struct ixgbe_hw *hw = &adapter->hw;
1832	int wait_loop = IXGBEVF_MAX_RX_DESC_POLL;
1833	u32 rxdctl;
1834	u8 reg_idx = ring->reg_idx;
1835
1836	if (IXGBE_REMOVED(hw->hw_addr))
1837		return;
1838	do {
1839		usleep_range(1000, 2000);
1840		rxdctl = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(reg_idx));
1841	} while (--wait_loop && !(rxdctl & IXGBE_RXDCTL_ENABLE));
1842
1843	if (!wait_loop)
1844		pr_err("RXDCTL.ENABLE queue %d not set while polling\n",
1845		       reg_idx);
1846}
1847
1848/**
1849 * ixgbevf_init_rss_key - Initialize adapter RSS key
1850 * @adapter: device handle
1851 *
1852 * Allocates and initializes the RSS key if it is not allocated.
1853 **/
1854static inline int ixgbevf_init_rss_key(struct ixgbevf_adapter *adapter)
1855{
1856	u32 *rss_key;
1857
1858	if (!adapter->rss_key) {
1859		rss_key = kzalloc(IXGBEVF_RSS_HASH_KEY_SIZE, GFP_KERNEL);
1860		if (unlikely(!rss_key))
1861			return -ENOMEM;
1862
1863		netdev_rss_key_fill(rss_key, IXGBEVF_RSS_HASH_KEY_SIZE);
1864		adapter->rss_key = rss_key;
1865	}
1866
1867	return 0;
1868}
1869
1870static void ixgbevf_setup_vfmrqc(struct ixgbevf_adapter *adapter)
1871{
1872	struct ixgbe_hw *hw = &adapter->hw;
1873	u32 vfmrqc = 0, vfreta = 0;
1874	u16 rss_i = adapter->num_rx_queues;
1875	u8 i, j;
1876
1877	/* Fill out hash function seeds */
 
1878	for (i = 0; i < IXGBEVF_VFRSSRK_REGS; i++)
1879		IXGBE_WRITE_REG(hw, IXGBE_VFRSSRK(i), *(adapter->rss_key + i));
1880
1881	for (i = 0, j = 0; i < IXGBEVF_X550_VFRETA_SIZE; i++, j++) {
1882		if (j == rss_i)
1883			j = 0;
1884
1885		adapter->rss_indir_tbl[i] = j;
1886
1887		vfreta |= j << (i & 0x3) * 8;
1888		if ((i & 3) == 3) {
1889			IXGBE_WRITE_REG(hw, IXGBE_VFRETA(i >> 2), vfreta);
1890			vfreta = 0;
1891		}
1892	}
1893
1894	/* Perform hash on these packet types */
1895	vfmrqc |= IXGBE_VFMRQC_RSS_FIELD_IPV4 |
1896		IXGBE_VFMRQC_RSS_FIELD_IPV4_TCP |
1897		IXGBE_VFMRQC_RSS_FIELD_IPV6 |
1898		IXGBE_VFMRQC_RSS_FIELD_IPV6_TCP;
1899
1900	vfmrqc |= IXGBE_VFMRQC_RSSEN;
1901
1902	IXGBE_WRITE_REG(hw, IXGBE_VFMRQC, vfmrqc);
1903}
1904
1905static void ixgbevf_configure_rx_ring(struct ixgbevf_adapter *adapter,
1906				      struct ixgbevf_ring *ring)
1907{
1908	struct ixgbe_hw *hw = &adapter->hw;
1909	union ixgbe_adv_rx_desc *rx_desc;
1910	u64 rdba = ring->dma;
1911	u32 rxdctl;
1912	u8 reg_idx = ring->reg_idx;
1913
1914	/* disable queue to avoid issues while updating state */
1915	rxdctl = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(reg_idx));
1916	ixgbevf_disable_rx_queue(adapter, ring);
1917
1918	IXGBE_WRITE_REG(hw, IXGBE_VFRDBAL(reg_idx), rdba & DMA_BIT_MASK(32));
1919	IXGBE_WRITE_REG(hw, IXGBE_VFRDBAH(reg_idx), rdba >> 32);
1920	IXGBE_WRITE_REG(hw, IXGBE_VFRDLEN(reg_idx),
1921			ring->count * sizeof(union ixgbe_adv_rx_desc));
1922
1923#ifndef CONFIG_SPARC
1924	/* enable relaxed ordering */
1925	IXGBE_WRITE_REG(hw, IXGBE_VFDCA_RXCTRL(reg_idx),
1926			IXGBE_DCA_RXCTRL_DESC_RRO_EN);
1927#else
1928	IXGBE_WRITE_REG(hw, IXGBE_VFDCA_RXCTRL(reg_idx),
1929			IXGBE_DCA_RXCTRL_DESC_RRO_EN |
1930			IXGBE_DCA_RXCTRL_DATA_WRO_EN);
1931#endif
1932
1933	/* reset head and tail pointers */
1934	IXGBE_WRITE_REG(hw, IXGBE_VFRDH(reg_idx), 0);
1935	IXGBE_WRITE_REG(hw, IXGBE_VFRDT(reg_idx), 0);
1936	ring->tail = adapter->io_addr + IXGBE_VFRDT(reg_idx);
1937
1938	/* initialize rx_buffer_info */
1939	memset(ring->rx_buffer_info, 0,
1940	       sizeof(struct ixgbevf_rx_buffer) * ring->count);
1941
1942	/* initialize Rx descriptor 0 */
1943	rx_desc = IXGBEVF_RX_DESC(ring, 0);
1944	rx_desc->wb.upper.length = 0;
1945
1946	/* reset ntu and ntc to place SW in sync with hardwdare */
1947	ring->next_to_clean = 0;
1948	ring->next_to_use = 0;
1949	ring->next_to_alloc = 0;
1950
1951	ixgbevf_configure_srrctl(adapter, ring, reg_idx);
1952
1953	/* RXDCTL.RLPML does not work on 82599 */
1954	if (adapter->hw.mac.type != ixgbe_mac_82599_vf) {
1955		rxdctl &= ~(IXGBE_RXDCTL_RLPMLMASK |
1956			    IXGBE_RXDCTL_RLPML_EN);
1957
1958#if (PAGE_SIZE < 8192)
1959		/* Limit the maximum frame size so we don't overrun the skb */
1960		if (ring_uses_build_skb(ring) &&
1961		    !ring_uses_large_buffer(ring))
1962			rxdctl |= IXGBEVF_MAX_FRAME_BUILD_SKB |
1963				  IXGBE_RXDCTL_RLPML_EN;
1964#endif
1965	}
1966
1967	rxdctl |= IXGBE_RXDCTL_ENABLE | IXGBE_RXDCTL_VME;
1968	IXGBE_WRITE_REG(hw, IXGBE_VFRXDCTL(reg_idx), rxdctl);
1969
1970	ixgbevf_rx_desc_queue_enable(adapter, ring);
1971	ixgbevf_alloc_rx_buffers(ring, ixgbevf_desc_unused(ring));
1972}
1973
1974static void ixgbevf_set_rx_buffer_len(struct ixgbevf_adapter *adapter,
1975				      struct ixgbevf_ring *rx_ring)
1976{
1977	struct net_device *netdev = adapter->netdev;
1978	unsigned int max_frame = netdev->mtu + ETH_HLEN + ETH_FCS_LEN;
1979
1980	/* set build_skb and buffer size flags */
1981	clear_ring_build_skb_enabled(rx_ring);
1982	clear_ring_uses_large_buffer(rx_ring);
1983
1984	if (adapter->flags & IXGBEVF_FLAGS_LEGACY_RX)
1985		return;
1986
1987	if (PAGE_SIZE < 8192)
1988		if (max_frame > IXGBEVF_MAX_FRAME_BUILD_SKB)
1989			set_ring_uses_large_buffer(rx_ring);
1990
1991	/* 82599 can't rely on RXDCTL.RLPML to restrict the size of the frame */
1992	if (adapter->hw.mac.type == ixgbe_mac_82599_vf && !ring_uses_large_buffer(rx_ring))
1993		return;
1994
1995	set_ring_build_skb_enabled(rx_ring);
1996}
1997
1998/**
1999 * ixgbevf_configure_rx - Configure 82599 VF Receive Unit after Reset
2000 * @adapter: board private structure
2001 *
2002 * Configure the Rx unit of the MAC after a reset.
2003 **/
2004static void ixgbevf_configure_rx(struct ixgbevf_adapter *adapter)
2005{
 
2006	struct ixgbe_hw *hw = &adapter->hw;
2007	struct net_device *netdev = adapter->netdev;
2008	int i, ret;
2009
2010	ixgbevf_setup_psrtype(adapter);
2011	if (hw->mac.type >= ixgbe_mac_X550_vf)
2012		ixgbevf_setup_vfmrqc(adapter);
2013
2014	spin_lock_bh(&adapter->mbx_lock);
2015	/* notify the PF of our intent to use this size of frame */
2016	ret = hw->mac.ops.set_rlpml(hw, netdev->mtu + ETH_HLEN + ETH_FCS_LEN);
2017	spin_unlock_bh(&adapter->mbx_lock);
2018	if (ret)
2019		dev_err(&adapter->pdev->dev,
2020			"Failed to set MTU at %d\n", netdev->mtu);
2021
2022	/* Setup the HW Rx Head and Tail Descriptor Pointers and
2023	 * the Base and Length of the Rx Descriptor Ring
2024	 */
2025	for (i = 0; i < adapter->num_rx_queues; i++) {
2026		struct ixgbevf_ring *rx_ring = adapter->rx_ring[i];
2027
2028		ixgbevf_set_rx_buffer_len(adapter, rx_ring);
2029		ixgbevf_configure_rx_ring(adapter, rx_ring);
2030	}
2031}
2032
2033static int ixgbevf_vlan_rx_add_vid(struct net_device *netdev,
2034				   __be16 proto, u16 vid)
2035{
2036	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
2037	struct ixgbe_hw *hw = &adapter->hw;
2038	int err;
2039
2040	spin_lock_bh(&adapter->mbx_lock);
2041
2042	/* add VID to filter table */
2043	err = hw->mac.ops.set_vfta(hw, vid, 0, true);
2044
2045	spin_unlock_bh(&adapter->mbx_lock);
2046
2047	if (err) {
2048		netdev_err(netdev, "VF could not set VLAN %d\n", vid);
2049
2050		/* translate error return types so error makes sense */
2051		if (err == IXGBE_ERR_MBX)
2052			return -EIO;
2053
2054		if (err == IXGBE_ERR_INVALID_ARGUMENT)
2055			return -EACCES;
2056	}
2057
2058	set_bit(vid, adapter->active_vlans);
2059
2060	return err;
2061}
2062
2063static int ixgbevf_vlan_rx_kill_vid(struct net_device *netdev,
2064				    __be16 proto, u16 vid)
2065{
2066	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
2067	struct ixgbe_hw *hw = &adapter->hw;
2068	int err;
2069
2070	spin_lock_bh(&adapter->mbx_lock);
2071
2072	/* remove VID from filter table */
2073	err = hw->mac.ops.set_vfta(hw, vid, 0, false);
2074
2075	spin_unlock_bh(&adapter->mbx_lock);
2076
2077	if (err)
2078		netdev_err(netdev, "Could not remove VLAN %d\n", vid);
2079
2080	clear_bit(vid, adapter->active_vlans);
2081
2082	return err;
2083}
2084
2085static void ixgbevf_restore_vlan(struct ixgbevf_adapter *adapter)
2086{
2087	u16 vid;
2088
2089	for_each_set_bit(vid, adapter->active_vlans, VLAN_N_VID)
2090		ixgbevf_vlan_rx_add_vid(adapter->netdev,
2091					htons(ETH_P_8021Q), vid);
2092}
2093
2094static int ixgbevf_write_uc_addr_list(struct net_device *netdev)
2095{
2096	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
2097	struct ixgbe_hw *hw = &adapter->hw;
2098	int count = 0;
2099
 
 
 
 
 
2100	if (!netdev_uc_empty(netdev)) {
2101		struct netdev_hw_addr *ha;
2102
2103		netdev_for_each_uc_addr(ha, netdev) {
2104			hw->mac.ops.set_uc_addr(hw, ++count, ha->addr);
2105			udelay(200);
2106		}
2107	} else {
2108		/* If the list is empty then send message to PF driver to
2109		 * clear all MAC VLANs on this VF.
2110		 */
2111		hw->mac.ops.set_uc_addr(hw, 0, NULL);
2112	}
2113
2114	return count;
2115}
2116
2117/**
2118 * ixgbevf_set_rx_mode - Multicast and unicast set
2119 * @netdev: network interface device structure
2120 *
2121 * The set_rx_method entry point is called whenever the multicast address
2122 * list, unicast address list or the network interface flags are updated.
2123 * This routine is responsible for configuring the hardware for proper
2124 * multicast mode and configuring requested unicast filters.
2125 **/
2126static void ixgbevf_set_rx_mode(struct net_device *netdev)
2127{
2128	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
2129	struct ixgbe_hw *hw = &adapter->hw;
2130	unsigned int flags = netdev->flags;
2131	int xcast_mode;
2132
2133	/* request the most inclusive mode we need */
2134	if (flags & IFF_PROMISC)
2135		xcast_mode = IXGBEVF_XCAST_MODE_PROMISC;
2136	else if (flags & IFF_ALLMULTI)
2137		xcast_mode = IXGBEVF_XCAST_MODE_ALLMULTI;
2138	else if (flags & (IFF_BROADCAST | IFF_MULTICAST))
2139		xcast_mode = IXGBEVF_XCAST_MODE_MULTI;
2140	else
2141		xcast_mode = IXGBEVF_XCAST_MODE_NONE;
2142
2143	spin_lock_bh(&adapter->mbx_lock);
2144
2145	hw->mac.ops.update_xcast_mode(hw, xcast_mode);
2146
2147	/* reprogram multicast list */
2148	hw->mac.ops.update_mc_addr_list(hw, netdev);
2149
2150	ixgbevf_write_uc_addr_list(netdev);
2151
2152	spin_unlock_bh(&adapter->mbx_lock);
2153}
2154
2155static void ixgbevf_napi_enable_all(struct ixgbevf_adapter *adapter)
2156{
2157	int q_idx;
2158	struct ixgbevf_q_vector *q_vector;
2159	int q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
2160
2161	for (q_idx = 0; q_idx < q_vectors; q_idx++) {
2162		q_vector = adapter->q_vector[q_idx];
 
 
 
2163		napi_enable(&q_vector->napi);
2164	}
2165}
2166
2167static void ixgbevf_napi_disable_all(struct ixgbevf_adapter *adapter)
2168{
2169	int q_idx;
2170	struct ixgbevf_q_vector *q_vector;
2171	int q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
2172
2173	for (q_idx = 0; q_idx < q_vectors; q_idx++) {
2174		q_vector = adapter->q_vector[q_idx];
2175		napi_disable(&q_vector->napi);
 
 
 
 
 
 
2176	}
2177}
2178
2179static int ixgbevf_configure_dcb(struct ixgbevf_adapter *adapter)
2180{
2181	struct ixgbe_hw *hw = &adapter->hw;
2182	unsigned int def_q = 0;
2183	unsigned int num_tcs = 0;
2184	unsigned int num_rx_queues = adapter->num_rx_queues;
2185	unsigned int num_tx_queues = adapter->num_tx_queues;
2186	int err;
2187
2188	spin_lock_bh(&adapter->mbx_lock);
2189
2190	/* fetch queue configuration from the PF */
2191	err = ixgbevf_get_queues(hw, &num_tcs, &def_q);
2192
2193	spin_unlock_bh(&adapter->mbx_lock);
2194
2195	if (err)
2196		return err;
2197
2198	if (num_tcs > 1) {
2199		/* we need only one Tx queue */
2200		num_tx_queues = 1;
2201
2202		/* update default Tx ring register index */
2203		adapter->tx_ring[0]->reg_idx = def_q;
2204
2205		/* we need as many queues as traffic classes */
2206		num_rx_queues = num_tcs;
2207	}
2208
2209	/* if we have a bad config abort request queue reset */
2210	if ((adapter->num_rx_queues != num_rx_queues) ||
2211	    (adapter->num_tx_queues != num_tx_queues)) {
2212		/* force mailbox timeout to prevent further messages */
2213		hw->mbx.timeout = 0;
2214
2215		/* wait for watchdog to come around and bail us out */
2216		set_bit(__IXGBEVF_QUEUE_RESET_REQUESTED, &adapter->state);
2217	}
2218
2219	return 0;
2220}
2221
2222static void ixgbevf_configure(struct ixgbevf_adapter *adapter)
2223{
2224	ixgbevf_configure_dcb(adapter);
2225
2226	ixgbevf_set_rx_mode(adapter->netdev);
2227
2228	ixgbevf_restore_vlan(adapter);
2229	ixgbevf_ipsec_restore(adapter);
2230
2231	ixgbevf_configure_tx(adapter);
2232	ixgbevf_configure_rx(adapter);
2233}
2234
2235static void ixgbevf_save_reset_stats(struct ixgbevf_adapter *adapter)
2236{
2237	/* Only save pre-reset stats if there are some */
2238	if (adapter->stats.vfgprc || adapter->stats.vfgptc) {
2239		adapter->stats.saved_reset_vfgprc += adapter->stats.vfgprc -
2240			adapter->stats.base_vfgprc;
2241		adapter->stats.saved_reset_vfgptc += adapter->stats.vfgptc -
2242			adapter->stats.base_vfgptc;
2243		adapter->stats.saved_reset_vfgorc += adapter->stats.vfgorc -
2244			adapter->stats.base_vfgorc;
2245		adapter->stats.saved_reset_vfgotc += adapter->stats.vfgotc -
2246			adapter->stats.base_vfgotc;
2247		adapter->stats.saved_reset_vfmprc += adapter->stats.vfmprc -
2248			adapter->stats.base_vfmprc;
2249	}
2250}
2251
2252static void ixgbevf_init_last_counter_stats(struct ixgbevf_adapter *adapter)
2253{
2254	struct ixgbe_hw *hw = &adapter->hw;
2255
2256	adapter->stats.last_vfgprc = IXGBE_READ_REG(hw, IXGBE_VFGPRC);
2257	adapter->stats.last_vfgorc = IXGBE_READ_REG(hw, IXGBE_VFGORC_LSB);
2258	adapter->stats.last_vfgorc |=
2259		(((u64)(IXGBE_READ_REG(hw, IXGBE_VFGORC_MSB))) << 32);
2260	adapter->stats.last_vfgptc = IXGBE_READ_REG(hw, IXGBE_VFGPTC);
2261	adapter->stats.last_vfgotc = IXGBE_READ_REG(hw, IXGBE_VFGOTC_LSB);
2262	adapter->stats.last_vfgotc |=
2263		(((u64)(IXGBE_READ_REG(hw, IXGBE_VFGOTC_MSB))) << 32);
2264	adapter->stats.last_vfmprc = IXGBE_READ_REG(hw, IXGBE_VFMPRC);
2265
2266	adapter->stats.base_vfgprc = adapter->stats.last_vfgprc;
2267	adapter->stats.base_vfgorc = adapter->stats.last_vfgorc;
2268	adapter->stats.base_vfgptc = adapter->stats.last_vfgptc;
2269	adapter->stats.base_vfgotc = adapter->stats.last_vfgotc;
2270	adapter->stats.base_vfmprc = adapter->stats.last_vfmprc;
2271}
2272
2273static void ixgbevf_negotiate_api(struct ixgbevf_adapter *adapter)
2274{
2275	struct ixgbe_hw *hw = &adapter->hw;
2276	static const int api[] = {
2277		ixgbe_mbox_api_15,
2278		ixgbe_mbox_api_14,
2279		ixgbe_mbox_api_13,
2280		ixgbe_mbox_api_12,
2281		ixgbe_mbox_api_11,
2282		ixgbe_mbox_api_10,
2283		ixgbe_mbox_api_unknown
2284	};
2285	int err, idx = 0;
2286
2287	spin_lock_bh(&adapter->mbx_lock);
2288
2289	while (api[idx] != ixgbe_mbox_api_unknown) {
2290		err = hw->mac.ops.negotiate_api_version(hw, api[idx]);
2291		if (!err)
2292			break;
2293		idx++;
2294	}
2295
2296	if (hw->api_version >= ixgbe_mbox_api_15) {
2297		hw->mbx.ops.init_params(hw);
2298		memcpy(&hw->mbx.ops, &ixgbevf_mbx_ops,
2299		       sizeof(struct ixgbe_mbx_operations));
2300	}
2301
2302	spin_unlock_bh(&adapter->mbx_lock);
2303}
2304
2305static void ixgbevf_up_complete(struct ixgbevf_adapter *adapter)
2306{
2307	struct net_device *netdev = adapter->netdev;
2308	struct pci_dev *pdev = adapter->pdev;
2309	struct ixgbe_hw *hw = &adapter->hw;
2310	bool state;
2311
2312	ixgbevf_configure_msix(adapter);
2313
2314	spin_lock_bh(&adapter->mbx_lock);
2315
2316	if (is_valid_ether_addr(hw->mac.addr))
2317		hw->mac.ops.set_rar(hw, 0, hw->mac.addr, 0);
2318	else
2319		hw->mac.ops.set_rar(hw, 0, hw->mac.perm_addr, 0);
2320
2321	spin_unlock_bh(&adapter->mbx_lock);
2322
2323	state = adapter->link_state;
2324	hw->mac.ops.get_link_state(hw, &adapter->link_state);
2325	if (state && state != adapter->link_state)
2326		dev_info(&pdev->dev, "VF is administratively disabled\n");
2327
2328	smp_mb__before_atomic();
2329	clear_bit(__IXGBEVF_DOWN, &adapter->state);
2330	ixgbevf_napi_enable_all(adapter);
2331
2332	/* clear any pending interrupts, may auto mask */
2333	IXGBE_READ_REG(hw, IXGBE_VTEICR);
2334	ixgbevf_irq_enable(adapter);
2335
2336	/* enable transmits */
2337	netif_tx_start_all_queues(netdev);
2338
2339	ixgbevf_save_reset_stats(adapter);
2340	ixgbevf_init_last_counter_stats(adapter);
2341
2342	hw->mac.get_link_status = 1;
2343	mod_timer(&adapter->service_timer, jiffies);
2344}
2345
2346void ixgbevf_up(struct ixgbevf_adapter *adapter)
2347{
2348	ixgbevf_configure(adapter);
2349
2350	ixgbevf_up_complete(adapter);
2351}
2352
2353/**
2354 * ixgbevf_clean_rx_ring - Free Rx Buffers per Queue
2355 * @rx_ring: ring to free buffers from
2356 **/
2357static void ixgbevf_clean_rx_ring(struct ixgbevf_ring *rx_ring)
2358{
2359	u16 i = rx_ring->next_to_clean;
 
 
2360
2361	/* Free Rx ring sk_buff */
2362	if (rx_ring->skb) {
2363		dev_kfree_skb(rx_ring->skb);
2364		rx_ring->skb = NULL;
2365	}
2366
 
 
 
 
2367	/* Free all the Rx ring pages */
2368	while (i != rx_ring->next_to_alloc) {
2369		struct ixgbevf_rx_buffer *rx_buffer;
2370
2371		rx_buffer = &rx_ring->rx_buffer_info[i];
2372
2373		/* Invalidate cache lines that may have been written to by
2374		 * device so that we avoid corrupting memory.
2375		 */
2376		dma_sync_single_range_for_cpu(rx_ring->dev,
2377					      rx_buffer->dma,
2378					      rx_buffer->page_offset,
2379					      ixgbevf_rx_bufsz(rx_ring),
2380					      DMA_FROM_DEVICE);
2381
2382		/* free resources associated with mapping */
2383		dma_unmap_page_attrs(rx_ring->dev,
2384				     rx_buffer->dma,
2385				     ixgbevf_rx_pg_size(rx_ring),
2386				     DMA_FROM_DEVICE,
2387				     IXGBEVF_RX_DMA_ATTR);
2388
2389		__page_frag_cache_drain(rx_buffer->page,
2390					rx_buffer->pagecnt_bias);
2391
2392		i++;
2393		if (i == rx_ring->count)
2394			i = 0;
2395	}
2396
2397	rx_ring->next_to_alloc = 0;
2398	rx_ring->next_to_clean = 0;
2399	rx_ring->next_to_use = 0;
 
 
2400}
2401
2402/**
2403 * ixgbevf_clean_tx_ring - Free Tx Buffers
2404 * @tx_ring: ring to be cleaned
2405 **/
2406static void ixgbevf_clean_tx_ring(struct ixgbevf_ring *tx_ring)
2407{
2408	u16 i = tx_ring->next_to_clean;
2409	struct ixgbevf_tx_buffer *tx_buffer = &tx_ring->tx_buffer_info[i];
2410
2411	while (i != tx_ring->next_to_use) {
2412		union ixgbe_adv_tx_desc *eop_desc, *tx_desc;
2413
2414		/* Free all the Tx ring sk_buffs */
2415		if (ring_is_xdp(tx_ring))
2416			page_frag_free(tx_buffer->data);
2417		else
2418			dev_kfree_skb_any(tx_buffer->skb);
2419
2420		/* unmap skb header data */
2421		dma_unmap_single(tx_ring->dev,
2422				 dma_unmap_addr(tx_buffer, dma),
2423				 dma_unmap_len(tx_buffer, len),
2424				 DMA_TO_DEVICE);
2425
2426		/* check for eop_desc to determine the end of the packet */
2427		eop_desc = tx_buffer->next_to_watch;
2428		tx_desc = IXGBEVF_TX_DESC(tx_ring, i);
2429
2430		/* unmap remaining buffers */
2431		while (tx_desc != eop_desc) {
2432			tx_buffer++;
2433			tx_desc++;
2434			i++;
2435			if (unlikely(i == tx_ring->count)) {
2436				i = 0;
2437				tx_buffer = tx_ring->tx_buffer_info;
2438				tx_desc = IXGBEVF_TX_DESC(tx_ring, 0);
2439			}
2440
2441			/* unmap any remaining paged data */
2442			if (dma_unmap_len(tx_buffer, len))
2443				dma_unmap_page(tx_ring->dev,
2444					       dma_unmap_addr(tx_buffer, dma),
2445					       dma_unmap_len(tx_buffer, len),
2446					       DMA_TO_DEVICE);
2447		}
2448
2449		/* move us one more past the eop_desc for start of next pkt */
2450		tx_buffer++;
2451		i++;
2452		if (unlikely(i == tx_ring->count)) {
2453			i = 0;
2454			tx_buffer = tx_ring->tx_buffer_info;
2455		}
2456	}
2457
2458	/* reset next_to_use and next_to_clean */
2459	tx_ring->next_to_use = 0;
2460	tx_ring->next_to_clean = 0;
2461
 
2462}
2463
2464/**
2465 * ixgbevf_clean_all_rx_rings - Free Rx Buffers for all queues
2466 * @adapter: board private structure
2467 **/
2468static void ixgbevf_clean_all_rx_rings(struct ixgbevf_adapter *adapter)
2469{
2470	int i;
2471
2472	for (i = 0; i < adapter->num_rx_queues; i++)
2473		ixgbevf_clean_rx_ring(adapter->rx_ring[i]);
2474}
2475
2476/**
2477 * ixgbevf_clean_all_tx_rings - Free Tx Buffers for all queues
2478 * @adapter: board private structure
2479 **/
2480static void ixgbevf_clean_all_tx_rings(struct ixgbevf_adapter *adapter)
2481{
2482	int i;
2483
2484	for (i = 0; i < adapter->num_tx_queues; i++)
2485		ixgbevf_clean_tx_ring(adapter->tx_ring[i]);
2486	for (i = 0; i < adapter->num_xdp_queues; i++)
2487		ixgbevf_clean_tx_ring(adapter->xdp_ring[i]);
2488}
2489
2490void ixgbevf_down(struct ixgbevf_adapter *adapter)
2491{
2492	struct net_device *netdev = adapter->netdev;
2493	struct ixgbe_hw *hw = &adapter->hw;
2494	int i;
2495
2496	/* signal that we are down to the interrupt handler */
2497	if (test_and_set_bit(__IXGBEVF_DOWN, &adapter->state))
2498		return; /* do nothing if already down */
2499
2500	/* disable all enabled Rx queues */
2501	for (i = 0; i < adapter->num_rx_queues; i++)
2502		ixgbevf_disable_rx_queue(adapter, adapter->rx_ring[i]);
2503
2504	usleep_range(10000, 20000);
2505
2506	netif_tx_stop_all_queues(netdev);
2507
2508	/* call carrier off first to avoid false dev_watchdog timeouts */
2509	netif_carrier_off(netdev);
2510	netif_tx_disable(netdev);
2511
2512	ixgbevf_irq_disable(adapter);
2513
2514	ixgbevf_napi_disable_all(adapter);
2515
2516	del_timer_sync(&adapter->service_timer);
2517
2518	/* disable transmits in the hardware now that interrupts are off */
2519	for (i = 0; i < adapter->num_tx_queues; i++) {
2520		u8 reg_idx = adapter->tx_ring[i]->reg_idx;
2521
2522		IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(reg_idx),
2523				IXGBE_TXDCTL_SWFLSH);
2524	}
2525
2526	for (i = 0; i < adapter->num_xdp_queues; i++) {
2527		u8 reg_idx = adapter->xdp_ring[i]->reg_idx;
2528
2529		IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(reg_idx),
2530				IXGBE_TXDCTL_SWFLSH);
2531	}
2532
2533	if (!pci_channel_offline(adapter->pdev))
2534		ixgbevf_reset(adapter);
2535
2536	ixgbevf_clean_all_tx_rings(adapter);
2537	ixgbevf_clean_all_rx_rings(adapter);
2538}
2539
2540void ixgbevf_reinit_locked(struct ixgbevf_adapter *adapter)
2541{
 
 
2542	while (test_and_set_bit(__IXGBEVF_RESETTING, &adapter->state))
2543		msleep(1);
2544
2545	ixgbevf_down(adapter);
2546	pci_set_master(adapter->pdev);
2547	ixgbevf_up(adapter);
2548
2549	clear_bit(__IXGBEVF_RESETTING, &adapter->state);
2550}
2551
2552void ixgbevf_reset(struct ixgbevf_adapter *adapter)
2553{
2554	struct ixgbe_hw *hw = &adapter->hw;
2555	struct net_device *netdev = adapter->netdev;
2556
2557	if (hw->mac.ops.reset_hw(hw)) {
2558		hw_dbg(hw, "PF still resetting\n");
2559	} else {
2560		hw->mac.ops.init_hw(hw);
2561		ixgbevf_negotiate_api(adapter);
2562	}
2563
2564	if (is_valid_ether_addr(adapter->hw.mac.addr)) {
2565		eth_hw_addr_set(netdev, adapter->hw.mac.addr);
2566		ether_addr_copy(netdev->perm_addr, adapter->hw.mac.addr);
2567	}
2568
2569	adapter->last_reset = jiffies;
2570}
2571
2572static int ixgbevf_acquire_msix_vectors(struct ixgbevf_adapter *adapter,
2573					int vectors)
2574{
2575	int vector_threshold;
2576
2577	/* We'll want at least 2 (vector_threshold):
2578	 * 1) TxQ[0] + RxQ[0] handler
2579	 * 2) Other (Link Status Change, etc.)
2580	 */
2581	vector_threshold = MIN_MSIX_COUNT;
2582
2583	/* The more we get, the more we will assign to Tx/Rx Cleanup
2584	 * for the separate queues...where Rx Cleanup >= Tx Cleanup.
2585	 * Right now, we simply care about how many we'll get; we'll
2586	 * set them up later while requesting irq's.
2587	 */
2588	vectors = pci_enable_msix_range(adapter->pdev, adapter->msix_entries,
2589					vector_threshold, vectors);
2590
2591	if (vectors < 0) {
2592		dev_err(&adapter->pdev->dev,
2593			"Unable to allocate MSI-X interrupts\n");
2594		kfree(adapter->msix_entries);
2595		adapter->msix_entries = NULL;
2596		return vectors;
2597	}
2598
2599	/* Adjust for only the vectors we'll use, which is minimum
2600	 * of max_msix_q_vectors + NON_Q_VECTORS, or the number of
2601	 * vectors we were allocated.
2602	 */
2603	adapter->num_msix_vectors = vectors;
2604
2605	return 0;
2606}
2607
2608/**
2609 * ixgbevf_set_num_queues - Allocate queues for device, feature dependent
2610 * @adapter: board private structure to initialize
2611 *
2612 * This is the top level queue allocation routine.  The order here is very
2613 * important, starting with the "most" number of features turned on at once,
2614 * and ending with the smallest set of features.  This way large combinations
2615 * can be allocated if they're turned on, and smaller combinations are the
2616 * fall through conditions.
2617 *
2618 **/
2619static void ixgbevf_set_num_queues(struct ixgbevf_adapter *adapter)
2620{
2621	struct ixgbe_hw *hw = &adapter->hw;
2622	unsigned int def_q = 0;
2623	unsigned int num_tcs = 0;
2624	int err;
2625
2626	/* Start with base case */
2627	adapter->num_rx_queues = 1;
2628	adapter->num_tx_queues = 1;
2629	adapter->num_xdp_queues = 0;
2630
2631	spin_lock_bh(&adapter->mbx_lock);
2632
2633	/* fetch queue configuration from the PF */
2634	err = ixgbevf_get_queues(hw, &num_tcs, &def_q);
2635
2636	spin_unlock_bh(&adapter->mbx_lock);
2637
2638	if (err)
2639		return;
2640
2641	/* we need as many queues as traffic classes */
2642	if (num_tcs > 1) {
2643		adapter->num_rx_queues = num_tcs;
2644	} else {
2645		u16 rss = min_t(u16, num_online_cpus(), IXGBEVF_MAX_RSS_QUEUES);
2646
2647		switch (hw->api_version) {
2648		case ixgbe_mbox_api_11:
2649		case ixgbe_mbox_api_12:
2650		case ixgbe_mbox_api_13:
2651		case ixgbe_mbox_api_14:
2652		case ixgbe_mbox_api_15:
2653			if (adapter->xdp_prog &&
2654			    hw->mac.max_tx_queues == rss)
2655				rss = rss > 3 ? 2 : 1;
2656
2657			adapter->num_rx_queues = rss;
2658			adapter->num_tx_queues = rss;
2659			adapter->num_xdp_queues = adapter->xdp_prog ? rss : 0;
2660			break;
2661		default:
2662			break;
2663		}
2664	}
2665}
2666
2667/**
2668 * ixgbevf_set_interrupt_capability - set MSI-X or FAIL if not supported
2669 * @adapter: board private structure to initialize
2670 *
2671 * Attempt to configure the interrupts using the best available
2672 * capabilities of the hardware and the kernel.
 
2673 **/
2674static int ixgbevf_set_interrupt_capability(struct ixgbevf_adapter *adapter)
2675{
2676	int vector, v_budget;
2677
2678	/* It's easy to be greedy for MSI-X vectors, but it really
2679	 * doesn't do us much good if we have a lot more vectors
2680	 * than CPU's.  So let's be conservative and only ask for
2681	 * (roughly) the same number of vectors as there are CPU's.
2682	 * The default is to use pairs of vectors.
2683	 */
2684	v_budget = max(adapter->num_rx_queues, adapter->num_tx_queues);
2685	v_budget = min_t(int, v_budget, num_online_cpus());
2686	v_budget += NON_Q_VECTORS;
2687
2688	adapter->msix_entries = kcalloc(v_budget,
2689					sizeof(struct msix_entry), GFP_KERNEL);
2690	if (!adapter->msix_entries)
2691		return -ENOMEM;
2692
2693	for (vector = 0; vector < v_budget; vector++)
2694		adapter->msix_entries[vector].entry = vector;
2695
2696	/* A failure in MSI-X entry allocation isn't fatal, but the VF driver
2697	 * does not support any other modes, so we will simply fail here. Note
2698	 * that we clean up the msix_entries pointer else-where.
2699	 */
2700	return ixgbevf_acquire_msix_vectors(adapter, v_budget);
2701}
2702
2703static void ixgbevf_add_ring(struct ixgbevf_ring *ring,
2704			     struct ixgbevf_ring_container *head)
2705{
2706	ring->next = head->ring;
2707	head->ring = ring;
2708	head->count++;
2709}
2710
2711/**
2712 * ixgbevf_alloc_q_vector - Allocate memory for a single interrupt vector
2713 * @adapter: board private structure to initialize
2714 * @v_idx: index of vector in adapter struct
2715 * @txr_count: number of Tx rings for q vector
2716 * @txr_idx: index of first Tx ring to assign
2717 * @xdp_count: total number of XDP rings to allocate
2718 * @xdp_idx: index of first XDP ring to allocate
2719 * @rxr_count: number of Rx rings for q vector
2720 * @rxr_idx: index of first Rx ring to assign
2721 *
2722 * We allocate one q_vector.  If allocation fails we return -ENOMEM.
2723 **/
2724static int ixgbevf_alloc_q_vector(struct ixgbevf_adapter *adapter, int v_idx,
2725				  int txr_count, int txr_idx,
2726				  int xdp_count, int xdp_idx,
2727				  int rxr_count, int rxr_idx)
2728{
2729	struct ixgbevf_q_vector *q_vector;
2730	int reg_idx = txr_idx + xdp_idx;
2731	struct ixgbevf_ring *ring;
2732	int ring_count, size;
2733
2734	ring_count = txr_count + xdp_count + rxr_count;
2735	size = sizeof(*q_vector) + (sizeof(*ring) * ring_count);
2736
2737	/* allocate q_vector and rings */
2738	q_vector = kzalloc(size, GFP_KERNEL);
2739	if (!q_vector)
2740		return -ENOMEM;
2741
2742	/* initialize NAPI */
2743	netif_napi_add(adapter->netdev, &q_vector->napi, ixgbevf_poll);
 
 
2744
2745	/* tie q_vector and adapter together */
2746	adapter->q_vector[v_idx] = q_vector;
2747	q_vector->adapter = adapter;
2748	q_vector->v_idx = v_idx;
2749
2750	/* initialize pointer to rings */
2751	ring = q_vector->ring;
2752
2753	while (txr_count) {
2754		/* assign generic ring traits */
2755		ring->dev = &adapter->pdev->dev;
2756		ring->netdev = adapter->netdev;
2757
2758		/* configure backlink on ring */
2759		ring->q_vector = q_vector;
2760
2761		/* update q_vector Tx values */
2762		ixgbevf_add_ring(ring, &q_vector->tx);
2763
2764		/* apply Tx specific ring traits */
2765		ring->count = adapter->tx_ring_count;
2766		ring->queue_index = txr_idx;
2767		ring->reg_idx = reg_idx;
2768
2769		/* assign ring to adapter */
2770		adapter->tx_ring[txr_idx] = ring;
2771
2772		/* update count and index */
2773		txr_count--;
2774		txr_idx++;
2775		reg_idx++;
2776
2777		/* push pointer to next ring */
2778		ring++;
2779	}
2780
2781	while (xdp_count) {
2782		/* assign generic ring traits */
2783		ring->dev = &adapter->pdev->dev;
2784		ring->netdev = adapter->netdev;
2785
2786		/* configure backlink on ring */
2787		ring->q_vector = q_vector;
2788
2789		/* update q_vector Tx values */
2790		ixgbevf_add_ring(ring, &q_vector->tx);
2791
2792		/* apply Tx specific ring traits */
2793		ring->count = adapter->tx_ring_count;
2794		ring->queue_index = xdp_idx;
2795		ring->reg_idx = reg_idx;
2796		set_ring_xdp(ring);
2797
2798		/* assign ring to adapter */
2799		adapter->xdp_ring[xdp_idx] = ring;
2800
2801		/* update count and index */
2802		xdp_count--;
2803		xdp_idx++;
2804		reg_idx++;
2805
2806		/* push pointer to next ring */
2807		ring++;
2808	}
2809
2810	while (rxr_count) {
2811		/* assign generic ring traits */
2812		ring->dev = &adapter->pdev->dev;
2813		ring->netdev = adapter->netdev;
2814
2815		/* configure backlink on ring */
2816		ring->q_vector = q_vector;
2817
2818		/* update q_vector Rx values */
2819		ixgbevf_add_ring(ring, &q_vector->rx);
2820
2821		/* apply Rx specific ring traits */
2822		ring->count = adapter->rx_ring_count;
2823		ring->queue_index = rxr_idx;
2824		ring->reg_idx = rxr_idx;
2825
2826		/* assign ring to adapter */
2827		adapter->rx_ring[rxr_idx] = ring;
2828
2829		/* update count and index */
2830		rxr_count--;
2831		rxr_idx++;
2832
2833		/* push pointer to next ring */
2834		ring++;
 
 
2835	}
2836
2837	return 0;
 
 
 
 
2838}
2839
2840/**
2841 * ixgbevf_free_q_vector - Free memory allocated for specific interrupt vector
2842 * @adapter: board private structure to initialize
2843 * @v_idx: index of vector in adapter struct
2844 *
2845 * This function frees the memory allocated to the q_vector.  In addition if
2846 * NAPI is enabled it will delete any references to the NAPI struct prior
2847 * to freeing the q_vector.
2848 **/
2849static void ixgbevf_free_q_vector(struct ixgbevf_adapter *adapter, int v_idx)
2850{
2851	struct ixgbevf_q_vector *q_vector = adapter->q_vector[v_idx];
2852	struct ixgbevf_ring *ring;
 
2853
2854	ixgbevf_for_each_ring(ring, q_vector->tx) {
2855		if (ring_is_xdp(ring))
2856			adapter->xdp_ring[ring->queue_index] = NULL;
2857		else
2858			adapter->tx_ring[ring->queue_index] = NULL;
2859	}
 
 
 
2860
2861	ixgbevf_for_each_ring(ring, q_vector->rx)
2862		adapter->rx_ring[ring->queue_index] = NULL;
 
 
 
 
 
2863
2864	adapter->q_vector[v_idx] = NULL;
2865	netif_napi_del(&q_vector->napi);
2866
2867	/* ixgbevf_get_stats() might access the rings on this vector,
2868	 * we must wait a grace period before freeing it.
2869	 */
2870	kfree_rcu(q_vector, rcu);
 
 
 
 
 
2871}
2872
2873/**
2874 * ixgbevf_alloc_q_vectors - Allocate memory for interrupt vectors
2875 * @adapter: board private structure to initialize
2876 *
2877 * We allocate one q_vector per queue interrupt.  If allocation fails we
2878 * return -ENOMEM.
2879 **/
2880static int ixgbevf_alloc_q_vectors(struct ixgbevf_adapter *adapter)
2881{
2882	int q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
2883	int rxr_remaining = adapter->num_rx_queues;
2884	int txr_remaining = adapter->num_tx_queues;
2885	int xdp_remaining = adapter->num_xdp_queues;
2886	int rxr_idx = 0, txr_idx = 0, xdp_idx = 0, v_idx = 0;
2887	int err;
2888
2889	if (q_vectors >= (rxr_remaining + txr_remaining + xdp_remaining)) {
2890		for (; rxr_remaining; v_idx++, q_vectors--) {
2891			int rqpv = DIV_ROUND_UP(rxr_remaining, q_vectors);
2892
2893			err = ixgbevf_alloc_q_vector(adapter, v_idx,
2894						     0, 0, 0, 0, rqpv, rxr_idx);
2895			if (err)
2896				goto err_out;
2897
2898			/* update counts and index */
2899			rxr_remaining -= rqpv;
2900			rxr_idx += rqpv;
2901		}
2902	}
2903
2904	for (; q_vectors; v_idx++, q_vectors--) {
2905		int rqpv = DIV_ROUND_UP(rxr_remaining, q_vectors);
2906		int tqpv = DIV_ROUND_UP(txr_remaining, q_vectors);
2907		int xqpv = DIV_ROUND_UP(xdp_remaining, q_vectors);
2908
2909		err = ixgbevf_alloc_q_vector(adapter, v_idx,
2910					     tqpv, txr_idx,
2911					     xqpv, xdp_idx,
2912					     rqpv, rxr_idx);
2913
2914		if (err)
 
 
2915			goto err_out;
2916
2917		/* update counts and index */
2918		rxr_remaining -= rqpv;
2919		rxr_idx += rqpv;
2920		txr_remaining -= tqpv;
2921		txr_idx += tqpv;
2922		xdp_remaining -= xqpv;
2923		xdp_idx += xqpv;
2924	}
2925
2926	return 0;
2927
2928err_out:
2929	while (v_idx) {
2930		v_idx--;
2931		ixgbevf_free_q_vector(adapter, v_idx);
 
 
 
 
 
 
2932	}
2933
2934	return -ENOMEM;
2935}
2936
2937/**
2938 * ixgbevf_free_q_vectors - Free memory allocated for interrupt vectors
2939 * @adapter: board private structure to initialize
2940 *
2941 * This function frees the memory allocated to the q_vectors.  In addition if
2942 * NAPI is enabled it will delete any references to the NAPI struct prior
2943 * to freeing the q_vector.
2944 **/
2945static void ixgbevf_free_q_vectors(struct ixgbevf_adapter *adapter)
2946{
2947	int q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
 
 
 
2948
2949	while (q_vectors) {
2950		q_vectors--;
2951		ixgbevf_free_q_vector(adapter, q_vectors);
 
 
 
2952	}
2953}
2954
2955/**
2956 * ixgbevf_reset_interrupt_capability - Reset MSIX setup
2957 * @adapter: board private structure
2958 *
2959 **/
2960static void ixgbevf_reset_interrupt_capability(struct ixgbevf_adapter *adapter)
2961{
2962	if (!adapter->msix_entries)
2963		return;
2964
2965	pci_disable_msix(adapter->pdev);
2966	kfree(adapter->msix_entries);
2967	adapter->msix_entries = NULL;
2968}
2969
2970/**
2971 * ixgbevf_init_interrupt_scheme - Determine if MSIX is supported and init
2972 * @adapter: board private structure to initialize
2973 *
2974 **/
2975static int ixgbevf_init_interrupt_scheme(struct ixgbevf_adapter *adapter)
2976{
2977	int err;
2978
2979	/* Number of supported queues */
2980	ixgbevf_set_num_queues(adapter);
2981
2982	err = ixgbevf_set_interrupt_capability(adapter);
2983	if (err) {
2984		hw_dbg(&adapter->hw,
2985		       "Unable to setup interrupt capabilities\n");
2986		goto err_set_interrupt;
2987	}
2988
2989	err = ixgbevf_alloc_q_vectors(adapter);
2990	if (err) {
2991		hw_dbg(&adapter->hw, "Unable to allocate memory for queue vectors\n");
2992		goto err_alloc_q_vectors;
2993	}
2994
2995	hw_dbg(&adapter->hw, "Multiqueue %s: Rx Queue count = %u, Tx Queue count = %u XDP Queue count %u\n",
2996	       (adapter->num_rx_queues > 1) ? "Enabled" : "Disabled",
2997	       adapter->num_rx_queues, adapter->num_tx_queues,
2998	       adapter->num_xdp_queues);
 
 
 
 
 
2999
3000	set_bit(__IXGBEVF_DOWN, &adapter->state);
3001
3002	return 0;
 
 
3003err_alloc_q_vectors:
3004	ixgbevf_reset_interrupt_capability(adapter);
3005err_set_interrupt:
3006	return err;
3007}
3008
3009/**
3010 * ixgbevf_clear_interrupt_scheme - Clear the current interrupt scheme settings
3011 * @adapter: board private structure to clear interrupt scheme on
3012 *
3013 * We go through and clear interrupt specific resources and reset the structure
3014 * to pre-load conditions
3015 **/
3016static void ixgbevf_clear_interrupt_scheme(struct ixgbevf_adapter *adapter)
3017{
 
 
 
 
 
 
 
 
 
 
 
3018	adapter->num_tx_queues = 0;
3019	adapter->num_xdp_queues = 0;
3020	adapter->num_rx_queues = 0;
3021
3022	ixgbevf_free_q_vectors(adapter);
3023	ixgbevf_reset_interrupt_capability(adapter);
3024}
3025
3026/**
3027 * ixgbevf_sw_init - Initialize general software structures
3028 * @adapter: board private structure to initialize
3029 *
3030 * ixgbevf_sw_init initializes the Adapter private data structure.
3031 * Fields are initialized based on PCI device information and
3032 * OS network device settings (MTU size).
3033 **/
3034static int ixgbevf_sw_init(struct ixgbevf_adapter *adapter)
3035{
3036	struct ixgbe_hw *hw = &adapter->hw;
3037	struct pci_dev *pdev = adapter->pdev;
3038	struct net_device *netdev = adapter->netdev;
3039	int err;
3040
3041	/* PCI config space info */
3042	hw->vendor_id = pdev->vendor;
3043	hw->device_id = pdev->device;
3044	hw->revision_id = pdev->revision;
3045	hw->subsystem_vendor_id = pdev->subsystem_vendor;
3046	hw->subsystem_device_id = pdev->subsystem_device;
3047
3048	hw->mbx.ops.init_params(hw);
3049
3050	if (hw->mac.type >= ixgbe_mac_X550_vf) {
3051		err = ixgbevf_init_rss_key(adapter);
3052		if (err)
3053			goto out;
3054	}
3055
3056	/* assume legacy case in which PF would only give VF 2 queues */
3057	hw->mac.max_tx_queues = 2;
3058	hw->mac.max_rx_queues = 2;
3059
3060	/* lock to protect mailbox accesses */
3061	spin_lock_init(&adapter->mbx_lock);
3062
3063	err = hw->mac.ops.reset_hw(hw);
3064	if (err) {
3065		dev_info(&pdev->dev,
3066			 "PF still in reset state.  Is the PF interface up?\n");
3067	} else {
3068		err = hw->mac.ops.init_hw(hw);
3069		if (err) {
3070			pr_err("init_shared_code failed: %d\n", err);
3071			goto out;
3072		}
3073		ixgbevf_negotiate_api(adapter);
3074		err = hw->mac.ops.get_mac_addr(hw, hw->mac.addr);
3075		if (err)
3076			dev_info(&pdev->dev, "Error reading MAC address\n");
3077		else if (is_zero_ether_addr(adapter->hw.mac.addr))
3078			dev_info(&pdev->dev,
3079				 "MAC address not assigned by administrator.\n");
3080		eth_hw_addr_set(netdev, hw->mac.addr);
3081	}
3082
3083	if (!is_valid_ether_addr(netdev->dev_addr)) {
3084		dev_info(&pdev->dev, "Assigning random MAC address\n");
3085		eth_hw_addr_random(netdev);
3086		ether_addr_copy(hw->mac.addr, netdev->dev_addr);
3087		ether_addr_copy(hw->mac.perm_addr, netdev->dev_addr);
3088	}
3089
3090	/* Enable dynamic interrupt throttling rates */
3091	adapter->rx_itr_setting = 1;
3092	adapter->tx_itr_setting = 1;
3093
3094	/* set default ring sizes */
3095	adapter->tx_ring_count = IXGBEVF_DEFAULT_TXD;
3096	adapter->rx_ring_count = IXGBEVF_DEFAULT_RXD;
3097
3098	adapter->link_state = true;
3099
3100	set_bit(__IXGBEVF_DOWN, &adapter->state);
3101	return 0;
3102
3103out:
3104	return err;
3105}
3106
3107#define UPDATE_VF_COUNTER_32bit(reg, last_counter, counter)	\
3108	{							\
3109		u32 current_counter = IXGBE_READ_REG(hw, reg);	\
3110		if (current_counter < last_counter)		\
3111			counter += 0x100000000LL;		\
3112		last_counter = current_counter;			\
3113		counter &= 0xFFFFFFFF00000000LL;		\
3114		counter |= current_counter;			\
3115	}
3116
3117#define UPDATE_VF_COUNTER_36bit(reg_lsb, reg_msb, last_counter, counter) \
3118	{								 \
3119		u64 current_counter_lsb = IXGBE_READ_REG(hw, reg_lsb);	 \
3120		u64 current_counter_msb = IXGBE_READ_REG(hw, reg_msb);	 \
3121		u64 current_counter = (current_counter_msb << 32) |	 \
3122			current_counter_lsb;				 \
3123		if (current_counter < last_counter)			 \
3124			counter += 0x1000000000LL;			 \
3125		last_counter = current_counter;				 \
3126		counter &= 0xFFFFFFF000000000LL;			 \
3127		counter |= current_counter;				 \
3128	}
3129/**
3130 * ixgbevf_update_stats - Update the board statistics counters.
3131 * @adapter: board private structure
3132 **/
3133void ixgbevf_update_stats(struct ixgbevf_adapter *adapter)
3134{
3135	struct ixgbe_hw *hw = &adapter->hw;
3136	u64 alloc_rx_page_failed = 0, alloc_rx_buff_failed = 0;
3137	u64 alloc_rx_page = 0, hw_csum_rx_error = 0;
3138	int i;
3139
3140	if (test_bit(__IXGBEVF_DOWN, &adapter->state) ||
3141	    test_bit(__IXGBEVF_RESETTING, &adapter->state))
3142		return;
3143
3144	UPDATE_VF_COUNTER_32bit(IXGBE_VFGPRC, adapter->stats.last_vfgprc,
3145				adapter->stats.vfgprc);
3146	UPDATE_VF_COUNTER_32bit(IXGBE_VFGPTC, adapter->stats.last_vfgptc,
3147				adapter->stats.vfgptc);
3148	UPDATE_VF_COUNTER_36bit(IXGBE_VFGORC_LSB, IXGBE_VFGORC_MSB,
3149				adapter->stats.last_vfgorc,
3150				adapter->stats.vfgorc);
3151	UPDATE_VF_COUNTER_36bit(IXGBE_VFGOTC_LSB, IXGBE_VFGOTC_MSB,
3152				adapter->stats.last_vfgotc,
3153				adapter->stats.vfgotc);
3154	UPDATE_VF_COUNTER_32bit(IXGBE_VFMPRC, adapter->stats.last_vfmprc,
3155				adapter->stats.vfmprc);
3156
3157	for (i = 0;  i  < adapter->num_rx_queues;  i++) {
3158		struct ixgbevf_ring *rx_ring = adapter->rx_ring[i];
3159
3160		hw_csum_rx_error += rx_ring->rx_stats.csum_err;
3161		alloc_rx_page_failed += rx_ring->rx_stats.alloc_rx_page_failed;
3162		alloc_rx_buff_failed += rx_ring->rx_stats.alloc_rx_buff_failed;
3163		alloc_rx_page += rx_ring->rx_stats.alloc_rx_page;
3164	}
3165
3166	adapter->hw_csum_rx_error = hw_csum_rx_error;
3167	adapter->alloc_rx_page_failed = alloc_rx_page_failed;
3168	adapter->alloc_rx_buff_failed = alloc_rx_buff_failed;
3169	adapter->alloc_rx_page = alloc_rx_page;
3170}
3171
3172/**
3173 * ixgbevf_service_timer - Timer Call-back
3174 * @t: pointer to timer_list struct
3175 **/
3176static void ixgbevf_service_timer(struct timer_list *t)
3177{
3178	struct ixgbevf_adapter *adapter = from_timer(adapter, t,
3179						     service_timer);
3180
3181	/* Reset the timer */
3182	mod_timer(&adapter->service_timer, (HZ * 2) + jiffies);
3183
3184	ixgbevf_service_event_schedule(adapter);
3185}
3186
3187static void ixgbevf_reset_subtask(struct ixgbevf_adapter *adapter)
3188{
3189	if (!test_and_clear_bit(__IXGBEVF_RESET_REQUESTED, &adapter->state))
3190		return;
3191
3192	rtnl_lock();
 
3193	/* If we're already down or resetting, just bail */
3194	if (test_bit(__IXGBEVF_DOWN, &adapter->state) ||
3195	    test_bit(__IXGBEVF_REMOVING, &adapter->state) ||
3196	    test_bit(__IXGBEVF_RESETTING, &adapter->state)) {
3197		rtnl_unlock();
3198		return;
3199	}
3200
3201	adapter->tx_timeout_count++;
3202
3203	ixgbevf_reinit_locked(adapter);
3204	rtnl_unlock();
3205}
3206
3207/**
3208 * ixgbevf_check_hang_subtask - check for hung queues and dropped interrupts
3209 * @adapter: pointer to the device adapter structure
3210 *
3211 * This function serves two purposes.  First it strobes the interrupt lines
3212 * in order to make certain interrupts are occurring.  Secondly it sets the
3213 * bits needed to check for TX hangs.  As a result we should immediately
3214 * determine if a hang has occurred.
3215 **/
3216static void ixgbevf_check_hang_subtask(struct ixgbevf_adapter *adapter)
3217{
3218	struct ixgbe_hw *hw = &adapter->hw;
3219	u32 eics = 0;
3220	int i;
3221
3222	/* If we're down or resetting, just bail */
3223	if (test_bit(__IXGBEVF_DOWN, &adapter->state) ||
3224	    test_bit(__IXGBEVF_RESETTING, &adapter->state))
3225		return;
3226
3227	/* Force detection of hung controller */
3228	if (netif_carrier_ok(adapter->netdev)) {
3229		for (i = 0; i < adapter->num_tx_queues; i++)
3230			set_check_for_tx_hang(adapter->tx_ring[i]);
3231		for (i = 0; i < adapter->num_xdp_queues; i++)
3232			set_check_for_tx_hang(adapter->xdp_ring[i]);
3233	}
3234
3235	/* get one bit for every active Tx/Rx interrupt vector */
3236	for (i = 0; i < adapter->num_msix_vectors - NON_Q_VECTORS; i++) {
3237		struct ixgbevf_q_vector *qv = adapter->q_vector[i];
3238
3239		if (qv->rx.ring || qv->tx.ring)
3240			eics |= BIT(i);
3241	}
3242
3243	/* Cause software interrupt to ensure rings are cleaned */
3244	IXGBE_WRITE_REG(hw, IXGBE_VTEICS, eics);
3245}
3246
3247/**
3248 * ixgbevf_watchdog_update_link - update the link status
3249 * @adapter: pointer to the device adapter structure
3250 **/
3251static void ixgbevf_watchdog_update_link(struct ixgbevf_adapter *adapter)
3252{
3253	struct ixgbe_hw *hw = &adapter->hw;
3254	u32 link_speed = adapter->link_speed;
3255	bool link_up = adapter->link_up;
3256	s32 err;
3257
3258	spin_lock_bh(&adapter->mbx_lock);
3259
3260	err = hw->mac.ops.check_link(hw, &link_speed, &link_up, false);
3261
3262	spin_unlock_bh(&adapter->mbx_lock);
3263
3264	/* if check for link returns error we will need to reset */
3265	if (err && time_after(jiffies, adapter->last_reset + (10 * HZ))) {
3266		set_bit(__IXGBEVF_RESET_REQUESTED, &adapter->state);
3267		link_up = false;
3268	}
3269
3270	adapter->link_up = link_up;
3271	adapter->link_speed = link_speed;
3272}
3273
3274/**
3275 * ixgbevf_watchdog_link_is_up - update netif_carrier status and
3276 *				 print link up message
3277 * @adapter: pointer to the device adapter structure
3278 **/
3279static void ixgbevf_watchdog_link_is_up(struct ixgbevf_adapter *adapter)
3280{
3281	struct net_device *netdev = adapter->netdev;
3282
3283	/* only continue if link was previously down */
3284	if (netif_carrier_ok(netdev))
3285		return;
3286
3287	dev_info(&adapter->pdev->dev, "NIC Link is Up %s\n",
3288		 (adapter->link_speed == IXGBE_LINK_SPEED_10GB_FULL) ?
3289		 "10 Gbps" :
3290		 (adapter->link_speed == IXGBE_LINK_SPEED_1GB_FULL) ?
3291		 "1 Gbps" :
3292		 (adapter->link_speed == IXGBE_LINK_SPEED_100_FULL) ?
3293		 "100 Mbps" :
3294		 "unknown speed");
3295
3296	netif_carrier_on(netdev);
3297}
3298
3299/**
3300 * ixgbevf_watchdog_link_is_down - update netif_carrier status and
3301 *				   print link down message
3302 * @adapter: pointer to the adapter structure
3303 **/
3304static void ixgbevf_watchdog_link_is_down(struct ixgbevf_adapter *adapter)
3305{
3306	struct net_device *netdev = adapter->netdev;
3307
3308	adapter->link_speed = 0;
3309
3310	/* only continue if link was up previously */
3311	if (!netif_carrier_ok(netdev))
3312		return;
3313
3314	dev_info(&adapter->pdev->dev, "NIC Link is Down\n");
3315
3316	netif_carrier_off(netdev);
3317}
3318
3319/**
3320 * ixgbevf_watchdog_subtask - worker thread to bring link up
3321 * @adapter: board private structure
3322 **/
3323static void ixgbevf_watchdog_subtask(struct ixgbevf_adapter *adapter)
3324{
3325	/* if interface is down do nothing */
3326	if (test_bit(__IXGBEVF_DOWN, &adapter->state) ||
3327	    test_bit(__IXGBEVF_RESETTING, &adapter->state))
3328		return;
3329
3330	ixgbevf_watchdog_update_link(adapter);
3331
3332	if (adapter->link_up && adapter->link_state)
3333		ixgbevf_watchdog_link_is_up(adapter);
3334	else
3335		ixgbevf_watchdog_link_is_down(adapter);
3336
3337	ixgbevf_update_stats(adapter);
3338}
3339
3340/**
3341 * ixgbevf_service_task - manages and runs subtasks
3342 * @work: pointer to work_struct containing our data
3343 **/
3344static void ixgbevf_service_task(struct work_struct *work)
3345{
3346	struct ixgbevf_adapter *adapter = container_of(work,
3347						       struct ixgbevf_adapter,
3348						       service_task);
3349	struct ixgbe_hw *hw = &adapter->hw;
3350
3351	if (IXGBE_REMOVED(hw->hw_addr)) {
3352		if (!test_bit(__IXGBEVF_DOWN, &adapter->state)) {
3353			rtnl_lock();
3354			ixgbevf_down(adapter);
3355			rtnl_unlock();
3356		}
3357		return;
3358	}
3359
3360	ixgbevf_queue_reset_subtask(adapter);
3361	ixgbevf_reset_subtask(adapter);
3362	ixgbevf_watchdog_subtask(adapter);
3363	ixgbevf_check_hang_subtask(adapter);
3364
3365	ixgbevf_service_event_complete(adapter);
3366}
3367
3368/**
3369 * ixgbevf_free_tx_resources - Free Tx Resources per Queue
3370 * @tx_ring: Tx descriptor ring for a specific queue
3371 *
3372 * Free all transmit software resources
3373 **/
3374void ixgbevf_free_tx_resources(struct ixgbevf_ring *tx_ring)
3375{
3376	ixgbevf_clean_tx_ring(tx_ring);
3377
3378	vfree(tx_ring->tx_buffer_info);
3379	tx_ring->tx_buffer_info = NULL;
3380
3381	/* if not set, then don't free */
3382	if (!tx_ring->desc)
3383		return;
3384
3385	dma_free_coherent(tx_ring->dev, tx_ring->size, tx_ring->desc,
3386			  tx_ring->dma);
3387
3388	tx_ring->desc = NULL;
3389}
3390
3391/**
3392 * ixgbevf_free_all_tx_resources - Free Tx Resources for All Queues
3393 * @adapter: board private structure
3394 *
3395 * Free all transmit software resources
3396 **/
3397static void ixgbevf_free_all_tx_resources(struct ixgbevf_adapter *adapter)
3398{
3399	int i;
3400
3401	for (i = 0; i < adapter->num_tx_queues; i++)
3402		if (adapter->tx_ring[i]->desc)
3403			ixgbevf_free_tx_resources(adapter->tx_ring[i]);
3404	for (i = 0; i < adapter->num_xdp_queues; i++)
3405		if (adapter->xdp_ring[i]->desc)
3406			ixgbevf_free_tx_resources(adapter->xdp_ring[i]);
3407}
3408
3409/**
3410 * ixgbevf_setup_tx_resources - allocate Tx resources (Descriptors)
3411 * @tx_ring: Tx descriptor ring (for a specific queue) to setup
3412 *
3413 * Return 0 on success, negative on failure
3414 **/
3415int ixgbevf_setup_tx_resources(struct ixgbevf_ring *tx_ring)
3416{
3417	struct ixgbevf_adapter *adapter = netdev_priv(tx_ring->netdev);
3418	int size;
3419
3420	size = sizeof(struct ixgbevf_tx_buffer) * tx_ring->count;
3421	tx_ring->tx_buffer_info = vmalloc(size);
3422	if (!tx_ring->tx_buffer_info)
3423		goto err;
3424
3425	u64_stats_init(&tx_ring->syncp);
3426
3427	/* round up to nearest 4K */
3428	tx_ring->size = tx_ring->count * sizeof(union ixgbe_adv_tx_desc);
3429	tx_ring->size = ALIGN(tx_ring->size, 4096);
3430
3431	tx_ring->desc = dma_alloc_coherent(tx_ring->dev, tx_ring->size,
3432					   &tx_ring->dma, GFP_KERNEL);
3433	if (!tx_ring->desc)
3434		goto err;
3435
3436	return 0;
3437
3438err:
3439	vfree(tx_ring->tx_buffer_info);
3440	tx_ring->tx_buffer_info = NULL;
3441	hw_dbg(&adapter->hw, "Unable to allocate memory for the transmit descriptor ring\n");
3442	return -ENOMEM;
3443}
3444
3445/**
3446 * ixgbevf_setup_all_tx_resources - allocate all queues Tx resources
3447 * @adapter: board private structure
3448 *
3449 * If this function returns with an error, then it's possible one or
3450 * more of the rings is populated (while the rest are not).  It is the
3451 * callers duty to clean those orphaned rings.
3452 *
3453 * Return 0 on success, negative on failure
3454 **/
3455static int ixgbevf_setup_all_tx_resources(struct ixgbevf_adapter *adapter)
3456{
3457	int i, j = 0, err = 0;
3458
3459	for (i = 0; i < adapter->num_tx_queues; i++) {
3460		err = ixgbevf_setup_tx_resources(adapter->tx_ring[i]);
3461		if (!err)
3462			continue;
3463		hw_dbg(&adapter->hw, "Allocation for Tx Queue %u failed\n", i);
3464		goto err_setup_tx;
3465	}
3466
3467	for (j = 0; j < adapter->num_xdp_queues; j++) {
3468		err = ixgbevf_setup_tx_resources(adapter->xdp_ring[j]);
3469		if (!err)
3470			continue;
3471		hw_dbg(&adapter->hw, "Allocation for XDP Queue %u failed\n", j);
3472		goto err_setup_tx;
3473	}
3474
3475	return 0;
3476err_setup_tx:
3477	/* rewind the index freeing the rings as we go */
3478	while (j--)
3479		ixgbevf_free_tx_resources(adapter->xdp_ring[j]);
3480	while (i--)
3481		ixgbevf_free_tx_resources(adapter->tx_ring[i]);
3482
3483	return err;
3484}
3485
3486/**
3487 * ixgbevf_setup_rx_resources - allocate Rx resources (Descriptors)
3488 * @adapter: board private structure
3489 * @rx_ring: Rx descriptor ring (for a specific queue) to setup
3490 *
3491 * Returns 0 on success, negative on failure
3492 **/
3493int ixgbevf_setup_rx_resources(struct ixgbevf_adapter *adapter,
3494			       struct ixgbevf_ring *rx_ring)
3495{
3496	int size;
3497
3498	size = sizeof(struct ixgbevf_rx_buffer) * rx_ring->count;
3499	rx_ring->rx_buffer_info = vmalloc(size);
3500	if (!rx_ring->rx_buffer_info)
3501		goto err;
3502
3503	u64_stats_init(&rx_ring->syncp);
3504
3505	/* Round up to nearest 4K */
3506	rx_ring->size = rx_ring->count * sizeof(union ixgbe_adv_rx_desc);
3507	rx_ring->size = ALIGN(rx_ring->size, 4096);
3508
3509	rx_ring->desc = dma_alloc_coherent(rx_ring->dev, rx_ring->size,
3510					   &rx_ring->dma, GFP_KERNEL);
3511
3512	if (!rx_ring->desc)
3513		goto err;
3514
3515	/* XDP RX-queue info */
3516	if (xdp_rxq_info_reg(&rx_ring->xdp_rxq, adapter->netdev,
3517			     rx_ring->queue_index, 0) < 0)
3518		goto err;
3519
3520	rx_ring->xdp_prog = adapter->xdp_prog;
3521
3522	return 0;
3523err:
3524	vfree(rx_ring->rx_buffer_info);
3525	rx_ring->rx_buffer_info = NULL;
3526	dev_err(rx_ring->dev, "Unable to allocate memory for the Rx descriptor ring\n");
3527	return -ENOMEM;
3528}
3529
3530/**
3531 * ixgbevf_setup_all_rx_resources - allocate all queues Rx resources
3532 * @adapter: board private structure
3533 *
3534 * If this function returns with an error, then it's possible one or
3535 * more of the rings is populated (while the rest are not).  It is the
3536 * callers duty to clean those orphaned rings.
3537 *
3538 * Return 0 on success, negative on failure
3539 **/
3540static int ixgbevf_setup_all_rx_resources(struct ixgbevf_adapter *adapter)
3541{
3542	int i, err = 0;
3543
3544	for (i = 0; i < adapter->num_rx_queues; i++) {
3545		err = ixgbevf_setup_rx_resources(adapter, adapter->rx_ring[i]);
3546		if (!err)
3547			continue;
3548		hw_dbg(&adapter->hw, "Allocation for Rx Queue %u failed\n", i);
3549		goto err_setup_rx;
3550	}
3551
3552	return 0;
3553err_setup_rx:
3554	/* rewind the index freeing the rings as we go */
3555	while (i--)
3556		ixgbevf_free_rx_resources(adapter->rx_ring[i]);
3557	return err;
3558}
3559
3560/**
3561 * ixgbevf_free_rx_resources - Free Rx Resources
3562 * @rx_ring: ring to clean the resources from
3563 *
3564 * Free all receive software resources
3565 **/
3566void ixgbevf_free_rx_resources(struct ixgbevf_ring *rx_ring)
3567{
3568	ixgbevf_clean_rx_ring(rx_ring);
3569
3570	rx_ring->xdp_prog = NULL;
3571	xdp_rxq_info_unreg(&rx_ring->xdp_rxq);
3572	vfree(rx_ring->rx_buffer_info);
3573	rx_ring->rx_buffer_info = NULL;
3574
3575	dma_free_coherent(rx_ring->dev, rx_ring->size, rx_ring->desc,
3576			  rx_ring->dma);
3577
3578	rx_ring->desc = NULL;
3579}
3580
3581/**
3582 * ixgbevf_free_all_rx_resources - Free Rx Resources for All Queues
3583 * @adapter: board private structure
3584 *
3585 * Free all receive software resources
3586 **/
3587static void ixgbevf_free_all_rx_resources(struct ixgbevf_adapter *adapter)
3588{
3589	int i;
3590
3591	for (i = 0; i < adapter->num_rx_queues; i++)
3592		if (adapter->rx_ring[i]->desc)
3593			ixgbevf_free_rx_resources(adapter->rx_ring[i]);
3594}
3595
3596/**
3597 * ixgbevf_open - Called when a network interface is made active
3598 * @netdev: network interface device structure
3599 *
3600 * Returns 0 on success, negative value on failure
3601 *
3602 * The open entry point is called when a network interface is made
3603 * active by the system (IFF_UP).  At this point all resources needed
3604 * for transmit and receive operations are allocated, the interrupt
3605 * handler is registered with the OS, the watchdog timer is started,
3606 * and the stack is notified that the interface is ready.
3607 **/
3608int ixgbevf_open(struct net_device *netdev)
3609{
3610	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3611	struct ixgbe_hw *hw = &adapter->hw;
3612	int err;
3613
3614	/* A previous failure to open the device because of a lack of
3615	 * available MSIX vector resources may have reset the number
3616	 * of msix vectors variable to zero.  The only way to recover
3617	 * is to unload/reload the driver and hope that the system has
3618	 * been able to recover some MSIX vector resources.
3619	 */
3620	if (!adapter->num_msix_vectors)
3621		return -ENOMEM;
3622
3623	if (hw->adapter_stopped) {
3624		ixgbevf_reset(adapter);
3625		/* if adapter is still stopped then PF isn't up and
3626		 * the VF can't start.
3627		 */
3628		if (hw->adapter_stopped) {
3629			err = IXGBE_ERR_MBX;
3630			pr_err("Unable to start - perhaps the PF Driver isn't up yet\n");
3631			goto err_setup_reset;
3632		}
3633	}
3634
3635	/* disallow open during test */
3636	if (test_bit(__IXGBEVF_TESTING, &adapter->state))
3637		return -EBUSY;
3638
3639	netif_carrier_off(netdev);
3640
3641	/* allocate transmit descriptors */
3642	err = ixgbevf_setup_all_tx_resources(adapter);
3643	if (err)
3644		goto err_setup_tx;
3645
3646	/* allocate receive descriptors */
3647	err = ixgbevf_setup_all_rx_resources(adapter);
3648	if (err)
3649		goto err_setup_rx;
3650
3651	ixgbevf_configure(adapter);
3652
 
 
 
 
 
 
3653	err = ixgbevf_request_irq(adapter);
3654	if (err)
3655		goto err_req_irq;
3656
3657	/* Notify the stack of the actual queue counts. */
3658	err = netif_set_real_num_tx_queues(netdev, adapter->num_tx_queues);
3659	if (err)
3660		goto err_set_queues;
3661
3662	err = netif_set_real_num_rx_queues(netdev, adapter->num_rx_queues);
3663	if (err)
3664		goto err_set_queues;
3665
3666	ixgbevf_up_complete(adapter);
3667
3668	return 0;
3669
3670err_set_queues:
3671	ixgbevf_free_irq(adapter);
3672err_req_irq:
3673	ixgbevf_free_all_rx_resources(adapter);
3674err_setup_rx:
3675	ixgbevf_free_all_tx_resources(adapter);
3676err_setup_tx:
 
3677	ixgbevf_reset(adapter);
 
3678err_setup_reset:
3679
3680	return err;
3681}
3682
3683/**
3684 * ixgbevf_close_suspend - actions necessary to both suspend and close flows
3685 * @adapter: the private adapter struct
3686 *
3687 * This function should contain the necessary work common to both suspending
3688 * and closing of the device.
3689 */
3690static void ixgbevf_close_suspend(struct ixgbevf_adapter *adapter)
3691{
3692	ixgbevf_down(adapter);
3693	ixgbevf_free_irq(adapter);
3694	ixgbevf_free_all_tx_resources(adapter);
3695	ixgbevf_free_all_rx_resources(adapter);
3696}
3697
3698/**
3699 * ixgbevf_close - Disables a network interface
3700 * @netdev: network interface device structure
3701 *
3702 * Returns 0, this is not allowed to fail
3703 *
3704 * The close entry point is called when an interface is de-activated
3705 * by the OS.  The hardware is still under the drivers control, but
3706 * needs to be disabled.  A global MAC reset is issued to stop the
3707 * hardware, and all transmit and receive resources are freed.
3708 **/
3709int ixgbevf_close(struct net_device *netdev)
3710{
3711	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3712
3713	if (netif_device_present(netdev))
3714		ixgbevf_close_suspend(adapter);
 
 
 
3715
3716	return 0;
3717}
3718
3719static void ixgbevf_queue_reset_subtask(struct ixgbevf_adapter *adapter)
3720{
3721	struct net_device *dev = adapter->netdev;
3722
3723	if (!test_and_clear_bit(__IXGBEVF_QUEUE_RESET_REQUESTED,
3724				&adapter->state))
3725		return;
3726
 
 
3727	/* if interface is down do nothing */
3728	if (test_bit(__IXGBEVF_DOWN, &adapter->state) ||
3729	    test_bit(__IXGBEVF_RESETTING, &adapter->state))
3730		return;
3731
3732	/* Hardware has to reinitialize queues and interrupts to
3733	 * match packet buffer alignment. Unfortunately, the
3734	 * hardware is not flexible enough to do this dynamically.
3735	 */
3736	rtnl_lock();
3737
3738	if (netif_running(dev))
3739		ixgbevf_close(dev);
3740
3741	ixgbevf_clear_interrupt_scheme(adapter);
3742	ixgbevf_init_interrupt_scheme(adapter);
3743
3744	if (netif_running(dev))
3745		ixgbevf_open(dev);
3746
3747	rtnl_unlock();
3748}
3749
3750static void ixgbevf_tx_ctxtdesc(struct ixgbevf_ring *tx_ring,
3751				u32 vlan_macip_lens, u32 fceof_saidx,
3752				u32 type_tucmd, u32 mss_l4len_idx)
3753{
3754	struct ixgbe_adv_tx_context_desc *context_desc;
3755	u16 i = tx_ring->next_to_use;
3756
3757	context_desc = IXGBEVF_TX_CTXTDESC(tx_ring, i);
3758
3759	i++;
3760	tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
3761
3762	/* set bits to identify this as an advanced context descriptor */
3763	type_tucmd |= IXGBE_TXD_CMD_DEXT | IXGBE_ADVTXD_DTYP_CTXT;
3764
3765	context_desc->vlan_macip_lens	= cpu_to_le32(vlan_macip_lens);
3766	context_desc->fceof_saidx	= cpu_to_le32(fceof_saidx);
3767	context_desc->type_tucmd_mlhl	= cpu_to_le32(type_tucmd);
3768	context_desc->mss_l4len_idx	= cpu_to_le32(mss_l4len_idx);
3769}
3770
3771static int ixgbevf_tso(struct ixgbevf_ring *tx_ring,
3772		       struct ixgbevf_tx_buffer *first,
3773		       u8 *hdr_len,
3774		       struct ixgbevf_ipsec_tx_data *itd)
3775{
3776	u32 vlan_macip_lens, type_tucmd, mss_l4len_idx;
3777	struct sk_buff *skb = first->skb;
3778	union {
3779		struct iphdr *v4;
3780		struct ipv6hdr *v6;
3781		unsigned char *hdr;
3782	} ip;
3783	union {
3784		struct tcphdr *tcp;
3785		unsigned char *hdr;
3786	} l4;
3787	u32 paylen, l4_offset;
3788	u32 fceof_saidx = 0;
3789	int err;
3790
3791	if (skb->ip_summed != CHECKSUM_PARTIAL)
3792		return 0;
3793
3794	if (!skb_is_gso(skb))
3795		return 0;
3796
3797	err = skb_cow_head(skb, 0);
3798	if (err < 0)
3799		return err;
3800
3801	if (eth_p_mpls(first->protocol))
3802		ip.hdr = skb_inner_network_header(skb);
3803	else
3804		ip.hdr = skb_network_header(skb);
3805	l4.hdr = skb_checksum_start(skb);
3806
3807	/* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
3808	type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;
3809
3810	/* initialize outer IP header fields */
3811	if (ip.v4->version == 4) {
3812		unsigned char *csum_start = skb_checksum_start(skb);
3813		unsigned char *trans_start = ip.hdr + (ip.v4->ihl * 4);
3814		int len = csum_start - trans_start;
3815
3816		/* IP header will have to cancel out any data that
3817		 * is not a part of the outer IP header, so set to
3818		 * a reverse csum if needed, else init check to 0.
3819		 */
3820		ip.v4->check = (skb_shinfo(skb)->gso_type & SKB_GSO_PARTIAL) ?
3821					   csum_fold(csum_partial(trans_start,
3822								  len, 0)) : 0;
3823		type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
3824
3825		ip.v4->tot_len = 0;
 
 
 
 
 
 
3826		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
3827				   IXGBE_TX_FLAGS_CSUM |
3828				   IXGBE_TX_FLAGS_IPV4;
3829	} else {
3830		ip.v6->payload_len = 0;
 
 
 
 
3831		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
3832				   IXGBE_TX_FLAGS_CSUM;
3833	}
3834
3835	/* determine offset of inner transport header */
3836	l4_offset = l4.hdr - skb->data;
3837
3838	/* compute length of segmentation header */
3839	*hdr_len = (l4.tcp->doff * 4) + l4_offset;
3840
3841	/* remove payload length from inner checksum */
3842	paylen = skb->len - l4_offset;
3843	csum_replace_by_diff(&l4.tcp->check, (__force __wsum)htonl(paylen));
3844
3845	/* update gso size and bytecount with header size */
3846	first->gso_segs = skb_shinfo(skb)->gso_segs;
3847	first->bytecount += (first->gso_segs - 1) * *hdr_len;
3848
3849	/* mss_l4len_id: use 1 as index for TSO */
3850	mss_l4len_idx = (*hdr_len - l4_offset) << IXGBE_ADVTXD_L4LEN_SHIFT;
3851	mss_l4len_idx |= skb_shinfo(skb)->gso_size << IXGBE_ADVTXD_MSS_SHIFT;
3852	mss_l4len_idx |= (1u << IXGBE_ADVTXD_IDX_SHIFT);
3853
3854	fceof_saidx |= itd->pfsa;
3855	type_tucmd |= itd->flags | itd->trailer_len;
3856
3857	/* vlan_macip_lens: HEADLEN, MACLEN, VLAN tag */
3858	vlan_macip_lens = l4.hdr - ip.hdr;
3859	vlan_macip_lens |= (ip.hdr - skb->data) << IXGBE_ADVTXD_MACLEN_SHIFT;
3860	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
3861
3862	ixgbevf_tx_ctxtdesc(tx_ring, vlan_macip_lens, fceof_saidx, type_tucmd,
3863			    mss_l4len_idx);
3864
3865	return 1;
3866}
3867
3868static void ixgbevf_tx_csum(struct ixgbevf_ring *tx_ring,
3869			    struct ixgbevf_tx_buffer *first,
3870			    struct ixgbevf_ipsec_tx_data *itd)
3871{
3872	struct sk_buff *skb = first->skb;
3873	u32 vlan_macip_lens = 0;
3874	u32 fceof_saidx = 0;
3875	u32 type_tucmd = 0;
3876
3877	if (skb->ip_summed != CHECKSUM_PARTIAL)
3878		goto no_csum;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
3879
3880	switch (skb->csum_offset) {
3881	case offsetof(struct tcphdr, check):
3882		type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;
3883		fallthrough;
3884	case offsetof(struct udphdr, check):
3885		break;
3886	case offsetof(struct sctphdr, checksum):
3887		/* validate that this is actually an SCTP request */
3888		if (skb_csum_is_sctp(skb)) {
3889			type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_SCTP;
 
 
 
 
3890			break;
 
 
 
 
 
 
 
 
3891		}
3892		fallthrough;
3893	default:
3894		skb_checksum_help(skb);
3895		goto no_csum;
3896	}
3897
3898	if (first->protocol == htons(ETH_P_IP))
3899		type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
 
3900
3901	/* update TX checksum flag */
3902	first->tx_flags |= IXGBE_TX_FLAGS_CSUM;
3903	vlan_macip_lens = skb_checksum_start_offset(skb) -
3904			  skb_network_offset(skb);
3905no_csum:
3906	/* vlan_macip_lens: MACLEN, VLAN tag */
3907	vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
3908	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
3909
3910	fceof_saidx |= itd->pfsa;
3911	type_tucmd |= itd->flags | itd->trailer_len;
3912
3913	ixgbevf_tx_ctxtdesc(tx_ring, vlan_macip_lens,
3914			    fceof_saidx, type_tucmd, 0);
3915}
3916
3917static __le32 ixgbevf_tx_cmd_type(u32 tx_flags)
3918{
3919	/* set type for advanced descriptor with frame checksum insertion */
3920	__le32 cmd_type = cpu_to_le32(IXGBE_ADVTXD_DTYP_DATA |
3921				      IXGBE_ADVTXD_DCMD_IFCS |
3922				      IXGBE_ADVTXD_DCMD_DEXT);
3923
3924	/* set HW VLAN bit if VLAN is present */
3925	if (tx_flags & IXGBE_TX_FLAGS_VLAN)
3926		cmd_type |= cpu_to_le32(IXGBE_ADVTXD_DCMD_VLE);
3927
3928	/* set segmentation enable bits for TSO/FSO */
3929	if (tx_flags & IXGBE_TX_FLAGS_TSO)
3930		cmd_type |= cpu_to_le32(IXGBE_ADVTXD_DCMD_TSE);
3931
3932	return cmd_type;
3933}
3934
3935static void ixgbevf_tx_olinfo_status(union ixgbe_adv_tx_desc *tx_desc,
3936				     u32 tx_flags, unsigned int paylen)
3937{
3938	__le32 olinfo_status = cpu_to_le32(paylen << IXGBE_ADVTXD_PAYLEN_SHIFT);
3939
3940	/* enable L4 checksum for TSO and TX checksum offload */
3941	if (tx_flags & IXGBE_TX_FLAGS_CSUM)
3942		olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_POPTS_TXSM);
3943
3944	/* enble IPv4 checksum for TSO */
3945	if (tx_flags & IXGBE_TX_FLAGS_IPV4)
3946		olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_POPTS_IXSM);
3947
3948	/* enable IPsec */
3949	if (tx_flags & IXGBE_TX_FLAGS_IPSEC)
3950		olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_POPTS_IPSEC);
3951
3952	/* use index 1 context for TSO/FSO/FCOE/IPSEC */
3953	if (tx_flags & (IXGBE_TX_FLAGS_TSO | IXGBE_TX_FLAGS_IPSEC))
3954		olinfo_status |= cpu_to_le32(1u << IXGBE_ADVTXD_IDX_SHIFT);
3955
3956	/* Check Context must be set if Tx switch is enabled, which it
3957	 * always is for case where virtual functions are running
3958	 */
3959	olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_CC);
3960
3961	tx_desc->read.olinfo_status = olinfo_status;
3962}
3963
3964static void ixgbevf_tx_map(struct ixgbevf_ring *tx_ring,
3965			   struct ixgbevf_tx_buffer *first,
3966			   const u8 hdr_len)
3967{
 
3968	struct sk_buff *skb = first->skb;
3969	struct ixgbevf_tx_buffer *tx_buffer;
3970	union ixgbe_adv_tx_desc *tx_desc;
3971	skb_frag_t *frag;
3972	dma_addr_t dma;
3973	unsigned int data_len, size;
 
3974	u32 tx_flags = first->tx_flags;
3975	__le32 cmd_type = ixgbevf_tx_cmd_type(tx_flags);
3976	u16 i = tx_ring->next_to_use;
3977
3978	tx_desc = IXGBEVF_TX_DESC(tx_ring, i);
3979
3980	ixgbevf_tx_olinfo_status(tx_desc, tx_flags, skb->len - hdr_len);
3981
3982	size = skb_headlen(skb);
3983	data_len = skb->data_len;
3984
3985	dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
 
 
3986
3987	tx_buffer = first;
 
 
3988
3989	for (frag = &skb_shinfo(skb)->frags[0];; frag++) {
3990		if (dma_mapping_error(tx_ring->dev, dma))
3991			goto dma_error;
3992
3993		/* record length, and DMA address */
3994		dma_unmap_len_set(tx_buffer, len, size);
3995		dma_unmap_addr_set(tx_buffer, dma, dma);
3996
3997		tx_desc->read.buffer_addr = cpu_to_le64(dma);
3998
 
3999		while (unlikely(size > IXGBE_MAX_DATA_PER_TXD)) {
4000			tx_desc->read.cmd_type_len =
4001				cmd_type | cpu_to_le32(IXGBE_MAX_DATA_PER_TXD);
4002
4003			i++;
4004			tx_desc++;
4005			if (i == tx_ring->count) {
4006				tx_desc = IXGBEVF_TX_DESC(tx_ring, 0);
4007				i = 0;
4008			}
4009			tx_desc->read.olinfo_status = 0;
4010
4011			dma += IXGBE_MAX_DATA_PER_TXD;
4012			size -= IXGBE_MAX_DATA_PER_TXD;
4013
4014			tx_desc->read.buffer_addr = cpu_to_le64(dma);
 
4015		}
4016
4017		if (likely(!data_len))
4018			break;
4019
4020		tx_desc->read.cmd_type_len = cmd_type | cpu_to_le32(size);
4021
4022		i++;
4023		tx_desc++;
4024		if (i == tx_ring->count) {
4025			tx_desc = IXGBEVF_TX_DESC(tx_ring, 0);
4026			i = 0;
4027		}
4028		tx_desc->read.olinfo_status = 0;
4029
4030		size = skb_frag_size(frag);
4031		data_len -= size;
4032
4033		dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
4034				       DMA_TO_DEVICE);
 
 
4035
4036		tx_buffer = &tx_ring->tx_buffer_info[i];
 
 
 
 
 
 
 
4037	}
4038
4039	/* write last descriptor with RS and EOP bits */
4040	cmd_type |= cpu_to_le32(size) | cpu_to_le32(IXGBE_TXD_CMD);
4041	tx_desc->read.cmd_type_len = cmd_type;
4042
4043	/* set the timestamp */
4044	first->time_stamp = jiffies;
4045
4046	skb_tx_timestamp(skb);
4047
4048	/* Force memory writes to complete before letting h/w know there
4049	 * are new descriptors to fetch.  (Only applicable for weak-ordered
4050	 * memory model archs, such as IA-64).
4051	 *
4052	 * We also need this memory barrier (wmb) to make certain all of the
4053	 * status bits have been updated before next_to_watch is written.
4054	 */
4055	wmb();
4056
4057	/* set next_to_watch value indicating a packet is present */
4058	first->next_to_watch = tx_desc;
4059
4060	i++;
4061	if (i == tx_ring->count)
4062		i = 0;
4063
4064	tx_ring->next_to_use = i;
4065
4066	/* notify HW of packet */
4067	ixgbevf_write_tail(tx_ring, i);
4068
4069	return;
4070dma_error:
4071	dev_err(tx_ring->dev, "TX DMA map failed\n");
4072	tx_buffer = &tx_ring->tx_buffer_info[i];
4073
4074	/* clear dma mappings for failed tx_buffer_info map */
4075	while (tx_buffer != first) {
4076		if (dma_unmap_len(tx_buffer, len))
4077			dma_unmap_page(tx_ring->dev,
4078				       dma_unmap_addr(tx_buffer, dma),
4079				       dma_unmap_len(tx_buffer, len),
4080				       DMA_TO_DEVICE);
4081		dma_unmap_len_set(tx_buffer, len, 0);
4082
4083		if (i-- == 0)
4084			i += tx_ring->count;
4085		tx_buffer = &tx_ring->tx_buffer_info[i];
 
 
 
 
 
 
4086	}
4087
4088	if (dma_unmap_len(tx_buffer, len))
4089		dma_unmap_single(tx_ring->dev,
4090				 dma_unmap_addr(tx_buffer, dma),
4091				 dma_unmap_len(tx_buffer, len),
4092				 DMA_TO_DEVICE);
4093	dma_unmap_len_set(tx_buffer, len, 0);
4094
4095	dev_kfree_skb_any(tx_buffer->skb);
4096	tx_buffer->skb = NULL;
4097
4098	tx_ring->next_to_use = i;
4099}
4100
4101static int __ixgbevf_maybe_stop_tx(struct ixgbevf_ring *tx_ring, int size)
4102{
4103	netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);
4104	/* Herbert's original patch had:
4105	 *  smp_mb__after_netif_stop_queue();
4106	 * but since that doesn't exist yet, just open code it.
4107	 */
4108	smp_mb();
4109
4110	/* We need to check again in a case another CPU has just
4111	 * made room available.
4112	 */
4113	if (likely(ixgbevf_desc_unused(tx_ring) < size))
4114		return -EBUSY;
4115
4116	/* A reprieve! - use start_queue because it doesn't call schedule */
4117	netif_start_subqueue(tx_ring->netdev, tx_ring->queue_index);
4118	++tx_ring->tx_stats.restart_queue;
4119
4120	return 0;
4121}
4122
4123static int ixgbevf_maybe_stop_tx(struct ixgbevf_ring *tx_ring, int size)
4124{
4125	if (likely(ixgbevf_desc_unused(tx_ring) >= size))
4126		return 0;
4127	return __ixgbevf_maybe_stop_tx(tx_ring, size);
4128}
4129
4130static int ixgbevf_xmit_frame_ring(struct sk_buff *skb,
4131				   struct ixgbevf_ring *tx_ring)
4132{
 
4133	struct ixgbevf_tx_buffer *first;
 
4134	int tso;
4135	u32 tx_flags = 0;
4136	u16 count = TXD_USE_COUNT(skb_headlen(skb));
4137	struct ixgbevf_ipsec_tx_data ipsec_tx = { 0 };
4138#if PAGE_SIZE > IXGBE_MAX_DATA_PER_TXD
4139	unsigned short f;
4140#endif
4141	u8 hdr_len = 0;
4142	u8 *dst_mac = skb_header_pointer(skb, 0, 0, NULL);
4143
4144	if (!dst_mac || is_link_local_ether_addr(dst_mac)) {
4145		dev_kfree_skb_any(skb);
4146		return NETDEV_TX_OK;
4147	}
4148
 
 
4149	/* need: 1 descriptor per page * PAGE_SIZE/IXGBE_MAX_DATA_PER_TXD,
4150	 *       + 1 desc for skb_headlen/IXGBE_MAX_DATA_PER_TXD,
4151	 *       + 2 desc gap to keep tail from touching head,
4152	 *       + 1 desc for context descriptor,
4153	 * otherwise try next time
4154	 */
4155#if PAGE_SIZE > IXGBE_MAX_DATA_PER_TXD
4156	for (f = 0; f < skb_shinfo(skb)->nr_frags; f++) {
4157		skb_frag_t *frag = &skb_shinfo(skb)->frags[f];
4158
4159		count += TXD_USE_COUNT(skb_frag_size(frag));
4160	}
4161#else
4162	count += skb_shinfo(skb)->nr_frags;
4163#endif
4164	if (ixgbevf_maybe_stop_tx(tx_ring, count + 3)) {
4165		tx_ring->tx_stats.tx_busy++;
4166		return NETDEV_TX_BUSY;
4167	}
4168
4169	/* record the location of the first descriptor for this packet */
4170	first = &tx_ring->tx_buffer_info[tx_ring->next_to_use];
4171	first->skb = skb;
4172	first->bytecount = skb->len;
4173	first->gso_segs = 1;
4174
4175	if (skb_vlan_tag_present(skb)) {
4176		tx_flags |= skb_vlan_tag_get(skb);
4177		tx_flags <<= IXGBE_TX_FLAGS_VLAN_SHIFT;
4178		tx_flags |= IXGBE_TX_FLAGS_VLAN;
4179	}
4180
4181	/* record initial flags and protocol */
4182	first->tx_flags = tx_flags;
4183	first->protocol = vlan_get_protocol(skb);
4184
4185#ifdef CONFIG_IXGBEVF_IPSEC
4186	if (xfrm_offload(skb) && !ixgbevf_ipsec_tx(tx_ring, first, &ipsec_tx))
4187		goto out_drop;
4188#endif
4189	tso = ixgbevf_tso(tx_ring, first, &hdr_len, &ipsec_tx);
4190	if (tso < 0)
4191		goto out_drop;
4192	else if (!tso)
4193		ixgbevf_tx_csum(tx_ring, first, &ipsec_tx);
4194
4195	ixgbevf_tx_map(tx_ring, first, hdr_len);
4196
4197	ixgbevf_maybe_stop_tx(tx_ring, DESC_NEEDED);
4198
4199	return NETDEV_TX_OK;
4200
4201out_drop:
4202	dev_kfree_skb_any(first->skb);
4203	first->skb = NULL;
4204
4205	return NETDEV_TX_OK;
4206}
4207
4208static netdev_tx_t ixgbevf_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
4209{
4210	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
4211	struct ixgbevf_ring *tx_ring;
4212
4213	if (skb->len <= 0) {
4214		dev_kfree_skb_any(skb);
4215		return NETDEV_TX_OK;
4216	}
4217
4218	/* The minimum packet size for olinfo paylen is 17 so pad the skb
4219	 * in order to meet this minimum size requirement.
4220	 */
4221	if (skb->len < 17) {
4222		if (skb_padto(skb, 17))
4223			return NETDEV_TX_OK;
4224		skb->len = 17;
4225	}
4226
4227	tx_ring = adapter->tx_ring[skb->queue_mapping];
4228	return ixgbevf_xmit_frame_ring(skb, tx_ring);
4229}
4230
4231/**
4232 * ixgbevf_set_mac - Change the Ethernet Address of the NIC
4233 * @netdev: network interface device structure
4234 * @p: pointer to an address structure
4235 *
4236 * Returns 0 on success, negative on failure
4237 **/
4238static int ixgbevf_set_mac(struct net_device *netdev, void *p)
4239{
4240	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
4241	struct ixgbe_hw *hw = &adapter->hw;
4242	struct sockaddr *addr = p;
4243	int err;
4244
4245	if (!is_valid_ether_addr(addr->sa_data))
4246		return -EADDRNOTAVAIL;
4247
4248	spin_lock_bh(&adapter->mbx_lock);
4249
4250	err = hw->mac.ops.set_rar(hw, 0, addr->sa_data, 0);
4251
4252	spin_unlock_bh(&adapter->mbx_lock);
4253
4254	if (err)
4255		return -EPERM;
4256
4257	ether_addr_copy(hw->mac.addr, addr->sa_data);
4258	ether_addr_copy(hw->mac.perm_addr, addr->sa_data);
4259	eth_hw_addr_set(netdev, addr->sa_data);
4260
4261	return 0;
4262}
4263
4264/**
4265 * ixgbevf_change_mtu - Change the Maximum Transfer Unit
4266 * @netdev: network interface device structure
4267 * @new_mtu: new value for maximum frame size
4268 *
4269 * Returns 0 on success, negative on failure
4270 **/
4271static int ixgbevf_change_mtu(struct net_device *netdev, int new_mtu)
4272{
4273	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
4274	struct ixgbe_hw *hw = &adapter->hw;
4275	int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN;
4276	int ret;
4277
4278	/* prevent MTU being changed to a size unsupported by XDP */
4279	if (adapter->xdp_prog) {
4280		dev_warn(&adapter->pdev->dev, "MTU cannot be changed while XDP program is loaded\n");
4281		return -EPERM;
 
 
 
 
 
4282	}
4283
4284	spin_lock_bh(&adapter->mbx_lock);
4285	/* notify the PF of our intent to use this size of frame */
4286	ret = hw->mac.ops.set_rlpml(hw, max_frame);
4287	spin_unlock_bh(&adapter->mbx_lock);
4288	if (ret)
4289		return -EINVAL;
4290
4291	hw_dbg(hw, "changing MTU from %d to %d\n",
4292	       netdev->mtu, new_mtu);
4293
4294	/* must set new MTU before calling down or up */
4295	netdev->mtu = new_mtu;
4296
4297	if (netif_running(netdev))
4298		ixgbevf_reinit_locked(adapter);
4299
4300	return 0;
4301}
4302
4303static int __maybe_unused ixgbevf_suspend(struct device *dev_d)
 
 
 
 
 
4304{
4305	struct net_device *netdev = dev_get_drvdata(dev_d);
4306	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
4307
4308	rtnl_lock();
4309	netif_device_detach(netdev);
4310
4311	if (netif_running(netdev))
4312		ixgbevf_close_suspend(adapter);
 
 
 
 
 
 
4313
4314	ixgbevf_clear_interrupt_scheme(adapter);
4315	rtnl_unlock();
 
 
 
 
 
 
 
 
4316
4317	return 0;
4318}
4319
4320static int __maybe_unused ixgbevf_resume(struct device *dev_d)
 
4321{
4322	struct pci_dev *pdev = to_pci_dev(dev_d);
4323	struct net_device *netdev = pci_get_drvdata(pdev);
4324	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
4325	u32 err;
4326
4327	adapter->hw.hw_addr = adapter->io_addr;
 
 
 
 
 
 
 
 
 
 
4328	smp_mb__before_atomic();
4329	clear_bit(__IXGBEVF_DISABLED, &adapter->state);
4330	pci_set_master(pdev);
4331
4332	ixgbevf_reset(adapter);
4333
4334	rtnl_lock();
4335	err = ixgbevf_init_interrupt_scheme(adapter);
4336	if (!err && netif_running(netdev))
4337		err = ixgbevf_open(netdev);
4338	rtnl_unlock();
4339	if (err)
 
4340		return err;
 
 
 
 
 
 
 
4341
4342	netif_device_attach(netdev);
4343
4344	return err;
4345}
4346
 
4347static void ixgbevf_shutdown(struct pci_dev *pdev)
4348{
4349	ixgbevf_suspend(&pdev->dev);
4350}
4351
4352static void ixgbevf_get_tx_ring_stats(struct rtnl_link_stats64 *stats,
4353				      const struct ixgbevf_ring *ring)
4354{
4355	u64 bytes, packets;
4356	unsigned int start;
4357
4358	if (ring) {
4359		do {
4360			start = u64_stats_fetch_begin(&ring->syncp);
4361			bytes = ring->stats.bytes;
4362			packets = ring->stats.packets;
4363		} while (u64_stats_fetch_retry(&ring->syncp, start));
4364		stats->tx_bytes += bytes;
4365		stats->tx_packets += packets;
4366	}
4367}
4368
4369static void ixgbevf_get_stats(struct net_device *netdev,
4370			      struct rtnl_link_stats64 *stats)
4371{
4372	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
4373	unsigned int start;
4374	u64 bytes, packets;
4375	const struct ixgbevf_ring *ring;
4376	int i;
4377
4378	ixgbevf_update_stats(adapter);
4379
4380	stats->multicast = adapter->stats.vfmprc - adapter->stats.base_vfmprc;
4381
4382	rcu_read_lock();
4383	for (i = 0; i < adapter->num_rx_queues; i++) {
4384		ring = adapter->rx_ring[i];
4385		do {
4386			start = u64_stats_fetch_begin(&ring->syncp);
4387			bytes = ring->stats.bytes;
4388			packets = ring->stats.packets;
4389		} while (u64_stats_fetch_retry(&ring->syncp, start));
4390		stats->rx_bytes += bytes;
4391		stats->rx_packets += packets;
4392	}
4393
4394	for (i = 0; i < adapter->num_tx_queues; i++) {
4395		ring = adapter->tx_ring[i];
4396		ixgbevf_get_tx_ring_stats(stats, ring);
4397	}
4398
4399	for (i = 0; i < adapter->num_xdp_queues; i++) {
4400		ring = adapter->xdp_ring[i];
4401		ixgbevf_get_tx_ring_stats(stats, ring);
4402	}
4403	rcu_read_unlock();
4404}
4405
4406#define IXGBEVF_MAX_MAC_HDR_LEN		127
4407#define IXGBEVF_MAX_NETWORK_HDR_LEN	511
4408
4409static netdev_features_t
4410ixgbevf_features_check(struct sk_buff *skb, struct net_device *dev,
4411		       netdev_features_t features)
4412{
4413	unsigned int network_hdr_len, mac_hdr_len;
4414
4415	/* Make certain the headers can be described by a context descriptor */
4416	mac_hdr_len = skb_network_header(skb) - skb->data;
4417	if (unlikely(mac_hdr_len > IXGBEVF_MAX_MAC_HDR_LEN))
4418		return features & ~(NETIF_F_HW_CSUM |
4419				    NETIF_F_SCTP_CRC |
4420				    NETIF_F_HW_VLAN_CTAG_TX |
4421				    NETIF_F_TSO |
4422				    NETIF_F_TSO6);
4423
4424	network_hdr_len = skb_checksum_start(skb) - skb_network_header(skb);
4425	if (unlikely(network_hdr_len >  IXGBEVF_MAX_NETWORK_HDR_LEN))
4426		return features & ~(NETIF_F_HW_CSUM |
4427				    NETIF_F_SCTP_CRC |
4428				    NETIF_F_TSO |
4429				    NETIF_F_TSO6);
4430
4431	/* We can only support IPV4 TSO in tunnels if we can mangle the
4432	 * inner IP ID field, so strip TSO if MANGLEID is not supported.
4433	 */
4434	if (skb->encapsulation && !(features & NETIF_F_TSO_MANGLEID))
4435		features &= ~NETIF_F_TSO;
4436
4437	return features;
4438}
4439
4440static int ixgbevf_xdp_setup(struct net_device *dev, struct bpf_prog *prog)
4441{
4442	int i, frame_size = dev->mtu + ETH_HLEN + ETH_FCS_LEN + VLAN_HLEN;
4443	struct ixgbevf_adapter *adapter = netdev_priv(dev);
4444	struct bpf_prog *old_prog;
4445
4446	/* verify ixgbevf ring attributes are sufficient for XDP */
4447	for (i = 0; i < adapter->num_rx_queues; i++) {
4448		struct ixgbevf_ring *ring = adapter->rx_ring[i];
4449
4450		if (frame_size > ixgbevf_rx_bufsz(ring))
4451			return -EINVAL;
4452	}
4453
4454	old_prog = xchg(&adapter->xdp_prog, prog);
4455
4456	/* If transitioning XDP modes reconfigure rings */
4457	if (!!prog != !!old_prog) {
4458		/* Hardware has to reinitialize queues and interrupts to
4459		 * match packet buffer alignment. Unfortunately, the
4460		 * hardware is not flexible enough to do this dynamically.
4461		 */
4462		if (netif_running(dev))
4463			ixgbevf_close(dev);
4464
4465		ixgbevf_clear_interrupt_scheme(adapter);
4466		ixgbevf_init_interrupt_scheme(adapter);
4467
4468		if (netif_running(dev))
4469			ixgbevf_open(dev);
4470	} else {
4471		for (i = 0; i < adapter->num_rx_queues; i++)
4472			xchg(&adapter->rx_ring[i]->xdp_prog, adapter->xdp_prog);
4473	}
4474
4475	if (old_prog)
4476		bpf_prog_put(old_prog);
4477
4478	return 0;
4479}
4480
4481static int ixgbevf_xdp(struct net_device *dev, struct netdev_bpf *xdp)
4482{
4483	switch (xdp->command) {
4484	case XDP_SETUP_PROG:
4485		return ixgbevf_xdp_setup(dev, xdp->prog);
4486	default:
4487		return -EINVAL;
4488	}
4489}
4490
4491static const struct net_device_ops ixgbevf_netdev_ops = {
4492	.ndo_open		= ixgbevf_open,
4493	.ndo_stop		= ixgbevf_close,
4494	.ndo_start_xmit		= ixgbevf_xmit_frame,
4495	.ndo_set_rx_mode	= ixgbevf_set_rx_mode,
4496	.ndo_get_stats64	= ixgbevf_get_stats,
4497	.ndo_validate_addr	= eth_validate_addr,
4498	.ndo_set_mac_address	= ixgbevf_set_mac,
4499	.ndo_change_mtu		= ixgbevf_change_mtu,
4500	.ndo_tx_timeout		= ixgbevf_tx_timeout,
4501	.ndo_vlan_rx_add_vid	= ixgbevf_vlan_rx_add_vid,
4502	.ndo_vlan_rx_kill_vid	= ixgbevf_vlan_rx_kill_vid,
4503	.ndo_features_check	= ixgbevf_features_check,
4504	.ndo_bpf		= ixgbevf_xdp,
 
 
 
 
 
4505};
4506
4507static void ixgbevf_assign_netdev_ops(struct net_device *dev)
4508{
4509	dev->netdev_ops = &ixgbevf_netdev_ops;
4510	ixgbevf_set_ethtool_ops(dev);
4511	dev->watchdog_timeo = 5 * HZ;
4512}
4513
4514/**
4515 * ixgbevf_probe - Device Initialization Routine
4516 * @pdev: PCI device information struct
4517 * @ent: entry in ixgbevf_pci_tbl
4518 *
4519 * Returns 0 on success, negative on failure
4520 *
4521 * ixgbevf_probe initializes an adapter identified by a pci_dev structure.
4522 * The OS initialization, configuring of the adapter private structure,
4523 * and a hardware reset occur.
4524 **/
4525static int ixgbevf_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
4526{
4527	struct net_device *netdev;
4528	struct ixgbevf_adapter *adapter = NULL;
4529	struct ixgbe_hw *hw = NULL;
4530	const struct ixgbevf_info *ii = ixgbevf_info_tbl[ent->driver_data];
 
4531	bool disable_dev = false;
4532	int err;
4533
4534	err = pci_enable_device(pdev);
4535	if (err)
4536		return err;
4537
4538	err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
4539	if (err) {
4540		dev_err(&pdev->dev, "No usable DMA configuration, aborting\n");
4541		goto err_dma;
 
 
 
 
 
4542	}
4543
4544	err = pci_request_regions(pdev, ixgbevf_driver_name);
4545	if (err) {
4546		dev_err(&pdev->dev, "pci_request_regions failed 0x%x\n", err);
4547		goto err_pci_reg;
4548	}
4549
4550	pci_set_master(pdev);
4551
4552	netdev = alloc_etherdev_mq(sizeof(struct ixgbevf_adapter),
4553				   MAX_TX_QUEUES);
4554	if (!netdev) {
4555		err = -ENOMEM;
4556		goto err_alloc_etherdev;
4557	}
4558
4559	SET_NETDEV_DEV(netdev, &pdev->dev);
4560
4561	adapter = netdev_priv(netdev);
4562
4563	adapter->netdev = netdev;
4564	adapter->pdev = pdev;
4565	hw = &adapter->hw;
4566	hw->back = adapter;
4567	adapter->msg_enable = netif_msg_init(debug, DEFAULT_MSG_ENABLE);
4568
4569	/* call save state here in standalone driver because it relies on
4570	 * adapter struct to exist, and needs to call netdev_priv
4571	 */
4572	pci_save_state(pdev);
4573
4574	hw->hw_addr = ioremap(pci_resource_start(pdev, 0),
4575			      pci_resource_len(pdev, 0));
4576	adapter->io_addr = hw->hw_addr;
4577	if (!hw->hw_addr) {
4578		err = -EIO;
4579		goto err_ioremap;
4580	}
4581
4582	ixgbevf_assign_netdev_ops(netdev);
4583
4584	/* Setup HW API */
4585	memcpy(&hw->mac.ops, ii->mac_ops, sizeof(hw->mac.ops));
4586	hw->mac.type  = ii->mac;
4587
4588	memcpy(&hw->mbx.ops, &ixgbevf_mbx_ops_legacy,
4589	       sizeof(struct ixgbe_mbx_operations));
4590
4591	/* setup the private structure */
4592	err = ixgbevf_sw_init(adapter);
4593	if (err)
4594		goto err_sw_init;
4595
4596	/* The HW MAC address was set and/or determined in sw_init */
4597	if (!is_valid_ether_addr(netdev->dev_addr)) {
4598		pr_err("invalid MAC address\n");
4599		err = -EIO;
4600		goto err_sw_init;
4601	}
4602
4603	netdev->hw_features = NETIF_F_SG |
 
 
4604			      NETIF_F_TSO |
4605			      NETIF_F_TSO6 |
4606			      NETIF_F_RXCSUM |
4607			      NETIF_F_HW_CSUM |
4608			      NETIF_F_SCTP_CRC;
4609
4610#define IXGBEVF_GSO_PARTIAL_FEATURES (NETIF_F_GSO_GRE | \
4611				      NETIF_F_GSO_GRE_CSUM | \
4612				      NETIF_F_GSO_IPXIP4 | \
4613				      NETIF_F_GSO_IPXIP6 | \
4614				      NETIF_F_GSO_UDP_TUNNEL | \
4615				      NETIF_F_GSO_UDP_TUNNEL_CSUM)
4616
4617	netdev->gso_partial_features = IXGBEVF_GSO_PARTIAL_FEATURES;
4618	netdev->hw_features |= NETIF_F_GSO_PARTIAL |
4619			       IXGBEVF_GSO_PARTIAL_FEATURES;
4620
4621	netdev->features = netdev->hw_features | NETIF_F_HIGHDMA;
4622
4623	netdev->vlan_features |= netdev->features | NETIF_F_TSO_MANGLEID;
4624	netdev->mpls_features |= NETIF_F_SG |
4625				 NETIF_F_TSO |
4626				 NETIF_F_TSO6 |
4627				 NETIF_F_HW_CSUM;
4628	netdev->mpls_features |= IXGBEVF_GSO_PARTIAL_FEATURES;
4629	netdev->hw_enc_features |= netdev->vlan_features;
4630
4631	/* set this bit last since it cannot be part of vlan_features */
4632	netdev->features |= NETIF_F_HW_VLAN_CTAG_FILTER |
4633			    NETIF_F_HW_VLAN_CTAG_RX |
4634			    NETIF_F_HW_VLAN_CTAG_TX;
4635
4636	netdev->priv_flags |= IFF_UNICAST_FLT;
4637	netdev->xdp_features = NETDEV_XDP_ACT_BASIC;
4638
4639	/* MTU range: 68 - 1504 or 9710 */
4640	netdev->min_mtu = ETH_MIN_MTU;
4641	switch (adapter->hw.api_version) {
4642	case ixgbe_mbox_api_11:
4643	case ixgbe_mbox_api_12:
4644	case ixgbe_mbox_api_13:
4645	case ixgbe_mbox_api_14:
4646	case ixgbe_mbox_api_15:
4647		netdev->max_mtu = IXGBE_MAX_JUMBO_FRAME_SIZE -
4648				  (ETH_HLEN + ETH_FCS_LEN);
4649		break;
4650	default:
4651		if (adapter->hw.mac.type != ixgbe_mac_82599_vf)
4652			netdev->max_mtu = IXGBE_MAX_JUMBO_FRAME_SIZE -
4653					  (ETH_HLEN + ETH_FCS_LEN);
4654		else
4655			netdev->max_mtu = ETH_DATA_LEN + ETH_FCS_LEN;
4656		break;
4657	}
4658
4659	if (IXGBE_REMOVED(hw->hw_addr)) {
4660		err = -EIO;
4661		goto err_sw_init;
4662	}
4663
4664	timer_setup(&adapter->service_timer, ixgbevf_service_timer, 0);
 
4665
4666	INIT_WORK(&adapter->service_task, ixgbevf_service_task);
4667	set_bit(__IXGBEVF_SERVICE_INITED, &adapter->state);
4668	clear_bit(__IXGBEVF_SERVICE_SCHED, &adapter->state);
4669
4670	err = ixgbevf_init_interrupt_scheme(adapter);
4671	if (err)
4672		goto err_sw_init;
4673
4674	strcpy(netdev->name, "eth%d");
4675
4676	err = register_netdev(netdev);
4677	if (err)
4678		goto err_register;
4679
4680	pci_set_drvdata(pdev, netdev);
4681	netif_carrier_off(netdev);
4682	ixgbevf_init_ipsec_offload(adapter);
4683
4684	ixgbevf_init_last_counter_stats(adapter);
4685
4686	/* print the VF info */
4687	dev_info(&pdev->dev, "%pM\n", netdev->dev_addr);
4688	dev_info(&pdev->dev, "MAC: %d\n", hw->mac.type);
4689
4690	switch (hw->mac.type) {
4691	case ixgbe_mac_X550_vf:
4692		dev_info(&pdev->dev, "Intel(R) X550 Virtual Function\n");
4693		break;
4694	case ixgbe_mac_X540_vf:
4695		dev_info(&pdev->dev, "Intel(R) X540 Virtual Function\n");
4696		break;
4697	case ixgbe_mac_82599_vf:
4698	default:
4699		dev_info(&pdev->dev, "Intel(R) 82599 Virtual Function\n");
4700		break;
4701	}
4702
4703	return 0;
4704
4705err_register:
4706	ixgbevf_clear_interrupt_scheme(adapter);
4707err_sw_init:
4708	ixgbevf_reset_interrupt_capability(adapter);
4709	iounmap(adapter->io_addr);
4710	kfree(adapter->rss_key);
4711err_ioremap:
4712	disable_dev = !test_and_set_bit(__IXGBEVF_DISABLED, &adapter->state);
4713	free_netdev(netdev);
4714err_alloc_etherdev:
4715	pci_release_regions(pdev);
4716err_pci_reg:
4717err_dma:
4718	if (!adapter || disable_dev)
4719		pci_disable_device(pdev);
4720	return err;
4721}
4722
4723/**
4724 * ixgbevf_remove - Device Removal Routine
4725 * @pdev: PCI device information struct
4726 *
4727 * ixgbevf_remove is called by the PCI subsystem to alert the driver
4728 * that it should release a PCI device.  The could be caused by a
4729 * Hot-Plug event, or because the driver is going to be removed from
4730 * memory.
4731 **/
4732static void ixgbevf_remove(struct pci_dev *pdev)
4733{
4734	struct net_device *netdev = pci_get_drvdata(pdev);
4735	struct ixgbevf_adapter *adapter;
4736	bool disable_dev;
4737
4738	if (!netdev)
4739		return;
4740
4741	adapter = netdev_priv(netdev);
4742
4743	set_bit(__IXGBEVF_REMOVING, &adapter->state);
4744	cancel_work_sync(&adapter->service_task);
4745
4746	if (netdev->reg_state == NETREG_REGISTERED)
4747		unregister_netdev(netdev);
4748
4749	ixgbevf_stop_ipsec_offload(adapter);
4750	ixgbevf_clear_interrupt_scheme(adapter);
4751	ixgbevf_reset_interrupt_capability(adapter);
4752
4753	iounmap(adapter->io_addr);
4754	pci_release_regions(pdev);
4755
4756	hw_dbg(&adapter->hw, "Remove complete\n");
4757
4758	kfree(adapter->rss_key);
4759	disable_dev = !test_and_set_bit(__IXGBEVF_DISABLED, &adapter->state);
4760	free_netdev(netdev);
4761
4762	if (disable_dev)
4763		pci_disable_device(pdev);
4764}
4765
4766/**
4767 * ixgbevf_io_error_detected - called when PCI error is detected
4768 * @pdev: Pointer to PCI device
4769 * @state: The current pci connection state
4770 *
4771 * This function is called after a PCI bus error affecting
4772 * this device has been detected.
4773 **/
4774static pci_ers_result_t ixgbevf_io_error_detected(struct pci_dev *pdev,
4775						  pci_channel_state_t state)
4776{
4777	struct net_device *netdev = pci_get_drvdata(pdev);
4778	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
4779
4780	if (!test_bit(__IXGBEVF_SERVICE_INITED, &adapter->state))
4781		return PCI_ERS_RESULT_DISCONNECT;
4782
4783	rtnl_lock();
4784	netif_device_detach(netdev);
4785
4786	if (netif_running(netdev))
4787		ixgbevf_close_suspend(adapter);
4788
4789	if (state == pci_channel_io_perm_failure) {
4790		rtnl_unlock();
4791		return PCI_ERS_RESULT_DISCONNECT;
4792	}
4793
 
 
 
4794	if (!test_and_set_bit(__IXGBEVF_DISABLED, &adapter->state))
4795		pci_disable_device(pdev);
4796	rtnl_unlock();
4797
4798	/* Request a slot reset. */
4799	return PCI_ERS_RESULT_NEED_RESET;
4800}
4801
4802/**
4803 * ixgbevf_io_slot_reset - called after the pci bus has been reset.
4804 * @pdev: Pointer to PCI device
4805 *
4806 * Restart the card from scratch, as if from a cold-boot. Implementation
4807 * resembles the first-half of the ixgbevf_resume routine.
4808 **/
4809static pci_ers_result_t ixgbevf_io_slot_reset(struct pci_dev *pdev)
4810{
4811	struct net_device *netdev = pci_get_drvdata(pdev);
4812	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
4813
4814	if (pci_enable_device_mem(pdev)) {
4815		dev_err(&pdev->dev,
4816			"Cannot re-enable PCI device after reset.\n");
4817		return PCI_ERS_RESULT_DISCONNECT;
4818	}
4819
4820	adapter->hw.hw_addr = adapter->io_addr;
4821	smp_mb__before_atomic();
4822	clear_bit(__IXGBEVF_DISABLED, &adapter->state);
4823	pci_set_master(pdev);
4824
4825	ixgbevf_reset(adapter);
4826
4827	return PCI_ERS_RESULT_RECOVERED;
4828}
4829
4830/**
4831 * ixgbevf_io_resume - called when traffic can start flowing again.
4832 * @pdev: Pointer to PCI device
4833 *
4834 * This callback is called when the error recovery driver tells us that
4835 * its OK to resume normal operation. Implementation resembles the
4836 * second-half of the ixgbevf_resume routine.
4837 **/
4838static void ixgbevf_io_resume(struct pci_dev *pdev)
4839{
4840	struct net_device *netdev = pci_get_drvdata(pdev);
 
4841
4842	rtnl_lock();
4843	if (netif_running(netdev))
4844		ixgbevf_open(netdev);
4845
4846	netif_device_attach(netdev);
4847	rtnl_unlock();
4848}
4849
4850/* PCI Error Recovery (ERS) */
4851static const struct pci_error_handlers ixgbevf_err_handler = {
4852	.error_detected = ixgbevf_io_error_detected,
4853	.slot_reset = ixgbevf_io_slot_reset,
4854	.resume = ixgbevf_io_resume,
4855};
4856
4857static SIMPLE_DEV_PM_OPS(ixgbevf_pm_ops, ixgbevf_suspend, ixgbevf_resume);
4858
4859static struct pci_driver ixgbevf_driver = {
4860	.name		= ixgbevf_driver_name,
4861	.id_table	= ixgbevf_pci_tbl,
4862	.probe		= ixgbevf_probe,
4863	.remove		= ixgbevf_remove,
4864
4865	/* Power Management Hooks */
4866	.driver.pm	= &ixgbevf_pm_ops,
4867
 
4868	.shutdown	= ixgbevf_shutdown,
4869	.err_handler	= &ixgbevf_err_handler
4870};
4871
4872/**
4873 * ixgbevf_init_module - Driver Registration Routine
4874 *
4875 * ixgbevf_init_module is the first routine called when the driver is
4876 * loaded. All it does is register with the PCI subsystem.
4877 **/
4878static int __init ixgbevf_init_module(void)
4879{
4880	int err;
 
4881
4882	pr_info("%s\n", ixgbevf_driver_string);
4883	pr_info("%s\n", ixgbevf_copyright);
4884	ixgbevf_wq = create_singlethread_workqueue(ixgbevf_driver_name);
4885	if (!ixgbevf_wq) {
4886		pr_err("%s: Failed to create workqueue\n", ixgbevf_driver_name);
4887		return -ENOMEM;
4888	}
4889
4890	err = pci_register_driver(&ixgbevf_driver);
4891	if (err) {
4892		destroy_workqueue(ixgbevf_wq);
4893		return err;
4894	}
4895
4896	return 0;
4897}
4898
4899module_init(ixgbevf_init_module);
4900
4901/**
4902 * ixgbevf_exit_module - Driver Exit Cleanup Routine
4903 *
4904 * ixgbevf_exit_module is called just before the driver is removed
4905 * from memory.
4906 **/
4907static void __exit ixgbevf_exit_module(void)
4908{
4909	pci_unregister_driver(&ixgbevf_driver);
4910	if (ixgbevf_wq) {
4911		destroy_workqueue(ixgbevf_wq);
4912		ixgbevf_wq = NULL;
4913	}
4914}
4915
4916#ifdef DEBUG
4917/**
4918 * ixgbevf_get_hw_dev_name - return device name string
4919 * used by hardware layer to print debugging information
4920 * @hw: pointer to private hardware struct
4921 **/
4922char *ixgbevf_get_hw_dev_name(struct ixgbe_hw *hw)
4923{
4924	struct ixgbevf_adapter *adapter = hw->back;
4925
4926	return adapter->netdev->name;
4927}
4928
4929#endif
4930module_exit(ixgbevf_exit_module);
4931
4932/* ixgbevf_main.c */
v4.6
   1/*******************************************************************************
   2
   3  Intel 82599 Virtual Function driver
   4  Copyright(c) 1999 - 2015 Intel Corporation.
   5
   6  This program is free software; you can redistribute it and/or modify it
   7  under the terms and conditions of the GNU General Public License,
   8  version 2, as published by the Free Software Foundation.
   9
  10  This program is distributed in the hope it will be useful, but WITHOUT
  11  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  12  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  13  more details.
  14
  15  You should have received a copy of the GNU General Public License along with
  16  this program; if not, see <http://www.gnu.org/licenses/>.
  17
  18  The full GNU General Public License is included in this distribution in
  19  the file called "COPYING".
  20
  21  Contact Information:
  22  e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
  23  Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  24
  25*******************************************************************************/
  26
  27/******************************************************************************
  28 Copyright (c)2006 - 2007 Myricom, Inc. for some LRO specific code
  29******************************************************************************/
  30
  31#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  32
  33#include <linux/types.h>
  34#include <linux/bitops.h>
  35#include <linux/module.h>
  36#include <linux/pci.h>
  37#include <linux/netdevice.h>
  38#include <linux/vmalloc.h>
  39#include <linux/string.h>
  40#include <linux/in.h>
  41#include <linux/ip.h>
  42#include <linux/tcp.h>
  43#include <linux/sctp.h>
  44#include <linux/ipv6.h>
  45#include <linux/slab.h>
  46#include <net/checksum.h>
  47#include <net/ip6_checksum.h>
  48#include <linux/ethtool.h>
  49#include <linux/if.h>
  50#include <linux/if_vlan.h>
  51#include <linux/prefetch.h>
 
 
 
 
 
  52
  53#include "ixgbevf.h"
  54
  55const char ixgbevf_driver_name[] = "ixgbevf";
  56static const char ixgbevf_driver_string[] =
  57	"Intel(R) 10 Gigabit PCI Express Virtual Function Network Driver";
  58
  59#define DRV_VERSION "2.12.1-k"
  60const char ixgbevf_driver_version[] = DRV_VERSION;
  61static char ixgbevf_copyright[] =
  62	"Copyright (c) 2009 - 2015 Intel Corporation.";
  63
  64static const struct ixgbevf_info *ixgbevf_info_tbl[] = {
  65	[board_82599_vf] = &ixgbevf_82599_vf_info,
  66	[board_X540_vf]  = &ixgbevf_X540_vf_info,
  67	[board_X550_vf]  = &ixgbevf_X550_vf_info,
  68	[board_X550EM_x_vf] = &ixgbevf_X550EM_x_vf_info,
 
 
 
 
 
  69};
  70
  71/* ixgbevf_pci_tbl - PCI Device ID Table
  72 *
  73 * Wildcard entries (PCI_ANY_ID) should come last
  74 * Last entry must be all 0s
  75 *
  76 * { Vendor ID, Device ID, SubVendor ID, SubDevice ID,
  77 *   Class, Class Mask, private data (not used) }
  78 */
  79static const struct pci_device_id ixgbevf_pci_tbl[] = {
  80	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_82599_VF), board_82599_vf },
 
  81	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X540_VF), board_X540_vf },
 
  82	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550_VF), board_X550_vf },
 
  83	{PCI_VDEVICE(INTEL, IXGBE_DEV_ID_X550EM_X_VF), board_X550EM_x_vf },
 
 
  84	/* required last entry */
  85	{0, }
  86};
  87MODULE_DEVICE_TABLE(pci, ixgbevf_pci_tbl);
  88
  89MODULE_AUTHOR("Intel Corporation, <linux.nics@intel.com>");
  90MODULE_DESCRIPTION("Intel(R) 10 Gigabit Virtual Function Network Driver");
  91MODULE_LICENSE("GPL");
  92MODULE_VERSION(DRV_VERSION);
  93
  94#define DEFAULT_MSG_ENABLE (NETIF_MSG_DRV|NETIF_MSG_PROBE|NETIF_MSG_LINK)
  95static int debug = -1;
  96module_param(debug, int, 0);
  97MODULE_PARM_DESC(debug, "Debug level (0=none,...,16=all)");
  98
  99static struct workqueue_struct *ixgbevf_wq;
 100
 101static void ixgbevf_service_event_schedule(struct ixgbevf_adapter *adapter)
 102{
 103	if (!test_bit(__IXGBEVF_DOWN, &adapter->state) &&
 104	    !test_bit(__IXGBEVF_REMOVING, &adapter->state) &&
 105	    !test_and_set_bit(__IXGBEVF_SERVICE_SCHED, &adapter->state))
 106		queue_work(ixgbevf_wq, &adapter->service_task);
 107}
 108
 109static void ixgbevf_service_event_complete(struct ixgbevf_adapter *adapter)
 110{
 111	BUG_ON(!test_bit(__IXGBEVF_SERVICE_SCHED, &adapter->state));
 112
 113	/* flush memory to make sure state is correct before next watchdog */
 114	smp_mb__before_atomic();
 115	clear_bit(__IXGBEVF_SERVICE_SCHED, &adapter->state);
 116}
 117
 118/* forward decls */
 119static void ixgbevf_queue_reset_subtask(struct ixgbevf_adapter *adapter);
 120static void ixgbevf_set_itr(struct ixgbevf_q_vector *q_vector);
 121static void ixgbevf_free_all_rx_resources(struct ixgbevf_adapter *adapter);
 
 
 
 122
 123static void ixgbevf_remove_adapter(struct ixgbe_hw *hw)
 124{
 125	struct ixgbevf_adapter *adapter = hw->back;
 126
 127	if (!hw->hw_addr)
 128		return;
 129	hw->hw_addr = NULL;
 130	dev_err(&adapter->pdev->dev, "Adapter removed\n");
 131	if (test_bit(__IXGBEVF_SERVICE_INITED, &adapter->state))
 132		ixgbevf_service_event_schedule(adapter);
 133}
 134
 135static void ixgbevf_check_remove(struct ixgbe_hw *hw, u32 reg)
 136{
 137	u32 value;
 138
 139	/* The following check not only optimizes a bit by not
 140	 * performing a read on the status register when the
 141	 * register just read was a status register read that
 142	 * returned IXGBE_FAILED_READ_REG. It also blocks any
 143	 * potential recursion.
 144	 */
 145	if (reg == IXGBE_VFSTATUS) {
 146		ixgbevf_remove_adapter(hw);
 147		return;
 148	}
 149	value = ixgbevf_read_reg(hw, IXGBE_VFSTATUS);
 150	if (value == IXGBE_FAILED_READ_REG)
 151		ixgbevf_remove_adapter(hw);
 152}
 153
 154u32 ixgbevf_read_reg(struct ixgbe_hw *hw, u32 reg)
 155{
 156	u8 __iomem *reg_addr = ACCESS_ONCE(hw->hw_addr);
 157	u32 value;
 158
 159	if (IXGBE_REMOVED(reg_addr))
 160		return IXGBE_FAILED_READ_REG;
 161	value = readl(reg_addr + reg);
 162	if (unlikely(value == IXGBE_FAILED_READ_REG))
 163		ixgbevf_check_remove(hw, reg);
 164	return value;
 165}
 166
 167/**
 168 * ixgbevf_set_ivar - set IVAR registers - maps interrupt causes to vectors
 169 * @adapter: pointer to adapter struct
 170 * @direction: 0 for Rx, 1 for Tx, -1 for other causes
 171 * @queue: queue to map the corresponding interrupt to
 172 * @msix_vector: the vector to map to the corresponding queue
 173 **/
 174static void ixgbevf_set_ivar(struct ixgbevf_adapter *adapter, s8 direction,
 175			     u8 queue, u8 msix_vector)
 176{
 177	u32 ivar, index;
 178	struct ixgbe_hw *hw = &adapter->hw;
 179
 180	if (direction == -1) {
 181		/* other causes */
 182		msix_vector |= IXGBE_IVAR_ALLOC_VAL;
 183		ivar = IXGBE_READ_REG(hw, IXGBE_VTIVAR_MISC);
 184		ivar &= ~0xFF;
 185		ivar |= msix_vector;
 186		IXGBE_WRITE_REG(hw, IXGBE_VTIVAR_MISC, ivar);
 187	} else {
 188		/* Tx or Rx causes */
 189		msix_vector |= IXGBE_IVAR_ALLOC_VAL;
 190		index = ((16 * (queue & 1)) + (8 * direction));
 191		ivar = IXGBE_READ_REG(hw, IXGBE_VTIVAR(queue >> 1));
 192		ivar &= ~(0xFF << index);
 193		ivar |= (msix_vector << index);
 194		IXGBE_WRITE_REG(hw, IXGBE_VTIVAR(queue >> 1), ivar);
 195	}
 196}
 197
 198static void ixgbevf_unmap_and_free_tx_resource(struct ixgbevf_ring *tx_ring,
 199					struct ixgbevf_tx_buffer *tx_buffer)
 200{
 201	if (tx_buffer->skb) {
 202		dev_kfree_skb_any(tx_buffer->skb);
 203		if (dma_unmap_len(tx_buffer, len))
 204			dma_unmap_single(tx_ring->dev,
 205					 dma_unmap_addr(tx_buffer, dma),
 206					 dma_unmap_len(tx_buffer, len),
 207					 DMA_TO_DEVICE);
 208	} else if (dma_unmap_len(tx_buffer, len)) {
 209		dma_unmap_page(tx_ring->dev,
 210			       dma_unmap_addr(tx_buffer, dma),
 211			       dma_unmap_len(tx_buffer, len),
 212			       DMA_TO_DEVICE);
 213	}
 214	tx_buffer->next_to_watch = NULL;
 215	tx_buffer->skb = NULL;
 216	dma_unmap_len_set(tx_buffer, len, 0);
 217	/* tx_buffer must be completely set up in the transmit path */
 218}
 219
 220static u64 ixgbevf_get_tx_completed(struct ixgbevf_ring *ring)
 221{
 222	return ring->stats.packets;
 223}
 224
 225static u32 ixgbevf_get_tx_pending(struct ixgbevf_ring *ring)
 226{
 227	struct ixgbevf_adapter *adapter = netdev_priv(ring->netdev);
 228	struct ixgbe_hw *hw = &adapter->hw;
 229
 230	u32 head = IXGBE_READ_REG(hw, IXGBE_VFTDH(ring->reg_idx));
 231	u32 tail = IXGBE_READ_REG(hw, IXGBE_VFTDT(ring->reg_idx));
 232
 233	if (head != tail)
 234		return (head < tail) ?
 235			tail - head : (tail + ring->count - head);
 236
 237	return 0;
 238}
 239
 240static inline bool ixgbevf_check_tx_hang(struct ixgbevf_ring *tx_ring)
 241{
 242	u32 tx_done = ixgbevf_get_tx_completed(tx_ring);
 243	u32 tx_done_old = tx_ring->tx_stats.tx_done_old;
 244	u32 tx_pending = ixgbevf_get_tx_pending(tx_ring);
 245
 246	clear_check_for_tx_hang(tx_ring);
 247
 248	/* Check for a hung queue, but be thorough. This verifies
 249	 * that a transmit has been completed since the previous
 250	 * check AND there is at least one packet pending. The
 251	 * ARMED bit is set to indicate a potential hang.
 252	 */
 253	if ((tx_done_old == tx_done) && tx_pending) {
 254		/* make sure it is true for two checks in a row */
 255		return test_and_set_bit(__IXGBEVF_HANG_CHECK_ARMED,
 256					&tx_ring->state);
 257	}
 258	/* reset the countdown */
 259	clear_bit(__IXGBEVF_HANG_CHECK_ARMED, &tx_ring->state);
 260
 261	/* update completed stats and continue */
 262	tx_ring->tx_stats.tx_done_old = tx_done;
 263
 264	return false;
 265}
 266
 267static void ixgbevf_tx_timeout_reset(struct ixgbevf_adapter *adapter)
 268{
 269	/* Do the reset outside of interrupt context */
 270	if (!test_bit(__IXGBEVF_DOWN, &adapter->state)) {
 271		adapter->flags |= IXGBEVF_FLAG_RESET_REQUESTED;
 272		ixgbevf_service_event_schedule(adapter);
 273	}
 274}
 275
 276/**
 277 * ixgbevf_tx_timeout - Respond to a Tx Hang
 278 * @netdev: network interface device structure
 
 279 **/
 280static void ixgbevf_tx_timeout(struct net_device *netdev)
 281{
 282	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
 283
 284	ixgbevf_tx_timeout_reset(adapter);
 285}
 286
 287/**
 288 * ixgbevf_clean_tx_irq - Reclaim resources after transmit completes
 289 * @q_vector: board private structure
 290 * @tx_ring: tx ring to clean
 
 291 **/
 292static bool ixgbevf_clean_tx_irq(struct ixgbevf_q_vector *q_vector,
 293				 struct ixgbevf_ring *tx_ring)
 294{
 295	struct ixgbevf_adapter *adapter = q_vector->adapter;
 296	struct ixgbevf_tx_buffer *tx_buffer;
 297	union ixgbe_adv_tx_desc *tx_desc;
 298	unsigned int total_bytes = 0, total_packets = 0;
 299	unsigned int budget = tx_ring->count / 2;
 300	unsigned int i = tx_ring->next_to_clean;
 301
 302	if (test_bit(__IXGBEVF_DOWN, &adapter->state))
 303		return true;
 304
 305	tx_buffer = &tx_ring->tx_buffer_info[i];
 306	tx_desc = IXGBEVF_TX_DESC(tx_ring, i);
 307	i -= tx_ring->count;
 308
 309	do {
 310		union ixgbe_adv_tx_desc *eop_desc = tx_buffer->next_to_watch;
 311
 312		/* if next_to_watch is not set then there is no work pending */
 313		if (!eop_desc)
 314			break;
 315
 316		/* prevent any other reads prior to eop_desc */
 317		read_barrier_depends();
 318
 319		/* if DD is not set pending work has not been completed */
 320		if (!(eop_desc->wb.status & cpu_to_le32(IXGBE_TXD_STAT_DD)))
 321			break;
 322
 323		/* clear next_to_watch to prevent false hangs */
 324		tx_buffer->next_to_watch = NULL;
 325
 326		/* update the statistics for this packet */
 327		total_bytes += tx_buffer->bytecount;
 328		total_packets += tx_buffer->gso_segs;
 
 
 329
 330		/* free the skb */
 331		dev_kfree_skb_any(tx_buffer->skb);
 
 
 
 332
 333		/* unmap skb header data */
 334		dma_unmap_single(tx_ring->dev,
 335				 dma_unmap_addr(tx_buffer, dma),
 336				 dma_unmap_len(tx_buffer, len),
 337				 DMA_TO_DEVICE);
 338
 339		/* clear tx_buffer data */
 340		tx_buffer->skb = NULL;
 341		dma_unmap_len_set(tx_buffer, len, 0);
 342
 343		/* unmap remaining buffers */
 344		while (tx_desc != eop_desc) {
 345			tx_buffer++;
 346			tx_desc++;
 347			i++;
 348			if (unlikely(!i)) {
 349				i -= tx_ring->count;
 350				tx_buffer = tx_ring->tx_buffer_info;
 351				tx_desc = IXGBEVF_TX_DESC(tx_ring, 0);
 352			}
 353
 354			/* unmap any remaining paged data */
 355			if (dma_unmap_len(tx_buffer, len)) {
 356				dma_unmap_page(tx_ring->dev,
 357					       dma_unmap_addr(tx_buffer, dma),
 358					       dma_unmap_len(tx_buffer, len),
 359					       DMA_TO_DEVICE);
 360				dma_unmap_len_set(tx_buffer, len, 0);
 361			}
 362		}
 363
 364		/* move us one more past the eop_desc for start of next pkt */
 365		tx_buffer++;
 366		tx_desc++;
 367		i++;
 368		if (unlikely(!i)) {
 369			i -= tx_ring->count;
 370			tx_buffer = tx_ring->tx_buffer_info;
 371			tx_desc = IXGBEVF_TX_DESC(tx_ring, 0);
 372		}
 373
 374		/* issue prefetch for next Tx descriptor */
 375		prefetch(tx_desc);
 376
 377		/* update budget accounting */
 378		budget--;
 379	} while (likely(budget));
 380
 381	i += tx_ring->count;
 382	tx_ring->next_to_clean = i;
 383	u64_stats_update_begin(&tx_ring->syncp);
 384	tx_ring->stats.bytes += total_bytes;
 385	tx_ring->stats.packets += total_packets;
 386	u64_stats_update_end(&tx_ring->syncp);
 387	q_vector->tx.total_bytes += total_bytes;
 388	q_vector->tx.total_packets += total_packets;
 
 389
 390	if (check_for_tx_hang(tx_ring) && ixgbevf_check_tx_hang(tx_ring)) {
 391		struct ixgbe_hw *hw = &adapter->hw;
 392		union ixgbe_adv_tx_desc *eop_desc;
 393
 394		eop_desc = tx_ring->tx_buffer_info[i].next_to_watch;
 395
 396		pr_err("Detected Tx Unit Hang\n"
 397		       "  Tx Queue             <%d>\n"
 398		       "  TDH, TDT             <%x>, <%x>\n"
 399		       "  next_to_use          <%x>\n"
 400		       "  next_to_clean        <%x>\n"
 401		       "tx_buffer_info[next_to_clean]\n"
 402		       "  next_to_watch        <%p>\n"
 403		       "  eop_desc->wb.status  <%x>\n"
 404		       "  time_stamp           <%lx>\n"
 405		       "  jiffies              <%lx>\n",
 
 406		       tx_ring->queue_index,
 407		       IXGBE_READ_REG(hw, IXGBE_VFTDH(tx_ring->reg_idx)),
 408		       IXGBE_READ_REG(hw, IXGBE_VFTDT(tx_ring->reg_idx)),
 409		       tx_ring->next_to_use, i,
 410		       eop_desc, (eop_desc ? eop_desc->wb.status : 0),
 411		       tx_ring->tx_buffer_info[i].time_stamp, jiffies);
 412
 413		netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);
 
 
 414
 415		/* schedule immediate reset if we believe we hung */
 416		ixgbevf_tx_timeout_reset(adapter);
 417
 418		return true;
 419	}
 420
 
 
 
 421#define TX_WAKE_THRESHOLD (DESC_NEEDED * 2)
 422	if (unlikely(total_packets && netif_carrier_ok(tx_ring->netdev) &&
 423		     (ixgbevf_desc_unused(tx_ring) >= TX_WAKE_THRESHOLD))) {
 424		/* Make sure that anybody stopping the queue after this
 425		 * sees the new next_to_clean.
 426		 */
 427		smp_mb();
 428
 429		if (__netif_subqueue_stopped(tx_ring->netdev,
 430					     tx_ring->queue_index) &&
 431		    !test_bit(__IXGBEVF_DOWN, &adapter->state)) {
 432			netif_wake_subqueue(tx_ring->netdev,
 433					    tx_ring->queue_index);
 434			++tx_ring->tx_stats.restart_queue;
 435		}
 436	}
 437
 438	return !!budget;
 439}
 440
 441/**
 442 * ixgbevf_rx_skb - Helper function to determine proper Rx method
 443 * @q_vector: structure containing interrupt and ring information
 444 * @skb: packet to send up
 445 **/
 446static void ixgbevf_rx_skb(struct ixgbevf_q_vector *q_vector,
 447			   struct sk_buff *skb)
 448{
 449#ifdef CONFIG_NET_RX_BUSY_POLL
 450	skb_mark_napi_id(skb, &q_vector->napi);
 451
 452	if (ixgbevf_qv_busy_polling(q_vector)) {
 453		netif_receive_skb(skb);
 454		/* exit early if we busy polled */
 455		return;
 456	}
 457#endif /* CONFIG_NET_RX_BUSY_POLL */
 458
 459	napi_gro_receive(&q_vector->napi, skb);
 460}
 461
 462#define IXGBE_RSS_L4_TYPES_MASK \
 463	((1ul << IXGBE_RXDADV_RSSTYPE_IPV4_TCP) | \
 464	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV4_UDP) | \
 465	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV6_TCP) | \
 466	 (1ul << IXGBE_RXDADV_RSSTYPE_IPV6_UDP))
 467
 468static inline void ixgbevf_rx_hash(struct ixgbevf_ring *ring,
 469				   union ixgbe_adv_rx_desc *rx_desc,
 470				   struct sk_buff *skb)
 471{
 472	u16 rss_type;
 473
 474	if (!(ring->netdev->features & NETIF_F_RXHASH))
 475		return;
 476
 477	rss_type = le16_to_cpu(rx_desc->wb.lower.lo_dword.hs_rss.pkt_info) &
 478		   IXGBE_RXDADV_RSSTYPE_MASK;
 479
 480	if (!rss_type)
 481		return;
 482
 483	skb_set_hash(skb, le32_to_cpu(rx_desc->wb.lower.hi_dword.rss),
 484		     (IXGBE_RSS_L4_TYPES_MASK & (1ul << rss_type)) ?
 485		     PKT_HASH_TYPE_L4 : PKT_HASH_TYPE_L3);
 486}
 487
 488/**
 489 * ixgbevf_rx_checksum - indicate in skb if hw indicated a good cksum
 490 * @ring: structure containig ring specific data
 491 * @rx_desc: current Rx descriptor being processed
 492 * @skb: skb currently being received and modified
 493 **/
 494static inline void ixgbevf_rx_checksum(struct ixgbevf_ring *ring,
 495				       union ixgbe_adv_rx_desc *rx_desc,
 496				       struct sk_buff *skb)
 497{
 498	skb_checksum_none_assert(skb);
 499
 500	/* Rx csum disabled */
 501	if (!(ring->netdev->features & NETIF_F_RXCSUM))
 502		return;
 503
 504	/* if IP and error */
 505	if (ixgbevf_test_staterr(rx_desc, IXGBE_RXD_STAT_IPCS) &&
 506	    ixgbevf_test_staterr(rx_desc, IXGBE_RXDADV_ERR_IPE)) {
 507		ring->rx_stats.csum_err++;
 508		return;
 509	}
 510
 511	if (!ixgbevf_test_staterr(rx_desc, IXGBE_RXD_STAT_L4CS))
 512		return;
 513
 514	if (ixgbevf_test_staterr(rx_desc, IXGBE_RXDADV_ERR_TCPE)) {
 515		ring->rx_stats.csum_err++;
 516		return;
 517	}
 518
 519	/* It must be a TCP or UDP packet with a valid checksum */
 520	skb->ip_summed = CHECKSUM_UNNECESSARY;
 521}
 522
 523/**
 524 * ixgbevf_process_skb_fields - Populate skb header fields from Rx descriptor
 525 * @rx_ring: rx descriptor ring packet is being transacted on
 526 * @rx_desc: pointer to the EOP Rx descriptor
 527 * @skb: pointer to current skb being populated
 528 *
 529 * This function checks the ring, descriptor, and packet information in
 530 * order to populate the checksum, VLAN, protocol, and other fields within
 531 * the skb.
 532 **/
 533static void ixgbevf_process_skb_fields(struct ixgbevf_ring *rx_ring,
 534				       union ixgbe_adv_rx_desc *rx_desc,
 535				       struct sk_buff *skb)
 536{
 537	ixgbevf_rx_hash(rx_ring, rx_desc, skb);
 538	ixgbevf_rx_checksum(rx_ring, rx_desc, skb);
 539
 540	if (ixgbevf_test_staterr(rx_desc, IXGBE_RXD_STAT_VP)) {
 541		u16 vid = le16_to_cpu(rx_desc->wb.upper.vlan);
 542		unsigned long *active_vlans = netdev_priv(rx_ring->netdev);
 543
 544		if (test_bit(vid & VLAN_VID_MASK, active_vlans))
 545			__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vid);
 546	}
 547
 
 
 
 548	skb->protocol = eth_type_trans(skb, rx_ring->netdev);
 549}
 550
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 551/**
 552 * ixgbevf_is_non_eop - process handling of non-EOP buffers
 553 * @rx_ring: Rx ring being processed
 554 * @rx_desc: Rx descriptor for current buffer
 555 * @skb: current socket buffer containing buffer in progress
 556 *
 557 * This function updates next to clean.  If the buffer is an EOP buffer
 558 * this function exits returning false, otherwise it will place the
 559 * sk_buff in the next buffer to be chained and return true indicating
 560 * that this is in fact a non-EOP buffer.
 561 **/
 562static bool ixgbevf_is_non_eop(struct ixgbevf_ring *rx_ring,
 563			       union ixgbe_adv_rx_desc *rx_desc)
 564{
 565	u32 ntc = rx_ring->next_to_clean + 1;
 566
 567	/* fetch, update, and store next to clean */
 568	ntc = (ntc < rx_ring->count) ? ntc : 0;
 569	rx_ring->next_to_clean = ntc;
 570
 571	prefetch(IXGBEVF_RX_DESC(rx_ring, ntc));
 572
 573	if (likely(ixgbevf_test_staterr(rx_desc, IXGBE_RXD_STAT_EOP)))
 574		return false;
 575
 576	return true;
 577}
 578
 
 
 
 
 
 579static bool ixgbevf_alloc_mapped_page(struct ixgbevf_ring *rx_ring,
 580				      struct ixgbevf_rx_buffer *bi)
 581{
 582	struct page *page = bi->page;
 583	dma_addr_t dma = bi->dma;
 584
 585	/* since we are recycling buffers we should seldom need to alloc */
 586	if (likely(page))
 587		return true;
 588
 589	/* alloc new page for storage */
 590	page = dev_alloc_page();
 591	if (unlikely(!page)) {
 592		rx_ring->rx_stats.alloc_rx_page_failed++;
 593		return false;
 594	}
 595
 596	/* map page for use */
 597	dma = dma_map_page(rx_ring->dev, page, 0,
 598			   PAGE_SIZE, DMA_FROM_DEVICE);
 
 599
 600	/* if mapping failed free memory back to system since
 601	 * there isn't much point in holding memory we can't use
 602	 */
 603	if (dma_mapping_error(rx_ring->dev, dma)) {
 604		__free_page(page);
 605
 606		rx_ring->rx_stats.alloc_rx_buff_failed++;
 607		return false;
 608	}
 609
 610	bi->dma = dma;
 611	bi->page = page;
 612	bi->page_offset = 0;
 
 
 613
 614	return true;
 615}
 616
 617/**
 618 * ixgbevf_alloc_rx_buffers - Replace used receive buffers; packet split
 619 * @rx_ring: rx descriptor ring (for a specific queue) to setup buffers on
 620 * @cleaned_count: number of buffers to replace
 621 **/
 622static void ixgbevf_alloc_rx_buffers(struct ixgbevf_ring *rx_ring,
 623				     u16 cleaned_count)
 624{
 625	union ixgbe_adv_rx_desc *rx_desc;
 626	struct ixgbevf_rx_buffer *bi;
 627	unsigned int i = rx_ring->next_to_use;
 628
 629	/* nothing to do or no valid netdev defined */
 630	if (!cleaned_count || !rx_ring->netdev)
 631		return;
 632
 633	rx_desc = IXGBEVF_RX_DESC(rx_ring, i);
 634	bi = &rx_ring->rx_buffer_info[i];
 635	i -= rx_ring->count;
 636
 637	do {
 638		if (!ixgbevf_alloc_mapped_page(rx_ring, bi))
 639			break;
 640
 
 
 
 
 
 
 641		/* Refresh the desc even if pkt_addr didn't change
 642		 * because each write-back erases this info.
 643		 */
 644		rx_desc->read.pkt_addr = cpu_to_le64(bi->dma + bi->page_offset);
 645
 646		rx_desc++;
 647		bi++;
 648		i++;
 649		if (unlikely(!i)) {
 650			rx_desc = IXGBEVF_RX_DESC(rx_ring, 0);
 651			bi = rx_ring->rx_buffer_info;
 652			i -= rx_ring->count;
 653		}
 654
 655		/* clear the hdr_addr for the next_to_use descriptor */
 656		rx_desc->read.hdr_addr = 0;
 657
 658		cleaned_count--;
 659	} while (cleaned_count);
 660
 661	i += rx_ring->count;
 662
 663	if (rx_ring->next_to_use != i) {
 664		/* record the next descriptor to use */
 665		rx_ring->next_to_use = i;
 666
 667		/* update next to alloc since we have filled the ring */
 668		rx_ring->next_to_alloc = i;
 669
 670		/* Force memory writes to complete before letting h/w
 671		 * know there are new descriptors to fetch.  (Only
 672		 * applicable for weak-ordered memory model archs,
 673		 * such as IA-64).
 674		 */
 675		wmb();
 676		ixgbevf_write_tail(rx_ring, i);
 677	}
 678}
 679
 680/**
 681 * ixgbevf_cleanup_headers - Correct corrupted or empty headers
 682 * @rx_ring: rx descriptor ring packet is being transacted on
 683 * @rx_desc: pointer to the EOP Rx descriptor
 684 * @skb: pointer to current skb being fixed
 685 *
 686 * Check for corrupted packet headers caused by senders on the local L2
 687 * embedded NIC switch not setting up their Tx Descriptors right.  These
 688 * should be very rare.
 689 *
 690 * Also address the case where we are pulling data in on pages only
 691 * and as such no data is present in the skb header.
 692 *
 693 * In addition if skb is not at least 60 bytes we need to pad it so that
 694 * it is large enough to qualify as a valid Ethernet frame.
 695 *
 696 * Returns true if an error was encountered and skb was freed.
 697 **/
 698static bool ixgbevf_cleanup_headers(struct ixgbevf_ring *rx_ring,
 699				    union ixgbe_adv_rx_desc *rx_desc,
 700				    struct sk_buff *skb)
 701{
 
 
 
 
 702	/* verify that the packet does not have any known errors */
 703	if (unlikely(ixgbevf_test_staterr(rx_desc,
 704					  IXGBE_RXDADV_ERR_FRAME_ERR_MASK))) {
 705		struct net_device *netdev = rx_ring->netdev;
 706
 707		if (!(netdev->features & NETIF_F_RXALL)) {
 708			dev_kfree_skb_any(skb);
 709			return true;
 710		}
 711	}
 712
 713	/* if eth_skb_pad returns an error the skb was freed */
 714	if (eth_skb_pad(skb))
 715		return true;
 716
 717	return false;
 718}
 719
 720/**
 721 * ixgbevf_reuse_rx_page - page flip buffer and store it back on the ring
 722 * @rx_ring: rx descriptor ring to store buffers on
 723 * @old_buff: donor buffer to have page reused
 724 *
 725 * Synchronizes page for reuse by the adapter
 726 **/
 727static void ixgbevf_reuse_rx_page(struct ixgbevf_ring *rx_ring,
 728				  struct ixgbevf_rx_buffer *old_buff)
 729{
 730	struct ixgbevf_rx_buffer *new_buff;
 731	u16 nta = rx_ring->next_to_alloc;
 732
 733	new_buff = &rx_ring->rx_buffer_info[nta];
 734
 735	/* update, and store next to alloc */
 736	nta++;
 737	rx_ring->next_to_alloc = (nta < rx_ring->count) ? nta : 0;
 738
 739	/* transfer page from old buffer to new buffer */
 740	new_buff->page = old_buff->page;
 741	new_buff->dma = old_buff->dma;
 742	new_buff->page_offset = old_buff->page_offset;
 743
 744	/* sync the buffer for use by the device */
 745	dma_sync_single_range_for_device(rx_ring->dev, new_buff->dma,
 746					 new_buff->page_offset,
 747					 IXGBEVF_RX_BUFSZ,
 748					 DMA_FROM_DEVICE);
 749}
 750
 751static inline bool ixgbevf_page_is_reserved(struct page *page)
 752{
 753	return (page_to_nid(page) != numa_mem_id()) || page_is_pfmemalloc(page);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 754}
 755
 756/**
 757 * ixgbevf_add_rx_frag - Add contents of Rx buffer to sk_buff
 758 * @rx_ring: rx descriptor ring to transact packets on
 759 * @rx_buffer: buffer containing page to add
 760 * @rx_desc: descriptor containing length of buffer written by hardware
 761 * @skb: sk_buff to place the data into
 
 762 *
 763 * This function will add the data contained in rx_buffer->page to the skb.
 764 * This is done either through a direct copy if the data in the buffer is
 765 * less than the skb header size, otherwise it will just attach the page as
 766 * a frag to the skb.
 767 *
 768 * The function will then update the page offset if necessary and return
 769 * true if the buffer can be reused by the adapter.
 770 **/
 771static bool ixgbevf_add_rx_frag(struct ixgbevf_ring *rx_ring,
 772				struct ixgbevf_rx_buffer *rx_buffer,
 773				union ixgbe_adv_rx_desc *rx_desc,
 774				struct sk_buff *skb)
 775{
 776	struct page *page = rx_buffer->page;
 777	unsigned char *va = page_address(page) + rx_buffer->page_offset;
 778	unsigned int size = le16_to_cpu(rx_desc->wb.upper.length);
 779#if (PAGE_SIZE < 8192)
 780	unsigned int truesize = IXGBEVF_RX_BUFSZ;
 
 
 
 
 
 
 
 
 
 781#else
 782	unsigned int truesize = ALIGN(size, L1_CACHE_BYTES);
 783#endif
 784	unsigned int pull_len;
 785
 786	if (unlikely(skb_is_nonlinear(skb)))
 787		goto add_tail_frag;
 
 
 
 
 
 
 
 
 
 
 
 
 
 788
 789	if (likely(size <= IXGBEVF_RX_HDR_SIZE)) {
 790		memcpy(__skb_put(skb, size), va, ALIGN(size, sizeof(long)));
 791
 792		/* page is not reserved, we can reuse buffer as is */
 793		if (likely(!ixgbevf_page_is_reserved(page)))
 794			return true;
 
 
 
 
 
 
 
 
 
 
 
 795
 796		/* this page cannot be reused so discard it */
 797		put_page(page);
 798		return false;
 799	}
 800
 801	/* we need the header to contain the greater of either ETH_HLEN or
 802	 * 60 bytes if the skb->len is less than 60 for skb_pad.
 803	 */
 804	pull_len = eth_get_headlen(va, IXGBEVF_RX_HDR_SIZE);
 
 805
 806	/* align pull length to size of long to optimize memcpy performance */
 807	memcpy(__skb_put(skb, pull_len), va, ALIGN(pull_len, sizeof(long)));
 
 808
 809	/* update all of the pointers */
 810	va += pull_len;
 811	size -= pull_len;
 
 
 
 
 
 
 
 
 
 
 
 
 812
 813add_tail_frag:
 814	skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, page,
 815			(unsigned long)va & ~PAGE_MASK, size, truesize);
 816
 817	/* avoid re-using remote pages */
 818	if (unlikely(ixgbevf_page_is_reserved(page)))
 819		return false;
 
 
 
 
 820
 
 
 
 
 
 
 821#if (PAGE_SIZE < 8192)
 822	/* if we are only owner of page we can reuse it */
 823	if (unlikely(page_count(page) != 1))
 824		return false;
 
 
 
 
 
 
 
 
 
 
 
 825
 826	/* flip page offset to other buffer */
 827	rx_buffer->page_offset ^= IXGBEVF_RX_BUFSZ;
 
 
 
 
 
 
 
 
 828
 
 
 
 829#else
 830	/* move offset up to the next cache line */
 831	rx_buffer->page_offset += truesize;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 832
 833	if (rx_buffer->page_offset > (PAGE_SIZE - IXGBEVF_RX_BUFSZ))
 834		return false;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 835
 836#endif
 837	/* Even if we own the page, we are not allowed to use atomic_set()
 838	 * This would break get_page_unless_zero() users.
 839	 */
 840	page_ref_inc(page);
 
 
 
 841
 842	return true;
 843}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 844
 845static struct sk_buff *ixgbevf_fetch_rx_buffer(struct ixgbevf_ring *rx_ring,
 846					       union ixgbe_adv_rx_desc *rx_desc,
 847					       struct sk_buff *skb)
 848{
 849	struct ixgbevf_rx_buffer *rx_buffer;
 850	struct page *page;
 851
 852	rx_buffer = &rx_ring->rx_buffer_info[rx_ring->next_to_clean];
 853	page = rx_buffer->page;
 854	prefetchw(page);
 855
 856	if (likely(!skb)) {
 857		void *page_addr = page_address(page) +
 858				  rx_buffer->page_offset;
 859
 860		/* prefetch first cache line of first page */
 861		prefetch(page_addr);
 862#if L1_CACHE_BYTES < 128
 863		prefetch(page_addr + L1_CACHE_BYTES);
 864#endif
 865
 866		/* allocate a skb to store the frags */
 867		skb = netdev_alloc_skb_ip_align(rx_ring->netdev,
 868						IXGBEVF_RX_HDR_SIZE);
 869		if (unlikely(!skb)) {
 870			rx_ring->rx_stats.alloc_rx_buff_failed++;
 871			return NULL;
 872		}
 
 873
 874		/* we will be copying header into skb->data in
 875		 * pskb_may_pull so it is in our interest to prefetch
 876		 * it now to avoid a possible cache miss
 877		 */
 878		prefetchw(skb->data);
 879	}
 880
 881	/* we are reusing so sync this buffer for CPU use */
 882	dma_sync_single_range_for_cpu(rx_ring->dev,
 883				      rx_buffer->dma,
 884				      rx_buffer->page_offset,
 885				      IXGBEVF_RX_BUFSZ,
 886				      DMA_FROM_DEVICE);
 887
 888	/* pull page into skb */
 889	if (ixgbevf_add_rx_frag(rx_ring, rx_buffer, rx_desc, skb)) {
 890		/* hand second half of page back to the ring */
 891		ixgbevf_reuse_rx_page(rx_ring, rx_buffer);
 892	} else {
 893		/* we are not reusing the buffer so unmap it */
 894		dma_unmap_page(rx_ring->dev, rx_buffer->dma,
 895			       PAGE_SIZE, DMA_FROM_DEVICE);
 
 
 
 
 
 
 
 
 
 
 
 
 896	}
 
 
 
 897
 898	/* clear contents of buffer_info */
 899	rx_buffer->dma = 0;
 900	rx_buffer->page = NULL;
 
 901
 902	return skb;
 
 
 
 
 
 
 
 
 903}
 904
 905static inline void ixgbevf_irq_enable_queues(struct ixgbevf_adapter *adapter,
 906					     u32 qmask)
 
 907{
 908	struct ixgbe_hw *hw = &adapter->hw;
 909
 910	IXGBE_WRITE_REG(hw, IXGBE_VTEIMS, qmask);
 
 
 
 
 911}
 912
 913static int ixgbevf_clean_rx_irq(struct ixgbevf_q_vector *q_vector,
 914				struct ixgbevf_ring *rx_ring,
 915				int budget)
 916{
 917	unsigned int total_rx_bytes = 0, total_rx_packets = 0;
 
 918	u16 cleaned_count = ixgbevf_desc_unused(rx_ring);
 919	struct sk_buff *skb = rx_ring->skb;
 
 
 
 
 
 
 
 
 920
 921	while (likely(total_rx_packets < budget)) {
 
 922		union ixgbe_adv_rx_desc *rx_desc;
 
 923
 924		/* return some buffers to hardware, one at a time is too slow */
 925		if (cleaned_count >= IXGBEVF_RX_BUFFER_WRITE) {
 926			ixgbevf_alloc_rx_buffers(rx_ring, cleaned_count);
 927			cleaned_count = 0;
 928		}
 929
 930		rx_desc = IXGBEVF_RX_DESC(rx_ring, rx_ring->next_to_clean);
 931
 932		if (!ixgbevf_test_staterr(rx_desc, IXGBE_RXD_STAT_DD))
 933			break;
 934
 935		/* This memory barrier is needed to keep us from reading
 936		 * any other fields out of the rx_desc until we know the
 937		 * RXD_STAT_DD bit is set
 938		 */
 939		rmb();
 940
 
 
 941		/* retrieve a buffer from the ring */
 942		skb = ixgbevf_fetch_rx_buffer(rx_ring, rx_desc, skb);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 943
 944		/* exit if we failed to retrieve a buffer */
 945		if (!skb)
 
 
 946			break;
 
 947
 
 948		cleaned_count++;
 949
 950		/* fetch next buffer in frame if non-eop */
 951		if (ixgbevf_is_non_eop(rx_ring, rx_desc))
 952			continue;
 953
 954		/* verify the packet layout is correct */
 955		if (ixgbevf_cleanup_headers(rx_ring, rx_desc, skb)) {
 956			skb = NULL;
 957			continue;
 958		}
 959
 960		/* probably a little skewed due to removing CRC */
 961		total_rx_bytes += skb->len;
 962
 963		/* Workaround hardware that can't do proper VEPA multicast
 964		 * source pruning.
 965		 */
 966		if ((skb->pkt_type == PACKET_BROADCAST ||
 967		     skb->pkt_type == PACKET_MULTICAST) &&
 968		    ether_addr_equal(rx_ring->netdev->dev_addr,
 969				     eth_hdr(skb)->h_source)) {
 970			dev_kfree_skb_irq(skb);
 971			continue;
 972		}
 973
 974		/* populate checksum, VLAN, and protocol */
 975		ixgbevf_process_skb_fields(rx_ring, rx_desc, skb);
 976
 977		ixgbevf_rx_skb(q_vector, skb);
 978
 979		/* reset skb pointer */
 980		skb = NULL;
 981
 982		/* update budget accounting */
 983		total_rx_packets++;
 984	}
 985
 986	/* place incomplete frames back on ring for completion */
 987	rx_ring->skb = skb;
 988
 
 
 
 
 
 
 
 
 
 
 
 989	u64_stats_update_begin(&rx_ring->syncp);
 990	rx_ring->stats.packets += total_rx_packets;
 991	rx_ring->stats.bytes += total_rx_bytes;
 992	u64_stats_update_end(&rx_ring->syncp);
 993	q_vector->rx.total_packets += total_rx_packets;
 994	q_vector->rx.total_bytes += total_rx_bytes;
 995
 996	return total_rx_packets;
 997}
 998
 999/**
1000 * ixgbevf_poll - NAPI polling calback
1001 * @napi: napi struct with our devices info in it
1002 * @budget: amount of work driver is allowed to do this pass, in packets
1003 *
1004 * This function will clean more than one or more rings associated with a
1005 * q_vector.
1006 **/
1007static int ixgbevf_poll(struct napi_struct *napi, int budget)
1008{
1009	struct ixgbevf_q_vector *q_vector =
1010		container_of(napi, struct ixgbevf_q_vector, napi);
1011	struct ixgbevf_adapter *adapter = q_vector->adapter;
1012	struct ixgbevf_ring *ring;
1013	int per_ring_budget, work_done = 0;
1014	bool clean_complete = true;
1015
1016	ixgbevf_for_each_ring(ring, q_vector->tx)
1017		clean_complete &= ixgbevf_clean_tx_irq(q_vector, ring);
 
 
1018
1019	if (budget <= 0)
1020		return budget;
1021#ifdef CONFIG_NET_RX_BUSY_POLL
1022	if (!ixgbevf_qv_lock_napi(q_vector))
1023		return budget;
1024#endif
1025
1026	/* attempt to distribute budget to each queue fairly, but don't allow
1027	 * the budget to go below 1 because we'll exit polling
1028	 */
1029	if (q_vector->rx.count > 1)
1030		per_ring_budget = max(budget/q_vector->rx.count, 1);
1031	else
1032		per_ring_budget = budget;
1033
1034	ixgbevf_for_each_ring(ring, q_vector->rx) {
1035		int cleaned = ixgbevf_clean_rx_irq(q_vector, ring,
1036						   per_ring_budget);
1037		work_done += cleaned;
1038		clean_complete &= (cleaned < per_ring_budget);
 
1039	}
1040
1041#ifdef CONFIG_NET_RX_BUSY_POLL
1042	ixgbevf_qv_unlock_napi(q_vector);
1043#endif
1044
1045	/* If all work not completed, return budget and keep polling */
1046	if (!clean_complete)
1047		return budget;
1048	/* all work done, exit the polling mode */
1049	napi_complete_done(napi, work_done);
1050	if (adapter->rx_itr_setting == 1)
1051		ixgbevf_set_itr(q_vector);
1052	if (!test_bit(__IXGBEVF_DOWN, &adapter->state) &&
1053	    !test_bit(__IXGBEVF_REMOVING, &adapter->state))
1054		ixgbevf_irq_enable_queues(adapter,
1055					  1 << q_vector->v_idx);
1056
1057	return 0;
 
 
 
 
 
 
 
 
 
 
 
 
1058}
1059
1060/**
1061 * ixgbevf_write_eitr - write VTEITR register in hardware specific way
1062 * @q_vector: structure containing interrupt and ring information
1063 **/
1064void ixgbevf_write_eitr(struct ixgbevf_q_vector *q_vector)
1065{
1066	struct ixgbevf_adapter *adapter = q_vector->adapter;
1067	struct ixgbe_hw *hw = &adapter->hw;
1068	int v_idx = q_vector->v_idx;
1069	u32 itr_reg = q_vector->itr & IXGBE_MAX_EITR;
1070
1071	/* set the WDIS bit to not clear the timer bits and cause an
1072	 * immediate assertion of the interrupt
1073	 */
1074	itr_reg |= IXGBE_EITR_CNT_WDIS;
1075
1076	IXGBE_WRITE_REG(hw, IXGBE_VTEITR(v_idx), itr_reg);
1077}
1078
1079#ifdef CONFIG_NET_RX_BUSY_POLL
1080/* must be called with local_bh_disable()d */
1081static int ixgbevf_busy_poll_recv(struct napi_struct *napi)
1082{
1083	struct ixgbevf_q_vector *q_vector =
1084			container_of(napi, struct ixgbevf_q_vector, napi);
1085	struct ixgbevf_adapter *adapter = q_vector->adapter;
1086	struct ixgbevf_ring  *ring;
1087	int found = 0;
1088
1089	if (test_bit(__IXGBEVF_DOWN, &adapter->state))
1090		return LL_FLUSH_FAILED;
1091
1092	if (!ixgbevf_qv_lock_poll(q_vector))
1093		return LL_FLUSH_BUSY;
1094
1095	ixgbevf_for_each_ring(ring, q_vector->rx) {
1096		found = ixgbevf_clean_rx_irq(q_vector, ring, 4);
1097#ifdef BP_EXTENDED_STATS
1098		if (found)
1099			ring->stats.cleaned += found;
1100		else
1101			ring->stats.misses++;
1102#endif
1103		if (found)
1104			break;
1105	}
1106
1107	ixgbevf_qv_unlock_poll(q_vector);
1108
1109	return found;
1110}
1111#endif /* CONFIG_NET_RX_BUSY_POLL */
1112
1113/**
1114 * ixgbevf_configure_msix - Configure MSI-X hardware
1115 * @adapter: board private structure
1116 *
1117 * ixgbevf_configure_msix sets up the hardware to properly generate MSI-X
1118 * interrupts.
1119 **/
1120static void ixgbevf_configure_msix(struct ixgbevf_adapter *adapter)
1121{
1122	struct ixgbevf_q_vector *q_vector;
1123	int q_vectors, v_idx;
1124
1125	q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
1126	adapter->eims_enable_mask = 0;
1127
1128	/* Populate the IVAR table and set the ITR values to the
1129	 * corresponding register.
1130	 */
1131	for (v_idx = 0; v_idx < q_vectors; v_idx++) {
1132		struct ixgbevf_ring *ring;
1133
1134		q_vector = adapter->q_vector[v_idx];
1135
1136		ixgbevf_for_each_ring(ring, q_vector->rx)
1137			ixgbevf_set_ivar(adapter, 0, ring->reg_idx, v_idx);
1138
1139		ixgbevf_for_each_ring(ring, q_vector->tx)
1140			ixgbevf_set_ivar(adapter, 1, ring->reg_idx, v_idx);
1141
1142		if (q_vector->tx.ring && !q_vector->rx.ring) {
1143			/* Tx only vector */
1144			if (adapter->tx_itr_setting == 1)
1145				q_vector->itr = IXGBE_12K_ITR;
1146			else
1147				q_vector->itr = adapter->tx_itr_setting;
1148		} else {
1149			/* Rx or Rx/Tx vector */
1150			if (adapter->rx_itr_setting == 1)
1151				q_vector->itr = IXGBE_20K_ITR;
1152			else
1153				q_vector->itr = adapter->rx_itr_setting;
1154		}
1155
1156		/* add q_vector eims value to global eims_enable_mask */
1157		adapter->eims_enable_mask |= 1 << v_idx;
1158
1159		ixgbevf_write_eitr(q_vector);
1160	}
1161
1162	ixgbevf_set_ivar(adapter, -1, 1, v_idx);
1163	/* setup eims_other and add value to global eims_enable_mask */
1164	adapter->eims_other = 1 << v_idx;
1165	adapter->eims_enable_mask |= adapter->eims_other;
1166}
1167
1168enum latency_range {
1169	lowest_latency = 0,
1170	low_latency = 1,
1171	bulk_latency = 2,
1172	latency_invalid = 255
1173};
1174
1175/**
1176 * ixgbevf_update_itr - update the dynamic ITR value based on statistics
1177 * @q_vector: structure containing interrupt and ring information
1178 * @ring_container: structure containing ring performance data
1179 *
1180 * Stores a new ITR value based on packets and byte
1181 * counts during the last interrupt.  The advantage of per interrupt
1182 * computation is faster updates and more accurate ITR for the current
1183 * traffic pattern.  Constants in this function were computed
1184 * based on theoretical maximum wire speed and thresholds were set based
1185 * on testing data as well as attempting to minimize response time
1186 * while increasing bulk throughput.
1187 **/
1188static void ixgbevf_update_itr(struct ixgbevf_q_vector *q_vector,
1189			       struct ixgbevf_ring_container *ring_container)
1190{
1191	int bytes = ring_container->total_bytes;
1192	int packets = ring_container->total_packets;
1193	u32 timepassed_us;
1194	u64 bytes_perint;
1195	u8 itr_setting = ring_container->itr;
1196
1197	if (packets == 0)
1198		return;
1199
1200	/* simple throttle rate management
1201	 *    0-20MB/s lowest (100000 ints/s)
1202	 *   20-100MB/s low   (20000 ints/s)
1203	 *  100-1249MB/s bulk (12000 ints/s)
1204	 */
1205	/* what was last interrupt timeslice? */
1206	timepassed_us = q_vector->itr >> 2;
 
 
 
1207	bytes_perint = bytes / timepassed_us; /* bytes/usec */
1208
1209	switch (itr_setting) {
1210	case lowest_latency:
1211		if (bytes_perint > 10)
1212			itr_setting = low_latency;
1213		break;
1214	case low_latency:
1215		if (bytes_perint > 20)
1216			itr_setting = bulk_latency;
1217		else if (bytes_perint <= 10)
1218			itr_setting = lowest_latency;
1219		break;
1220	case bulk_latency:
1221		if (bytes_perint <= 20)
1222			itr_setting = low_latency;
1223		break;
1224	}
1225
1226	/* clear work counters since we have the values we need */
1227	ring_container->total_bytes = 0;
1228	ring_container->total_packets = 0;
1229
1230	/* write updated itr to ring container */
1231	ring_container->itr = itr_setting;
1232}
1233
1234static void ixgbevf_set_itr(struct ixgbevf_q_vector *q_vector)
1235{
1236	u32 new_itr = q_vector->itr;
1237	u8 current_itr;
1238
1239	ixgbevf_update_itr(q_vector, &q_vector->tx);
1240	ixgbevf_update_itr(q_vector, &q_vector->rx);
1241
1242	current_itr = max(q_vector->rx.itr, q_vector->tx.itr);
1243
1244	switch (current_itr) {
1245	/* counts and packets in update_itr are dependent on these numbers */
1246	case lowest_latency:
1247		new_itr = IXGBE_100K_ITR;
1248		break;
1249	case low_latency:
1250		new_itr = IXGBE_20K_ITR;
1251		break;
1252	case bulk_latency:
1253		new_itr = IXGBE_12K_ITR;
1254		break;
1255	default:
1256		break;
1257	}
1258
1259	if (new_itr != q_vector->itr) {
1260		/* do an exponential smoothing */
1261		new_itr = (10 * new_itr * q_vector->itr) /
1262			  ((9 * new_itr) + q_vector->itr);
1263
1264		/* save the algorithm value here */
1265		q_vector->itr = new_itr;
1266
1267		ixgbevf_write_eitr(q_vector);
1268	}
1269}
1270
1271static irqreturn_t ixgbevf_msix_other(int irq, void *data)
1272{
1273	struct ixgbevf_adapter *adapter = data;
1274	struct ixgbe_hw *hw = &adapter->hw;
1275
1276	hw->mac.get_link_status = 1;
1277
1278	ixgbevf_service_event_schedule(adapter);
1279
1280	IXGBE_WRITE_REG(hw, IXGBE_VTEIMS, adapter->eims_other);
1281
1282	return IRQ_HANDLED;
1283}
1284
1285/**
1286 * ixgbevf_msix_clean_rings - single unshared vector rx clean (all queues)
1287 * @irq: unused
1288 * @data: pointer to our q_vector struct for this interrupt vector
1289 **/
1290static irqreturn_t ixgbevf_msix_clean_rings(int irq, void *data)
1291{
1292	struct ixgbevf_q_vector *q_vector = data;
1293
1294	/* EIAM disabled interrupts (on this vector) for us */
1295	if (q_vector->rx.ring || q_vector->tx.ring)
1296		napi_schedule_irqoff(&q_vector->napi);
1297
1298	return IRQ_HANDLED;
1299}
1300
1301static inline void map_vector_to_rxq(struct ixgbevf_adapter *a, int v_idx,
1302				     int r_idx)
1303{
1304	struct ixgbevf_q_vector *q_vector = a->q_vector[v_idx];
1305
1306	a->rx_ring[r_idx]->next = q_vector->rx.ring;
1307	q_vector->rx.ring = a->rx_ring[r_idx];
1308	q_vector->rx.count++;
1309}
1310
1311static inline void map_vector_to_txq(struct ixgbevf_adapter *a, int v_idx,
1312				     int t_idx)
1313{
1314	struct ixgbevf_q_vector *q_vector = a->q_vector[v_idx];
1315
1316	a->tx_ring[t_idx]->next = q_vector->tx.ring;
1317	q_vector->tx.ring = a->tx_ring[t_idx];
1318	q_vector->tx.count++;
1319}
1320
1321/**
1322 * ixgbevf_map_rings_to_vectors - Maps descriptor rings to vectors
1323 * @adapter: board private structure to initialize
1324 *
1325 * This function maps descriptor rings to the queue-specific vectors
1326 * we were allotted through the MSI-X enabling code.  Ideally, we'd have
1327 * one vector per ring/queue, but on a constrained vector budget, we
1328 * group the rings as "efficiently" as possible.  You would add new
1329 * mapping configurations in here.
1330 **/
1331static int ixgbevf_map_rings_to_vectors(struct ixgbevf_adapter *adapter)
1332{
1333	int q_vectors;
1334	int v_start = 0;
1335	int rxr_idx = 0, txr_idx = 0;
1336	int rxr_remaining = adapter->num_rx_queues;
1337	int txr_remaining = adapter->num_tx_queues;
1338	int i, j;
1339	int rqpv, tqpv;
1340
1341	q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
1342
1343	/* The ideal configuration...
1344	 * We have enough vectors to map one per queue.
1345	 */
1346	if (q_vectors == adapter->num_rx_queues + adapter->num_tx_queues) {
1347		for (; rxr_idx < rxr_remaining; v_start++, rxr_idx++)
1348			map_vector_to_rxq(adapter, v_start, rxr_idx);
1349
1350		for (; txr_idx < txr_remaining; v_start++, txr_idx++)
1351			map_vector_to_txq(adapter, v_start, txr_idx);
1352		return 0;
1353	}
1354
1355	/* If we don't have enough vectors for a 1-to-1
1356	 * mapping, we'll have to group them so there are
1357	 * multiple queues per vector.
1358	 */
1359	/* Re-adjusting *qpv takes care of the remainder. */
1360	for (i = v_start; i < q_vectors; i++) {
1361		rqpv = DIV_ROUND_UP(rxr_remaining, q_vectors - i);
1362		for (j = 0; j < rqpv; j++) {
1363			map_vector_to_rxq(adapter, i, rxr_idx);
1364			rxr_idx++;
1365			rxr_remaining--;
1366		}
1367	}
1368	for (i = v_start; i < q_vectors; i++) {
1369		tqpv = DIV_ROUND_UP(txr_remaining, q_vectors - i);
1370		for (j = 0; j < tqpv; j++) {
1371			map_vector_to_txq(adapter, i, txr_idx);
1372			txr_idx++;
1373			txr_remaining--;
1374		}
1375	}
1376
1377	return 0;
1378}
1379
1380/**
1381 * ixgbevf_request_msix_irqs - Initialize MSI-X interrupts
1382 * @adapter: board private structure
1383 *
1384 * ixgbevf_request_msix_irqs allocates MSI-X vectors and requests
1385 * interrupts from the kernel.
1386 **/
1387static int ixgbevf_request_msix_irqs(struct ixgbevf_adapter *adapter)
1388{
1389	struct net_device *netdev = adapter->netdev;
1390	int q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
 
1391	int vector, err;
1392	int ri = 0, ti = 0;
1393
1394	for (vector = 0; vector < q_vectors; vector++) {
1395		struct ixgbevf_q_vector *q_vector = adapter->q_vector[vector];
1396		struct msix_entry *entry = &adapter->msix_entries[vector];
1397
1398		if (q_vector->tx.ring && q_vector->rx.ring) {
1399			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
1400				 "%s-%s-%d", netdev->name, "TxRx", ri++);
1401			ti++;
1402		} else if (q_vector->rx.ring) {
1403			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
1404				 "%s-%s-%d", netdev->name, "rx", ri++);
1405		} else if (q_vector->tx.ring) {
1406			snprintf(q_vector->name, sizeof(q_vector->name) - 1,
1407				 "%s-%s-%d", netdev->name, "tx", ti++);
1408		} else {
1409			/* skip this unused q_vector */
1410			continue;
1411		}
1412		err = request_irq(entry->vector, &ixgbevf_msix_clean_rings, 0,
1413				  q_vector->name, q_vector);
1414		if (err) {
1415			hw_dbg(&adapter->hw,
1416			       "request_irq failed for MSIX interrupt Error: %d\n",
1417			       err);
1418			goto free_queue_irqs;
1419		}
1420	}
1421
1422	err = request_irq(adapter->msix_entries[vector].vector,
1423			  &ixgbevf_msix_other, 0, netdev->name, adapter);
1424	if (err) {
1425		hw_dbg(&adapter->hw, "request_irq for msix_other failed: %d\n",
1426		       err);
1427		goto free_queue_irqs;
1428	}
1429
1430	return 0;
1431
1432free_queue_irqs:
1433	while (vector) {
1434		vector--;
1435		free_irq(adapter->msix_entries[vector].vector,
1436			 adapter->q_vector[vector]);
1437	}
1438	/* This failure is non-recoverable - it indicates the system is
1439	 * out of MSIX vector resources and the VF driver cannot run
1440	 * without them.  Set the number of msix vectors to zero
1441	 * indicating that not enough can be allocated.  The error
1442	 * will be returned to the user indicating device open failed.
1443	 * Any further attempts to force the driver to open will also
1444	 * fail.  The only way to recover is to unload the driver and
1445	 * reload it again.  If the system has recovered some MSIX
1446	 * vectors then it may succeed.
1447	 */
1448	adapter->num_msix_vectors = 0;
1449	return err;
1450}
1451
1452static inline void ixgbevf_reset_q_vectors(struct ixgbevf_adapter *adapter)
1453{
1454	int i, q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
1455
1456	for (i = 0; i < q_vectors; i++) {
1457		struct ixgbevf_q_vector *q_vector = adapter->q_vector[i];
1458
1459		q_vector->rx.ring = NULL;
1460		q_vector->tx.ring = NULL;
1461		q_vector->rx.count = 0;
1462		q_vector->tx.count = 0;
1463	}
1464}
1465
1466/**
1467 * ixgbevf_request_irq - initialize interrupts
1468 * @adapter: board private structure
1469 *
1470 * Attempts to configure interrupts using the best available
1471 * capabilities of the hardware and kernel.
1472 **/
1473static int ixgbevf_request_irq(struct ixgbevf_adapter *adapter)
1474{
1475	int err = ixgbevf_request_msix_irqs(adapter);
1476
1477	if (err)
1478		hw_dbg(&adapter->hw, "request_irq failed, Error %d\n", err);
1479
1480	return err;
1481}
1482
1483static void ixgbevf_free_irq(struct ixgbevf_adapter *adapter)
1484{
1485	int i, q_vectors;
1486
 
 
 
1487	q_vectors = adapter->num_msix_vectors;
1488	i = q_vectors - 1;
1489
1490	free_irq(adapter->msix_entries[i].vector, adapter);
1491	i--;
1492
1493	for (; i >= 0; i--) {
1494		/* free only the irqs that were actually requested */
1495		if (!adapter->q_vector[i]->rx.ring &&
1496		    !adapter->q_vector[i]->tx.ring)
1497			continue;
1498
1499		free_irq(adapter->msix_entries[i].vector,
1500			 adapter->q_vector[i]);
1501	}
1502
1503	ixgbevf_reset_q_vectors(adapter);
1504}
1505
1506/**
1507 * ixgbevf_irq_disable - Mask off interrupt generation on the NIC
1508 * @adapter: board private structure
1509 **/
1510static inline void ixgbevf_irq_disable(struct ixgbevf_adapter *adapter)
1511{
1512	struct ixgbe_hw *hw = &adapter->hw;
1513	int i;
1514
1515	IXGBE_WRITE_REG(hw, IXGBE_VTEIAM, 0);
1516	IXGBE_WRITE_REG(hw, IXGBE_VTEIMC, ~0);
1517	IXGBE_WRITE_REG(hw, IXGBE_VTEIAC, 0);
1518
1519	IXGBE_WRITE_FLUSH(hw);
1520
1521	for (i = 0; i < adapter->num_msix_vectors; i++)
1522		synchronize_irq(adapter->msix_entries[i].vector);
1523}
1524
1525/**
1526 * ixgbevf_irq_enable - Enable default interrupt generation settings
1527 * @adapter: board private structure
1528 **/
1529static inline void ixgbevf_irq_enable(struct ixgbevf_adapter *adapter)
1530{
1531	struct ixgbe_hw *hw = &adapter->hw;
1532
1533	IXGBE_WRITE_REG(hw, IXGBE_VTEIAM, adapter->eims_enable_mask);
1534	IXGBE_WRITE_REG(hw, IXGBE_VTEIAC, adapter->eims_enable_mask);
1535	IXGBE_WRITE_REG(hw, IXGBE_VTEIMS, adapter->eims_enable_mask);
1536}
1537
1538/**
1539 * ixgbevf_configure_tx_ring - Configure 82599 VF Tx ring after Reset
1540 * @adapter: board private structure
1541 * @ring: structure containing ring specific data
1542 *
1543 * Configure the Tx descriptor ring after a reset.
1544 **/
1545static void ixgbevf_configure_tx_ring(struct ixgbevf_adapter *adapter,
1546				      struct ixgbevf_ring *ring)
1547{
1548	struct ixgbe_hw *hw = &adapter->hw;
1549	u64 tdba = ring->dma;
1550	int wait_loop = 10;
1551	u32 txdctl = IXGBE_TXDCTL_ENABLE;
1552	u8 reg_idx = ring->reg_idx;
1553
1554	/* disable queue to avoid issues while updating state */
1555	IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(reg_idx), IXGBE_TXDCTL_SWFLSH);
1556	IXGBE_WRITE_FLUSH(hw);
1557
1558	IXGBE_WRITE_REG(hw, IXGBE_VFTDBAL(reg_idx), tdba & DMA_BIT_MASK(32));
1559	IXGBE_WRITE_REG(hw, IXGBE_VFTDBAH(reg_idx), tdba >> 32);
1560	IXGBE_WRITE_REG(hw, IXGBE_VFTDLEN(reg_idx),
1561			ring->count * sizeof(union ixgbe_adv_tx_desc));
1562
1563	/* disable head writeback */
1564	IXGBE_WRITE_REG(hw, IXGBE_VFTDWBAH(reg_idx), 0);
1565	IXGBE_WRITE_REG(hw, IXGBE_VFTDWBAL(reg_idx), 0);
1566
1567	/* enable relaxed ordering */
1568	IXGBE_WRITE_REG(hw, IXGBE_VFDCA_TXCTRL(reg_idx),
1569			(IXGBE_DCA_TXCTRL_DESC_RRO_EN |
1570			 IXGBE_DCA_TXCTRL_DATA_RRO_EN));
1571
1572	/* reset head and tail pointers */
1573	IXGBE_WRITE_REG(hw, IXGBE_VFTDH(reg_idx), 0);
1574	IXGBE_WRITE_REG(hw, IXGBE_VFTDT(reg_idx), 0);
1575	ring->tail = adapter->io_addr + IXGBE_VFTDT(reg_idx);
1576
1577	/* reset ntu and ntc to place SW in sync with hardwdare */
1578	ring->next_to_clean = 0;
1579	ring->next_to_use = 0;
1580
1581	/* In order to avoid issues WTHRESH + PTHRESH should always be equal
1582	 * to or less than the number of on chip descriptors, which is
1583	 * currently 40.
1584	 */
1585	txdctl |= (8 << 16);    /* WTHRESH = 8 */
1586
1587	/* Setting PTHRESH to 32 both improves performance */
1588	txdctl |= (1 << 8) |    /* HTHRESH = 1 */
1589		  32;          /* PTHRESH = 32 */
 
 
 
 
1590
1591	clear_bit(__IXGBEVF_HANG_CHECK_ARMED, &ring->state);
 
1592
1593	IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(reg_idx), txdctl);
1594
1595	/* poll to verify queue is enabled */
1596	do {
1597		usleep_range(1000, 2000);
1598		txdctl = IXGBE_READ_REG(hw, IXGBE_VFTXDCTL(reg_idx));
1599	}  while (--wait_loop && !(txdctl & IXGBE_TXDCTL_ENABLE));
1600	if (!wait_loop)
1601		pr_err("Could not enable Tx Queue %d\n", reg_idx);
1602}
1603
1604/**
1605 * ixgbevf_configure_tx - Configure 82599 VF Transmit Unit after Reset
1606 * @adapter: board private structure
1607 *
1608 * Configure the Tx unit of the MAC after a reset.
1609 **/
1610static void ixgbevf_configure_tx(struct ixgbevf_adapter *adapter)
1611{
1612	u32 i;
1613
1614	/* Setup the HW Tx Head and Tail descriptor pointers */
1615	for (i = 0; i < adapter->num_tx_queues; i++)
1616		ixgbevf_configure_tx_ring(adapter, adapter->tx_ring[i]);
 
 
1617}
1618
1619#define IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT	2
1620
1621static void ixgbevf_configure_srrctl(struct ixgbevf_adapter *adapter, int index)
 
1622{
1623	struct ixgbe_hw *hw = &adapter->hw;
1624	u32 srrctl;
1625
1626	srrctl = IXGBE_SRRCTL_DROP_EN;
1627
1628	srrctl |= IXGBEVF_RX_HDR_SIZE << IXGBE_SRRCTL_BSIZEHDRSIZE_SHIFT;
1629	srrctl |= IXGBEVF_RX_BUFSZ >> IXGBE_SRRCTL_BSIZEPKT_SHIFT;
 
 
 
1630	srrctl |= IXGBE_SRRCTL_DESCTYPE_ADV_ONEBUF;
1631
1632	IXGBE_WRITE_REG(hw, IXGBE_VFSRRCTL(index), srrctl);
1633}
1634
1635static void ixgbevf_setup_psrtype(struct ixgbevf_adapter *adapter)
1636{
1637	struct ixgbe_hw *hw = &adapter->hw;
1638
1639	/* PSRTYPE must be initialized in 82599 */
1640	u32 psrtype = IXGBE_PSRTYPE_TCPHDR | IXGBE_PSRTYPE_UDPHDR |
1641		      IXGBE_PSRTYPE_IPV4HDR | IXGBE_PSRTYPE_IPV6HDR |
1642		      IXGBE_PSRTYPE_L2HDR;
1643
1644	if (adapter->num_rx_queues > 1)
1645		psrtype |= 1 << 29;
1646
1647	IXGBE_WRITE_REG(hw, IXGBE_VFPSRTYPE, psrtype);
1648}
1649
1650#define IXGBEVF_MAX_RX_DESC_POLL 10
1651static void ixgbevf_disable_rx_queue(struct ixgbevf_adapter *adapter,
1652				     struct ixgbevf_ring *ring)
1653{
1654	struct ixgbe_hw *hw = &adapter->hw;
1655	int wait_loop = IXGBEVF_MAX_RX_DESC_POLL;
1656	u32 rxdctl;
1657	u8 reg_idx = ring->reg_idx;
1658
1659	if (IXGBE_REMOVED(hw->hw_addr))
1660		return;
1661	rxdctl = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(reg_idx));
1662	rxdctl &= ~IXGBE_RXDCTL_ENABLE;
1663
1664	/* write value back with RXDCTL.ENABLE bit cleared */
1665	IXGBE_WRITE_REG(hw, IXGBE_VFRXDCTL(reg_idx), rxdctl);
1666
1667	/* the hardware may take up to 100us to really disable the Rx queue */
1668	do {
1669		udelay(10);
1670		rxdctl = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(reg_idx));
1671	} while (--wait_loop && (rxdctl & IXGBE_RXDCTL_ENABLE));
1672
1673	if (!wait_loop)
1674		pr_err("RXDCTL.ENABLE queue %d not cleared while polling\n",
1675		       reg_idx);
1676}
1677
1678static void ixgbevf_rx_desc_queue_enable(struct ixgbevf_adapter *adapter,
1679					 struct ixgbevf_ring *ring)
1680{
1681	struct ixgbe_hw *hw = &adapter->hw;
1682	int wait_loop = IXGBEVF_MAX_RX_DESC_POLL;
1683	u32 rxdctl;
1684	u8 reg_idx = ring->reg_idx;
1685
1686	if (IXGBE_REMOVED(hw->hw_addr))
1687		return;
1688	do {
1689		usleep_range(1000, 2000);
1690		rxdctl = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(reg_idx));
1691	} while (--wait_loop && !(rxdctl & IXGBE_RXDCTL_ENABLE));
1692
1693	if (!wait_loop)
1694		pr_err("RXDCTL.ENABLE queue %d not set while polling\n",
1695		       reg_idx);
1696}
1697
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1698static void ixgbevf_setup_vfmrqc(struct ixgbevf_adapter *adapter)
1699{
1700	struct ixgbe_hw *hw = &adapter->hw;
1701	u32 vfmrqc = 0, vfreta = 0;
1702	u16 rss_i = adapter->num_rx_queues;
1703	u8 i, j;
1704
1705	/* Fill out hash function seeds */
1706	netdev_rss_key_fill(adapter->rss_key, sizeof(adapter->rss_key));
1707	for (i = 0; i < IXGBEVF_VFRSSRK_REGS; i++)
1708		IXGBE_WRITE_REG(hw, IXGBE_VFRSSRK(i), adapter->rss_key[i]);
1709
1710	for (i = 0, j = 0; i < IXGBEVF_X550_VFRETA_SIZE; i++, j++) {
1711		if (j == rss_i)
1712			j = 0;
1713
1714		adapter->rss_indir_tbl[i] = j;
1715
1716		vfreta |= j << (i & 0x3) * 8;
1717		if ((i & 3) == 3) {
1718			IXGBE_WRITE_REG(hw, IXGBE_VFRETA(i >> 2), vfreta);
1719			vfreta = 0;
1720		}
1721	}
1722
1723	/* Perform hash on these packet types */
1724	vfmrqc |= IXGBE_VFMRQC_RSS_FIELD_IPV4 |
1725		IXGBE_VFMRQC_RSS_FIELD_IPV4_TCP |
1726		IXGBE_VFMRQC_RSS_FIELD_IPV6 |
1727		IXGBE_VFMRQC_RSS_FIELD_IPV6_TCP;
1728
1729	vfmrqc |= IXGBE_VFMRQC_RSSEN;
1730
1731	IXGBE_WRITE_REG(hw, IXGBE_VFMRQC, vfmrqc);
1732}
1733
1734static void ixgbevf_configure_rx_ring(struct ixgbevf_adapter *adapter,
1735				      struct ixgbevf_ring *ring)
1736{
1737	struct ixgbe_hw *hw = &adapter->hw;
 
1738	u64 rdba = ring->dma;
1739	u32 rxdctl;
1740	u8 reg_idx = ring->reg_idx;
1741
1742	/* disable queue to avoid issues while updating state */
1743	rxdctl = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(reg_idx));
1744	ixgbevf_disable_rx_queue(adapter, ring);
1745
1746	IXGBE_WRITE_REG(hw, IXGBE_VFRDBAL(reg_idx), rdba & DMA_BIT_MASK(32));
1747	IXGBE_WRITE_REG(hw, IXGBE_VFRDBAH(reg_idx), rdba >> 32);
1748	IXGBE_WRITE_REG(hw, IXGBE_VFRDLEN(reg_idx),
1749			ring->count * sizeof(union ixgbe_adv_rx_desc));
1750
 
1751	/* enable relaxed ordering */
1752	IXGBE_WRITE_REG(hw, IXGBE_VFDCA_RXCTRL(reg_idx),
1753			IXGBE_DCA_RXCTRL_DESC_RRO_EN);
 
 
 
 
 
1754
1755	/* reset head and tail pointers */
1756	IXGBE_WRITE_REG(hw, IXGBE_VFRDH(reg_idx), 0);
1757	IXGBE_WRITE_REG(hw, IXGBE_VFRDT(reg_idx), 0);
1758	ring->tail = adapter->io_addr + IXGBE_VFRDT(reg_idx);
1759
 
 
 
 
 
 
 
 
1760	/* reset ntu and ntc to place SW in sync with hardwdare */
1761	ring->next_to_clean = 0;
1762	ring->next_to_use = 0;
1763	ring->next_to_alloc = 0;
1764
1765	ixgbevf_configure_srrctl(adapter, reg_idx);
1766
1767	/* allow any size packet since we can handle overflow */
1768	rxdctl &= ~IXGBE_RXDCTL_RLPML_EN;
 
 
 
 
 
 
 
 
 
 
 
1769
1770	rxdctl |= IXGBE_RXDCTL_ENABLE | IXGBE_RXDCTL_VME;
1771	IXGBE_WRITE_REG(hw, IXGBE_VFRXDCTL(reg_idx), rxdctl);
1772
1773	ixgbevf_rx_desc_queue_enable(adapter, ring);
1774	ixgbevf_alloc_rx_buffers(ring, ixgbevf_desc_unused(ring));
1775}
1776
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1777/**
1778 * ixgbevf_configure_rx - Configure 82599 VF Receive Unit after Reset
1779 * @adapter: board private structure
1780 *
1781 * Configure the Rx unit of the MAC after a reset.
1782 **/
1783static void ixgbevf_configure_rx(struct ixgbevf_adapter *adapter)
1784{
1785	int i;
1786	struct ixgbe_hw *hw = &adapter->hw;
1787	struct net_device *netdev = adapter->netdev;
 
1788
1789	ixgbevf_setup_psrtype(adapter);
1790	if (hw->mac.type >= ixgbe_mac_X550_vf)
1791		ixgbevf_setup_vfmrqc(adapter);
1792
 
1793	/* notify the PF of our intent to use this size of frame */
1794	ixgbevf_rlpml_set_vf(hw, netdev->mtu + ETH_HLEN + ETH_FCS_LEN);
 
 
 
 
1795
1796	/* Setup the HW Rx Head and Tail Descriptor Pointers and
1797	 * the Base and Length of the Rx Descriptor Ring
1798	 */
1799	for (i = 0; i < adapter->num_rx_queues; i++)
1800		ixgbevf_configure_rx_ring(adapter, adapter->rx_ring[i]);
 
 
 
 
1801}
1802
1803static int ixgbevf_vlan_rx_add_vid(struct net_device *netdev,
1804				   __be16 proto, u16 vid)
1805{
1806	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
1807	struct ixgbe_hw *hw = &adapter->hw;
1808	int err;
1809
1810	spin_lock_bh(&adapter->mbx_lock);
1811
1812	/* add VID to filter table */
1813	err = hw->mac.ops.set_vfta(hw, vid, 0, true);
1814
1815	spin_unlock_bh(&adapter->mbx_lock);
1816
1817	/* translate error return types so error makes sense */
1818	if (err == IXGBE_ERR_MBX)
1819		return -EIO;
 
 
 
1820
1821	if (err == IXGBE_ERR_INVALID_ARGUMENT)
1822		return -EACCES;
 
1823
1824	set_bit(vid, adapter->active_vlans);
1825
1826	return err;
1827}
1828
1829static int ixgbevf_vlan_rx_kill_vid(struct net_device *netdev,
1830				    __be16 proto, u16 vid)
1831{
1832	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
1833	struct ixgbe_hw *hw = &adapter->hw;
1834	int err;
1835
1836	spin_lock_bh(&adapter->mbx_lock);
1837
1838	/* remove VID from filter table */
1839	err = hw->mac.ops.set_vfta(hw, vid, 0, false);
1840
1841	spin_unlock_bh(&adapter->mbx_lock);
1842
 
 
 
1843	clear_bit(vid, adapter->active_vlans);
1844
1845	return err;
1846}
1847
1848static void ixgbevf_restore_vlan(struct ixgbevf_adapter *adapter)
1849{
1850	u16 vid;
1851
1852	for_each_set_bit(vid, adapter->active_vlans, VLAN_N_VID)
1853		ixgbevf_vlan_rx_add_vid(adapter->netdev,
1854					htons(ETH_P_8021Q), vid);
1855}
1856
1857static int ixgbevf_write_uc_addr_list(struct net_device *netdev)
1858{
1859	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
1860	struct ixgbe_hw *hw = &adapter->hw;
1861	int count = 0;
1862
1863	if ((netdev_uc_count(netdev)) > 10) {
1864		pr_err("Too many unicast filters - No Space\n");
1865		return -ENOSPC;
1866	}
1867
1868	if (!netdev_uc_empty(netdev)) {
1869		struct netdev_hw_addr *ha;
1870
1871		netdev_for_each_uc_addr(ha, netdev) {
1872			hw->mac.ops.set_uc_addr(hw, ++count, ha->addr);
1873			udelay(200);
1874		}
1875	} else {
1876		/* If the list is empty then send message to PF driver to
1877		 * clear all MAC VLANs on this VF.
1878		 */
1879		hw->mac.ops.set_uc_addr(hw, 0, NULL);
1880	}
1881
1882	return count;
1883}
1884
1885/**
1886 * ixgbevf_set_rx_mode - Multicast and unicast set
1887 * @netdev: network interface device structure
1888 *
1889 * The set_rx_method entry point is called whenever the multicast address
1890 * list, unicast address list or the network interface flags are updated.
1891 * This routine is responsible for configuring the hardware for proper
1892 * multicast mode and configuring requested unicast filters.
1893 **/
1894static void ixgbevf_set_rx_mode(struct net_device *netdev)
1895{
1896	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
1897	struct ixgbe_hw *hw = &adapter->hw;
1898	unsigned int flags = netdev->flags;
1899	int xcast_mode;
1900
1901	xcast_mode = (flags & IFF_ALLMULTI) ? IXGBEVF_XCAST_MODE_ALLMULTI :
1902		     (flags & (IFF_BROADCAST | IFF_MULTICAST)) ?
1903		     IXGBEVF_XCAST_MODE_MULTI : IXGBEVF_XCAST_MODE_NONE;
 
 
 
 
 
 
1904
1905	spin_lock_bh(&adapter->mbx_lock);
1906
1907	hw->mac.ops.update_xcast_mode(hw, netdev, xcast_mode);
1908
1909	/* reprogram multicast list */
1910	hw->mac.ops.update_mc_addr_list(hw, netdev);
1911
1912	ixgbevf_write_uc_addr_list(netdev);
1913
1914	spin_unlock_bh(&adapter->mbx_lock);
1915}
1916
1917static void ixgbevf_napi_enable_all(struct ixgbevf_adapter *adapter)
1918{
1919	int q_idx;
1920	struct ixgbevf_q_vector *q_vector;
1921	int q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
1922
1923	for (q_idx = 0; q_idx < q_vectors; q_idx++) {
1924		q_vector = adapter->q_vector[q_idx];
1925#ifdef CONFIG_NET_RX_BUSY_POLL
1926		ixgbevf_qv_init_lock(adapter->q_vector[q_idx]);
1927#endif
1928		napi_enable(&q_vector->napi);
1929	}
1930}
1931
1932static void ixgbevf_napi_disable_all(struct ixgbevf_adapter *adapter)
1933{
1934	int q_idx;
1935	struct ixgbevf_q_vector *q_vector;
1936	int q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
1937
1938	for (q_idx = 0; q_idx < q_vectors; q_idx++) {
1939		q_vector = adapter->q_vector[q_idx];
1940		napi_disable(&q_vector->napi);
1941#ifdef CONFIG_NET_RX_BUSY_POLL
1942		while (!ixgbevf_qv_disable(adapter->q_vector[q_idx])) {
1943			pr_info("QV %d locked\n", q_idx);
1944			usleep_range(1000, 20000);
1945		}
1946#endif /* CONFIG_NET_RX_BUSY_POLL */
1947	}
1948}
1949
1950static int ixgbevf_configure_dcb(struct ixgbevf_adapter *adapter)
1951{
1952	struct ixgbe_hw *hw = &adapter->hw;
1953	unsigned int def_q = 0;
1954	unsigned int num_tcs = 0;
1955	unsigned int num_rx_queues = adapter->num_rx_queues;
1956	unsigned int num_tx_queues = adapter->num_tx_queues;
1957	int err;
1958
1959	spin_lock_bh(&adapter->mbx_lock);
1960
1961	/* fetch queue configuration from the PF */
1962	err = ixgbevf_get_queues(hw, &num_tcs, &def_q);
1963
1964	spin_unlock_bh(&adapter->mbx_lock);
1965
1966	if (err)
1967		return err;
1968
1969	if (num_tcs > 1) {
1970		/* we need only one Tx queue */
1971		num_tx_queues = 1;
1972
1973		/* update default Tx ring register index */
1974		adapter->tx_ring[0]->reg_idx = def_q;
1975
1976		/* we need as many queues as traffic classes */
1977		num_rx_queues = num_tcs;
1978	}
1979
1980	/* if we have a bad config abort request queue reset */
1981	if ((adapter->num_rx_queues != num_rx_queues) ||
1982	    (adapter->num_tx_queues != num_tx_queues)) {
1983		/* force mailbox timeout to prevent further messages */
1984		hw->mbx.timeout = 0;
1985
1986		/* wait for watchdog to come around and bail us out */
1987		adapter->flags |= IXGBEVF_FLAG_QUEUE_RESET_REQUESTED;
1988	}
1989
1990	return 0;
1991}
1992
1993static void ixgbevf_configure(struct ixgbevf_adapter *adapter)
1994{
1995	ixgbevf_configure_dcb(adapter);
1996
1997	ixgbevf_set_rx_mode(adapter->netdev);
1998
1999	ixgbevf_restore_vlan(adapter);
 
2000
2001	ixgbevf_configure_tx(adapter);
2002	ixgbevf_configure_rx(adapter);
2003}
2004
2005static void ixgbevf_save_reset_stats(struct ixgbevf_adapter *adapter)
2006{
2007	/* Only save pre-reset stats if there are some */
2008	if (adapter->stats.vfgprc || adapter->stats.vfgptc) {
2009		adapter->stats.saved_reset_vfgprc += adapter->stats.vfgprc -
2010			adapter->stats.base_vfgprc;
2011		adapter->stats.saved_reset_vfgptc += adapter->stats.vfgptc -
2012			adapter->stats.base_vfgptc;
2013		adapter->stats.saved_reset_vfgorc += adapter->stats.vfgorc -
2014			adapter->stats.base_vfgorc;
2015		adapter->stats.saved_reset_vfgotc += adapter->stats.vfgotc -
2016			adapter->stats.base_vfgotc;
2017		adapter->stats.saved_reset_vfmprc += adapter->stats.vfmprc -
2018			adapter->stats.base_vfmprc;
2019	}
2020}
2021
2022static void ixgbevf_init_last_counter_stats(struct ixgbevf_adapter *adapter)
2023{
2024	struct ixgbe_hw *hw = &adapter->hw;
2025
2026	adapter->stats.last_vfgprc = IXGBE_READ_REG(hw, IXGBE_VFGPRC);
2027	adapter->stats.last_vfgorc = IXGBE_READ_REG(hw, IXGBE_VFGORC_LSB);
2028	adapter->stats.last_vfgorc |=
2029		(((u64)(IXGBE_READ_REG(hw, IXGBE_VFGORC_MSB))) << 32);
2030	adapter->stats.last_vfgptc = IXGBE_READ_REG(hw, IXGBE_VFGPTC);
2031	adapter->stats.last_vfgotc = IXGBE_READ_REG(hw, IXGBE_VFGOTC_LSB);
2032	adapter->stats.last_vfgotc |=
2033		(((u64)(IXGBE_READ_REG(hw, IXGBE_VFGOTC_MSB))) << 32);
2034	adapter->stats.last_vfmprc = IXGBE_READ_REG(hw, IXGBE_VFMPRC);
2035
2036	adapter->stats.base_vfgprc = adapter->stats.last_vfgprc;
2037	adapter->stats.base_vfgorc = adapter->stats.last_vfgorc;
2038	adapter->stats.base_vfgptc = adapter->stats.last_vfgptc;
2039	adapter->stats.base_vfgotc = adapter->stats.last_vfgotc;
2040	adapter->stats.base_vfmprc = adapter->stats.last_vfmprc;
2041}
2042
2043static void ixgbevf_negotiate_api(struct ixgbevf_adapter *adapter)
2044{
2045	struct ixgbe_hw *hw = &adapter->hw;
2046	int api[] = { ixgbe_mbox_api_12,
2047		      ixgbe_mbox_api_11,
2048		      ixgbe_mbox_api_10,
2049		      ixgbe_mbox_api_unknown };
 
 
 
 
 
2050	int err, idx = 0;
2051
2052	spin_lock_bh(&adapter->mbx_lock);
2053
2054	while (api[idx] != ixgbe_mbox_api_unknown) {
2055		err = ixgbevf_negotiate_api_version(hw, api[idx]);
2056		if (!err)
2057			break;
2058		idx++;
2059	}
2060
 
 
 
 
 
 
2061	spin_unlock_bh(&adapter->mbx_lock);
2062}
2063
2064static void ixgbevf_up_complete(struct ixgbevf_adapter *adapter)
2065{
2066	struct net_device *netdev = adapter->netdev;
 
2067	struct ixgbe_hw *hw = &adapter->hw;
 
2068
2069	ixgbevf_configure_msix(adapter);
2070
2071	spin_lock_bh(&adapter->mbx_lock);
2072
2073	if (is_valid_ether_addr(hw->mac.addr))
2074		hw->mac.ops.set_rar(hw, 0, hw->mac.addr, 0);
2075	else
2076		hw->mac.ops.set_rar(hw, 0, hw->mac.perm_addr, 0);
2077
2078	spin_unlock_bh(&adapter->mbx_lock);
2079
 
 
 
 
 
2080	smp_mb__before_atomic();
2081	clear_bit(__IXGBEVF_DOWN, &adapter->state);
2082	ixgbevf_napi_enable_all(adapter);
2083
2084	/* clear any pending interrupts, may auto mask */
2085	IXGBE_READ_REG(hw, IXGBE_VTEICR);
2086	ixgbevf_irq_enable(adapter);
2087
2088	/* enable transmits */
2089	netif_tx_start_all_queues(netdev);
2090
2091	ixgbevf_save_reset_stats(adapter);
2092	ixgbevf_init_last_counter_stats(adapter);
2093
2094	hw->mac.get_link_status = 1;
2095	mod_timer(&adapter->service_timer, jiffies);
2096}
2097
2098void ixgbevf_up(struct ixgbevf_adapter *adapter)
2099{
2100	ixgbevf_configure(adapter);
2101
2102	ixgbevf_up_complete(adapter);
2103}
2104
2105/**
2106 * ixgbevf_clean_rx_ring - Free Rx Buffers per Queue
2107 * @rx_ring: ring to free buffers from
2108 **/
2109static void ixgbevf_clean_rx_ring(struct ixgbevf_ring *rx_ring)
2110{
2111	struct device *dev = rx_ring->dev;
2112	unsigned long size;
2113	unsigned int i;
2114
2115	/* Free Rx ring sk_buff */
2116	if (rx_ring->skb) {
2117		dev_kfree_skb(rx_ring->skb);
2118		rx_ring->skb = NULL;
2119	}
2120
2121	/* ring already cleared, nothing to do */
2122	if (!rx_ring->rx_buffer_info)
2123		return;
2124
2125	/* Free all the Rx ring pages */
2126	for (i = 0; i < rx_ring->count; i++) {
2127		struct ixgbevf_rx_buffer *rx_buffer;
2128
2129		rx_buffer = &rx_ring->rx_buffer_info[i];
2130		if (rx_buffer->dma)
2131			dma_unmap_page(dev, rx_buffer->dma,
2132				       PAGE_SIZE, DMA_FROM_DEVICE);
2133		rx_buffer->dma = 0;
2134		if (rx_buffer->page)
2135			__free_page(rx_buffer->page);
2136		rx_buffer->page = NULL;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2137	}
2138
2139	size = sizeof(struct ixgbevf_rx_buffer) * rx_ring->count;
2140	memset(rx_ring->rx_buffer_info, 0, size);
2141
2142	/* Zero out the descriptor ring */
2143	memset(rx_ring->desc, 0, rx_ring->size);
2144}
2145
2146/**
2147 * ixgbevf_clean_tx_ring - Free Tx Buffers
2148 * @tx_ring: ring to be cleaned
2149 **/
2150static void ixgbevf_clean_tx_ring(struct ixgbevf_ring *tx_ring)
2151{
2152	struct ixgbevf_tx_buffer *tx_buffer_info;
2153	unsigned long size;
2154	unsigned int i;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2155
2156	if (!tx_ring->tx_buffer_info)
2157		return;
 
 
 
 
 
2158
2159	/* Free all the Tx ring sk_buffs */
2160	for (i = 0; i < tx_ring->count; i++) {
2161		tx_buffer_info = &tx_ring->tx_buffer_info[i];
2162		ixgbevf_unmap_and_free_tx_resource(tx_ring, tx_buffer_info);
 
 
 
2163	}
2164
2165	size = sizeof(struct ixgbevf_tx_buffer) * tx_ring->count;
2166	memset(tx_ring->tx_buffer_info, 0, size);
 
2167
2168	memset(tx_ring->desc, 0, tx_ring->size);
2169}
2170
2171/**
2172 * ixgbevf_clean_all_rx_rings - Free Rx Buffers for all queues
2173 * @adapter: board private structure
2174 **/
2175static void ixgbevf_clean_all_rx_rings(struct ixgbevf_adapter *adapter)
2176{
2177	int i;
2178
2179	for (i = 0; i < adapter->num_rx_queues; i++)
2180		ixgbevf_clean_rx_ring(adapter->rx_ring[i]);
2181}
2182
2183/**
2184 * ixgbevf_clean_all_tx_rings - Free Tx Buffers for all queues
2185 * @adapter: board private structure
2186 **/
2187static void ixgbevf_clean_all_tx_rings(struct ixgbevf_adapter *adapter)
2188{
2189	int i;
2190
2191	for (i = 0; i < adapter->num_tx_queues; i++)
2192		ixgbevf_clean_tx_ring(adapter->tx_ring[i]);
 
 
2193}
2194
2195void ixgbevf_down(struct ixgbevf_adapter *adapter)
2196{
2197	struct net_device *netdev = adapter->netdev;
2198	struct ixgbe_hw *hw = &adapter->hw;
2199	int i;
2200
2201	/* signal that we are down to the interrupt handler */
2202	if (test_and_set_bit(__IXGBEVF_DOWN, &adapter->state))
2203		return; /* do nothing if already down */
2204
2205	/* disable all enabled Rx queues */
2206	for (i = 0; i < adapter->num_rx_queues; i++)
2207		ixgbevf_disable_rx_queue(adapter, adapter->rx_ring[i]);
2208
2209	usleep_range(10000, 20000);
2210
2211	netif_tx_stop_all_queues(netdev);
2212
2213	/* call carrier off first to avoid false dev_watchdog timeouts */
2214	netif_carrier_off(netdev);
2215	netif_tx_disable(netdev);
2216
2217	ixgbevf_irq_disable(adapter);
2218
2219	ixgbevf_napi_disable_all(adapter);
2220
2221	del_timer_sync(&adapter->service_timer);
2222
2223	/* disable transmits in the hardware now that interrupts are off */
2224	for (i = 0; i < adapter->num_tx_queues; i++) {
2225		u8 reg_idx = adapter->tx_ring[i]->reg_idx;
2226
2227		IXGBE_WRITE_REG(hw, IXGBE_VFTXDCTL(reg_idx),
2228				IXGBE_TXDCTL_SWFLSH);
2229	}
2230
 
 
 
 
 
 
 
2231	if (!pci_channel_offline(adapter->pdev))
2232		ixgbevf_reset(adapter);
2233
2234	ixgbevf_clean_all_tx_rings(adapter);
2235	ixgbevf_clean_all_rx_rings(adapter);
2236}
2237
2238void ixgbevf_reinit_locked(struct ixgbevf_adapter *adapter)
2239{
2240	WARN_ON(in_interrupt());
2241
2242	while (test_and_set_bit(__IXGBEVF_RESETTING, &adapter->state))
2243		msleep(1);
2244
2245	ixgbevf_down(adapter);
 
2246	ixgbevf_up(adapter);
2247
2248	clear_bit(__IXGBEVF_RESETTING, &adapter->state);
2249}
2250
2251void ixgbevf_reset(struct ixgbevf_adapter *adapter)
2252{
2253	struct ixgbe_hw *hw = &adapter->hw;
2254	struct net_device *netdev = adapter->netdev;
2255
2256	if (hw->mac.ops.reset_hw(hw)) {
2257		hw_dbg(hw, "PF still resetting\n");
2258	} else {
2259		hw->mac.ops.init_hw(hw);
2260		ixgbevf_negotiate_api(adapter);
2261	}
2262
2263	if (is_valid_ether_addr(adapter->hw.mac.addr)) {
2264		ether_addr_copy(netdev->dev_addr, adapter->hw.mac.addr);
2265		ether_addr_copy(netdev->perm_addr, adapter->hw.mac.addr);
2266	}
2267
2268	adapter->last_reset = jiffies;
2269}
2270
2271static int ixgbevf_acquire_msix_vectors(struct ixgbevf_adapter *adapter,
2272					int vectors)
2273{
2274	int vector_threshold;
2275
2276	/* We'll want at least 2 (vector_threshold):
2277	 * 1) TxQ[0] + RxQ[0] handler
2278	 * 2) Other (Link Status Change, etc.)
2279	 */
2280	vector_threshold = MIN_MSIX_COUNT;
2281
2282	/* The more we get, the more we will assign to Tx/Rx Cleanup
2283	 * for the separate queues...where Rx Cleanup >= Tx Cleanup.
2284	 * Right now, we simply care about how many we'll get; we'll
2285	 * set them up later while requesting irq's.
2286	 */
2287	vectors = pci_enable_msix_range(adapter->pdev, adapter->msix_entries,
2288					vector_threshold, vectors);
2289
2290	if (vectors < 0) {
2291		dev_err(&adapter->pdev->dev,
2292			"Unable to allocate MSI-X interrupts\n");
2293		kfree(adapter->msix_entries);
2294		adapter->msix_entries = NULL;
2295		return vectors;
2296	}
2297
2298	/* Adjust for only the vectors we'll use, which is minimum
2299	 * of max_msix_q_vectors + NON_Q_VECTORS, or the number of
2300	 * vectors we were allocated.
2301	 */
2302	adapter->num_msix_vectors = vectors;
2303
2304	return 0;
2305}
2306
2307/**
2308 * ixgbevf_set_num_queues - Allocate queues for device, feature dependent
2309 * @adapter: board private structure to initialize
2310 *
2311 * This is the top level queue allocation routine.  The order here is very
2312 * important, starting with the "most" number of features turned on at once,
2313 * and ending with the smallest set of features.  This way large combinations
2314 * can be allocated if they're turned on, and smaller combinations are the
2315 * fallthrough conditions.
2316 *
2317 **/
2318static void ixgbevf_set_num_queues(struct ixgbevf_adapter *adapter)
2319{
2320	struct ixgbe_hw *hw = &adapter->hw;
2321	unsigned int def_q = 0;
2322	unsigned int num_tcs = 0;
2323	int err;
2324
2325	/* Start with base case */
2326	adapter->num_rx_queues = 1;
2327	adapter->num_tx_queues = 1;
 
2328
2329	spin_lock_bh(&adapter->mbx_lock);
2330
2331	/* fetch queue configuration from the PF */
2332	err = ixgbevf_get_queues(hw, &num_tcs, &def_q);
2333
2334	spin_unlock_bh(&adapter->mbx_lock);
2335
2336	if (err)
2337		return;
2338
2339	/* we need as many queues as traffic classes */
2340	if (num_tcs > 1) {
2341		adapter->num_rx_queues = num_tcs;
2342	} else {
2343		u16 rss = min_t(u16, num_online_cpus(), IXGBEVF_MAX_RSS_QUEUES);
2344
2345		switch (hw->api_version) {
2346		case ixgbe_mbox_api_11:
2347		case ixgbe_mbox_api_12:
 
 
 
 
 
 
 
2348			adapter->num_rx_queues = rss;
2349			adapter->num_tx_queues = rss;
 
 
2350		default:
2351			break;
2352		}
2353	}
2354}
2355
2356/**
2357 * ixgbevf_alloc_queues - Allocate memory for all rings
2358 * @adapter: board private structure to initialize
2359 *
2360 * We allocate one ring per queue at run-time since we don't know the
2361 * number of queues at compile-time.  The polling_netdev array is
2362 * intended for Multiqueue, but should work fine with a single queue.
2363 **/
2364static int ixgbevf_alloc_queues(struct ixgbevf_adapter *adapter)
2365{
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2366	struct ixgbevf_ring *ring;
2367	int rx = 0, tx = 0;
 
 
 
 
 
 
 
 
2368
2369	for (; tx < adapter->num_tx_queues; tx++) {
2370		ring = kzalloc(sizeof(*ring), GFP_KERNEL);
2371		if (!ring)
2372			goto err_allocation;
2373
 
 
 
 
 
 
 
 
 
 
2374		ring->dev = &adapter->pdev->dev;
2375		ring->netdev = adapter->netdev;
 
 
 
 
 
 
 
 
2376		ring->count = adapter->tx_ring_count;
2377		ring->queue_index = tx;
2378		ring->reg_idx = tx;
 
 
 
2379
2380		adapter->tx_ring[tx] = ring;
 
 
 
 
 
 
2381	}
2382
2383	for (; rx < adapter->num_rx_queues; rx++) {
2384		ring = kzalloc(sizeof(*ring), GFP_KERNEL);
2385		if (!ring)
2386			goto err_allocation;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2387
 
 
 
 
 
 
 
 
 
 
 
2388		ring->dev = &adapter->pdev->dev;
2389		ring->netdev = adapter->netdev;
2390
 
 
 
 
 
 
 
2391		ring->count = adapter->rx_ring_count;
2392		ring->queue_index = rx;
2393		ring->reg_idx = rx;
2394
2395		adapter->rx_ring[rx] = ring;
2396	}
2397
2398	return 0;
 
 
2399
2400err_allocation:
2401	while (tx) {
2402		kfree(adapter->tx_ring[--tx]);
2403		adapter->tx_ring[tx] = NULL;
2404	}
2405
2406	while (rx) {
2407		kfree(adapter->rx_ring[--rx]);
2408		adapter->rx_ring[rx] = NULL;
2409	}
2410	return -ENOMEM;
2411}
2412
2413/**
2414 * ixgbevf_set_interrupt_capability - set MSI-X or FAIL if not supported
2415 * @adapter: board private structure to initialize
 
2416 *
2417 * Attempt to configure the interrupts using the best available
2418 * capabilities of the hardware and the kernel.
 
2419 **/
2420static int ixgbevf_set_interrupt_capability(struct ixgbevf_adapter *adapter)
2421{
2422	struct net_device *netdev = adapter->netdev;
2423	int err;
2424	int vector, v_budget;
2425
2426	/* It's easy to be greedy for MSI-X vectors, but it really
2427	 * doesn't do us much good if we have a lot more vectors
2428	 * than CPU's.  So let's be conservative and only ask for
2429	 * (roughly) the same number of vectors as there are CPU's.
2430	 * The default is to use pairs of vectors.
2431	 */
2432	v_budget = max(adapter->num_rx_queues, adapter->num_tx_queues);
2433	v_budget = min_t(int, v_budget, num_online_cpus());
2434	v_budget += NON_Q_VECTORS;
2435
2436	/* A failure in MSI-X entry allocation isn't fatal, but it does
2437	 * mean we disable MSI-X capabilities of the adapter.
2438	 */
2439	adapter->msix_entries = kcalloc(v_budget,
2440					sizeof(struct msix_entry), GFP_KERNEL);
2441	if (!adapter->msix_entries)
2442		return -ENOMEM;
2443
2444	for (vector = 0; vector < v_budget; vector++)
2445		adapter->msix_entries[vector].entry = vector;
2446
2447	err = ixgbevf_acquire_msix_vectors(adapter, v_budget);
2448	if (err)
2449		return err;
2450
2451	err = netif_set_real_num_tx_queues(netdev, adapter->num_tx_queues);
2452	if (err)
2453		return err;
2454
2455	return netif_set_real_num_rx_queues(netdev, adapter->num_rx_queues);
2456}
2457
2458/**
2459 * ixgbevf_alloc_q_vectors - Allocate memory for interrupt vectors
2460 * @adapter: board private structure to initialize
2461 *
2462 * We allocate one q_vector per queue interrupt.  If allocation fails we
2463 * return -ENOMEM.
2464 **/
2465static int ixgbevf_alloc_q_vectors(struct ixgbevf_adapter *adapter)
2466{
2467	int q_idx, num_q_vectors;
2468	struct ixgbevf_q_vector *q_vector;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2469
2470	num_q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
 
 
 
 
 
 
 
 
2471
2472	for (q_idx = 0; q_idx < num_q_vectors; q_idx++) {
2473		q_vector = kzalloc(sizeof(struct ixgbevf_q_vector), GFP_KERNEL);
2474		if (!q_vector)
2475			goto err_out;
2476		q_vector->adapter = adapter;
2477		q_vector->v_idx = q_idx;
2478		netif_napi_add(adapter->netdev, &q_vector->napi,
2479			       ixgbevf_poll, 64);
2480		adapter->q_vector[q_idx] = q_vector;
 
 
 
2481	}
2482
2483	return 0;
2484
2485err_out:
2486	while (q_idx) {
2487		q_idx--;
2488		q_vector = adapter->q_vector[q_idx];
2489#ifdef CONFIG_NET_RX_BUSY_POLL
2490		napi_hash_del(&q_vector->napi);
2491#endif
2492		netif_napi_del(&q_vector->napi);
2493		kfree(q_vector);
2494		adapter->q_vector[q_idx] = NULL;
2495	}
 
2496	return -ENOMEM;
2497}
2498
2499/**
2500 * ixgbevf_free_q_vectors - Free memory allocated for interrupt vectors
2501 * @adapter: board private structure to initialize
2502 *
2503 * This function frees the memory allocated to the q_vectors.  In addition if
2504 * NAPI is enabled it will delete any references to the NAPI struct prior
2505 * to freeing the q_vector.
2506 **/
2507static void ixgbevf_free_q_vectors(struct ixgbevf_adapter *adapter)
2508{
2509	int q_idx, num_q_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
2510
2511	for (q_idx = 0; q_idx < num_q_vectors; q_idx++) {
2512		struct ixgbevf_q_vector *q_vector = adapter->q_vector[q_idx];
2513
2514		adapter->q_vector[q_idx] = NULL;
2515#ifdef CONFIG_NET_RX_BUSY_POLL
2516		napi_hash_del(&q_vector->napi);
2517#endif
2518		netif_napi_del(&q_vector->napi);
2519		kfree(q_vector);
2520	}
2521}
2522
2523/**
2524 * ixgbevf_reset_interrupt_capability - Reset MSIX setup
2525 * @adapter: board private structure
2526 *
2527 **/
2528static void ixgbevf_reset_interrupt_capability(struct ixgbevf_adapter *adapter)
2529{
 
 
 
2530	pci_disable_msix(adapter->pdev);
2531	kfree(adapter->msix_entries);
2532	adapter->msix_entries = NULL;
2533}
2534
2535/**
2536 * ixgbevf_init_interrupt_scheme - Determine if MSIX is supported and init
2537 * @adapter: board private structure to initialize
2538 *
2539 **/
2540static int ixgbevf_init_interrupt_scheme(struct ixgbevf_adapter *adapter)
2541{
2542	int err;
2543
2544	/* Number of supported queues */
2545	ixgbevf_set_num_queues(adapter);
2546
2547	err = ixgbevf_set_interrupt_capability(adapter);
2548	if (err) {
2549		hw_dbg(&adapter->hw,
2550		       "Unable to setup interrupt capabilities\n");
2551		goto err_set_interrupt;
2552	}
2553
2554	err = ixgbevf_alloc_q_vectors(adapter);
2555	if (err) {
2556		hw_dbg(&adapter->hw, "Unable to allocate memory for queue vectors\n");
2557		goto err_alloc_q_vectors;
2558	}
2559
2560	err = ixgbevf_alloc_queues(adapter);
2561	if (err) {
2562		pr_err("Unable to allocate memory for queues\n");
2563		goto err_alloc_queues;
2564	}
2565
2566	hw_dbg(&adapter->hw, "Multiqueue %s: Rx Queue count = %u, Tx Queue count = %u\n",
2567	       (adapter->num_rx_queues > 1) ? "Enabled" :
2568	       "Disabled", adapter->num_rx_queues, adapter->num_tx_queues);
2569
2570	set_bit(__IXGBEVF_DOWN, &adapter->state);
2571
2572	return 0;
2573err_alloc_queues:
2574	ixgbevf_free_q_vectors(adapter);
2575err_alloc_q_vectors:
2576	ixgbevf_reset_interrupt_capability(adapter);
2577err_set_interrupt:
2578	return err;
2579}
2580
2581/**
2582 * ixgbevf_clear_interrupt_scheme - Clear the current interrupt scheme settings
2583 * @adapter: board private structure to clear interrupt scheme on
2584 *
2585 * We go through and clear interrupt specific resources and reset the structure
2586 * to pre-load conditions
2587 **/
2588static void ixgbevf_clear_interrupt_scheme(struct ixgbevf_adapter *adapter)
2589{
2590	int i;
2591
2592	for (i = 0; i < adapter->num_tx_queues; i++) {
2593		kfree(adapter->tx_ring[i]);
2594		adapter->tx_ring[i] = NULL;
2595	}
2596	for (i = 0; i < adapter->num_rx_queues; i++) {
2597		kfree(adapter->rx_ring[i]);
2598		adapter->rx_ring[i] = NULL;
2599	}
2600
2601	adapter->num_tx_queues = 0;
 
2602	adapter->num_rx_queues = 0;
2603
2604	ixgbevf_free_q_vectors(adapter);
2605	ixgbevf_reset_interrupt_capability(adapter);
2606}
2607
2608/**
2609 * ixgbevf_sw_init - Initialize general software structures
2610 * @adapter: board private structure to initialize
2611 *
2612 * ixgbevf_sw_init initializes the Adapter private data structure.
2613 * Fields are initialized based on PCI device information and
2614 * OS network device settings (MTU size).
2615 **/
2616static int ixgbevf_sw_init(struct ixgbevf_adapter *adapter)
2617{
2618	struct ixgbe_hw *hw = &adapter->hw;
2619	struct pci_dev *pdev = adapter->pdev;
2620	struct net_device *netdev = adapter->netdev;
2621	int err;
2622
2623	/* PCI config space info */
2624	hw->vendor_id = pdev->vendor;
2625	hw->device_id = pdev->device;
2626	hw->revision_id = pdev->revision;
2627	hw->subsystem_vendor_id = pdev->subsystem_vendor;
2628	hw->subsystem_device_id = pdev->subsystem_device;
2629
2630	hw->mbx.ops.init_params(hw);
2631
 
 
 
 
 
 
2632	/* assume legacy case in which PF would only give VF 2 queues */
2633	hw->mac.max_tx_queues = 2;
2634	hw->mac.max_rx_queues = 2;
2635
2636	/* lock to protect mailbox accesses */
2637	spin_lock_init(&adapter->mbx_lock);
2638
2639	err = hw->mac.ops.reset_hw(hw);
2640	if (err) {
2641		dev_info(&pdev->dev,
2642			 "PF still in reset state.  Is the PF interface up?\n");
2643	} else {
2644		err = hw->mac.ops.init_hw(hw);
2645		if (err) {
2646			pr_err("init_shared_code failed: %d\n", err);
2647			goto out;
2648		}
2649		ixgbevf_negotiate_api(adapter);
2650		err = hw->mac.ops.get_mac_addr(hw, hw->mac.addr);
2651		if (err)
2652			dev_info(&pdev->dev, "Error reading MAC address\n");
2653		else if (is_zero_ether_addr(adapter->hw.mac.addr))
2654			dev_info(&pdev->dev,
2655				 "MAC address not assigned by administrator.\n");
2656		ether_addr_copy(netdev->dev_addr, hw->mac.addr);
2657	}
2658
2659	if (!is_valid_ether_addr(netdev->dev_addr)) {
2660		dev_info(&pdev->dev, "Assigning random MAC address\n");
2661		eth_hw_addr_random(netdev);
2662		ether_addr_copy(hw->mac.addr, netdev->dev_addr);
2663		ether_addr_copy(hw->mac.perm_addr, netdev->dev_addr);
2664	}
2665
2666	/* Enable dynamic interrupt throttling rates */
2667	adapter->rx_itr_setting = 1;
2668	adapter->tx_itr_setting = 1;
2669
2670	/* set default ring sizes */
2671	adapter->tx_ring_count = IXGBEVF_DEFAULT_TXD;
2672	adapter->rx_ring_count = IXGBEVF_DEFAULT_RXD;
2673
 
 
2674	set_bit(__IXGBEVF_DOWN, &adapter->state);
2675	return 0;
2676
2677out:
2678	return err;
2679}
2680
2681#define UPDATE_VF_COUNTER_32bit(reg, last_counter, counter)	\
2682	{							\
2683		u32 current_counter = IXGBE_READ_REG(hw, reg);	\
2684		if (current_counter < last_counter)		\
2685			counter += 0x100000000LL;		\
2686		last_counter = current_counter;			\
2687		counter &= 0xFFFFFFFF00000000LL;		\
2688		counter |= current_counter;			\
2689	}
2690
2691#define UPDATE_VF_COUNTER_36bit(reg_lsb, reg_msb, last_counter, counter) \
2692	{								 \
2693		u64 current_counter_lsb = IXGBE_READ_REG(hw, reg_lsb);	 \
2694		u64 current_counter_msb = IXGBE_READ_REG(hw, reg_msb);	 \
2695		u64 current_counter = (current_counter_msb << 32) |	 \
2696			current_counter_lsb;				 \
2697		if (current_counter < last_counter)			 \
2698			counter += 0x1000000000LL;			 \
2699		last_counter = current_counter;				 \
2700		counter &= 0xFFFFFFF000000000LL;			 \
2701		counter |= current_counter;				 \
2702	}
2703/**
2704 * ixgbevf_update_stats - Update the board statistics counters.
2705 * @adapter: board private structure
2706 **/
2707void ixgbevf_update_stats(struct ixgbevf_adapter *adapter)
2708{
2709	struct ixgbe_hw *hw = &adapter->hw;
 
 
2710	int i;
2711
2712	if (test_bit(__IXGBEVF_DOWN, &adapter->state) ||
2713	    test_bit(__IXGBEVF_RESETTING, &adapter->state))
2714		return;
2715
2716	UPDATE_VF_COUNTER_32bit(IXGBE_VFGPRC, adapter->stats.last_vfgprc,
2717				adapter->stats.vfgprc);
2718	UPDATE_VF_COUNTER_32bit(IXGBE_VFGPTC, adapter->stats.last_vfgptc,
2719				adapter->stats.vfgptc);
2720	UPDATE_VF_COUNTER_36bit(IXGBE_VFGORC_LSB, IXGBE_VFGORC_MSB,
2721				adapter->stats.last_vfgorc,
2722				adapter->stats.vfgorc);
2723	UPDATE_VF_COUNTER_36bit(IXGBE_VFGOTC_LSB, IXGBE_VFGOTC_MSB,
2724				adapter->stats.last_vfgotc,
2725				adapter->stats.vfgotc);
2726	UPDATE_VF_COUNTER_32bit(IXGBE_VFMPRC, adapter->stats.last_vfmprc,
2727				adapter->stats.vfmprc);
2728
2729	for (i = 0;  i  < adapter->num_rx_queues;  i++) {
2730		adapter->hw_csum_rx_error +=
2731			adapter->rx_ring[i]->hw_csum_rx_error;
2732		adapter->rx_ring[i]->hw_csum_rx_error = 0;
 
 
 
2733	}
 
 
 
 
 
2734}
2735
2736/**
2737 * ixgbevf_service_timer - Timer Call-back
2738 * @data: pointer to adapter cast into an unsigned long
2739 **/
2740static void ixgbevf_service_timer(unsigned long data)
2741{
2742	struct ixgbevf_adapter *adapter = (struct ixgbevf_adapter *)data;
 
2743
2744	/* Reset the timer */
2745	mod_timer(&adapter->service_timer, (HZ * 2) + jiffies);
2746
2747	ixgbevf_service_event_schedule(adapter);
2748}
2749
2750static void ixgbevf_reset_subtask(struct ixgbevf_adapter *adapter)
2751{
2752	if (!(adapter->flags & IXGBEVF_FLAG_RESET_REQUESTED))
2753		return;
2754
2755	adapter->flags &= ~IXGBEVF_FLAG_RESET_REQUESTED;
2756
2757	/* If we're already down or resetting, just bail */
2758	if (test_bit(__IXGBEVF_DOWN, &adapter->state) ||
2759	    test_bit(__IXGBEVF_RESETTING, &adapter->state))
 
 
2760		return;
 
2761
2762	adapter->tx_timeout_count++;
2763
2764	ixgbevf_reinit_locked(adapter);
 
2765}
2766
2767/**
2768 * ixgbevf_check_hang_subtask - check for hung queues and dropped interrupts
2769 * @adapter: pointer to the device adapter structure
2770 *
2771 * This function serves two purposes.  First it strobes the interrupt lines
2772 * in order to make certain interrupts are occurring.  Secondly it sets the
2773 * bits needed to check for TX hangs.  As a result we should immediately
2774 * determine if a hang has occurred.
2775 **/
2776static void ixgbevf_check_hang_subtask(struct ixgbevf_adapter *adapter)
2777{
2778	struct ixgbe_hw *hw = &adapter->hw;
2779	u32 eics = 0;
2780	int i;
2781
2782	/* If we're down or resetting, just bail */
2783	if (test_bit(__IXGBEVF_DOWN, &adapter->state) ||
2784	    test_bit(__IXGBEVF_RESETTING, &adapter->state))
2785		return;
2786
2787	/* Force detection of hung controller */
2788	if (netif_carrier_ok(adapter->netdev)) {
2789		for (i = 0; i < adapter->num_tx_queues; i++)
2790			set_check_for_tx_hang(adapter->tx_ring[i]);
 
 
2791	}
2792
2793	/* get one bit for every active Tx/Rx interrupt vector */
2794	for (i = 0; i < adapter->num_msix_vectors - NON_Q_VECTORS; i++) {
2795		struct ixgbevf_q_vector *qv = adapter->q_vector[i];
2796
2797		if (qv->rx.ring || qv->tx.ring)
2798			eics |= 1 << i;
2799	}
2800
2801	/* Cause software interrupt to ensure rings are cleaned */
2802	IXGBE_WRITE_REG(hw, IXGBE_VTEICS, eics);
2803}
2804
2805/**
2806 * ixgbevf_watchdog_update_link - update the link status
2807 * @adapter: pointer to the device adapter structure
2808 **/
2809static void ixgbevf_watchdog_update_link(struct ixgbevf_adapter *adapter)
2810{
2811	struct ixgbe_hw *hw = &adapter->hw;
2812	u32 link_speed = adapter->link_speed;
2813	bool link_up = adapter->link_up;
2814	s32 err;
2815
2816	spin_lock_bh(&adapter->mbx_lock);
2817
2818	err = hw->mac.ops.check_link(hw, &link_speed, &link_up, false);
2819
2820	spin_unlock_bh(&adapter->mbx_lock);
2821
2822	/* if check for link returns error we will need to reset */
2823	if (err && time_after(jiffies, adapter->last_reset + (10 * HZ))) {
2824		adapter->flags |= IXGBEVF_FLAG_RESET_REQUESTED;
2825		link_up = false;
2826	}
2827
2828	adapter->link_up = link_up;
2829	adapter->link_speed = link_speed;
2830}
2831
2832/**
2833 * ixgbevf_watchdog_link_is_up - update netif_carrier status and
2834 *				 print link up message
2835 * @adapter: pointer to the device adapter structure
2836 **/
2837static void ixgbevf_watchdog_link_is_up(struct ixgbevf_adapter *adapter)
2838{
2839	struct net_device *netdev = adapter->netdev;
2840
2841	/* only continue if link was previously down */
2842	if (netif_carrier_ok(netdev))
2843		return;
2844
2845	dev_info(&adapter->pdev->dev, "NIC Link is Up %s\n",
2846		 (adapter->link_speed == IXGBE_LINK_SPEED_10GB_FULL) ?
2847		 "10 Gbps" :
2848		 (adapter->link_speed == IXGBE_LINK_SPEED_1GB_FULL) ?
2849		 "1 Gbps" :
2850		 (adapter->link_speed == IXGBE_LINK_SPEED_100_FULL) ?
2851		 "100 Mbps" :
2852		 "unknown speed");
2853
2854	netif_carrier_on(netdev);
2855}
2856
2857/**
2858 * ixgbevf_watchdog_link_is_down - update netif_carrier status and
2859 *				   print link down message
2860 * @adapter: pointer to the adapter structure
2861 **/
2862static void ixgbevf_watchdog_link_is_down(struct ixgbevf_adapter *adapter)
2863{
2864	struct net_device *netdev = adapter->netdev;
2865
2866	adapter->link_speed = 0;
2867
2868	/* only continue if link was up previously */
2869	if (!netif_carrier_ok(netdev))
2870		return;
2871
2872	dev_info(&adapter->pdev->dev, "NIC Link is Down\n");
2873
2874	netif_carrier_off(netdev);
2875}
2876
2877/**
2878 * ixgbevf_watchdog_subtask - worker thread to bring link up
2879 * @work: pointer to work_struct containing our data
2880 **/
2881static void ixgbevf_watchdog_subtask(struct ixgbevf_adapter *adapter)
2882{
2883	/* if interface is down do nothing */
2884	if (test_bit(__IXGBEVF_DOWN, &adapter->state) ||
2885	    test_bit(__IXGBEVF_RESETTING, &adapter->state))
2886		return;
2887
2888	ixgbevf_watchdog_update_link(adapter);
2889
2890	if (adapter->link_up)
2891		ixgbevf_watchdog_link_is_up(adapter);
2892	else
2893		ixgbevf_watchdog_link_is_down(adapter);
2894
2895	ixgbevf_update_stats(adapter);
2896}
2897
2898/**
2899 * ixgbevf_service_task - manages and runs subtasks
2900 * @work: pointer to work_struct containing our data
2901 **/
2902static void ixgbevf_service_task(struct work_struct *work)
2903{
2904	struct ixgbevf_adapter *adapter = container_of(work,
2905						       struct ixgbevf_adapter,
2906						       service_task);
2907	struct ixgbe_hw *hw = &adapter->hw;
2908
2909	if (IXGBE_REMOVED(hw->hw_addr)) {
2910		if (!test_bit(__IXGBEVF_DOWN, &adapter->state)) {
2911			rtnl_lock();
2912			ixgbevf_down(adapter);
2913			rtnl_unlock();
2914		}
2915		return;
2916	}
2917
2918	ixgbevf_queue_reset_subtask(adapter);
2919	ixgbevf_reset_subtask(adapter);
2920	ixgbevf_watchdog_subtask(adapter);
2921	ixgbevf_check_hang_subtask(adapter);
2922
2923	ixgbevf_service_event_complete(adapter);
2924}
2925
2926/**
2927 * ixgbevf_free_tx_resources - Free Tx Resources per Queue
2928 * @tx_ring: Tx descriptor ring for a specific queue
2929 *
2930 * Free all transmit software resources
2931 **/
2932void ixgbevf_free_tx_resources(struct ixgbevf_ring *tx_ring)
2933{
2934	ixgbevf_clean_tx_ring(tx_ring);
2935
2936	vfree(tx_ring->tx_buffer_info);
2937	tx_ring->tx_buffer_info = NULL;
2938
2939	/* if not set, then don't free */
2940	if (!tx_ring->desc)
2941		return;
2942
2943	dma_free_coherent(tx_ring->dev, tx_ring->size, tx_ring->desc,
2944			  tx_ring->dma);
2945
2946	tx_ring->desc = NULL;
2947}
2948
2949/**
2950 * ixgbevf_free_all_tx_resources - Free Tx Resources for All Queues
2951 * @adapter: board private structure
2952 *
2953 * Free all transmit software resources
2954 **/
2955static void ixgbevf_free_all_tx_resources(struct ixgbevf_adapter *adapter)
2956{
2957	int i;
2958
2959	for (i = 0; i < adapter->num_tx_queues; i++)
2960		if (adapter->tx_ring[i]->desc)
2961			ixgbevf_free_tx_resources(adapter->tx_ring[i]);
 
 
 
2962}
2963
2964/**
2965 * ixgbevf_setup_tx_resources - allocate Tx resources (Descriptors)
2966 * @tx_ring: Tx descriptor ring (for a specific queue) to setup
2967 *
2968 * Return 0 on success, negative on failure
2969 **/
2970int ixgbevf_setup_tx_resources(struct ixgbevf_ring *tx_ring)
2971{
 
2972	int size;
2973
2974	size = sizeof(struct ixgbevf_tx_buffer) * tx_ring->count;
2975	tx_ring->tx_buffer_info = vzalloc(size);
2976	if (!tx_ring->tx_buffer_info)
2977		goto err;
2978
 
 
2979	/* round up to nearest 4K */
2980	tx_ring->size = tx_ring->count * sizeof(union ixgbe_adv_tx_desc);
2981	tx_ring->size = ALIGN(tx_ring->size, 4096);
2982
2983	tx_ring->desc = dma_alloc_coherent(tx_ring->dev, tx_ring->size,
2984					   &tx_ring->dma, GFP_KERNEL);
2985	if (!tx_ring->desc)
2986		goto err;
2987
2988	return 0;
2989
2990err:
2991	vfree(tx_ring->tx_buffer_info);
2992	tx_ring->tx_buffer_info = NULL;
2993	hw_dbg(&adapter->hw, "Unable to allocate memory for the transmit descriptor ring\n");
2994	return -ENOMEM;
2995}
2996
2997/**
2998 * ixgbevf_setup_all_tx_resources - allocate all queues Tx resources
2999 * @adapter: board private structure
3000 *
3001 * If this function returns with an error, then it's possible one or
3002 * more of the rings is populated (while the rest are not).  It is the
3003 * callers duty to clean those orphaned rings.
3004 *
3005 * Return 0 on success, negative on failure
3006 **/
3007static int ixgbevf_setup_all_tx_resources(struct ixgbevf_adapter *adapter)
3008{
3009	int i, err = 0;
3010
3011	for (i = 0; i < adapter->num_tx_queues; i++) {
3012		err = ixgbevf_setup_tx_resources(adapter->tx_ring[i]);
3013		if (!err)
3014			continue;
3015		hw_dbg(&adapter->hw, "Allocation for Tx Queue %u failed\n", i);
3016		break;
 
 
 
 
 
 
 
 
3017	}
3018
 
 
 
 
 
 
 
 
3019	return err;
3020}
3021
3022/**
3023 * ixgbevf_setup_rx_resources - allocate Rx resources (Descriptors)
 
3024 * @rx_ring: Rx descriptor ring (for a specific queue) to setup
3025 *
3026 * Returns 0 on success, negative on failure
3027 **/
3028int ixgbevf_setup_rx_resources(struct ixgbevf_ring *rx_ring)
 
3029{
3030	int size;
3031
3032	size = sizeof(struct ixgbevf_rx_buffer) * rx_ring->count;
3033	rx_ring->rx_buffer_info = vzalloc(size);
3034	if (!rx_ring->rx_buffer_info)
3035		goto err;
3036
 
 
3037	/* Round up to nearest 4K */
3038	rx_ring->size = rx_ring->count * sizeof(union ixgbe_adv_rx_desc);
3039	rx_ring->size = ALIGN(rx_ring->size, 4096);
3040
3041	rx_ring->desc = dma_alloc_coherent(rx_ring->dev, rx_ring->size,
3042					   &rx_ring->dma, GFP_KERNEL);
3043
3044	if (!rx_ring->desc)
3045		goto err;
3046
 
 
 
 
 
 
 
3047	return 0;
3048err:
3049	vfree(rx_ring->rx_buffer_info);
3050	rx_ring->rx_buffer_info = NULL;
3051	dev_err(rx_ring->dev, "Unable to allocate memory for the Rx descriptor ring\n");
3052	return -ENOMEM;
3053}
3054
3055/**
3056 * ixgbevf_setup_all_rx_resources - allocate all queues Rx resources
3057 * @adapter: board private structure
3058 *
3059 * If this function returns with an error, then it's possible one or
3060 * more of the rings is populated (while the rest are not).  It is the
3061 * callers duty to clean those orphaned rings.
3062 *
3063 * Return 0 on success, negative on failure
3064 **/
3065static int ixgbevf_setup_all_rx_resources(struct ixgbevf_adapter *adapter)
3066{
3067	int i, err = 0;
3068
3069	for (i = 0; i < adapter->num_rx_queues; i++) {
3070		err = ixgbevf_setup_rx_resources(adapter->rx_ring[i]);
3071		if (!err)
3072			continue;
3073		hw_dbg(&adapter->hw, "Allocation for Rx Queue %u failed\n", i);
3074		break;
3075	}
 
 
 
 
 
 
3076	return err;
3077}
3078
3079/**
3080 * ixgbevf_free_rx_resources - Free Rx Resources
3081 * @rx_ring: ring to clean the resources from
3082 *
3083 * Free all receive software resources
3084 **/
3085void ixgbevf_free_rx_resources(struct ixgbevf_ring *rx_ring)
3086{
3087	ixgbevf_clean_rx_ring(rx_ring);
3088
 
 
3089	vfree(rx_ring->rx_buffer_info);
3090	rx_ring->rx_buffer_info = NULL;
3091
3092	dma_free_coherent(rx_ring->dev, rx_ring->size, rx_ring->desc,
3093			  rx_ring->dma);
3094
3095	rx_ring->desc = NULL;
3096}
3097
3098/**
3099 * ixgbevf_free_all_rx_resources - Free Rx Resources for All Queues
3100 * @adapter: board private structure
3101 *
3102 * Free all receive software resources
3103 **/
3104static void ixgbevf_free_all_rx_resources(struct ixgbevf_adapter *adapter)
3105{
3106	int i;
3107
3108	for (i = 0; i < adapter->num_rx_queues; i++)
3109		if (adapter->rx_ring[i]->desc)
3110			ixgbevf_free_rx_resources(adapter->rx_ring[i]);
3111}
3112
3113/**
3114 * ixgbevf_open - Called when a network interface is made active
3115 * @netdev: network interface device structure
3116 *
3117 * Returns 0 on success, negative value on failure
3118 *
3119 * The open entry point is called when a network interface is made
3120 * active by the system (IFF_UP).  At this point all resources needed
3121 * for transmit and receive operations are allocated, the interrupt
3122 * handler is registered with the OS, the watchdog timer is started,
3123 * and the stack is notified that the interface is ready.
3124 **/
3125int ixgbevf_open(struct net_device *netdev)
3126{
3127	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3128	struct ixgbe_hw *hw = &adapter->hw;
3129	int err;
3130
3131	/* A previous failure to open the device because of a lack of
3132	 * available MSIX vector resources may have reset the number
3133	 * of msix vectors variable to zero.  The only way to recover
3134	 * is to unload/reload the driver and hope that the system has
3135	 * been able to recover some MSIX vector resources.
3136	 */
3137	if (!adapter->num_msix_vectors)
3138		return -ENOMEM;
3139
3140	if (hw->adapter_stopped) {
3141		ixgbevf_reset(adapter);
3142		/* if adapter is still stopped then PF isn't up and
3143		 * the VF can't start.
3144		 */
3145		if (hw->adapter_stopped) {
3146			err = IXGBE_ERR_MBX;
3147			pr_err("Unable to start - perhaps the PF Driver isn't up yet\n");
3148			goto err_setup_reset;
3149		}
3150	}
3151
3152	/* disallow open during test */
3153	if (test_bit(__IXGBEVF_TESTING, &adapter->state))
3154		return -EBUSY;
3155
3156	netif_carrier_off(netdev);
3157
3158	/* allocate transmit descriptors */
3159	err = ixgbevf_setup_all_tx_resources(adapter);
3160	if (err)
3161		goto err_setup_tx;
3162
3163	/* allocate receive descriptors */
3164	err = ixgbevf_setup_all_rx_resources(adapter);
3165	if (err)
3166		goto err_setup_rx;
3167
3168	ixgbevf_configure(adapter);
3169
3170	/* Map the Tx/Rx rings to the vectors we were allotted.
3171	 * if request_irq will be called in this function map_rings
3172	 * must be called *before* up_complete
3173	 */
3174	ixgbevf_map_rings_to_vectors(adapter);
3175
3176	err = ixgbevf_request_irq(adapter);
3177	if (err)
3178		goto err_req_irq;
3179
 
 
 
 
 
 
 
 
 
3180	ixgbevf_up_complete(adapter);
3181
3182	return 0;
3183
 
 
3184err_req_irq:
3185	ixgbevf_down(adapter);
3186err_setup_rx:
3187	ixgbevf_free_all_rx_resources(adapter);
3188err_setup_tx:
3189	ixgbevf_free_all_tx_resources(adapter);
3190	ixgbevf_reset(adapter);
3191
3192err_setup_reset:
3193
3194	return err;
3195}
3196
3197/**
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
3198 * ixgbevf_close - Disables a network interface
3199 * @netdev: network interface device structure
3200 *
3201 * Returns 0, this is not allowed to fail
3202 *
3203 * The close entry point is called when an interface is de-activated
3204 * by the OS.  The hardware is still under the drivers control, but
3205 * needs to be disabled.  A global MAC reset is issued to stop the
3206 * hardware, and all transmit and receive resources are freed.
3207 **/
3208int ixgbevf_close(struct net_device *netdev)
3209{
3210	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3211
3212	ixgbevf_down(adapter);
3213	ixgbevf_free_irq(adapter);
3214
3215	ixgbevf_free_all_tx_resources(adapter);
3216	ixgbevf_free_all_rx_resources(adapter);
3217
3218	return 0;
3219}
3220
3221static void ixgbevf_queue_reset_subtask(struct ixgbevf_adapter *adapter)
3222{
3223	struct net_device *dev = adapter->netdev;
3224
3225	if (!(adapter->flags & IXGBEVF_FLAG_QUEUE_RESET_REQUESTED))
 
3226		return;
3227
3228	adapter->flags &= ~IXGBEVF_FLAG_QUEUE_RESET_REQUESTED;
3229
3230	/* if interface is down do nothing */
3231	if (test_bit(__IXGBEVF_DOWN, &adapter->state) ||
3232	    test_bit(__IXGBEVF_RESETTING, &adapter->state))
3233		return;
3234
3235	/* Hardware has to reinitialize queues and interrupts to
3236	 * match packet buffer alignment. Unfortunately, the
3237	 * hardware is not flexible enough to do this dynamically.
3238	 */
 
 
3239	if (netif_running(dev))
3240		ixgbevf_close(dev);
3241
3242	ixgbevf_clear_interrupt_scheme(adapter);
3243	ixgbevf_init_interrupt_scheme(adapter);
3244
3245	if (netif_running(dev))
3246		ixgbevf_open(dev);
 
 
3247}
3248
3249static void ixgbevf_tx_ctxtdesc(struct ixgbevf_ring *tx_ring,
3250				u32 vlan_macip_lens, u32 type_tucmd,
3251				u32 mss_l4len_idx)
3252{
3253	struct ixgbe_adv_tx_context_desc *context_desc;
3254	u16 i = tx_ring->next_to_use;
3255
3256	context_desc = IXGBEVF_TX_CTXTDESC(tx_ring, i);
3257
3258	i++;
3259	tx_ring->next_to_use = (i < tx_ring->count) ? i : 0;
3260
3261	/* set bits to identify this as an advanced context descriptor */
3262	type_tucmd |= IXGBE_TXD_CMD_DEXT | IXGBE_ADVTXD_DTYP_CTXT;
3263
3264	context_desc->vlan_macip_lens	= cpu_to_le32(vlan_macip_lens);
3265	context_desc->seqnum_seed	= 0;
3266	context_desc->type_tucmd_mlhl	= cpu_to_le32(type_tucmd);
3267	context_desc->mss_l4len_idx	= cpu_to_le32(mss_l4len_idx);
3268}
3269
3270static int ixgbevf_tso(struct ixgbevf_ring *tx_ring,
3271		       struct ixgbevf_tx_buffer *first,
3272		       u8 *hdr_len)
 
3273{
 
3274	struct sk_buff *skb = first->skb;
3275	u32 vlan_macip_lens, type_tucmd;
3276	u32 mss_l4len_idx, l4len;
 
 
 
 
 
 
 
 
 
3277	int err;
3278
3279	if (skb->ip_summed != CHECKSUM_PARTIAL)
3280		return 0;
3281
3282	if (!skb_is_gso(skb))
3283		return 0;
3284
3285	err = skb_cow_head(skb, 0);
3286	if (err < 0)
3287		return err;
3288
 
 
 
 
 
 
3289	/* ADV DTYP TUCMD MKRLOC/ISCSIHEDLEN */
3290	type_tucmd = IXGBE_ADVTXD_TUCMD_L4T_TCP;
3291
3292	if (first->protocol == htons(ETH_P_IP)) {
3293		struct iphdr *iph = ip_hdr(skb);
 
 
 
 
 
 
 
 
 
 
 
 
3294
3295		iph->tot_len = 0;
3296		iph->check = 0;
3297		tcp_hdr(skb)->check = ~csum_tcpudp_magic(iph->saddr,
3298							 iph->daddr, 0,
3299							 IPPROTO_TCP,
3300							 0);
3301		type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
3302		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
3303				   IXGBE_TX_FLAGS_CSUM |
3304				   IXGBE_TX_FLAGS_IPV4;
3305	} else if (skb_is_gso_v6(skb)) {
3306		ipv6_hdr(skb)->payload_len = 0;
3307		tcp_hdr(skb)->check =
3308		    ~csum_ipv6_magic(&ipv6_hdr(skb)->saddr,
3309				     &ipv6_hdr(skb)->daddr,
3310				     0, IPPROTO_TCP, 0);
3311		first->tx_flags |= IXGBE_TX_FLAGS_TSO |
3312				   IXGBE_TX_FLAGS_CSUM;
3313	}
3314
3315	/* compute header lengths */
3316	l4len = tcp_hdrlen(skb);
3317	*hdr_len += l4len;
3318	*hdr_len = skb_transport_offset(skb) + l4len;
 
 
 
 
 
3319
3320	/* update GSO size and bytecount with header size */
3321	first->gso_segs = skb_shinfo(skb)->gso_segs;
3322	first->bytecount += (first->gso_segs - 1) * *hdr_len;
3323
3324	/* mss_l4len_id: use 1 as index for TSO */
3325	mss_l4len_idx = l4len << IXGBE_ADVTXD_L4LEN_SHIFT;
3326	mss_l4len_idx |= skb_shinfo(skb)->gso_size << IXGBE_ADVTXD_MSS_SHIFT;
3327	mss_l4len_idx |= 1 << IXGBE_ADVTXD_IDX_SHIFT;
 
 
 
3328
3329	/* vlan_macip_lens: HEADLEN, MACLEN, VLAN tag */
3330	vlan_macip_lens = skb_network_header_len(skb);
3331	vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
3332	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
3333
3334	ixgbevf_tx_ctxtdesc(tx_ring, vlan_macip_lens,
3335			    type_tucmd, mss_l4len_idx);
3336
3337	return 1;
3338}
3339
3340static void ixgbevf_tx_csum(struct ixgbevf_ring *tx_ring,
3341			    struct ixgbevf_tx_buffer *first)
 
3342{
3343	struct sk_buff *skb = first->skb;
3344	u32 vlan_macip_lens = 0;
3345	u32 mss_l4len_idx = 0;
3346	u32 type_tucmd = 0;
3347
3348	if (skb->ip_summed == CHECKSUM_PARTIAL) {
3349		u8 l4_hdr = 0;
3350		__be16 frag_off;
3351
3352		switch (first->protocol) {
3353		case htons(ETH_P_IP):
3354			vlan_macip_lens |= skb_network_header_len(skb);
3355			type_tucmd |= IXGBE_ADVTXD_TUCMD_IPV4;
3356			l4_hdr = ip_hdr(skb)->protocol;
3357			break;
3358		case htons(ETH_P_IPV6):
3359			vlan_macip_lens |= skb_network_header_len(skb);
3360			l4_hdr = ipv6_hdr(skb)->nexthdr;
3361			if (likely(skb_network_header_len(skb) ==
3362				   sizeof(struct ipv6hdr)))
3363				break;
3364			ipv6_skip_exthdr(skb, skb_network_offset(skb) +
3365					      sizeof(struct ipv6hdr),
3366					 &l4_hdr, &frag_off);
3367			if (unlikely(frag_off))
3368				l4_hdr = NEXTHDR_FRAGMENT;
3369			break;
3370		default:
3371			break;
3372		}
3373
3374		switch (l4_hdr) {
3375		case IPPROTO_TCP:
3376			type_tucmd |= IXGBE_ADVTXD_TUCMD_L4T_TCP;
3377			mss_l4len_idx = tcp_hdrlen(skb) <<
3378					IXGBE_ADVTXD_L4LEN_SHIFT;
3379			break;
3380		case IPPROTO_SCTP:
3381			type_tucmd |= IXGBE_ADVTXD_TUCMD_L4T_SCTP;
3382			mss_l4len_idx = sizeof(struct sctphdr) <<
3383					IXGBE_ADVTXD_L4LEN_SHIFT;
3384			break;
3385		case IPPROTO_UDP:
3386			mss_l4len_idx = sizeof(struct udphdr) <<
3387					IXGBE_ADVTXD_L4LEN_SHIFT;
3388			break;
3389		default:
3390			if (unlikely(net_ratelimit())) {
3391				dev_warn(tx_ring->dev,
3392					 "partial checksum, l3 proto=%x, l4 proto=%x\n",
3393					 first->protocol, l4_hdr);
3394			}
3395			skb_checksum_help(skb);
3396			goto no_csum;
3397		}
 
 
 
 
 
3398
3399		/* update TX checksum flag */
3400		first->tx_flags |= IXGBE_TX_FLAGS_CSUM;
3401	}
3402
 
 
 
 
3403no_csum:
3404	/* vlan_macip_lens: MACLEN, VLAN tag */
3405	vlan_macip_lens |= skb_network_offset(skb) << IXGBE_ADVTXD_MACLEN_SHIFT;
3406	vlan_macip_lens |= first->tx_flags & IXGBE_TX_FLAGS_VLAN_MASK;
3407
 
 
 
3408	ixgbevf_tx_ctxtdesc(tx_ring, vlan_macip_lens,
3409			    type_tucmd, mss_l4len_idx);
3410}
3411
3412static __le32 ixgbevf_tx_cmd_type(u32 tx_flags)
3413{
3414	/* set type for advanced descriptor with frame checksum insertion */
3415	__le32 cmd_type = cpu_to_le32(IXGBE_ADVTXD_DTYP_DATA |
3416				      IXGBE_ADVTXD_DCMD_IFCS |
3417				      IXGBE_ADVTXD_DCMD_DEXT);
3418
3419	/* set HW VLAN bit if VLAN is present */
3420	if (tx_flags & IXGBE_TX_FLAGS_VLAN)
3421		cmd_type |= cpu_to_le32(IXGBE_ADVTXD_DCMD_VLE);
3422
3423	/* set segmentation enable bits for TSO/FSO */
3424	if (tx_flags & IXGBE_TX_FLAGS_TSO)
3425		cmd_type |= cpu_to_le32(IXGBE_ADVTXD_DCMD_TSE);
3426
3427	return cmd_type;
3428}
3429
3430static void ixgbevf_tx_olinfo_status(union ixgbe_adv_tx_desc *tx_desc,
3431				     u32 tx_flags, unsigned int paylen)
3432{
3433	__le32 olinfo_status = cpu_to_le32(paylen << IXGBE_ADVTXD_PAYLEN_SHIFT);
3434
3435	/* enable L4 checksum for TSO and TX checksum offload */
3436	if (tx_flags & IXGBE_TX_FLAGS_CSUM)
3437		olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_POPTS_TXSM);
3438
3439	/* enble IPv4 checksum for TSO */
3440	if (tx_flags & IXGBE_TX_FLAGS_IPV4)
3441		olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_POPTS_IXSM);
3442
3443	/* use index 1 context for TSO/FSO/FCOE */
3444	if (tx_flags & IXGBE_TX_FLAGS_TSO)
3445		olinfo_status |= cpu_to_le32(1 << IXGBE_ADVTXD_IDX_SHIFT);
 
 
 
 
3446
3447	/* Check Context must be set if Tx switch is enabled, which it
3448	 * always is for case where virtual functions are running
3449	 */
3450	olinfo_status |= cpu_to_le32(IXGBE_ADVTXD_CC);
3451
3452	tx_desc->read.olinfo_status = olinfo_status;
3453}
3454
3455static void ixgbevf_tx_map(struct ixgbevf_ring *tx_ring,
3456			   struct ixgbevf_tx_buffer *first,
3457			   const u8 hdr_len)
3458{
3459	dma_addr_t dma;
3460	struct sk_buff *skb = first->skb;
3461	struct ixgbevf_tx_buffer *tx_buffer;
3462	union ixgbe_adv_tx_desc *tx_desc;
3463	struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[0];
3464	unsigned int data_len = skb->data_len;
3465	unsigned int size = skb_headlen(skb);
3466	unsigned int paylen = skb->len - hdr_len;
3467	u32 tx_flags = first->tx_flags;
3468	__le32 cmd_type;
3469	u16 i = tx_ring->next_to_use;
3470
3471	tx_desc = IXGBEVF_TX_DESC(tx_ring, i);
3472
3473	ixgbevf_tx_olinfo_status(tx_desc, tx_flags, paylen);
3474	cmd_type = ixgbevf_tx_cmd_type(tx_flags);
 
 
3475
3476	dma = dma_map_single(tx_ring->dev, skb->data, size, DMA_TO_DEVICE);
3477	if (dma_mapping_error(tx_ring->dev, dma))
3478		goto dma_error;
3479
3480	/* record length, and DMA address */
3481	dma_unmap_len_set(first, len, size);
3482	dma_unmap_addr_set(first, dma, dma);
3483
3484	tx_desc->read.buffer_addr = cpu_to_le64(dma);
 
 
 
 
 
 
 
 
3485
3486	for (;;) {
3487		while (unlikely(size > IXGBE_MAX_DATA_PER_TXD)) {
3488			tx_desc->read.cmd_type_len =
3489				cmd_type | cpu_to_le32(IXGBE_MAX_DATA_PER_TXD);
3490
3491			i++;
3492			tx_desc++;
3493			if (i == tx_ring->count) {
3494				tx_desc = IXGBEVF_TX_DESC(tx_ring, 0);
3495				i = 0;
3496			}
 
3497
3498			dma += IXGBE_MAX_DATA_PER_TXD;
3499			size -= IXGBE_MAX_DATA_PER_TXD;
3500
3501			tx_desc->read.buffer_addr = cpu_to_le64(dma);
3502			tx_desc->read.olinfo_status = 0;
3503		}
3504
3505		if (likely(!data_len))
3506			break;
3507
3508		tx_desc->read.cmd_type_len = cmd_type | cpu_to_le32(size);
3509
3510		i++;
3511		tx_desc++;
3512		if (i == tx_ring->count) {
3513			tx_desc = IXGBEVF_TX_DESC(tx_ring, 0);
3514			i = 0;
3515		}
 
3516
3517		size = skb_frag_size(frag);
3518		data_len -= size;
3519
3520		dma = skb_frag_dma_map(tx_ring->dev, frag, 0, size,
3521				       DMA_TO_DEVICE);
3522		if (dma_mapping_error(tx_ring->dev, dma))
3523			goto dma_error;
3524
3525		tx_buffer = &tx_ring->tx_buffer_info[i];
3526		dma_unmap_len_set(tx_buffer, len, size);
3527		dma_unmap_addr_set(tx_buffer, dma, dma);
3528
3529		tx_desc->read.buffer_addr = cpu_to_le64(dma);
3530		tx_desc->read.olinfo_status = 0;
3531
3532		frag++;
3533	}
3534
3535	/* write last descriptor with RS and EOP bits */
3536	cmd_type |= cpu_to_le32(size) | cpu_to_le32(IXGBE_TXD_CMD);
3537	tx_desc->read.cmd_type_len = cmd_type;
3538
3539	/* set the timestamp */
3540	first->time_stamp = jiffies;
3541
 
 
3542	/* Force memory writes to complete before letting h/w know there
3543	 * are new descriptors to fetch.  (Only applicable for weak-ordered
3544	 * memory model archs, such as IA-64).
3545	 *
3546	 * We also need this memory barrier (wmb) to make certain all of the
3547	 * status bits have been updated before next_to_watch is written.
3548	 */
3549	wmb();
3550
3551	/* set next_to_watch value indicating a packet is present */
3552	first->next_to_watch = tx_desc;
3553
3554	i++;
3555	if (i == tx_ring->count)
3556		i = 0;
3557
3558	tx_ring->next_to_use = i;
3559
3560	/* notify HW of packet */
3561	ixgbevf_write_tail(tx_ring, i);
3562
3563	return;
3564dma_error:
3565	dev_err(tx_ring->dev, "TX DMA map failed\n");
 
3566
3567	/* clear dma mappings for failed tx_buffer_info map */
3568	for (;;) {
 
 
 
 
 
 
 
 
 
3569		tx_buffer = &tx_ring->tx_buffer_info[i];
3570		ixgbevf_unmap_and_free_tx_resource(tx_ring, tx_buffer);
3571		if (tx_buffer == first)
3572			break;
3573		if (i == 0)
3574			i = tx_ring->count;
3575		i--;
3576	}
3577
 
 
 
 
 
 
 
 
 
 
3578	tx_ring->next_to_use = i;
3579}
3580
3581static int __ixgbevf_maybe_stop_tx(struct ixgbevf_ring *tx_ring, int size)
3582{
3583	netif_stop_subqueue(tx_ring->netdev, tx_ring->queue_index);
3584	/* Herbert's original patch had:
3585	 *  smp_mb__after_netif_stop_queue();
3586	 * but since that doesn't exist yet, just open code it.
3587	 */
3588	smp_mb();
3589
3590	/* We need to check again in a case another CPU has just
3591	 * made room available.
3592	 */
3593	if (likely(ixgbevf_desc_unused(tx_ring) < size))
3594		return -EBUSY;
3595
3596	/* A reprieve! - use start_queue because it doesn't call schedule */
3597	netif_start_subqueue(tx_ring->netdev, tx_ring->queue_index);
3598	++tx_ring->tx_stats.restart_queue;
3599
3600	return 0;
3601}
3602
3603static int ixgbevf_maybe_stop_tx(struct ixgbevf_ring *tx_ring, int size)
3604{
3605	if (likely(ixgbevf_desc_unused(tx_ring) >= size))
3606		return 0;
3607	return __ixgbevf_maybe_stop_tx(tx_ring, size);
3608}
3609
3610static int ixgbevf_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
 
3611{
3612	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3613	struct ixgbevf_tx_buffer *first;
3614	struct ixgbevf_ring *tx_ring;
3615	int tso;
3616	u32 tx_flags = 0;
3617	u16 count = TXD_USE_COUNT(skb_headlen(skb));
 
3618#if PAGE_SIZE > IXGBE_MAX_DATA_PER_TXD
3619	unsigned short f;
3620#endif
3621	u8 hdr_len = 0;
3622	u8 *dst_mac = skb_header_pointer(skb, 0, 0, NULL);
3623
3624	if (!dst_mac || is_link_local_ether_addr(dst_mac)) {
3625		dev_kfree_skb_any(skb);
3626		return NETDEV_TX_OK;
3627	}
3628
3629	tx_ring = adapter->tx_ring[skb->queue_mapping];
3630
3631	/* need: 1 descriptor per page * PAGE_SIZE/IXGBE_MAX_DATA_PER_TXD,
3632	 *       + 1 desc for skb_headlen/IXGBE_MAX_DATA_PER_TXD,
3633	 *       + 2 desc gap to keep tail from touching head,
3634	 *       + 1 desc for context descriptor,
3635	 * otherwise try next time
3636	 */
3637#if PAGE_SIZE > IXGBE_MAX_DATA_PER_TXD
3638	for (f = 0; f < skb_shinfo(skb)->nr_frags; f++)
3639		count += TXD_USE_COUNT(skb_shinfo(skb)->frags[f].size);
 
 
 
3640#else
3641	count += skb_shinfo(skb)->nr_frags;
3642#endif
3643	if (ixgbevf_maybe_stop_tx(tx_ring, count + 3)) {
3644		tx_ring->tx_stats.tx_busy++;
3645		return NETDEV_TX_BUSY;
3646	}
3647
3648	/* record the location of the first descriptor for this packet */
3649	first = &tx_ring->tx_buffer_info[tx_ring->next_to_use];
3650	first->skb = skb;
3651	first->bytecount = skb->len;
3652	first->gso_segs = 1;
3653
3654	if (skb_vlan_tag_present(skb)) {
3655		tx_flags |= skb_vlan_tag_get(skb);
3656		tx_flags <<= IXGBE_TX_FLAGS_VLAN_SHIFT;
3657		tx_flags |= IXGBE_TX_FLAGS_VLAN;
3658	}
3659
3660	/* record initial flags and protocol */
3661	first->tx_flags = tx_flags;
3662	first->protocol = vlan_get_protocol(skb);
3663
3664	tso = ixgbevf_tso(tx_ring, first, &hdr_len);
 
 
 
 
3665	if (tso < 0)
3666		goto out_drop;
3667	else if (!tso)
3668		ixgbevf_tx_csum(tx_ring, first);
3669
3670	ixgbevf_tx_map(tx_ring, first, hdr_len);
3671
3672	ixgbevf_maybe_stop_tx(tx_ring, DESC_NEEDED);
3673
3674	return NETDEV_TX_OK;
3675
3676out_drop:
3677	dev_kfree_skb_any(first->skb);
3678	first->skb = NULL;
3679
3680	return NETDEV_TX_OK;
3681}
3682
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
3683/**
3684 * ixgbevf_set_mac - Change the Ethernet Address of the NIC
3685 * @netdev: network interface device structure
3686 * @p: pointer to an address structure
3687 *
3688 * Returns 0 on success, negative on failure
3689 **/
3690static int ixgbevf_set_mac(struct net_device *netdev, void *p)
3691{
3692	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3693	struct ixgbe_hw *hw = &adapter->hw;
3694	struct sockaddr *addr = p;
3695	int err;
3696
3697	if (!is_valid_ether_addr(addr->sa_data))
3698		return -EADDRNOTAVAIL;
3699
3700	spin_lock_bh(&adapter->mbx_lock);
3701
3702	err = hw->mac.ops.set_rar(hw, 0, addr->sa_data, 0);
3703
3704	spin_unlock_bh(&adapter->mbx_lock);
3705
3706	if (err)
3707		return -EPERM;
3708
3709	ether_addr_copy(hw->mac.addr, addr->sa_data);
3710	ether_addr_copy(netdev->dev_addr, addr->sa_data);
 
3711
3712	return 0;
3713}
3714
3715/**
3716 * ixgbevf_change_mtu - Change the Maximum Transfer Unit
3717 * @netdev: network interface device structure
3718 * @new_mtu: new value for maximum frame size
3719 *
3720 * Returns 0 on success, negative on failure
3721 **/
3722static int ixgbevf_change_mtu(struct net_device *netdev, int new_mtu)
3723{
3724	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3725	struct ixgbe_hw *hw = &adapter->hw;
3726	int max_frame = new_mtu + ETH_HLEN + ETH_FCS_LEN;
3727	int max_possible_frame = MAXIMUM_ETHERNET_VLAN_SIZE;
3728
3729	switch (adapter->hw.api_version) {
3730	case ixgbe_mbox_api_11:
3731	case ixgbe_mbox_api_12:
3732		max_possible_frame = IXGBE_MAX_JUMBO_FRAME_SIZE;
3733		break;
3734	default:
3735		if (adapter->hw.mac.type != ixgbe_mac_82599_vf)
3736			max_possible_frame = IXGBE_MAX_JUMBO_FRAME_SIZE;
3737		break;
3738	}
3739
3740	/* MTU < 68 is an error and causes problems on some kernels */
3741	if ((new_mtu < 68) || (max_frame > max_possible_frame))
 
 
 
3742		return -EINVAL;
3743
3744	hw_dbg(hw, "changing MTU from %d to %d\n",
3745	       netdev->mtu, new_mtu);
 
3746	/* must set new MTU before calling down or up */
3747	netdev->mtu = new_mtu;
3748
3749	/* notify the PF of our intent to use this size of frame */
3750	ixgbevf_rlpml_set_vf(hw, max_frame);
3751
3752	return 0;
3753}
3754
3755#ifdef CONFIG_NET_POLL_CONTROLLER
3756/* Polling 'interrupt' - used by things like netconsole to send skbs
3757 * without having to re-enable interrupts. It's not called while
3758 * the interrupt routine is executing.
3759 */
3760static void ixgbevf_netpoll(struct net_device *netdev)
3761{
 
3762	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3763	int i;
3764
3765	/* if interface is down do nothing */
3766	if (test_bit(__IXGBEVF_DOWN, &adapter->state))
3767		return;
3768	for (i = 0; i < adapter->num_rx_queues; i++)
3769		ixgbevf_msix_clean_rings(0, adapter->q_vector[i]);
3770}
3771#endif /* CONFIG_NET_POLL_CONTROLLER */
3772
3773static int ixgbevf_suspend(struct pci_dev *pdev, pm_message_t state)
3774{
3775	struct net_device *netdev = pci_get_drvdata(pdev);
3776	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3777#ifdef CONFIG_PM
3778	int retval = 0;
3779#endif
3780
 
3781	netif_device_detach(netdev);
3782
3783	if (netif_running(netdev)) {
3784		rtnl_lock();
3785		ixgbevf_down(adapter);
3786		ixgbevf_free_irq(adapter);
3787		ixgbevf_free_all_tx_resources(adapter);
3788		ixgbevf_free_all_rx_resources(adapter);
3789		rtnl_unlock();
3790	}
3791
3792	ixgbevf_clear_interrupt_scheme(adapter);
3793
3794#ifdef CONFIG_PM
3795	retval = pci_save_state(pdev);
3796	if (retval)
3797		return retval;
3798
3799#endif
3800	if (!test_and_set_bit(__IXGBEVF_DISABLED, &adapter->state))
3801		pci_disable_device(pdev);
3802
3803	return 0;
3804}
3805
3806#ifdef CONFIG_PM
3807static int ixgbevf_resume(struct pci_dev *pdev)
3808{
 
3809	struct net_device *netdev = pci_get_drvdata(pdev);
3810	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3811	u32 err;
3812
3813	pci_restore_state(pdev);
3814	/* pci_restore_state clears dev->state_saved so call
3815	 * pci_save_state to restore it.
3816	 */
3817	pci_save_state(pdev);
3818
3819	err = pci_enable_device_mem(pdev);
3820	if (err) {
3821		dev_err(&pdev->dev, "Cannot enable PCI device from suspend\n");
3822		return err;
3823	}
3824	smp_mb__before_atomic();
3825	clear_bit(__IXGBEVF_DISABLED, &adapter->state);
3826	pci_set_master(pdev);
3827
3828	ixgbevf_reset(adapter);
3829
3830	rtnl_lock();
3831	err = ixgbevf_init_interrupt_scheme(adapter);
 
 
3832	rtnl_unlock();
3833	if (err) {
3834		dev_err(&pdev->dev, "Cannot initialize interrupts\n");
3835		return err;
3836	}
3837
3838	if (netif_running(netdev)) {
3839		err = ixgbevf_open(netdev);
3840		if (err)
3841			return err;
3842	}
3843
3844	netif_device_attach(netdev);
3845
3846	return err;
3847}
3848
3849#endif /* CONFIG_PM */
3850static void ixgbevf_shutdown(struct pci_dev *pdev)
3851{
3852	ixgbevf_suspend(pdev, PMSG_SUSPEND);
3853}
3854
3855static struct rtnl_link_stats64 *ixgbevf_get_stats(struct net_device *netdev,
3856						struct rtnl_link_stats64 *stats)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
3857{
3858	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
3859	unsigned int start;
3860	u64 bytes, packets;
3861	const struct ixgbevf_ring *ring;
3862	int i;
3863
3864	ixgbevf_update_stats(adapter);
3865
3866	stats->multicast = adapter->stats.vfmprc - adapter->stats.base_vfmprc;
3867
 
3868	for (i = 0; i < adapter->num_rx_queues; i++) {
3869		ring = adapter->rx_ring[i];
3870		do {
3871			start = u64_stats_fetch_begin_irq(&ring->syncp);
3872			bytes = ring->stats.bytes;
3873			packets = ring->stats.packets;
3874		} while (u64_stats_fetch_retry_irq(&ring->syncp, start));
3875		stats->rx_bytes += bytes;
3876		stats->rx_packets += packets;
3877	}
3878
3879	for (i = 0; i < adapter->num_tx_queues; i++) {
3880		ring = adapter->tx_ring[i];
3881		do {
3882			start = u64_stats_fetch_begin_irq(&ring->syncp);
3883			bytes = ring->stats.bytes;
3884			packets = ring->stats.packets;
3885		} while (u64_stats_fetch_retry_irq(&ring->syncp, start));
3886		stats->tx_bytes += bytes;
3887		stats->tx_packets += packets;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
3888	}
3889
3890	return stats;
 
 
 
 
 
 
 
 
 
 
 
 
 
3891}
3892
3893static const struct net_device_ops ixgbevf_netdev_ops = {
3894	.ndo_open		= ixgbevf_open,
3895	.ndo_stop		= ixgbevf_close,
3896	.ndo_start_xmit		= ixgbevf_xmit_frame,
3897	.ndo_set_rx_mode	= ixgbevf_set_rx_mode,
3898	.ndo_get_stats64	= ixgbevf_get_stats,
3899	.ndo_validate_addr	= eth_validate_addr,
3900	.ndo_set_mac_address	= ixgbevf_set_mac,
3901	.ndo_change_mtu		= ixgbevf_change_mtu,
3902	.ndo_tx_timeout		= ixgbevf_tx_timeout,
3903	.ndo_vlan_rx_add_vid	= ixgbevf_vlan_rx_add_vid,
3904	.ndo_vlan_rx_kill_vid	= ixgbevf_vlan_rx_kill_vid,
3905#ifdef CONFIG_NET_RX_BUSY_POLL
3906	.ndo_busy_poll		= ixgbevf_busy_poll_recv,
3907#endif
3908#ifdef CONFIG_NET_POLL_CONTROLLER
3909	.ndo_poll_controller	= ixgbevf_netpoll,
3910#endif
3911	.ndo_features_check	= passthru_features_check,
3912};
3913
3914static void ixgbevf_assign_netdev_ops(struct net_device *dev)
3915{
3916	dev->netdev_ops = &ixgbevf_netdev_ops;
3917	ixgbevf_set_ethtool_ops(dev);
3918	dev->watchdog_timeo = 5 * HZ;
3919}
3920
3921/**
3922 * ixgbevf_probe - Device Initialization Routine
3923 * @pdev: PCI device information struct
3924 * @ent: entry in ixgbevf_pci_tbl
3925 *
3926 * Returns 0 on success, negative on failure
3927 *
3928 * ixgbevf_probe initializes an adapter identified by a pci_dev structure.
3929 * The OS initialization, configuring of the adapter private structure,
3930 * and a hardware reset occur.
3931 **/
3932static int ixgbevf_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
3933{
3934	struct net_device *netdev;
3935	struct ixgbevf_adapter *adapter = NULL;
3936	struct ixgbe_hw *hw = NULL;
3937	const struct ixgbevf_info *ii = ixgbevf_info_tbl[ent->driver_data];
3938	int err, pci_using_dac;
3939	bool disable_dev = false;
 
3940
3941	err = pci_enable_device(pdev);
3942	if (err)
3943		return err;
3944
3945	if (!dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64))) {
3946		pci_using_dac = 1;
3947	} else {
3948		err = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
3949		if (err) {
3950			dev_err(&pdev->dev, "No usable DMA configuration, aborting\n");
3951			goto err_dma;
3952		}
3953		pci_using_dac = 0;
3954	}
3955
3956	err = pci_request_regions(pdev, ixgbevf_driver_name);
3957	if (err) {
3958		dev_err(&pdev->dev, "pci_request_regions failed 0x%x\n", err);
3959		goto err_pci_reg;
3960	}
3961
3962	pci_set_master(pdev);
3963
3964	netdev = alloc_etherdev_mq(sizeof(struct ixgbevf_adapter),
3965				   MAX_TX_QUEUES);
3966	if (!netdev) {
3967		err = -ENOMEM;
3968		goto err_alloc_etherdev;
3969	}
3970
3971	SET_NETDEV_DEV(netdev, &pdev->dev);
3972
3973	adapter = netdev_priv(netdev);
3974
3975	adapter->netdev = netdev;
3976	adapter->pdev = pdev;
3977	hw = &adapter->hw;
3978	hw->back = adapter;
3979	adapter->msg_enable = netif_msg_init(debug, DEFAULT_MSG_ENABLE);
3980
3981	/* call save state here in standalone driver because it relies on
3982	 * adapter struct to exist, and needs to call netdev_priv
3983	 */
3984	pci_save_state(pdev);
3985
3986	hw->hw_addr = ioremap(pci_resource_start(pdev, 0),
3987			      pci_resource_len(pdev, 0));
3988	adapter->io_addr = hw->hw_addr;
3989	if (!hw->hw_addr) {
3990		err = -EIO;
3991		goto err_ioremap;
3992	}
3993
3994	ixgbevf_assign_netdev_ops(netdev);
3995
3996	/* Setup HW API */
3997	memcpy(&hw->mac.ops, ii->mac_ops, sizeof(hw->mac.ops));
3998	hw->mac.type  = ii->mac;
3999
4000	memcpy(&hw->mbx.ops, &ixgbevf_mbx_ops,
4001	       sizeof(struct ixgbe_mbx_operations));
4002
4003	/* setup the private structure */
4004	err = ixgbevf_sw_init(adapter);
4005	if (err)
4006		goto err_sw_init;
4007
4008	/* The HW MAC address was set and/or determined in sw_init */
4009	if (!is_valid_ether_addr(netdev->dev_addr)) {
4010		pr_err("invalid MAC address\n");
4011		err = -EIO;
4012		goto err_sw_init;
4013	}
4014
4015	netdev->hw_features = NETIF_F_SG |
4016			      NETIF_F_IP_CSUM |
4017			      NETIF_F_IPV6_CSUM |
4018			      NETIF_F_TSO |
4019			      NETIF_F_TSO6 |
4020			      NETIF_F_RXCSUM;
4021
4022	netdev->features = netdev->hw_features |
4023			   NETIF_F_HW_VLAN_CTAG_TX |
4024			   NETIF_F_HW_VLAN_CTAG_RX |
4025			   NETIF_F_HW_VLAN_CTAG_FILTER;
4026
4027	netdev->vlan_features |= NETIF_F_TSO |
 
 
 
 
 
 
 
 
 
 
 
 
4028				 NETIF_F_TSO6 |
4029				 NETIF_F_IP_CSUM |
4030				 NETIF_F_IPV6_CSUM |
4031				 NETIF_F_SG;
 
 
 
 
 
4032
4033	if (pci_using_dac)
4034		netdev->features |= NETIF_F_HIGHDMA;
4035
4036	netdev->priv_flags |= IFF_UNICAST_FLT;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
4037
4038	if (IXGBE_REMOVED(hw->hw_addr)) {
4039		err = -EIO;
4040		goto err_sw_init;
4041	}
4042
4043	setup_timer(&adapter->service_timer, &ixgbevf_service_timer,
4044		    (unsigned long)adapter);
4045
4046	INIT_WORK(&adapter->service_task, ixgbevf_service_task);
4047	set_bit(__IXGBEVF_SERVICE_INITED, &adapter->state);
4048	clear_bit(__IXGBEVF_SERVICE_SCHED, &adapter->state);
4049
4050	err = ixgbevf_init_interrupt_scheme(adapter);
4051	if (err)
4052		goto err_sw_init;
4053
4054	strcpy(netdev->name, "eth%d");
4055
4056	err = register_netdev(netdev);
4057	if (err)
4058		goto err_register;
4059
4060	pci_set_drvdata(pdev, netdev);
4061	netif_carrier_off(netdev);
 
4062
4063	ixgbevf_init_last_counter_stats(adapter);
4064
4065	/* print the VF info */
4066	dev_info(&pdev->dev, "%pM\n", netdev->dev_addr);
4067	dev_info(&pdev->dev, "MAC: %d\n", hw->mac.type);
4068
4069	switch (hw->mac.type) {
4070	case ixgbe_mac_X550_vf:
4071		dev_info(&pdev->dev, "Intel(R) X550 Virtual Function\n");
4072		break;
4073	case ixgbe_mac_X540_vf:
4074		dev_info(&pdev->dev, "Intel(R) X540 Virtual Function\n");
4075		break;
4076	case ixgbe_mac_82599_vf:
4077	default:
4078		dev_info(&pdev->dev, "Intel(R) 82599 Virtual Function\n");
4079		break;
4080	}
4081
4082	return 0;
4083
4084err_register:
4085	ixgbevf_clear_interrupt_scheme(adapter);
4086err_sw_init:
4087	ixgbevf_reset_interrupt_capability(adapter);
4088	iounmap(adapter->io_addr);
 
4089err_ioremap:
4090	disable_dev = !test_and_set_bit(__IXGBEVF_DISABLED, &adapter->state);
4091	free_netdev(netdev);
4092err_alloc_etherdev:
4093	pci_release_regions(pdev);
4094err_pci_reg:
4095err_dma:
4096	if (!adapter || disable_dev)
4097		pci_disable_device(pdev);
4098	return err;
4099}
4100
4101/**
4102 * ixgbevf_remove - Device Removal Routine
4103 * @pdev: PCI device information struct
4104 *
4105 * ixgbevf_remove is called by the PCI subsystem to alert the driver
4106 * that it should release a PCI device.  The could be caused by a
4107 * Hot-Plug event, or because the driver is going to be removed from
4108 * memory.
4109 **/
4110static void ixgbevf_remove(struct pci_dev *pdev)
4111{
4112	struct net_device *netdev = pci_get_drvdata(pdev);
4113	struct ixgbevf_adapter *adapter;
4114	bool disable_dev;
4115
4116	if (!netdev)
4117		return;
4118
4119	adapter = netdev_priv(netdev);
4120
4121	set_bit(__IXGBEVF_REMOVING, &adapter->state);
4122	cancel_work_sync(&adapter->service_task);
4123
4124	if (netdev->reg_state == NETREG_REGISTERED)
4125		unregister_netdev(netdev);
4126
 
4127	ixgbevf_clear_interrupt_scheme(adapter);
4128	ixgbevf_reset_interrupt_capability(adapter);
4129
4130	iounmap(adapter->io_addr);
4131	pci_release_regions(pdev);
4132
4133	hw_dbg(&adapter->hw, "Remove complete\n");
4134
 
4135	disable_dev = !test_and_set_bit(__IXGBEVF_DISABLED, &adapter->state);
4136	free_netdev(netdev);
4137
4138	if (disable_dev)
4139		pci_disable_device(pdev);
4140}
4141
4142/**
4143 * ixgbevf_io_error_detected - called when PCI error is detected
4144 * @pdev: Pointer to PCI device
4145 * @state: The current pci connection state
4146 *
4147 * This function is called after a PCI bus error affecting
4148 * this device has been detected.
4149 **/
4150static pci_ers_result_t ixgbevf_io_error_detected(struct pci_dev *pdev,
4151						  pci_channel_state_t state)
4152{
4153	struct net_device *netdev = pci_get_drvdata(pdev);
4154	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
4155
4156	if (!test_bit(__IXGBEVF_SERVICE_INITED, &adapter->state))
4157		return PCI_ERS_RESULT_DISCONNECT;
4158
4159	rtnl_lock();
4160	netif_device_detach(netdev);
4161
 
 
 
4162	if (state == pci_channel_io_perm_failure) {
4163		rtnl_unlock();
4164		return PCI_ERS_RESULT_DISCONNECT;
4165	}
4166
4167	if (netif_running(netdev))
4168		ixgbevf_down(adapter);
4169
4170	if (!test_and_set_bit(__IXGBEVF_DISABLED, &adapter->state))
4171		pci_disable_device(pdev);
4172	rtnl_unlock();
4173
4174	/* Request a slot slot reset. */
4175	return PCI_ERS_RESULT_NEED_RESET;
4176}
4177
4178/**
4179 * ixgbevf_io_slot_reset - called after the pci bus has been reset.
4180 * @pdev: Pointer to PCI device
4181 *
4182 * Restart the card from scratch, as if from a cold-boot. Implementation
4183 * resembles the first-half of the ixgbevf_resume routine.
4184 **/
4185static pci_ers_result_t ixgbevf_io_slot_reset(struct pci_dev *pdev)
4186{
4187	struct net_device *netdev = pci_get_drvdata(pdev);
4188	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
4189
4190	if (pci_enable_device_mem(pdev)) {
4191		dev_err(&pdev->dev,
4192			"Cannot re-enable PCI device after reset.\n");
4193		return PCI_ERS_RESULT_DISCONNECT;
4194	}
4195
 
4196	smp_mb__before_atomic();
4197	clear_bit(__IXGBEVF_DISABLED, &adapter->state);
4198	pci_set_master(pdev);
4199
4200	ixgbevf_reset(adapter);
4201
4202	return PCI_ERS_RESULT_RECOVERED;
4203}
4204
4205/**
4206 * ixgbevf_io_resume - called when traffic can start flowing again.
4207 * @pdev: Pointer to PCI device
4208 *
4209 * This callback is called when the error recovery driver tells us that
4210 * its OK to resume normal operation. Implementation resembles the
4211 * second-half of the ixgbevf_resume routine.
4212 **/
4213static void ixgbevf_io_resume(struct pci_dev *pdev)
4214{
4215	struct net_device *netdev = pci_get_drvdata(pdev);
4216	struct ixgbevf_adapter *adapter = netdev_priv(netdev);
4217
 
4218	if (netif_running(netdev))
4219		ixgbevf_up(adapter);
4220
4221	netif_device_attach(netdev);
 
4222}
4223
4224/* PCI Error Recovery (ERS) */
4225static const struct pci_error_handlers ixgbevf_err_handler = {
4226	.error_detected = ixgbevf_io_error_detected,
4227	.slot_reset = ixgbevf_io_slot_reset,
4228	.resume = ixgbevf_io_resume,
4229};
4230
 
 
4231static struct pci_driver ixgbevf_driver = {
4232	.name		= ixgbevf_driver_name,
4233	.id_table	= ixgbevf_pci_tbl,
4234	.probe		= ixgbevf_probe,
4235	.remove		= ixgbevf_remove,
4236#ifdef CONFIG_PM
4237	/* Power Management Hooks */
4238	.suspend	= ixgbevf_suspend,
4239	.resume		= ixgbevf_resume,
4240#endif
4241	.shutdown	= ixgbevf_shutdown,
4242	.err_handler	= &ixgbevf_err_handler
4243};
4244
4245/**
4246 * ixgbevf_init_module - Driver Registration Routine
4247 *
4248 * ixgbevf_init_module is the first routine called when the driver is
4249 * loaded. All it does is register with the PCI subsystem.
4250 **/
4251static int __init ixgbevf_init_module(void)
4252{
4253	pr_info("%s - version %s\n", ixgbevf_driver_string,
4254		ixgbevf_driver_version);
4255
 
4256	pr_info("%s\n", ixgbevf_copyright);
4257	ixgbevf_wq = create_singlethread_workqueue(ixgbevf_driver_name);
4258	if (!ixgbevf_wq) {
4259		pr_err("%s: Failed to create workqueue\n", ixgbevf_driver_name);
4260		return -ENOMEM;
4261	}
4262
4263	return pci_register_driver(&ixgbevf_driver);
 
 
 
 
 
 
4264}
4265
4266module_init(ixgbevf_init_module);
4267
4268/**
4269 * ixgbevf_exit_module - Driver Exit Cleanup Routine
4270 *
4271 * ixgbevf_exit_module is called just before the driver is removed
4272 * from memory.
4273 **/
4274static void __exit ixgbevf_exit_module(void)
4275{
4276	pci_unregister_driver(&ixgbevf_driver);
4277	if (ixgbevf_wq) {
4278		destroy_workqueue(ixgbevf_wq);
4279		ixgbevf_wq = NULL;
4280	}
4281}
4282
4283#ifdef DEBUG
4284/**
4285 * ixgbevf_get_hw_dev_name - return device name string
4286 * used by hardware layer to print debugging information
 
4287 **/
4288char *ixgbevf_get_hw_dev_name(struct ixgbe_hw *hw)
4289{
4290	struct ixgbevf_adapter *adapter = hw->back;
4291
4292	return adapter->netdev->name;
4293}
4294
4295#endif
4296module_exit(ixgbevf_exit_module);
4297
4298/* ixgbevf_main.c */