Linux Audio

Check our new training course

Yocto / OpenEmbedded training

Feb 10-13, 2025
Register
Loading...
v6.8
   1// SPDX-License-Identifier: GPL-2.0
   2/* Copyright(c) 1999 - 2018 Intel Corporation. */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
   3
   4/* ethtool support for ixgbe */
   5
   6#include <linux/interrupt.h>
   7#include <linux/types.h>
   8#include <linux/module.h>
   9#include <linux/slab.h>
  10#include <linux/pci.h>
  11#include <linux/netdevice.h>
  12#include <linux/ethtool.h>
  13#include <linux/vmalloc.h>
  14#include <linux/highmem.h>
  15#include <linux/uaccess.h>
  16
  17#include "ixgbe.h"
  18#include "ixgbe_phy.h"
  19
  20
 
 
  21enum {NETDEV_STATS, IXGBE_STATS};
  22
  23struct ixgbe_stats {
  24	char stat_string[ETH_GSTRING_LEN];
  25	int type;
  26	int sizeof_stat;
  27	int stat_offset;
  28};
  29
  30#define IXGBE_STAT(m)		IXGBE_STATS, \
  31				sizeof(((struct ixgbe_adapter *)0)->m), \
  32				offsetof(struct ixgbe_adapter, m)
  33#define IXGBE_NETDEV_STAT(m)	NETDEV_STATS, \
  34				sizeof(((struct rtnl_link_stats64 *)0)->m), \
  35				offsetof(struct rtnl_link_stats64, m)
  36
  37static const struct ixgbe_stats ixgbe_gstrings_stats[] = {
  38	{"rx_packets", IXGBE_NETDEV_STAT(rx_packets)},
  39	{"tx_packets", IXGBE_NETDEV_STAT(tx_packets)},
  40	{"rx_bytes", IXGBE_NETDEV_STAT(rx_bytes)},
  41	{"tx_bytes", IXGBE_NETDEV_STAT(tx_bytes)},
  42	{"rx_pkts_nic", IXGBE_STAT(stats.gprc)},
  43	{"tx_pkts_nic", IXGBE_STAT(stats.gptc)},
  44	{"rx_bytes_nic", IXGBE_STAT(stats.gorc)},
  45	{"tx_bytes_nic", IXGBE_STAT(stats.gotc)},
  46	{"lsc_int", IXGBE_STAT(lsc_int)},
  47	{"tx_busy", IXGBE_STAT(tx_busy)},
  48	{"non_eop_descs", IXGBE_STAT(non_eop_descs)},
  49	{"rx_errors", IXGBE_NETDEV_STAT(rx_errors)},
  50	{"tx_errors", IXGBE_NETDEV_STAT(tx_errors)},
  51	{"rx_dropped", IXGBE_NETDEV_STAT(rx_dropped)},
  52	{"tx_dropped", IXGBE_NETDEV_STAT(tx_dropped)},
  53	{"multicast", IXGBE_NETDEV_STAT(multicast)},
  54	{"broadcast", IXGBE_STAT(stats.bprc)},
  55	{"rx_no_buffer_count", IXGBE_STAT(stats.rnbc[0]) },
  56	{"collisions", IXGBE_NETDEV_STAT(collisions)},
  57	{"rx_over_errors", IXGBE_NETDEV_STAT(rx_over_errors)},
  58	{"rx_crc_errors", IXGBE_NETDEV_STAT(rx_crc_errors)},
  59	{"rx_frame_errors", IXGBE_NETDEV_STAT(rx_frame_errors)},
  60	{"hw_rsc_aggregated", IXGBE_STAT(rsc_total_count)},
  61	{"hw_rsc_flushed", IXGBE_STAT(rsc_total_flush)},
  62	{"fdir_match", IXGBE_STAT(stats.fdirmatch)},
  63	{"fdir_miss", IXGBE_STAT(stats.fdirmiss)},
  64	{"fdir_overflow", IXGBE_STAT(fdir_overflow)},
  65	{"rx_fifo_errors", IXGBE_NETDEV_STAT(rx_fifo_errors)},
  66	{"rx_missed_errors", IXGBE_NETDEV_STAT(rx_missed_errors)},
  67	{"tx_aborted_errors", IXGBE_NETDEV_STAT(tx_aborted_errors)},
  68	{"tx_carrier_errors", IXGBE_NETDEV_STAT(tx_carrier_errors)},
  69	{"tx_fifo_errors", IXGBE_NETDEV_STAT(tx_fifo_errors)},
  70	{"tx_heartbeat_errors", IXGBE_NETDEV_STAT(tx_heartbeat_errors)},
  71	{"tx_timeout_count", IXGBE_STAT(tx_timeout_count)},
  72	{"tx_restart_queue", IXGBE_STAT(restart_queue)},
  73	{"rx_length_errors", IXGBE_STAT(stats.rlec)},
  74	{"rx_long_length_errors", IXGBE_STAT(stats.roc)},
  75	{"rx_short_length_errors", IXGBE_STAT(stats.ruc)},
  76	{"tx_flow_control_xon", IXGBE_STAT(stats.lxontxc)},
  77	{"rx_flow_control_xon", IXGBE_STAT(stats.lxonrxc)},
  78	{"tx_flow_control_xoff", IXGBE_STAT(stats.lxofftxc)},
  79	{"rx_flow_control_xoff", IXGBE_STAT(stats.lxoffrxc)},
  80	{"rx_csum_offload_errors", IXGBE_STAT(hw_csum_rx_error)},
  81	{"alloc_rx_page", IXGBE_STAT(alloc_rx_page)},
  82	{"alloc_rx_page_failed", IXGBE_STAT(alloc_rx_page_failed)},
  83	{"alloc_rx_buff_failed", IXGBE_STAT(alloc_rx_buff_failed)},
  84	{"rx_no_dma_resources", IXGBE_STAT(hw_rx_no_dma_resources)},
  85	{"os2bmc_rx_by_bmc", IXGBE_STAT(stats.o2bgptc)},
  86	{"os2bmc_tx_by_bmc", IXGBE_STAT(stats.b2ospc)},
  87	{"os2bmc_tx_by_host", IXGBE_STAT(stats.o2bspc)},
  88	{"os2bmc_rx_by_host", IXGBE_STAT(stats.b2ogprc)},
  89	{"tx_hwtstamp_timeouts", IXGBE_STAT(tx_hwtstamp_timeouts)},
  90	{"tx_hwtstamp_skipped", IXGBE_STAT(tx_hwtstamp_skipped)},
  91	{"rx_hwtstamp_cleared", IXGBE_STAT(rx_hwtstamp_cleared)},
  92	{"tx_ipsec", IXGBE_STAT(tx_ipsec)},
  93	{"rx_ipsec", IXGBE_STAT(rx_ipsec)},
  94#ifdef IXGBE_FCOE
  95	{"fcoe_bad_fccrc", IXGBE_STAT(stats.fccrc)},
  96	{"rx_fcoe_dropped", IXGBE_STAT(stats.fcoerpdc)},
  97	{"rx_fcoe_packets", IXGBE_STAT(stats.fcoeprc)},
  98	{"rx_fcoe_dwords", IXGBE_STAT(stats.fcoedwrc)},
  99	{"fcoe_noddp", IXGBE_STAT(stats.fcoe_noddp)},
 100	{"fcoe_noddp_ext_buff", IXGBE_STAT(stats.fcoe_noddp_ext_buff)},
 101	{"tx_fcoe_packets", IXGBE_STAT(stats.fcoeptc)},
 102	{"tx_fcoe_dwords", IXGBE_STAT(stats.fcoedwtc)},
 103#endif /* IXGBE_FCOE */
 104};
 105
 106/* ixgbe allocates num_tx_queues and num_rx_queues symmetrically so
 107 * we set the num_rx_queues to evaluate to num_tx_queues. This is
 108 * used because we do not have a good way to get the max number of
 109 * rx queues with CONFIG_RPS disabled.
 110 */
 111#define IXGBE_NUM_RX_QUEUES netdev->num_tx_queues
 112
 113#define IXGBE_QUEUE_STATS_LEN ( \
 114	(netdev->num_tx_queues + IXGBE_NUM_RX_QUEUES) * \
 115	(sizeof(struct ixgbe_queue_stats) / sizeof(u64)))
 116#define IXGBE_GLOBAL_STATS_LEN ARRAY_SIZE(ixgbe_gstrings_stats)
 117#define IXGBE_PB_STATS_LEN ( \
 118			(sizeof(((struct ixgbe_adapter *)0)->stats.pxonrxc) + \
 119			 sizeof(((struct ixgbe_adapter *)0)->stats.pxontxc) + \
 120			 sizeof(((struct ixgbe_adapter *)0)->stats.pxoffrxc) + \
 121			 sizeof(((struct ixgbe_adapter *)0)->stats.pxofftxc)) \
 122			/ sizeof(u64))
 123#define IXGBE_STATS_LEN (IXGBE_GLOBAL_STATS_LEN + \
 124			 IXGBE_PB_STATS_LEN + \
 125			 IXGBE_QUEUE_STATS_LEN)
 126
 127static const char ixgbe_gstrings_test[][ETH_GSTRING_LEN] = {
 128	"Register test  (offline)", "Eeprom test    (offline)",
 129	"Interrupt test (offline)", "Loopback test  (offline)",
 130	"Link test   (on/offline)"
 131};
 132#define IXGBE_TEST_LEN sizeof(ixgbe_gstrings_test) / ETH_GSTRING_LEN
 133
 134static const char ixgbe_priv_flags_strings[][ETH_GSTRING_LEN] = {
 135#define IXGBE_PRIV_FLAGS_LEGACY_RX	BIT(0)
 136	"legacy-rx",
 137#define IXGBE_PRIV_FLAGS_VF_IPSEC_EN	BIT(1)
 138	"vf-ipsec",
 139#define IXGBE_PRIV_FLAGS_AUTO_DISABLE_VF	BIT(2)
 140	"mdd-disable-vf",
 141};
 142
 143#define IXGBE_PRIV_FLAGS_STR_LEN ARRAY_SIZE(ixgbe_priv_flags_strings)
 144
 145#define ixgbe_isbackplane(type) ((type) == ixgbe_media_type_backplane)
 146
 147static void ixgbe_set_supported_10gtypes(struct ixgbe_hw *hw,
 148					 struct ethtool_link_ksettings *cmd)
 149{
 150	if (!ixgbe_isbackplane(hw->phy.media_type)) {
 151		ethtool_link_ksettings_add_link_mode(cmd, supported,
 152						     10000baseT_Full);
 153		return;
 154	}
 155
 156	switch (hw->device_id) {
 157	case IXGBE_DEV_ID_82598:
 158	case IXGBE_DEV_ID_82599_KX4:
 159	case IXGBE_DEV_ID_82599_KX4_MEZZ:
 160	case IXGBE_DEV_ID_X550EM_X_KX4:
 161		ethtool_link_ksettings_add_link_mode
 162			(cmd, supported, 10000baseKX4_Full);
 163		break;
 164	case IXGBE_DEV_ID_82598_BX:
 165	case IXGBE_DEV_ID_82599_KR:
 166	case IXGBE_DEV_ID_X550EM_X_KR:
 167	case IXGBE_DEV_ID_X550EM_X_XFI:
 168		ethtool_link_ksettings_add_link_mode
 169			(cmd, supported, 10000baseKR_Full);
 170		break;
 171	default:
 172		ethtool_link_ksettings_add_link_mode
 173			(cmd, supported, 10000baseKX4_Full);
 174		ethtool_link_ksettings_add_link_mode
 175			(cmd, supported, 10000baseKR_Full);
 176		break;
 177	}
 178}
 179
 180static void ixgbe_set_advertising_10gtypes(struct ixgbe_hw *hw,
 181					   struct ethtool_link_ksettings *cmd)
 182{
 183	if (!ixgbe_isbackplane(hw->phy.media_type)) {
 184		ethtool_link_ksettings_add_link_mode(cmd, advertising,
 185						     10000baseT_Full);
 186		return;
 187	}
 188
 189	switch (hw->device_id) {
 190	case IXGBE_DEV_ID_82598:
 191	case IXGBE_DEV_ID_82599_KX4:
 192	case IXGBE_DEV_ID_82599_KX4_MEZZ:
 193	case IXGBE_DEV_ID_X550EM_X_KX4:
 194		ethtool_link_ksettings_add_link_mode
 195			(cmd, advertising, 10000baseKX4_Full);
 196		break;
 197	case IXGBE_DEV_ID_82598_BX:
 198	case IXGBE_DEV_ID_82599_KR:
 199	case IXGBE_DEV_ID_X550EM_X_KR:
 200	case IXGBE_DEV_ID_X550EM_X_XFI:
 201		ethtool_link_ksettings_add_link_mode
 202			(cmd, advertising, 10000baseKR_Full);
 203		break;
 204	default:
 205		ethtool_link_ksettings_add_link_mode
 206			(cmd, advertising, 10000baseKX4_Full);
 207		ethtool_link_ksettings_add_link_mode
 208			(cmd, advertising, 10000baseKR_Full);
 209		break;
 210	}
 211}
 212
 213static int ixgbe_get_link_ksettings(struct net_device *netdev,
 214				    struct ethtool_link_ksettings *cmd)
 215{
 216	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 217	struct ixgbe_hw *hw = &adapter->hw;
 218	ixgbe_link_speed supported_link;
 219	bool autoneg = false;
 220
 221	ethtool_link_ksettings_zero_link_mode(cmd, supported);
 222	ethtool_link_ksettings_zero_link_mode(cmd, advertising);
 
 
 
 
 
 223
 224	hw->mac.ops.get_link_capabilities(hw, &supported_link, &autoneg);
 
 
 
 
 
 
 225
 226	/* set the supported link speeds */
 227	if (supported_link & IXGBE_LINK_SPEED_10GB_FULL) {
 228		ixgbe_set_supported_10gtypes(hw, cmd);
 229		ixgbe_set_advertising_10gtypes(hw, cmd);
 230	}
 231	if (supported_link & IXGBE_LINK_SPEED_5GB_FULL)
 232		ethtool_link_ksettings_add_link_mode(cmd, supported,
 233						     5000baseT_Full);
 234
 235	if (supported_link & IXGBE_LINK_SPEED_2_5GB_FULL)
 236		ethtool_link_ksettings_add_link_mode(cmd, supported,
 237						     2500baseT_Full);
 238
 239	if (supported_link & IXGBE_LINK_SPEED_1GB_FULL) {
 240		if (ixgbe_isbackplane(hw->phy.media_type)) {
 241			ethtool_link_ksettings_add_link_mode(cmd, supported,
 242							     1000baseKX_Full);
 243			ethtool_link_ksettings_add_link_mode(cmd, advertising,
 244							     1000baseKX_Full);
 245		} else {
 246			ethtool_link_ksettings_add_link_mode(cmd, supported,
 247							     1000baseT_Full);
 248			ethtool_link_ksettings_add_link_mode(cmd, advertising,
 249							     1000baseT_Full);
 250		}
 251	}
 252	if (supported_link & IXGBE_LINK_SPEED_100_FULL) {
 253		ethtool_link_ksettings_add_link_mode(cmd, supported,
 254						     100baseT_Full);
 255		ethtool_link_ksettings_add_link_mode(cmd, advertising,
 256						     100baseT_Full);
 257	}
 258	if (supported_link & IXGBE_LINK_SPEED_10_FULL) {
 259		ethtool_link_ksettings_add_link_mode(cmd, supported,
 260						     10baseT_Full);
 261		ethtool_link_ksettings_add_link_mode(cmd, advertising,
 262						     10baseT_Full);
 263	}
 264
 265	/* set the advertised speeds */
 266	if (hw->phy.autoneg_advertised) {
 267		ethtool_link_ksettings_zero_link_mode(cmd, advertising);
 268		if (hw->phy.autoneg_advertised & IXGBE_LINK_SPEED_10_FULL)
 269			ethtool_link_ksettings_add_link_mode(cmd, advertising,
 270							     10baseT_Full);
 271		if (hw->phy.autoneg_advertised & IXGBE_LINK_SPEED_100_FULL)
 272			ethtool_link_ksettings_add_link_mode(cmd, advertising,
 273							     100baseT_Full);
 274		if (hw->phy.autoneg_advertised & IXGBE_LINK_SPEED_10GB_FULL)
 275			ixgbe_set_advertising_10gtypes(hw, cmd);
 276		if (hw->phy.autoneg_advertised & IXGBE_LINK_SPEED_1GB_FULL) {
 277			if (ethtool_link_ksettings_test_link_mode
 278				(cmd, supported, 1000baseKX_Full))
 279				ethtool_link_ksettings_add_link_mode
 280					(cmd, advertising, 1000baseKX_Full);
 281			else
 282				ethtool_link_ksettings_add_link_mode
 283					(cmd, advertising, 1000baseT_Full);
 284		}
 285		if (hw->phy.autoneg_advertised & IXGBE_LINK_SPEED_5GB_FULL)
 286			ethtool_link_ksettings_add_link_mode(cmd, advertising,
 287							     5000baseT_Full);
 288		if (hw->phy.autoneg_advertised & IXGBE_LINK_SPEED_2_5GB_FULL)
 289			ethtool_link_ksettings_add_link_mode(cmd, advertising,
 290							     2500baseT_Full);
 291	} else {
 292		if (hw->phy.multispeed_fiber && !autoneg) {
 293			if (supported_link & IXGBE_LINK_SPEED_10GB_FULL)
 294				ethtool_link_ksettings_add_link_mode
 295					(cmd, advertising, 10000baseT_Full);
 296		}
 297	}
 298
 299	if (autoneg) {
 300		ethtool_link_ksettings_add_link_mode(cmd, supported, Autoneg);
 301		ethtool_link_ksettings_add_link_mode(cmd, advertising, Autoneg);
 302		cmd->base.autoneg = AUTONEG_ENABLE;
 303	} else
 304		cmd->base.autoneg = AUTONEG_DISABLE;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 305
 306	/* Determine the remaining settings based on the PHY type. */
 307	switch (adapter->hw.phy.type) {
 308	case ixgbe_phy_tn:
 309	case ixgbe_phy_aq:
 310	case ixgbe_phy_x550em_ext_t:
 311	case ixgbe_phy_fw:
 312	case ixgbe_phy_cu_unknown:
 313		ethtool_link_ksettings_add_link_mode(cmd, supported, TP);
 314		ethtool_link_ksettings_add_link_mode(cmd, advertising, TP);
 315		cmd->base.port = PORT_TP;
 316		break;
 317	case ixgbe_phy_qt:
 318		ethtool_link_ksettings_add_link_mode(cmd, supported, FIBRE);
 319		ethtool_link_ksettings_add_link_mode(cmd, advertising, FIBRE);
 320		cmd->base.port = PORT_FIBRE;
 321		break;
 322	case ixgbe_phy_nl:
 323	case ixgbe_phy_sfp_passive_tyco:
 324	case ixgbe_phy_sfp_passive_unknown:
 325	case ixgbe_phy_sfp_ftl:
 326	case ixgbe_phy_sfp_avago:
 327	case ixgbe_phy_sfp_intel:
 328	case ixgbe_phy_sfp_unknown:
 329	case ixgbe_phy_qsfp_passive_unknown:
 330	case ixgbe_phy_qsfp_active_unknown:
 331	case ixgbe_phy_qsfp_intel:
 332	case ixgbe_phy_qsfp_unknown:
 333		/* SFP+ devices, further checking needed */
 334		switch (adapter->hw.phy.sfp_type) {
 
 335		case ixgbe_sfp_type_da_cu:
 336		case ixgbe_sfp_type_da_cu_core0:
 337		case ixgbe_sfp_type_da_cu_core1:
 338			ethtool_link_ksettings_add_link_mode(cmd, supported,
 339							     FIBRE);
 340			ethtool_link_ksettings_add_link_mode(cmd, advertising,
 341							     FIBRE);
 342			cmd->base.port = PORT_DA;
 343			break;
 344		case ixgbe_sfp_type_sr:
 345		case ixgbe_sfp_type_lr:
 346		case ixgbe_sfp_type_srlr_core0:
 347		case ixgbe_sfp_type_srlr_core1:
 348		case ixgbe_sfp_type_1g_sx_core0:
 349		case ixgbe_sfp_type_1g_sx_core1:
 350		case ixgbe_sfp_type_1g_lx_core0:
 351		case ixgbe_sfp_type_1g_lx_core1:
 352			ethtool_link_ksettings_add_link_mode(cmd, supported,
 353							     FIBRE);
 354			ethtool_link_ksettings_add_link_mode(cmd, advertising,
 355							     FIBRE);
 356			cmd->base.port = PORT_FIBRE;
 357			break;
 358		case ixgbe_sfp_type_not_present:
 359			ethtool_link_ksettings_add_link_mode(cmd, supported,
 360							     FIBRE);
 361			ethtool_link_ksettings_add_link_mode(cmd, advertising,
 362							     FIBRE);
 363			cmd->base.port = PORT_NONE;
 364			break;
 365		case ixgbe_sfp_type_1g_cu_core0:
 366		case ixgbe_sfp_type_1g_cu_core1:
 367			ethtool_link_ksettings_add_link_mode(cmd, supported,
 368							     TP);
 369			ethtool_link_ksettings_add_link_mode(cmd, advertising,
 370							     TP);
 371			cmd->base.port = PORT_TP;
 372			break;
 373		case ixgbe_sfp_type_unknown:
 374		default:
 375			ethtool_link_ksettings_add_link_mode(cmd, supported,
 376							     FIBRE);
 377			ethtool_link_ksettings_add_link_mode(cmd, advertising,
 378							     FIBRE);
 379			cmd->base.port = PORT_OTHER;
 380			break;
 381		}
 382		break;
 383	case ixgbe_phy_xaui:
 384		ethtool_link_ksettings_add_link_mode(cmd, supported,
 385						     FIBRE);
 386		ethtool_link_ksettings_add_link_mode(cmd, advertising,
 387						     FIBRE);
 388		cmd->base.port = PORT_NONE;
 389		break;
 390	case ixgbe_phy_unknown:
 391	case ixgbe_phy_generic:
 392	case ixgbe_phy_sfp_unsupported:
 393	default:
 394		ethtool_link_ksettings_add_link_mode(cmd, supported,
 395						     FIBRE);
 396		ethtool_link_ksettings_add_link_mode(cmd, advertising,
 397						     FIBRE);
 398		cmd->base.port = PORT_OTHER;
 399		break;
 400	}
 401
 402	/* Indicate pause support */
 403	ethtool_link_ksettings_add_link_mode(cmd, supported, Pause);
 404
 405	switch (hw->fc.requested_mode) {
 406	case ixgbe_fc_full:
 407		ethtool_link_ksettings_add_link_mode(cmd, advertising, Pause);
 408		break;
 409	case ixgbe_fc_rx_pause:
 410		ethtool_link_ksettings_add_link_mode(cmd, advertising, Pause);
 411		ethtool_link_ksettings_add_link_mode(cmd, advertising,
 412						     Asym_Pause);
 413		break;
 414	case ixgbe_fc_tx_pause:
 415		ethtool_link_ksettings_add_link_mode(cmd, advertising,
 416						     Asym_Pause);
 417		break;
 418	default:
 419		ethtool_link_ksettings_del_link_mode(cmd, advertising, Pause);
 420		ethtool_link_ksettings_del_link_mode(cmd, advertising,
 421						     Asym_Pause);
 422	}
 423
 424	if (netif_carrier_ok(netdev)) {
 425		switch (adapter->link_speed) {
 426		case IXGBE_LINK_SPEED_10GB_FULL:
 427			cmd->base.speed = SPEED_10000;
 428			break;
 429		case IXGBE_LINK_SPEED_5GB_FULL:
 430			cmd->base.speed = SPEED_5000;
 431			break;
 432		case IXGBE_LINK_SPEED_2_5GB_FULL:
 433			cmd->base.speed = SPEED_2500;
 434			break;
 435		case IXGBE_LINK_SPEED_1GB_FULL:
 436			cmd->base.speed = SPEED_1000;
 437			break;
 438		case IXGBE_LINK_SPEED_100_FULL:
 439			cmd->base.speed = SPEED_100;
 440			break;
 441		case IXGBE_LINK_SPEED_10_FULL:
 442			cmd->base.speed = SPEED_10;
 443			break;
 444		default:
 445			break;
 446		}
 447		cmd->base.duplex = DUPLEX_FULL;
 448	} else {
 449		cmd->base.speed = SPEED_UNKNOWN;
 450		cmd->base.duplex = DUPLEX_UNKNOWN;
 451	}
 452
 453	return 0;
 454}
 455
 456static int ixgbe_set_link_ksettings(struct net_device *netdev,
 457				    const struct ethtool_link_ksettings *cmd)
 458{
 459	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 460	struct ixgbe_hw *hw = &adapter->hw;
 461	u32 advertised, old;
 462	s32 err = 0;
 463
 464	if ((hw->phy.media_type == ixgbe_media_type_copper) ||
 465	    (hw->phy.multispeed_fiber)) {
 466		/*
 467		 * this function does not support duplex forcing, but can
 468		 * limit the advertising of the adapter to the specified speed
 469		 */
 470		if (!linkmode_subset(cmd->link_modes.advertising,
 471				     cmd->link_modes.supported))
 472			return -EINVAL;
 473
 474		/* only allow one speed at a time if no autoneg */
 475		if (!cmd->base.autoneg && hw->phy.multispeed_fiber) {
 476			if (ethtool_link_ksettings_test_link_mode(cmd, advertising,
 477								  10000baseT_Full) &&
 478			    ethtool_link_ksettings_test_link_mode(cmd, advertising,
 479								  1000baseT_Full))
 480				return -EINVAL;
 481		}
 482
 483		old = hw->phy.autoneg_advertised;
 484		advertised = 0;
 485		if (ethtool_link_ksettings_test_link_mode(cmd, advertising,
 486							  10000baseT_Full))
 487			advertised |= IXGBE_LINK_SPEED_10GB_FULL;
 488		if (ethtool_link_ksettings_test_link_mode(cmd, advertising,
 489							  5000baseT_Full))
 490			advertised |= IXGBE_LINK_SPEED_5GB_FULL;
 491		if (ethtool_link_ksettings_test_link_mode(cmd, advertising,
 492							  2500baseT_Full))
 493			advertised |= IXGBE_LINK_SPEED_2_5GB_FULL;
 494		if (ethtool_link_ksettings_test_link_mode(cmd, advertising,
 495							  1000baseT_Full))
 496			advertised |= IXGBE_LINK_SPEED_1GB_FULL;
 497
 498		if (ethtool_link_ksettings_test_link_mode(cmd, advertising,
 499							  100baseT_Full))
 500			advertised |= IXGBE_LINK_SPEED_100_FULL;
 501
 502		if (ethtool_link_ksettings_test_link_mode(cmd, advertising,
 503							  10baseT_Full))
 504			advertised |= IXGBE_LINK_SPEED_10_FULL;
 505
 506		if (old == advertised)
 507			return err;
 508		/* this sets the link speed and restarts auto-neg */
 509		while (test_and_set_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
 510			usleep_range(1000, 2000);
 511
 512		hw->mac.autotry_restart = true;
 513		err = hw->mac.ops.setup_link(hw, advertised, true);
 514		if (err) {
 515			e_info(probe, "setup link failed with code %d\n", err);
 516			hw->mac.ops.setup_link(hw, old, true);
 517		}
 518		clear_bit(__IXGBE_IN_SFP_INIT, &adapter->state);
 519	} else {
 520		/* in this case we currently only support 10Gb/FULL */
 521		u32 speed = cmd->base.speed;
 522
 523		if ((cmd->base.autoneg == AUTONEG_ENABLE) ||
 524		    (!ethtool_link_ksettings_test_link_mode(cmd, advertising,
 525							    10000baseT_Full)) ||
 526		    (speed + cmd->base.duplex != SPEED_10000 + DUPLEX_FULL))
 527			return -EINVAL;
 528	}
 529
 530	return err;
 531}
 532
 533static void ixgbe_get_pause_stats(struct net_device *netdev,
 534				  struct ethtool_pause_stats *stats)
 535{
 536	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 537	struct ixgbe_hw_stats *hwstats = &adapter->stats;
 538
 539	stats->tx_pause_frames = hwstats->lxontxc + hwstats->lxofftxc;
 540	stats->rx_pause_frames = hwstats->lxonrxc + hwstats->lxoffrxc;
 541}
 542
 543static void ixgbe_get_pauseparam(struct net_device *netdev,
 544				 struct ethtool_pauseparam *pause)
 545{
 546	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 547	struct ixgbe_hw *hw = &adapter->hw;
 548
 549	if (ixgbe_device_supports_autoneg_fc(hw) &&
 550	    !hw->fc.disable_fc_autoneg)
 551		pause->autoneg = 1;
 552	else
 553		pause->autoneg = 0;
 
 
 554
 555	if (hw->fc.current_mode == ixgbe_fc_rx_pause) {
 556		pause->rx_pause = 1;
 557	} else if (hw->fc.current_mode == ixgbe_fc_tx_pause) {
 558		pause->tx_pause = 1;
 559	} else if (hw->fc.current_mode == ixgbe_fc_full) {
 560		pause->rx_pause = 1;
 561		pause->tx_pause = 1;
 562	}
 563}
 564
 565static int ixgbe_set_pauseparam(struct net_device *netdev,
 566				struct ethtool_pauseparam *pause)
 567{
 568	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 569	struct ixgbe_hw *hw = &adapter->hw;
 570	struct ixgbe_fc_info fc = hw->fc;
 571
 572	/* 82598 does no support link flow control with DCB enabled */
 573	if ((hw->mac.type == ixgbe_mac_82598EB) &&
 574	    (adapter->flags & IXGBE_FLAG_DCB_ENABLED))
 575		return -EINVAL;
 576
 577	/* some devices do not support autoneg of link flow control */
 578	if ((pause->autoneg == AUTONEG_ENABLE) &&
 579	    !ixgbe_device_supports_autoneg_fc(hw))
 580		return -EINVAL;
 581
 582	fc.disable_fc_autoneg = (pause->autoneg != AUTONEG_ENABLE);
 583
 584	if ((pause->rx_pause && pause->tx_pause) || pause->autoneg)
 585		fc.requested_mode = ixgbe_fc_full;
 586	else if (pause->rx_pause && !pause->tx_pause)
 587		fc.requested_mode = ixgbe_fc_rx_pause;
 588	else if (!pause->rx_pause && pause->tx_pause)
 589		fc.requested_mode = ixgbe_fc_tx_pause;
 590	else
 591		fc.requested_mode = ixgbe_fc_none;
 592
 593	/* if the thing changed then we'll update and use new autoneg */
 594	if (memcmp(&fc, &hw->fc, sizeof(struct ixgbe_fc_info))) {
 595		hw->fc = fc;
 596		if (netif_running(netdev))
 597			ixgbe_reinit_locked(adapter);
 598		else
 599			ixgbe_reset(adapter);
 600	}
 601
 602	return 0;
 603}
 604
 605static u32 ixgbe_get_msglevel(struct net_device *netdev)
 606{
 607	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 608	return adapter->msg_enable;
 609}
 610
 611static void ixgbe_set_msglevel(struct net_device *netdev, u32 data)
 612{
 613	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 614	adapter->msg_enable = data;
 615}
 616
 617static int ixgbe_get_regs_len(struct net_device *netdev)
 618{
 619#define IXGBE_REGS_LEN  1145
 620	return IXGBE_REGS_LEN * sizeof(u32);
 621}
 622
 623#define IXGBE_GET_STAT(_A_, _R_) _A_->stats._R_
 624
 625static void ixgbe_get_regs(struct net_device *netdev,
 626			   struct ethtool_regs *regs, void *p)
 627{
 628	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 629	struct ixgbe_hw *hw = &adapter->hw;
 630	u32 *regs_buff = p;
 631	u8 i;
 632
 633	memset(p, 0, IXGBE_REGS_LEN * sizeof(u32));
 634
 635	regs->version = hw->mac.type << 24 | hw->revision_id << 16 |
 636			hw->device_id;
 637
 638	/* General Registers */
 639	regs_buff[0] = IXGBE_READ_REG(hw, IXGBE_CTRL);
 640	regs_buff[1] = IXGBE_READ_REG(hw, IXGBE_STATUS);
 641	regs_buff[2] = IXGBE_READ_REG(hw, IXGBE_CTRL_EXT);
 642	regs_buff[3] = IXGBE_READ_REG(hw, IXGBE_ESDP);
 643	regs_buff[4] = IXGBE_READ_REG(hw, IXGBE_EODSDP);
 644	regs_buff[5] = IXGBE_READ_REG(hw, IXGBE_LEDCTL);
 645	regs_buff[6] = IXGBE_READ_REG(hw, IXGBE_FRTIMER);
 646	regs_buff[7] = IXGBE_READ_REG(hw, IXGBE_TCPTIMER);
 647
 648	/* NVM Register */
 649	regs_buff[8] = IXGBE_READ_REG(hw, IXGBE_EEC(hw));
 650	regs_buff[9] = IXGBE_READ_REG(hw, IXGBE_EERD);
 651	regs_buff[10] = IXGBE_READ_REG(hw, IXGBE_FLA(hw));
 652	regs_buff[11] = IXGBE_READ_REG(hw, IXGBE_EEMNGCTL);
 653	regs_buff[12] = IXGBE_READ_REG(hw, IXGBE_EEMNGDATA);
 654	regs_buff[13] = IXGBE_READ_REG(hw, IXGBE_FLMNGCTL);
 655	regs_buff[14] = IXGBE_READ_REG(hw, IXGBE_FLMNGDATA);
 656	regs_buff[15] = IXGBE_READ_REG(hw, IXGBE_FLMNGCNT);
 657	regs_buff[16] = IXGBE_READ_REG(hw, IXGBE_FLOP);
 658	regs_buff[17] = IXGBE_READ_REG(hw, IXGBE_GRC(hw));
 659
 660	/* Interrupt */
 661	/* don't read EICR because it can clear interrupt causes, instead
 662	 * read EICS which is a shadow but doesn't clear EICR */
 663	regs_buff[18] = IXGBE_READ_REG(hw, IXGBE_EICS);
 664	regs_buff[19] = IXGBE_READ_REG(hw, IXGBE_EICS);
 665	regs_buff[20] = IXGBE_READ_REG(hw, IXGBE_EIMS);
 666	regs_buff[21] = IXGBE_READ_REG(hw, IXGBE_EIMC);
 667	regs_buff[22] = IXGBE_READ_REG(hw, IXGBE_EIAC);
 668	regs_buff[23] = IXGBE_READ_REG(hw, IXGBE_EIAM);
 669	regs_buff[24] = IXGBE_READ_REG(hw, IXGBE_EITR(0));
 670	regs_buff[25] = IXGBE_READ_REG(hw, IXGBE_IVAR(0));
 671	regs_buff[26] = IXGBE_READ_REG(hw, IXGBE_MSIXT);
 672	regs_buff[27] = IXGBE_READ_REG(hw, IXGBE_MSIXPBA);
 673	regs_buff[28] = IXGBE_READ_REG(hw, IXGBE_PBACL(0));
 674	regs_buff[29] = IXGBE_READ_REG(hw, IXGBE_GPIE);
 675
 676	/* Flow Control */
 677	regs_buff[30] = IXGBE_READ_REG(hw, IXGBE_PFCTOP);
 678	for (i = 0; i < 4; i++)
 679		regs_buff[31 + i] = IXGBE_READ_REG(hw, IXGBE_FCTTV(i));
 
 
 680	for (i = 0; i < 8; i++) {
 681		switch (hw->mac.type) {
 682		case ixgbe_mac_82598EB:
 683			regs_buff[35 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTL(i));
 684			regs_buff[43 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTH(i));
 685			break;
 686		case ixgbe_mac_82599EB:
 687		case ixgbe_mac_X540:
 688		case ixgbe_mac_X550:
 689		case ixgbe_mac_X550EM_x:
 690		case ixgbe_mac_x550em_a:
 691			regs_buff[35 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTL_82599(i));
 692			regs_buff[43 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTH_82599(i));
 693			break;
 694		default:
 695			break;
 696		}
 697	}
 698	regs_buff[51] = IXGBE_READ_REG(hw, IXGBE_FCRTV);
 699	regs_buff[52] = IXGBE_READ_REG(hw, IXGBE_TFCS);
 700
 701	/* Receive DMA */
 702	for (i = 0; i < 64; i++)
 703		regs_buff[53 + i] = IXGBE_READ_REG(hw, IXGBE_RDBAL(i));
 704	for (i = 0; i < 64; i++)
 705		regs_buff[117 + i] = IXGBE_READ_REG(hw, IXGBE_RDBAH(i));
 706	for (i = 0; i < 64; i++)
 707		regs_buff[181 + i] = IXGBE_READ_REG(hw, IXGBE_RDLEN(i));
 708	for (i = 0; i < 64; i++)
 709		regs_buff[245 + i] = IXGBE_READ_REG(hw, IXGBE_RDH(i));
 710	for (i = 0; i < 64; i++)
 711		regs_buff[309 + i] = IXGBE_READ_REG(hw, IXGBE_RDT(i));
 712	for (i = 0; i < 64; i++)
 713		regs_buff[373 + i] = IXGBE_READ_REG(hw, IXGBE_RXDCTL(i));
 714	for (i = 0; i < 16; i++)
 715		regs_buff[437 + i] = IXGBE_READ_REG(hw, IXGBE_SRRCTL(i));
 716	for (i = 0; i < 16; i++)
 717		regs_buff[453 + i] = IXGBE_READ_REG(hw, IXGBE_DCA_RXCTRL(i));
 718	regs_buff[469] = IXGBE_READ_REG(hw, IXGBE_RDRXCTL);
 719	for (i = 0; i < 8; i++)
 720		regs_buff[470 + i] = IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(i));
 721	regs_buff[478] = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
 722	regs_buff[479] = IXGBE_READ_REG(hw, IXGBE_DROPEN);
 723
 724	/* Receive */
 725	regs_buff[480] = IXGBE_READ_REG(hw, IXGBE_RXCSUM);
 726	regs_buff[481] = IXGBE_READ_REG(hw, IXGBE_RFCTL);
 727	for (i = 0; i < 16; i++)
 728		regs_buff[482 + i] = IXGBE_READ_REG(hw, IXGBE_RAL(i));
 729	for (i = 0; i < 16; i++)
 730		regs_buff[498 + i] = IXGBE_READ_REG(hw, IXGBE_RAH(i));
 731	regs_buff[514] = IXGBE_READ_REG(hw, IXGBE_PSRTYPE(0));
 732	regs_buff[515] = IXGBE_READ_REG(hw, IXGBE_FCTRL);
 733	regs_buff[516] = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
 734	regs_buff[517] = IXGBE_READ_REG(hw, IXGBE_MCSTCTRL);
 735	regs_buff[518] = IXGBE_READ_REG(hw, IXGBE_MRQC);
 736	regs_buff[519] = IXGBE_READ_REG(hw, IXGBE_VMD_CTL);
 737	for (i = 0; i < 8; i++)
 738		regs_buff[520 + i] = IXGBE_READ_REG(hw, IXGBE_IMIR(i));
 739	for (i = 0; i < 8; i++)
 740		regs_buff[528 + i] = IXGBE_READ_REG(hw, IXGBE_IMIREXT(i));
 741	regs_buff[536] = IXGBE_READ_REG(hw, IXGBE_IMIRVP);
 742
 743	/* Transmit */
 744	for (i = 0; i < 32; i++)
 745		regs_buff[537 + i] = IXGBE_READ_REG(hw, IXGBE_TDBAL(i));
 746	for (i = 0; i < 32; i++)
 747		regs_buff[569 + i] = IXGBE_READ_REG(hw, IXGBE_TDBAH(i));
 748	for (i = 0; i < 32; i++)
 749		regs_buff[601 + i] = IXGBE_READ_REG(hw, IXGBE_TDLEN(i));
 750	for (i = 0; i < 32; i++)
 751		regs_buff[633 + i] = IXGBE_READ_REG(hw, IXGBE_TDH(i));
 752	for (i = 0; i < 32; i++)
 753		regs_buff[665 + i] = IXGBE_READ_REG(hw, IXGBE_TDT(i));
 754	for (i = 0; i < 32; i++)
 755		regs_buff[697 + i] = IXGBE_READ_REG(hw, IXGBE_TXDCTL(i));
 756	for (i = 0; i < 32; i++)
 757		regs_buff[729 + i] = IXGBE_READ_REG(hw, IXGBE_TDWBAL(i));
 758	for (i = 0; i < 32; i++)
 759		regs_buff[761 + i] = IXGBE_READ_REG(hw, IXGBE_TDWBAH(i));
 760	regs_buff[793] = IXGBE_READ_REG(hw, IXGBE_DTXCTL);
 761	for (i = 0; i < 16; i++)
 762		regs_buff[794 + i] = IXGBE_READ_REG(hw, IXGBE_DCA_TXCTRL(i));
 763	regs_buff[810] = IXGBE_READ_REG(hw, IXGBE_TIPG);
 764	for (i = 0; i < 8; i++)
 765		regs_buff[811 + i] = IXGBE_READ_REG(hw, IXGBE_TXPBSIZE(i));
 766	regs_buff[819] = IXGBE_READ_REG(hw, IXGBE_MNGTXMAP);
 767
 768	/* Wake Up */
 769	regs_buff[820] = IXGBE_READ_REG(hw, IXGBE_WUC);
 770	regs_buff[821] = IXGBE_READ_REG(hw, IXGBE_WUFC);
 771	regs_buff[822] = IXGBE_READ_REG(hw, IXGBE_WUS);
 772	regs_buff[823] = IXGBE_READ_REG(hw, IXGBE_IPAV);
 773	regs_buff[824] = IXGBE_READ_REG(hw, IXGBE_IP4AT);
 774	regs_buff[825] = IXGBE_READ_REG(hw, IXGBE_IP6AT);
 775	regs_buff[826] = IXGBE_READ_REG(hw, IXGBE_WUPL);
 776	regs_buff[827] = IXGBE_READ_REG(hw, IXGBE_WUPM);
 777	regs_buff[828] = IXGBE_READ_REG(hw, IXGBE_FHFT(0));
 778
 779	/* DCB */
 780	regs_buff[829] = IXGBE_READ_REG(hw, IXGBE_RMCS);   /* same as FCCFG  */
 781	regs_buff[831] = IXGBE_READ_REG(hw, IXGBE_PDPMCS); /* same as RTTPCS */
 782
 783	switch (hw->mac.type) {
 784	case ixgbe_mac_82598EB:
 785		regs_buff[830] = IXGBE_READ_REG(hw, IXGBE_DPMCS);
 786		regs_buff[832] = IXGBE_READ_REG(hw, IXGBE_RUPPBMR);
 787		for (i = 0; i < 8; i++)
 788			regs_buff[833 + i] =
 789				IXGBE_READ_REG(hw, IXGBE_RT2CR(i));
 790		for (i = 0; i < 8; i++)
 791			regs_buff[841 + i] =
 792				IXGBE_READ_REG(hw, IXGBE_RT2SR(i));
 793		for (i = 0; i < 8; i++)
 794			regs_buff[849 + i] =
 795				IXGBE_READ_REG(hw, IXGBE_TDTQ2TCCR(i));
 796		for (i = 0; i < 8; i++)
 797			regs_buff[857 + i] =
 798				IXGBE_READ_REG(hw, IXGBE_TDTQ2TCSR(i));
 799		break;
 800	case ixgbe_mac_82599EB:
 801	case ixgbe_mac_X540:
 802	case ixgbe_mac_X550:
 803	case ixgbe_mac_X550EM_x:
 804	case ixgbe_mac_x550em_a:
 805		regs_buff[830] = IXGBE_READ_REG(hw, IXGBE_RTTDCS);
 806		regs_buff[832] = IXGBE_READ_REG(hw, IXGBE_RTRPCS);
 807		for (i = 0; i < 8; i++)
 808			regs_buff[833 + i] =
 809				IXGBE_READ_REG(hw, IXGBE_RTRPT4C(i));
 810		for (i = 0; i < 8; i++)
 811			regs_buff[841 + i] =
 812				IXGBE_READ_REG(hw, IXGBE_RTRPT4S(i));
 813		for (i = 0; i < 8; i++)
 814			regs_buff[849 + i] =
 815				IXGBE_READ_REG(hw, IXGBE_RTTDT2C(i));
 816		for (i = 0; i < 8; i++)
 817			regs_buff[857 + i] =
 818				IXGBE_READ_REG(hw, IXGBE_RTTDT2S(i));
 819		break;
 820	default:
 821		break;
 822	}
 823
 824	for (i = 0; i < 8; i++)
 825		regs_buff[865 + i] =
 826		IXGBE_READ_REG(hw, IXGBE_TDPT2TCCR(i)); /* same as RTTPT2C */
 827	for (i = 0; i < 8; i++)
 828		regs_buff[873 + i] =
 829		IXGBE_READ_REG(hw, IXGBE_TDPT2TCSR(i)); /* same as RTTPT2S */
 
 
 
 
 
 830
 831	/* Statistics */
 832	regs_buff[881] = IXGBE_GET_STAT(adapter, crcerrs);
 833	regs_buff[882] = IXGBE_GET_STAT(adapter, illerrc);
 834	regs_buff[883] = IXGBE_GET_STAT(adapter, errbc);
 835	regs_buff[884] = IXGBE_GET_STAT(adapter, mspdc);
 836	for (i = 0; i < 8; i++)
 837		regs_buff[885 + i] = IXGBE_GET_STAT(adapter, mpc[i]);
 838	regs_buff[893] = IXGBE_GET_STAT(adapter, mlfc);
 839	regs_buff[894] = IXGBE_GET_STAT(adapter, mrfc);
 840	regs_buff[895] = IXGBE_GET_STAT(adapter, rlec);
 841	regs_buff[896] = IXGBE_GET_STAT(adapter, lxontxc);
 842	regs_buff[897] = IXGBE_GET_STAT(adapter, lxonrxc);
 843	regs_buff[898] = IXGBE_GET_STAT(adapter, lxofftxc);
 844	regs_buff[899] = IXGBE_GET_STAT(adapter, lxoffrxc);
 845	for (i = 0; i < 8; i++)
 846		regs_buff[900 + i] = IXGBE_GET_STAT(adapter, pxontxc[i]);
 847	for (i = 0; i < 8; i++)
 848		regs_buff[908 + i] = IXGBE_GET_STAT(adapter, pxonrxc[i]);
 849	for (i = 0; i < 8; i++)
 850		regs_buff[916 + i] = IXGBE_GET_STAT(adapter, pxofftxc[i]);
 851	for (i = 0; i < 8; i++)
 852		regs_buff[924 + i] = IXGBE_GET_STAT(adapter, pxoffrxc[i]);
 853	regs_buff[932] = IXGBE_GET_STAT(adapter, prc64);
 854	regs_buff[933] = IXGBE_GET_STAT(adapter, prc127);
 855	regs_buff[934] = IXGBE_GET_STAT(adapter, prc255);
 856	regs_buff[935] = IXGBE_GET_STAT(adapter, prc511);
 857	regs_buff[936] = IXGBE_GET_STAT(adapter, prc1023);
 858	regs_buff[937] = IXGBE_GET_STAT(adapter, prc1522);
 859	regs_buff[938] = IXGBE_GET_STAT(adapter, gprc);
 860	regs_buff[939] = IXGBE_GET_STAT(adapter, bprc);
 861	regs_buff[940] = IXGBE_GET_STAT(adapter, mprc);
 862	regs_buff[941] = IXGBE_GET_STAT(adapter, gptc);
 863	regs_buff[942] = (u32)IXGBE_GET_STAT(adapter, gorc);
 864	regs_buff[943] = (u32)(IXGBE_GET_STAT(adapter, gorc) >> 32);
 865	regs_buff[944] = (u32)IXGBE_GET_STAT(adapter, gotc);
 866	regs_buff[945] = (u32)(IXGBE_GET_STAT(adapter, gotc) >> 32);
 867	for (i = 0; i < 8; i++)
 868		regs_buff[946 + i] = IXGBE_GET_STAT(adapter, rnbc[i]);
 869	regs_buff[954] = IXGBE_GET_STAT(adapter, ruc);
 870	regs_buff[955] = IXGBE_GET_STAT(adapter, rfc);
 871	regs_buff[956] = IXGBE_GET_STAT(adapter, roc);
 872	regs_buff[957] = IXGBE_GET_STAT(adapter, rjc);
 873	regs_buff[958] = IXGBE_GET_STAT(adapter, mngprc);
 874	regs_buff[959] = IXGBE_GET_STAT(adapter, mngpdc);
 875	regs_buff[960] = IXGBE_GET_STAT(adapter, mngptc);
 876	regs_buff[961] = (u32)IXGBE_GET_STAT(adapter, tor);
 877	regs_buff[962] = (u32)(IXGBE_GET_STAT(adapter, tor) >> 32);
 878	regs_buff[963] = IXGBE_GET_STAT(adapter, tpr);
 879	regs_buff[964] = IXGBE_GET_STAT(adapter, tpt);
 880	regs_buff[965] = IXGBE_GET_STAT(adapter, ptc64);
 881	regs_buff[966] = IXGBE_GET_STAT(adapter, ptc127);
 882	regs_buff[967] = IXGBE_GET_STAT(adapter, ptc255);
 883	regs_buff[968] = IXGBE_GET_STAT(adapter, ptc511);
 884	regs_buff[969] = IXGBE_GET_STAT(adapter, ptc1023);
 885	regs_buff[970] = IXGBE_GET_STAT(adapter, ptc1522);
 886	regs_buff[971] = IXGBE_GET_STAT(adapter, mptc);
 887	regs_buff[972] = IXGBE_GET_STAT(adapter, bptc);
 888	regs_buff[973] = IXGBE_GET_STAT(adapter, xec);
 889	for (i = 0; i < 16; i++)
 890		regs_buff[974 + i] = IXGBE_GET_STAT(adapter, qprc[i]);
 891	for (i = 0; i < 16; i++)
 892		regs_buff[990 + i] = IXGBE_GET_STAT(adapter, qptc[i]);
 893	for (i = 0; i < 16; i++)
 894		regs_buff[1006 + i] = IXGBE_GET_STAT(adapter, qbrc[i]);
 895	for (i = 0; i < 16; i++)
 896		regs_buff[1022 + i] = IXGBE_GET_STAT(adapter, qbtc[i]);
 897
 898	/* MAC */
 899	regs_buff[1038] = IXGBE_READ_REG(hw, IXGBE_PCS1GCFIG);
 900	regs_buff[1039] = IXGBE_READ_REG(hw, IXGBE_PCS1GLCTL);
 901	regs_buff[1040] = IXGBE_READ_REG(hw, IXGBE_PCS1GLSTA);
 902	regs_buff[1041] = IXGBE_READ_REG(hw, IXGBE_PCS1GDBG0);
 903	regs_buff[1042] = IXGBE_READ_REG(hw, IXGBE_PCS1GDBG1);
 904	regs_buff[1043] = IXGBE_READ_REG(hw, IXGBE_PCS1GANA);
 905	regs_buff[1044] = IXGBE_READ_REG(hw, IXGBE_PCS1GANLP);
 906	regs_buff[1045] = IXGBE_READ_REG(hw, IXGBE_PCS1GANNP);
 907	regs_buff[1046] = IXGBE_READ_REG(hw, IXGBE_PCS1GANLPNP);
 908	regs_buff[1047] = IXGBE_READ_REG(hw, IXGBE_HLREG0);
 909	regs_buff[1048] = IXGBE_READ_REG(hw, IXGBE_HLREG1);
 910	regs_buff[1049] = IXGBE_READ_REG(hw, IXGBE_PAP);
 911	regs_buff[1050] = IXGBE_READ_REG(hw, IXGBE_MACA);
 912	regs_buff[1051] = IXGBE_READ_REG(hw, IXGBE_APAE);
 913	regs_buff[1052] = IXGBE_READ_REG(hw, IXGBE_ARD);
 914	regs_buff[1053] = IXGBE_READ_REG(hw, IXGBE_AIS);
 915	regs_buff[1054] = IXGBE_READ_REG(hw, IXGBE_MSCA);
 916	regs_buff[1055] = IXGBE_READ_REG(hw, IXGBE_MSRWD);
 917	regs_buff[1056] = IXGBE_READ_REG(hw, IXGBE_MLADD);
 918	regs_buff[1057] = IXGBE_READ_REG(hw, IXGBE_MHADD);
 919	regs_buff[1058] = IXGBE_READ_REG(hw, IXGBE_TREG);
 920	regs_buff[1059] = IXGBE_READ_REG(hw, IXGBE_PCSS1);
 921	regs_buff[1060] = IXGBE_READ_REG(hw, IXGBE_PCSS2);
 922	regs_buff[1061] = IXGBE_READ_REG(hw, IXGBE_XPCSS);
 923	regs_buff[1062] = IXGBE_READ_REG(hw, IXGBE_SERDESC);
 924	regs_buff[1063] = IXGBE_READ_REG(hw, IXGBE_MACS);
 925	regs_buff[1064] = IXGBE_READ_REG(hw, IXGBE_AUTOC);
 926	regs_buff[1065] = IXGBE_READ_REG(hw, IXGBE_LINKS);
 927	regs_buff[1066] = IXGBE_READ_REG(hw, IXGBE_AUTOC2);
 928	regs_buff[1067] = IXGBE_READ_REG(hw, IXGBE_AUTOC3);
 929	regs_buff[1068] = IXGBE_READ_REG(hw, IXGBE_ANLP1);
 930	regs_buff[1069] = IXGBE_READ_REG(hw, IXGBE_ANLP2);
 931	regs_buff[1070] = IXGBE_READ_REG(hw, IXGBE_ATLASCTL);
 932
 933	/* Diagnostic */
 934	regs_buff[1071] = IXGBE_READ_REG(hw, IXGBE_RDSTATCTL);
 935	for (i = 0; i < 8; i++)
 936		regs_buff[1072 + i] = IXGBE_READ_REG(hw, IXGBE_RDSTAT(i));
 937	regs_buff[1080] = IXGBE_READ_REG(hw, IXGBE_RDHMPN);
 938	for (i = 0; i < 4; i++)
 939		regs_buff[1081 + i] = IXGBE_READ_REG(hw, IXGBE_RIC_DW(i));
 940	regs_buff[1085] = IXGBE_READ_REG(hw, IXGBE_RDPROBE);
 941	regs_buff[1086] = IXGBE_READ_REG(hw, IXGBE_TDSTATCTL);
 942	for (i = 0; i < 8; i++)
 943		regs_buff[1087 + i] = IXGBE_READ_REG(hw, IXGBE_TDSTAT(i));
 944	regs_buff[1095] = IXGBE_READ_REG(hw, IXGBE_TDHMPN);
 945	for (i = 0; i < 4; i++)
 946		regs_buff[1096 + i] = IXGBE_READ_REG(hw, IXGBE_TIC_DW(i));
 947	regs_buff[1100] = IXGBE_READ_REG(hw, IXGBE_TDPROBE);
 948	regs_buff[1101] = IXGBE_READ_REG(hw, IXGBE_TXBUFCTRL);
 949	for (i = 0; i < 4; i++)
 950		regs_buff[1102 + i] = IXGBE_READ_REG(hw, IXGBE_TXBUFDATA(i));
 
 
 951	regs_buff[1106] = IXGBE_READ_REG(hw, IXGBE_RXBUFCTRL);
 952	for (i = 0; i < 4; i++)
 953		regs_buff[1107 + i] = IXGBE_READ_REG(hw, IXGBE_RXBUFDATA(i));
 
 
 954	for (i = 0; i < 8; i++)
 955		regs_buff[1111 + i] = IXGBE_READ_REG(hw, IXGBE_PCIE_DIAG(i));
 956	regs_buff[1119] = IXGBE_READ_REG(hw, IXGBE_RFVAL);
 957	regs_buff[1120] = IXGBE_READ_REG(hw, IXGBE_MDFTC1);
 958	regs_buff[1121] = IXGBE_READ_REG(hw, IXGBE_MDFTC2);
 959	regs_buff[1122] = IXGBE_READ_REG(hw, IXGBE_MDFTFIFO1);
 960	regs_buff[1123] = IXGBE_READ_REG(hw, IXGBE_MDFTFIFO2);
 961	regs_buff[1124] = IXGBE_READ_REG(hw, IXGBE_MDFTS);
 962	regs_buff[1125] = IXGBE_READ_REG(hw, IXGBE_PCIEECCCTL);
 963	regs_buff[1126] = IXGBE_READ_REG(hw, IXGBE_PBTXECC);
 964	regs_buff[1127] = IXGBE_READ_REG(hw, IXGBE_PBRXECC);
 965
 966	/* 82599 X540 specific registers  */
 967	regs_buff[1128] = IXGBE_READ_REG(hw, IXGBE_MFLCN);
 968
 969	/* 82599 X540 specific DCB registers  */
 970	regs_buff[1129] = IXGBE_READ_REG(hw, IXGBE_RTRUP2TC);
 971	regs_buff[1130] = IXGBE_READ_REG(hw, IXGBE_RTTUP2TC);
 972	for (i = 0; i < 4; i++)
 973		regs_buff[1131 + i] = IXGBE_READ_REG(hw, IXGBE_TXLLQ(i));
 974	regs_buff[1135] = IXGBE_READ_REG(hw, IXGBE_RTTBCNRM);
 975					/* same as RTTQCNRM */
 976	regs_buff[1136] = IXGBE_READ_REG(hw, IXGBE_RTTBCNRD);
 977					/* same as RTTQCNRR */
 978
 979	/* X540 specific DCB registers  */
 980	regs_buff[1137] = IXGBE_READ_REG(hw, IXGBE_RTTQCNCR);
 981	regs_buff[1138] = IXGBE_READ_REG(hw, IXGBE_RTTQCNTG);
 982
 983	/* Security config registers */
 984	regs_buff[1139] = IXGBE_READ_REG(hw, IXGBE_SECTXCTRL);
 985	regs_buff[1140] = IXGBE_READ_REG(hw, IXGBE_SECTXSTAT);
 986	regs_buff[1141] = IXGBE_READ_REG(hw, IXGBE_SECTXBUFFAF);
 987	regs_buff[1142] = IXGBE_READ_REG(hw, IXGBE_SECTXMINIFG);
 988	regs_buff[1143] = IXGBE_READ_REG(hw, IXGBE_SECRXCTRL);
 989	regs_buff[1144] = IXGBE_READ_REG(hw, IXGBE_SECRXSTAT);
 990}
 991
 992static int ixgbe_get_eeprom_len(struct net_device *netdev)
 993{
 994	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 995	return adapter->hw.eeprom.word_size * 2;
 996}
 997
 998static int ixgbe_get_eeprom(struct net_device *netdev,
 999			    struct ethtool_eeprom *eeprom, u8 *bytes)
1000{
1001	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1002	struct ixgbe_hw *hw = &adapter->hw;
1003	u16 *eeprom_buff;
1004	int first_word, last_word, eeprom_len;
1005	int ret_val = 0;
1006	u16 i;
1007
1008	if (eeprom->len == 0)
1009		return -EINVAL;
1010
1011	eeprom->magic = hw->vendor_id | (hw->device_id << 16);
1012
1013	first_word = eeprom->offset >> 1;
1014	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
1015	eeprom_len = last_word - first_word + 1;
1016
1017	eeprom_buff = kmalloc_array(eeprom_len, sizeof(u16), GFP_KERNEL);
1018	if (!eeprom_buff)
1019		return -ENOMEM;
1020
1021	ret_val = hw->eeprom.ops.read_buffer(hw, first_word, eeprom_len,
1022					     eeprom_buff);
1023
1024	/* Device's eeprom is always little-endian, word addressable */
1025	for (i = 0; i < eeprom_len; i++)
1026		le16_to_cpus(&eeprom_buff[i]);
1027
1028	memcpy(bytes, (u8 *)eeprom_buff + (eeprom->offset & 1), eeprom->len);
1029	kfree(eeprom_buff);
1030
1031	return ret_val;
1032}
1033
1034static int ixgbe_set_eeprom(struct net_device *netdev,
1035			    struct ethtool_eeprom *eeprom, u8 *bytes)
1036{
1037	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1038	struct ixgbe_hw *hw = &adapter->hw;
1039	u16 *eeprom_buff;
1040	void *ptr;
1041	int max_len, first_word, last_word, ret_val = 0;
1042	u16 i;
1043
1044	if (eeprom->len == 0)
1045		return -EINVAL;
1046
1047	if (eeprom->magic != (hw->vendor_id | (hw->device_id << 16)))
1048		return -EINVAL;
1049
1050	max_len = hw->eeprom.word_size * 2;
1051
1052	first_word = eeprom->offset >> 1;
1053	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
1054	eeprom_buff = kmalloc(max_len, GFP_KERNEL);
1055	if (!eeprom_buff)
1056		return -ENOMEM;
1057
1058	ptr = eeprom_buff;
1059
1060	if (eeprom->offset & 1) {
1061		/*
1062		 * need read/modify/write of first changed EEPROM word
1063		 * only the second byte of the word is being modified
1064		 */
1065		ret_val = hw->eeprom.ops.read(hw, first_word, &eeprom_buff[0]);
1066		if (ret_val)
1067			goto err;
1068
1069		ptr++;
1070	}
1071	if ((eeprom->offset + eeprom->len) & 1) {
1072		/*
1073		 * need read/modify/write of last changed EEPROM word
1074		 * only the first byte of the word is being modified
1075		 */
1076		ret_val = hw->eeprom.ops.read(hw, last_word,
1077					  &eeprom_buff[last_word - first_word]);
1078		if (ret_val)
1079			goto err;
1080	}
1081
1082	/* Device's eeprom is always little-endian, word addressable */
1083	for (i = 0; i < last_word - first_word + 1; i++)
1084		le16_to_cpus(&eeprom_buff[i]);
1085
1086	memcpy(ptr, bytes, eeprom->len);
1087
1088	for (i = 0; i < last_word - first_word + 1; i++)
1089		cpu_to_le16s(&eeprom_buff[i]);
1090
1091	ret_val = hw->eeprom.ops.write_buffer(hw, first_word,
1092					      last_word - first_word + 1,
1093					      eeprom_buff);
1094
1095	/* Update the checksum */
1096	if (ret_val == 0)
1097		hw->eeprom.ops.update_checksum(hw);
1098
1099err:
1100	kfree(eeprom_buff);
1101	return ret_val;
1102}
1103
1104static void ixgbe_get_drvinfo(struct net_device *netdev,
1105			      struct ethtool_drvinfo *drvinfo)
1106{
1107	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 
1108
1109	strscpy(drvinfo->driver, ixgbe_driver_name, sizeof(drvinfo->driver));
 
 
1110
1111	strscpy(drvinfo->fw_version, adapter->eeprom_id,
1112		sizeof(drvinfo->fw_version));
 
 
1113
1114	strscpy(drvinfo->bus_info, pci_name(adapter->pdev),
1115		sizeof(drvinfo->bus_info));
1116
1117	drvinfo->n_priv_flags = IXGBE_PRIV_FLAGS_STR_LEN;
1118}
1119
1120static u32 ixgbe_get_max_rxd(struct ixgbe_adapter *adapter)
1121{
1122	switch (adapter->hw.mac.type) {
1123	case ixgbe_mac_82598EB:
1124		return IXGBE_MAX_RXD_82598;
1125	case ixgbe_mac_82599EB:
1126		return IXGBE_MAX_RXD_82599;
1127	case ixgbe_mac_X540:
1128		return IXGBE_MAX_RXD_X540;
1129	case ixgbe_mac_X550:
1130	case ixgbe_mac_X550EM_x:
1131	case ixgbe_mac_x550em_a:
1132		return IXGBE_MAX_RXD_X550;
1133	default:
1134		return IXGBE_MAX_RXD_82598;
1135	}
1136}
1137
1138static u32 ixgbe_get_max_txd(struct ixgbe_adapter *adapter)
1139{
1140	switch (adapter->hw.mac.type) {
1141	case ixgbe_mac_82598EB:
1142		return IXGBE_MAX_TXD_82598;
1143	case ixgbe_mac_82599EB:
1144		return IXGBE_MAX_TXD_82599;
1145	case ixgbe_mac_X540:
1146		return IXGBE_MAX_TXD_X540;
1147	case ixgbe_mac_X550:
1148	case ixgbe_mac_X550EM_x:
1149	case ixgbe_mac_x550em_a:
1150		return IXGBE_MAX_TXD_X550;
1151	default:
1152		return IXGBE_MAX_TXD_82598;
1153	}
1154}
1155
1156static void ixgbe_get_ringparam(struct net_device *netdev,
1157				struct ethtool_ringparam *ring,
1158				struct kernel_ethtool_ringparam *kernel_ring,
1159				struct netlink_ext_ack *extack)
1160{
1161	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1162	struct ixgbe_ring *tx_ring = adapter->tx_ring[0];
1163	struct ixgbe_ring *rx_ring = adapter->rx_ring[0];
1164
1165	ring->rx_max_pending = ixgbe_get_max_rxd(adapter);
1166	ring->tx_max_pending = ixgbe_get_max_txd(adapter);
1167	ring->rx_pending = rx_ring->count;
1168	ring->tx_pending = tx_ring->count;
1169}
1170
1171static int ixgbe_set_ringparam(struct net_device *netdev,
1172			       struct ethtool_ringparam *ring,
1173			       struct kernel_ethtool_ringparam *kernel_ring,
1174			       struct netlink_ext_ack *extack)
1175{
1176	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1177	struct ixgbe_ring *temp_ring;
1178	int i, j, err = 0;
1179	u32 new_rx_count, new_tx_count;
 
1180
1181	if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending))
1182		return -EINVAL;
1183
1184	new_tx_count = clamp_t(u32, ring->tx_pending,
1185			       IXGBE_MIN_TXD, ixgbe_get_max_txd(adapter));
1186	new_tx_count = ALIGN(new_tx_count, IXGBE_REQ_TX_DESCRIPTOR_MULTIPLE);
1187
1188	new_rx_count = clamp_t(u32, ring->rx_pending,
1189			       IXGBE_MIN_RXD, ixgbe_get_max_rxd(adapter));
1190	new_rx_count = ALIGN(new_rx_count, IXGBE_REQ_RX_DESCRIPTOR_MULTIPLE);
1191
1192	if ((new_tx_count == adapter->tx_ring_count) &&
1193	    (new_rx_count == adapter->rx_ring_count)) {
 
 
 
 
1194		/* nothing to do */
1195		return 0;
1196	}
1197
1198	while (test_and_set_bit(__IXGBE_RESETTING, &adapter->state))
1199		usleep_range(1000, 2000);
1200
1201	if (!netif_running(adapter->netdev)) {
1202		for (i = 0; i < adapter->num_tx_queues; i++)
1203			adapter->tx_ring[i]->count = new_tx_count;
1204		for (i = 0; i < adapter->num_xdp_queues; i++)
1205			adapter->xdp_ring[i]->count = new_tx_count;
1206		for (i = 0; i < adapter->num_rx_queues; i++)
1207			adapter->rx_ring[i]->count = new_rx_count;
1208		adapter->tx_ring_count = new_tx_count;
1209		adapter->xdp_ring_count = new_tx_count;
1210		adapter->rx_ring_count = new_rx_count;
1211		goto clear_reset;
1212	}
1213
1214	/* allocate temporary buffer to store rings in */
1215	i = max_t(int, adapter->num_tx_queues + adapter->num_xdp_queues,
1216		  adapter->num_rx_queues);
1217	temp_ring = vmalloc(array_size(i, sizeof(struct ixgbe_ring)));
1218
1219	if (!temp_ring) {
1220		err = -ENOMEM;
1221		goto clear_reset;
1222	}
1223
1224	ixgbe_down(adapter);
1225
1226	/*
1227	 * Setup new Tx resources and free the old Tx resources in that order.
1228	 * We can then assign the new resources to the rings via a memcpy.
1229	 * The advantage to this approach is that we are guaranteed to still
1230	 * have resources even in the case of an allocation failure.
1231	 */
1232	if (new_tx_count != adapter->tx_ring_count) {
1233		for (i = 0; i < adapter->num_tx_queues; i++) {
1234			memcpy(&temp_ring[i], adapter->tx_ring[i],
1235			       sizeof(struct ixgbe_ring));
1236
1237			temp_ring[i].count = new_tx_count;
1238			err = ixgbe_setup_tx_resources(&temp_ring[i]);
1239			if (err) {
1240				while (i) {
1241					i--;
1242					ixgbe_free_tx_resources(&temp_ring[i]);
1243				}
1244				goto err_setup;
1245			}
1246		}
1247
1248		for (j = 0; j < adapter->num_xdp_queues; j++, i++) {
1249			memcpy(&temp_ring[i], adapter->xdp_ring[j],
1250			       sizeof(struct ixgbe_ring));
1251
1252			temp_ring[i].count = new_tx_count;
1253			err = ixgbe_setup_tx_resources(&temp_ring[i]);
1254			if (err) {
1255				while (i) {
1256					i--;
1257					ixgbe_free_tx_resources(&temp_ring[i]);
1258				}
1259				goto err_setup;
1260			}
1261		}
 
 
1262
1263		for (i = 0; i < adapter->num_tx_queues; i++) {
1264			ixgbe_free_tx_resources(adapter->tx_ring[i]);
1265
1266			memcpy(adapter->tx_ring[i], &temp_ring[i],
1267			       sizeof(struct ixgbe_ring));
1268		}
1269		for (j = 0; j < adapter->num_xdp_queues; j++, i++) {
1270			ixgbe_free_tx_resources(adapter->xdp_ring[j]);
1271
1272			memcpy(adapter->xdp_ring[j], &temp_ring[i],
1273			       sizeof(struct ixgbe_ring));
1274		}
1275
1276		adapter->tx_ring_count = new_tx_count;
1277	}
1278
1279	/* Repeat the process for the Rx rings if needed */
1280	if (new_rx_count != adapter->rx_ring_count) {
1281		for (i = 0; i < adapter->num_rx_queues; i++) {
1282			memcpy(&temp_ring[i], adapter->rx_ring[i],
1283			       sizeof(struct ixgbe_ring));
1284
1285			/* Clear copied XDP RX-queue info */
1286			memset(&temp_ring[i].xdp_rxq, 0,
1287			       sizeof(temp_ring[i].xdp_rxq));
1288
1289			temp_ring[i].count = new_rx_count;
1290			err = ixgbe_setup_rx_resources(adapter, &temp_ring[i]);
1291			if (err) {
1292				while (i) {
1293					i--;
1294					ixgbe_free_rx_resources(&temp_ring[i]);
1295				}
1296				goto err_setup;
1297			}
1298
1299		}
 
 
1300
1301		for (i = 0; i < adapter->num_rx_queues; i++) {
1302			ixgbe_free_rx_resources(adapter->rx_ring[i]);
1303
1304			memcpy(adapter->rx_ring[i], &temp_ring[i],
1305			       sizeof(struct ixgbe_ring));
 
 
 
 
 
 
 
1306		}
1307
1308		adapter->rx_ring_count = new_rx_count;
 
 
 
 
 
 
 
 
 
1309	}
1310
 
1311err_setup:
1312	ixgbe_up(adapter);
1313	vfree(temp_ring);
1314clear_reset:
1315	clear_bit(__IXGBE_RESETTING, &adapter->state);
1316	return err;
1317}
1318
1319static int ixgbe_get_sset_count(struct net_device *netdev, int sset)
1320{
1321	switch (sset) {
1322	case ETH_SS_TEST:
1323		return IXGBE_TEST_LEN;
1324	case ETH_SS_STATS:
1325		return IXGBE_STATS_LEN;
1326	case ETH_SS_PRIV_FLAGS:
1327		return IXGBE_PRIV_FLAGS_STR_LEN;
1328	default:
1329		return -EOPNOTSUPP;
1330	}
1331}
1332
1333static void ixgbe_get_ethtool_stats(struct net_device *netdev,
1334				    struct ethtool_stats *stats, u64 *data)
1335{
1336	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1337	struct rtnl_link_stats64 temp;
1338	const struct rtnl_link_stats64 *net_stats;
1339	unsigned int start;
1340	struct ixgbe_ring *ring;
1341	int i, j;
1342	char *p = NULL;
1343
1344	ixgbe_update_stats(adapter);
1345	net_stats = dev_get_stats(netdev, &temp);
1346	for (i = 0; i < IXGBE_GLOBAL_STATS_LEN; i++) {
1347		switch (ixgbe_gstrings_stats[i].type) {
1348		case NETDEV_STATS:
1349			p = (char *) net_stats +
1350					ixgbe_gstrings_stats[i].stat_offset;
1351			break;
1352		case IXGBE_STATS:
1353			p = (char *) adapter +
1354					ixgbe_gstrings_stats[i].stat_offset;
1355			break;
1356		default:
1357			data[i] = 0;
1358			continue;
1359		}
1360
1361		data[i] = (ixgbe_gstrings_stats[i].sizeof_stat ==
1362			   sizeof(u64)) ? *(u64 *)p : *(u32 *)p;
1363	}
1364	for (j = 0; j < netdev->num_tx_queues; j++) {
1365		ring = adapter->tx_ring[j];
1366		if (!ring) {
1367			data[i] = 0;
1368			data[i+1] = 0;
1369			i += 2;
1370			continue;
1371		}
1372
1373		do {
1374			start = u64_stats_fetch_begin(&ring->syncp);
1375			data[i]   = ring->stats.packets;
1376			data[i+1] = ring->stats.bytes;
1377		} while (u64_stats_fetch_retry(&ring->syncp, start));
1378		i += 2;
1379	}
1380	for (j = 0; j < IXGBE_NUM_RX_QUEUES; j++) {
1381		ring = adapter->rx_ring[j];
1382		if (!ring) {
1383			data[i] = 0;
1384			data[i+1] = 0;
1385			i += 2;
1386			continue;
1387		}
1388
1389		do {
1390			start = u64_stats_fetch_begin(&ring->syncp);
1391			data[i]   = ring->stats.packets;
1392			data[i+1] = ring->stats.bytes;
1393		} while (u64_stats_fetch_retry(&ring->syncp, start));
1394		i += 2;
1395	}
1396
1397	for (j = 0; j < IXGBE_MAX_PACKET_BUFFERS; j++) {
1398		data[i++] = adapter->stats.pxontxc[j];
1399		data[i++] = adapter->stats.pxofftxc[j];
1400	}
1401	for (j = 0; j < IXGBE_MAX_PACKET_BUFFERS; j++) {
1402		data[i++] = adapter->stats.pxonrxc[j];
1403		data[i++] = adapter->stats.pxoffrxc[j];
1404	}
1405}
1406
1407static void ixgbe_get_strings(struct net_device *netdev, u32 stringset,
1408			      u8 *data)
1409{
1410	unsigned int i;
1411	u8 *p = data;
1412
1413	switch (stringset) {
1414	case ETH_SS_TEST:
1415		for (i = 0; i < IXGBE_TEST_LEN; i++)
1416			ethtool_puts(&p, ixgbe_gstrings_test[i]);
1417		break;
1418	case ETH_SS_STATS:
1419		for (i = 0; i < IXGBE_GLOBAL_STATS_LEN; i++)
1420			ethtool_puts(&p, ixgbe_gstrings_stats[i].stat_string);
 
 
 
1421		for (i = 0; i < netdev->num_tx_queues; i++) {
1422			ethtool_sprintf(&p, "tx_queue_%u_packets", i);
1423			ethtool_sprintf(&p, "tx_queue_%u_bytes", i);
 
 
1424		}
1425		for (i = 0; i < IXGBE_NUM_RX_QUEUES; i++) {
1426			ethtool_sprintf(&p, "rx_queue_%u_packets", i);
1427			ethtool_sprintf(&p, "rx_queue_%u_bytes", i);
 
 
1428		}
1429		for (i = 0; i < IXGBE_MAX_PACKET_BUFFERS; i++) {
1430			ethtool_sprintf(&p, "tx_pb_%u_pxon", i);
1431			ethtool_sprintf(&p, "tx_pb_%u_pxoff", i);
 
 
1432		}
1433		for (i = 0; i < IXGBE_MAX_PACKET_BUFFERS; i++) {
1434			ethtool_sprintf(&p, "rx_pb_%u_pxon", i);
1435			ethtool_sprintf(&p, "rx_pb_%u_pxoff", i);
 
 
1436		}
1437		/* BUG_ON(p - data != IXGBE_STATS_LEN * ETH_GSTRING_LEN); */
1438		break;
1439	case ETH_SS_PRIV_FLAGS:
1440		memcpy(data, ixgbe_priv_flags_strings,
1441		       IXGBE_PRIV_FLAGS_STR_LEN * ETH_GSTRING_LEN);
1442	}
1443}
1444
1445static int ixgbe_link_test(struct ixgbe_adapter *adapter, u64 *data)
1446{
1447	struct ixgbe_hw *hw = &adapter->hw;
1448	bool link_up;
1449	u32 link_speed = 0;
1450
1451	if (ixgbe_removed(hw->hw_addr)) {
1452		*data = 1;
1453		return 1;
1454	}
1455	*data = 0;
1456
1457	hw->mac.ops.check_link(hw, &link_speed, &link_up, true);
1458	if (link_up)
1459		return *data;
1460	else
1461		*data = 1;
1462	return *data;
1463}
1464
1465/* ethtool register test data */
1466struct ixgbe_reg_test {
1467	u16 reg;
1468	u8  array_len;
1469	u8  test_type;
1470	u32 mask;
1471	u32 write;
1472};
1473
1474/* In the hardware, registers are laid out either singly, in arrays
1475 * spaced 0x40 bytes apart, or in contiguous tables.  We assume
1476 * most tests take place on arrays or single registers (handled
1477 * as a single-element array) and special-case the tables.
1478 * Table tests are always pattern tests.
1479 *
1480 * We also make provision for some required setup steps by specifying
1481 * registers to be written without any read-back testing.
1482 */
1483
1484#define PATTERN_TEST	1
1485#define SET_READ_TEST	2
1486#define WRITE_NO_TEST	3
1487#define TABLE32_TEST	4
1488#define TABLE64_TEST_LO	5
1489#define TABLE64_TEST_HI	6
1490
1491/* default 82599 register test */
1492static const struct ixgbe_reg_test reg_test_82599[] = {
1493	{ IXGBE_FCRTL_82599(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1494	{ IXGBE_FCRTH_82599(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1495	{ IXGBE_PFCTOP, 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1496	{ IXGBE_VLNCTRL, 1, PATTERN_TEST, 0x00000000, 0x00000000 },
1497	{ IXGBE_RDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFF80 },
1498	{ IXGBE_RDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1499	{ IXGBE_RDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFFFF },
1500	{ IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, IXGBE_RXDCTL_ENABLE },
1501	{ IXGBE_RDT(0), 4, PATTERN_TEST, 0x0000FFFF, 0x0000FFFF },
1502	{ IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, 0 },
1503	{ IXGBE_FCRTH(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1504	{ IXGBE_FCTTV(0), 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1505	{ IXGBE_TDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFFFF },
1506	{ IXGBE_TDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1507	{ IXGBE_TDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFF80 },
1508	{ IXGBE_RXCTRL, 1, SET_READ_TEST, 0x00000001, 0x00000001 },
1509	{ IXGBE_RAL(0), 16, TABLE64_TEST_LO, 0xFFFFFFFF, 0xFFFFFFFF },
1510	{ IXGBE_RAL(0), 16, TABLE64_TEST_HI, 0x8001FFFF, 0x800CFFFF },
1511	{ IXGBE_MTA(0), 128, TABLE32_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1512	{ .reg = 0 }
1513};
1514
1515/* default 82598 register test */
1516static const struct ixgbe_reg_test reg_test_82598[] = {
1517	{ IXGBE_FCRTL(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1518	{ IXGBE_FCRTH(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1519	{ IXGBE_PFCTOP, 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1520	{ IXGBE_VLNCTRL, 1, PATTERN_TEST, 0x00000000, 0x00000000 },
1521	{ IXGBE_RDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFFFF },
1522	{ IXGBE_RDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1523	{ IXGBE_RDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFFFF },
1524	/* Enable all four RX queues before testing. */
1525	{ IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, IXGBE_RXDCTL_ENABLE },
1526	/* RDH is read-only for 82598, only test RDT. */
1527	{ IXGBE_RDT(0), 4, PATTERN_TEST, 0x0000FFFF, 0x0000FFFF },
1528	{ IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, 0 },
1529	{ IXGBE_FCRTH(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1530	{ IXGBE_FCTTV(0), 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1531	{ IXGBE_TIPG, 1, PATTERN_TEST, 0x000000FF, 0x000000FF },
1532	{ IXGBE_TDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFFFF },
1533	{ IXGBE_TDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1534	{ IXGBE_TDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFFFF },
1535	{ IXGBE_RXCTRL, 1, SET_READ_TEST, 0x00000003, 0x00000003 },
1536	{ IXGBE_DTXCTL, 1, SET_READ_TEST, 0x00000005, 0x00000005 },
1537	{ IXGBE_RAL(0), 16, TABLE64_TEST_LO, 0xFFFFFFFF, 0xFFFFFFFF },
1538	{ IXGBE_RAL(0), 16, TABLE64_TEST_HI, 0x800CFFFF, 0x800CFFFF },
1539	{ IXGBE_MTA(0), 128, TABLE32_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1540	{ .reg = 0 }
1541};
1542
1543static bool reg_pattern_test(struct ixgbe_adapter *adapter, u64 *data, int reg,
1544			     u32 mask, u32 write)
1545{
1546	u32 pat, val, before;
1547	static const u32 test_pattern[] = {
1548		0x5A5A5A5A, 0xA5A5A5A5, 0x00000000, 0xFFFFFFFF};
1549
1550	if (ixgbe_removed(adapter->hw.hw_addr)) {
1551		*data = 1;
1552		return true;
1553	}
1554	for (pat = 0; pat < ARRAY_SIZE(test_pattern); pat++) {
1555		before = ixgbe_read_reg(&adapter->hw, reg);
1556		ixgbe_write_reg(&adapter->hw, reg, test_pattern[pat] & write);
1557		val = ixgbe_read_reg(&adapter->hw, reg);
 
1558		if (val != (test_pattern[pat] & write & mask)) {
1559			e_err(drv, "pattern test reg %04X failed: got 0x%08X expected 0x%08X\n",
 
1560			      reg, val, (test_pattern[pat] & write & mask));
1561			*data = reg;
1562			ixgbe_write_reg(&adapter->hw, reg, before);
1563			return true;
1564		}
1565		ixgbe_write_reg(&adapter->hw, reg, before);
1566	}
1567	return false;
1568}
1569
1570static bool reg_set_and_check(struct ixgbe_adapter *adapter, u64 *data, int reg,
1571			      u32 mask, u32 write)
1572{
1573	u32 val, before;
1574
1575	if (ixgbe_removed(adapter->hw.hw_addr)) {
1576		*data = 1;
1577		return true;
1578	}
1579	before = ixgbe_read_reg(&adapter->hw, reg);
1580	ixgbe_write_reg(&adapter->hw, reg, write & mask);
1581	val = ixgbe_read_reg(&adapter->hw, reg);
1582	if ((write & mask) != (val & mask)) {
1583		e_err(drv, "set/check reg %04X test failed: got 0x%08X expected 0x%08X\n",
1584		      reg, (val & mask), (write & mask));
1585		*data = reg;
1586		ixgbe_write_reg(&adapter->hw, reg, before);
1587		return true;
1588	}
1589	ixgbe_write_reg(&adapter->hw, reg, before);
1590	return false;
1591}
1592
 
 
 
 
 
 
 
 
 
 
 
 
 
1593static int ixgbe_reg_test(struct ixgbe_adapter *adapter, u64 *data)
1594{
1595	const struct ixgbe_reg_test *test;
1596	u32 value, before, after;
1597	u32 i, toggle;
1598
1599	if (ixgbe_removed(adapter->hw.hw_addr)) {
1600		e_err(drv, "Adapter removed - register test blocked\n");
1601		*data = 1;
1602		return 1;
1603	}
1604	switch (adapter->hw.mac.type) {
1605	case ixgbe_mac_82598EB:
1606		toggle = 0x7FFFF3FF;
1607		test = reg_test_82598;
1608		break;
1609	case ixgbe_mac_82599EB:
1610	case ixgbe_mac_X540:
1611	case ixgbe_mac_X550:
1612	case ixgbe_mac_X550EM_x:
1613	case ixgbe_mac_x550em_a:
1614		toggle = 0x7FFFF30F;
1615		test = reg_test_82599;
1616		break;
1617	default:
1618		*data = 1;
1619		return 1;
 
1620	}
1621
1622	/*
1623	 * Because the status register is such a special case,
1624	 * we handle it separately from the rest of the register
1625	 * tests.  Some bits are read-only, some toggle, and some
1626	 * are writeable on newer MACs.
1627	 */
1628	before = ixgbe_read_reg(&adapter->hw, IXGBE_STATUS);
1629	value = (ixgbe_read_reg(&adapter->hw, IXGBE_STATUS) & toggle);
1630	ixgbe_write_reg(&adapter->hw, IXGBE_STATUS, toggle);
1631	after = ixgbe_read_reg(&adapter->hw, IXGBE_STATUS) & toggle;
1632	if (value != after) {
1633		e_err(drv, "failed STATUS register test got: 0x%08X expected: 0x%08X\n",
1634		      after, value);
1635		*data = 1;
1636		return 1;
1637	}
1638	/* restore previous status */
1639	ixgbe_write_reg(&adapter->hw, IXGBE_STATUS, before);
1640
1641	/*
1642	 * Perform the remainder of the register test, looping through
1643	 * the test table until we either fail or reach the null entry.
1644	 */
1645	while (test->reg) {
1646		for (i = 0; i < test->array_len; i++) {
1647			bool b = false;
1648
1649			switch (test->test_type) {
1650			case PATTERN_TEST:
1651				b = reg_pattern_test(adapter, data,
1652						     test->reg + (i * 0x40),
1653						     test->mask,
1654						     test->write);
1655				break;
1656			case SET_READ_TEST:
1657				b = reg_set_and_check(adapter, data,
1658						      test->reg + (i * 0x40),
1659						      test->mask,
1660						      test->write);
1661				break;
1662			case WRITE_NO_TEST:
1663				ixgbe_write_reg(&adapter->hw,
1664						test->reg + (i * 0x40),
1665						test->write);
1666				break;
1667			case TABLE32_TEST:
1668				b = reg_pattern_test(adapter, data,
1669						     test->reg + (i * 4),
1670						     test->mask,
1671						     test->write);
1672				break;
1673			case TABLE64_TEST_LO:
1674				b = reg_pattern_test(adapter, data,
1675						     test->reg + (i * 8),
1676						     test->mask,
1677						     test->write);
1678				break;
1679			case TABLE64_TEST_HI:
1680				b = reg_pattern_test(adapter, data,
1681						     (test->reg + 4) + (i * 8),
1682						     test->mask,
1683						     test->write);
1684				break;
1685			}
1686			if (b)
1687				return 1;
1688		}
1689		test++;
1690	}
1691
1692	*data = 0;
1693	return 0;
1694}
1695
1696static int ixgbe_eeprom_test(struct ixgbe_adapter *adapter, u64 *data)
1697{
1698	struct ixgbe_hw *hw = &adapter->hw;
1699	if (hw->eeprom.ops.validate_checksum(hw, NULL))
1700		*data = 1;
1701	else
1702		*data = 0;
1703	return *data;
1704}
1705
1706static irqreturn_t ixgbe_test_intr(int irq, void *data)
1707{
1708	struct net_device *netdev = (struct net_device *) data;
1709	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1710
1711	adapter->test_icr |= IXGBE_READ_REG(&adapter->hw, IXGBE_EICR);
1712
1713	return IRQ_HANDLED;
1714}
1715
1716static int ixgbe_intr_test(struct ixgbe_adapter *adapter, u64 *data)
1717{
1718	struct net_device *netdev = adapter->netdev;
1719	u32 mask, i = 0, shared_int = true;
1720	u32 irq = adapter->pdev->irq;
1721
1722	*data = 0;
1723
1724	/* Hook up test interrupt handler just for this test */
1725	if (adapter->msix_entries) {
1726		/* NOTE: we don't test MSI-X interrupts here, yet */
1727		return 0;
1728	} else if (adapter->flags & IXGBE_FLAG_MSI_ENABLED) {
1729		shared_int = false;
1730		if (request_irq(irq, ixgbe_test_intr, 0, netdev->name,
1731				netdev)) {
1732			*data = 1;
1733			return -1;
1734		}
1735	} else if (!request_irq(irq, ixgbe_test_intr, IRQF_PROBE_SHARED,
1736				netdev->name, netdev)) {
1737		shared_int = false;
1738	} else if (request_irq(irq, ixgbe_test_intr, IRQF_SHARED,
1739			       netdev->name, netdev)) {
1740		*data = 1;
1741		return -1;
1742	}
1743	e_info(hw, "testing %s interrupt\n", shared_int ?
1744	       "shared" : "unshared");
1745
1746	/* Disable all the interrupts */
1747	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFFFFFF);
1748	IXGBE_WRITE_FLUSH(&adapter->hw);
1749	usleep_range(10000, 20000);
1750
1751	/* Test each interrupt */
1752	for (; i < 10; i++) {
1753		/* Interrupt to test */
1754		mask = BIT(i);
1755
1756		if (!shared_int) {
1757			/*
1758			 * Disable the interrupts to be reported in
1759			 * the cause register and then force the same
1760			 * interrupt and see if one gets posted.  If
1761			 * an interrupt was posted to the bus, the
1762			 * test failed.
1763			 */
1764			adapter->test_icr = 0;
1765			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC,
1766					~mask & 0x00007FFF);
1767			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS,
1768					~mask & 0x00007FFF);
1769			IXGBE_WRITE_FLUSH(&adapter->hw);
1770			usleep_range(10000, 20000);
1771
1772			if (adapter->test_icr & mask) {
1773				*data = 3;
1774				break;
1775			}
1776		}
1777
1778		/*
1779		 * Enable the interrupt to be reported in the cause
1780		 * register and then force the same interrupt and see
1781		 * if one gets posted.  If an interrupt was not posted
1782		 * to the bus, the test failed.
1783		 */
1784		adapter->test_icr = 0;
1785		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMS, mask);
1786		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS, mask);
1787		IXGBE_WRITE_FLUSH(&adapter->hw);
1788		usleep_range(10000, 20000);
1789
1790		if (!(adapter->test_icr & mask)) {
1791			*data = 4;
1792			break;
1793		}
1794
1795		if (!shared_int) {
1796			/*
1797			 * Disable the other interrupts to be reported in
1798			 * the cause register and then force the other
1799			 * interrupts and see if any get posted.  If
1800			 * an interrupt was posted to the bus, the
1801			 * test failed.
1802			 */
1803			adapter->test_icr = 0;
1804			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC,
1805					~mask & 0x00007FFF);
1806			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS,
1807					~mask & 0x00007FFF);
1808			IXGBE_WRITE_FLUSH(&adapter->hw);
1809			usleep_range(10000, 20000);
1810
1811			if (adapter->test_icr) {
1812				*data = 5;
1813				break;
1814			}
1815		}
1816	}
1817
1818	/* Disable all the interrupts */
1819	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFFFFFF);
1820	IXGBE_WRITE_FLUSH(&adapter->hw);
1821	usleep_range(10000, 20000);
1822
1823	/* Unhook test interrupt handler */
1824	free_irq(irq, netdev);
1825
1826	return *data;
1827}
1828
1829static void ixgbe_free_desc_rings(struct ixgbe_adapter *adapter)
1830{
1831	/* Shut down the DMA engines now so they can be reinitialized later,
1832	 * since the test rings and normally used rings should overlap on
1833	 * queue 0 we can just use the standard disable Rx/Tx calls and they
1834	 * will take care of disabling the test rings for us.
1835	 */
 
1836
1837	/* first Rx */
1838	ixgbe_disable_rx(adapter);
 
 
 
1839
1840	/* now Tx */
1841	ixgbe_disable_tx(adapter);
 
 
 
 
 
 
 
 
 
 
 
 
 
1842
1843	ixgbe_reset(adapter);
1844
1845	ixgbe_free_tx_resources(&adapter->test_tx_ring);
1846	ixgbe_free_rx_resources(&adapter->test_rx_ring);
1847}
1848
1849static int ixgbe_setup_desc_rings(struct ixgbe_adapter *adapter)
1850{
1851	struct ixgbe_ring *tx_ring = &adapter->test_tx_ring;
1852	struct ixgbe_ring *rx_ring = &adapter->test_rx_ring;
1853	struct ixgbe_hw *hw = &adapter->hw;
1854	u32 rctl, reg_data;
1855	int ret_val;
1856	int err;
1857
1858	/* Setup Tx descriptor ring and Tx buffers */
1859	tx_ring->count = IXGBE_DEFAULT_TXD;
1860	tx_ring->queue_index = 0;
1861	tx_ring->dev = &adapter->pdev->dev;
1862	tx_ring->netdev = adapter->netdev;
1863	tx_ring->reg_idx = adapter->tx_ring[0]->reg_idx;
1864
1865	err = ixgbe_setup_tx_resources(tx_ring);
1866	if (err)
1867		return 1;
1868
1869	switch (adapter->hw.mac.type) {
1870	case ixgbe_mac_82599EB:
1871	case ixgbe_mac_X540:
1872	case ixgbe_mac_X550:
1873	case ixgbe_mac_X550EM_x:
1874	case ixgbe_mac_x550em_a:
1875		reg_data = IXGBE_READ_REG(&adapter->hw, IXGBE_DMATXCTL);
1876		reg_data |= IXGBE_DMATXCTL_TE;
1877		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DMATXCTL, reg_data);
1878		break;
1879	default:
1880		break;
1881	}
1882
1883	ixgbe_configure_tx_ring(adapter, tx_ring);
1884
1885	/* Setup Rx Descriptor ring and Rx buffers */
1886	rx_ring->count = IXGBE_DEFAULT_RXD;
1887	rx_ring->queue_index = 0;
1888	rx_ring->dev = &adapter->pdev->dev;
1889	rx_ring->netdev = adapter->netdev;
1890	rx_ring->reg_idx = adapter->rx_ring[0]->reg_idx;
1891
1892	err = ixgbe_setup_rx_resources(adapter, rx_ring);
1893	if (err) {
1894		ret_val = 4;
1895		goto err_nomem;
1896	}
1897
1898	hw->mac.ops.disable_rx(hw);
 
1899
1900	ixgbe_configure_rx_ring(adapter, rx_ring);
1901
1902	rctl = IXGBE_READ_REG(&adapter->hw, IXGBE_RXCTRL);
1903	rctl |= IXGBE_RXCTRL_DMBYPS;
1904	IXGBE_WRITE_REG(&adapter->hw, IXGBE_RXCTRL, rctl);
1905
1906	hw->mac.ops.enable_rx(hw);
1907
1908	return 0;
1909
1910err_nomem:
1911	ixgbe_free_desc_rings(adapter);
1912	return ret_val;
1913}
1914
1915static int ixgbe_setup_loopback_test(struct ixgbe_adapter *adapter)
1916{
1917	struct ixgbe_hw *hw = &adapter->hw;
1918	u32 reg_data;
1919
 
 
 
 
 
 
1920
1921	/* Setup MAC loopback */
1922	reg_data = IXGBE_READ_REG(hw, IXGBE_HLREG0);
 
1923	reg_data |= IXGBE_HLREG0_LPBK;
1924	IXGBE_WRITE_REG(hw, IXGBE_HLREG0, reg_data);
1925
1926	reg_data = IXGBE_READ_REG(hw, IXGBE_FCTRL);
1927	reg_data |= IXGBE_FCTRL_BAM | IXGBE_FCTRL_SBP | IXGBE_FCTRL_MPE;
1928	IXGBE_WRITE_REG(hw, IXGBE_FCTRL, reg_data);
1929
1930	/* X540 and X550 needs to set the MACC.FLU bit to force link up */
1931	switch (adapter->hw.mac.type) {
1932	case ixgbe_mac_X540:
1933	case ixgbe_mac_X550:
1934	case ixgbe_mac_X550EM_x:
1935	case ixgbe_mac_x550em_a:
1936		reg_data = IXGBE_READ_REG(hw, IXGBE_MACC);
1937		reg_data |= IXGBE_MACC_FLU;
1938		IXGBE_WRITE_REG(hw, IXGBE_MACC, reg_data);
1939		break;
1940	default:
1941		if (hw->mac.orig_autoc) {
1942			reg_data = hw->mac.orig_autoc | IXGBE_AUTOC_FLU;
1943			IXGBE_WRITE_REG(hw, IXGBE_AUTOC, reg_data);
1944		} else {
1945			return 10;
1946		}
1947	}
1948	IXGBE_WRITE_FLUSH(hw);
1949	usleep_range(10000, 20000);
1950
1951	/* Disable Atlas Tx lanes; re-enabled in reset path */
1952	if (hw->mac.type == ixgbe_mac_82598EB) {
1953		u8 atlas;
1954
1955		hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_LPBK, &atlas);
1956		atlas |= IXGBE_ATLAS_PDN_TX_REG_EN;
1957		hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_LPBK, atlas);
1958
1959		hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_10G, &atlas);
1960		atlas |= IXGBE_ATLAS_PDN_TX_10G_QL_ALL;
1961		hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_10G, atlas);
1962
1963		hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_1G, &atlas);
1964		atlas |= IXGBE_ATLAS_PDN_TX_1G_QL_ALL;
1965		hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_1G, atlas);
1966
1967		hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_AN, &atlas);
1968		atlas |= IXGBE_ATLAS_PDN_TX_AN_QL_ALL;
1969		hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_AN, atlas);
1970	}
1971
1972	return 0;
1973}
1974
1975static void ixgbe_loopback_cleanup(struct ixgbe_adapter *adapter)
1976{
1977	u32 reg_data;
1978
1979	reg_data = IXGBE_READ_REG(&adapter->hw, IXGBE_HLREG0);
1980	reg_data &= ~IXGBE_HLREG0_LPBK;
1981	IXGBE_WRITE_REG(&adapter->hw, IXGBE_HLREG0, reg_data);
1982}
1983
1984static void ixgbe_create_lbtest_frame(struct sk_buff *skb,
1985				      unsigned int frame_size)
1986{
1987	memset(skb->data, 0xFF, frame_size);
1988	frame_size >>= 1;
1989	memset(&skb->data[frame_size], 0xAA, frame_size / 2 - 1);
1990	skb->data[frame_size + 10] = 0xBE;
1991	skb->data[frame_size + 12] = 0xAF;
1992}
1993
1994static bool ixgbe_check_lbtest_frame(struct ixgbe_rx_buffer *rx_buffer,
1995				     unsigned int frame_size)
1996{
1997	unsigned char *data;
 
1998
1999	frame_size >>= 1;
2000
2001	data = page_address(rx_buffer->page) + rx_buffer->page_offset;
 
 
 
 
 
 
 
2002
2003	return data[3] == 0xFF && data[frame_size + 10] == 0xBE &&
2004		data[frame_size + 12] == 0xAF;
2005}
2006
2007static u16 ixgbe_clean_test_rings(struct ixgbe_ring *rx_ring,
2008				  struct ixgbe_ring *tx_ring,
2009				  unsigned int size)
2010{
2011	union ixgbe_adv_rx_desc *rx_desc;
 
 
2012	u16 rx_ntc, tx_ntc, count = 0;
2013
2014	/* initialize next to clean and descriptor values */
2015	rx_ntc = rx_ring->next_to_clean;
2016	tx_ntc = tx_ring->next_to_clean;
2017	rx_desc = IXGBE_RX_DESC(rx_ring, rx_ntc);
2018
2019	while (tx_ntc != tx_ring->next_to_use) {
2020		union ixgbe_adv_tx_desc *tx_desc;
2021		struct ixgbe_tx_buffer *tx_buffer;
2022
2023		tx_desc = IXGBE_TX_DESC(tx_ring, tx_ntc);
2024
2025		/* if DD is not set transmit has not completed */
2026		if (!(tx_desc->wb.status & cpu_to_le32(IXGBE_TXD_STAT_DD)))
2027			return count;
2028
2029		/* unmap buffer on Tx side */
2030		tx_buffer = &tx_ring->tx_buffer_info[tx_ntc];
2031
2032		/* Free all the Tx ring sk_buffs */
2033		dev_kfree_skb_any(tx_buffer->skb);
2034
2035		/* unmap skb header data */
2036		dma_unmap_single(tx_ring->dev,
2037				 dma_unmap_addr(tx_buffer, dma),
2038				 dma_unmap_len(tx_buffer, len),
2039				 DMA_TO_DEVICE);
2040		dma_unmap_len_set(tx_buffer, len, 0);
2041
2042		/* increment Tx next to clean counter */
2043		tx_ntc++;
2044		if (tx_ntc == tx_ring->count)
2045			tx_ntc = 0;
2046	}
2047
2048	while (rx_desc->wb.upper.length) {
2049		struct ixgbe_rx_buffer *rx_buffer;
2050
2051		/* check Rx buffer */
2052		rx_buffer = &rx_ring->rx_buffer_info[rx_ntc];
2053
2054		/* sync Rx buffer for CPU read */
2055		dma_sync_single_for_cpu(rx_ring->dev,
2056					rx_buffer->dma,
2057					ixgbe_rx_bufsz(rx_ring),
2058					DMA_FROM_DEVICE);
2059
2060		/* verify contents of skb */
2061		if (ixgbe_check_lbtest_frame(rx_buffer, size))
2062			count++;
2063		else
2064			break;
2065
2066		/* sync Rx buffer for device write */
2067		dma_sync_single_for_device(rx_ring->dev,
2068					   rx_buffer->dma,
2069					   ixgbe_rx_bufsz(rx_ring),
2070					   DMA_FROM_DEVICE);
2071
2072		/* increment Rx next to clean counter */
 
 
 
 
2073		rx_ntc++;
2074		if (rx_ntc == rx_ring->count)
2075			rx_ntc = 0;
 
 
 
2076
2077		/* fetch next descriptor */
2078		rx_desc = IXGBE_RX_DESC(rx_ring, rx_ntc);
2079	}
2080
2081	netdev_tx_reset_queue(txring_txq(tx_ring));
2082
2083	/* re-map buffers to ring, store next to clean values */
2084	ixgbe_alloc_rx_buffers(rx_ring, count);
2085	rx_ring->next_to_clean = rx_ntc;
2086	tx_ring->next_to_clean = tx_ntc;
2087
2088	return count;
2089}
2090
2091static int ixgbe_run_loopback_test(struct ixgbe_adapter *adapter)
2092{
2093	struct ixgbe_ring *tx_ring = &adapter->test_tx_ring;
2094	struct ixgbe_ring *rx_ring = &adapter->test_rx_ring;
2095	int i, j, lc, good_cnt, ret_val = 0;
2096	unsigned int size = 1024;
2097	netdev_tx_t tx_ret_val;
2098	struct sk_buff *skb;
2099	u32 flags_orig = adapter->flags;
2100
2101	/* DCB can modify the frames on Tx */
2102	adapter->flags &= ~IXGBE_FLAG_DCB_ENABLED;
2103
2104	/* allocate test skb */
2105	skb = alloc_skb(size, GFP_KERNEL);
2106	if (!skb)
2107		return 11;
2108
2109	/* place data into test skb */
2110	ixgbe_create_lbtest_frame(skb, size);
2111	skb_put(skb, size);
2112
2113	/*
2114	 * Calculate the loop count based on the largest descriptor ring
2115	 * The idea is to wrap the largest ring a number of times using 64
2116	 * send/receive pairs during each loop
2117	 */
2118
2119	if (rx_ring->count <= tx_ring->count)
2120		lc = ((tx_ring->count / 64) * 2) + 1;
2121	else
2122		lc = ((rx_ring->count / 64) * 2) + 1;
2123
2124	for (j = 0; j <= lc; j++) {
2125		/* reset count of good packets */
2126		good_cnt = 0;
2127
2128		/* place 64 packets on the transmit queue*/
2129		for (i = 0; i < 64; i++) {
2130			skb_get(skb);
2131			tx_ret_val = ixgbe_xmit_frame_ring(skb,
2132							   adapter,
2133							   tx_ring);
2134			if (tx_ret_val == NETDEV_TX_OK)
2135				good_cnt++;
2136		}
2137
2138		if (good_cnt != 64) {
2139			ret_val = 12;
2140			break;
2141		}
2142
2143		/* allow 200 milliseconds for packets to go from Tx to Rx */
2144		msleep(200);
2145
2146		good_cnt = ixgbe_clean_test_rings(rx_ring, tx_ring, size);
2147		if (good_cnt != 64) {
2148			ret_val = 13;
2149			break;
2150		}
2151	}
2152
2153	/* free the original skb */
2154	kfree_skb(skb);
2155	adapter->flags = flags_orig;
2156
2157	return ret_val;
2158}
2159
2160static int ixgbe_loopback_test(struct ixgbe_adapter *adapter, u64 *data)
2161{
2162	*data = ixgbe_setup_desc_rings(adapter);
2163	if (*data)
2164		goto out;
2165	*data = ixgbe_setup_loopback_test(adapter);
2166	if (*data)
2167		goto err_loopback;
2168	*data = ixgbe_run_loopback_test(adapter);
2169	ixgbe_loopback_cleanup(adapter);
2170
2171err_loopback:
2172	ixgbe_free_desc_rings(adapter);
2173out:
2174	return *data;
2175}
2176
2177static void ixgbe_diag_test(struct net_device *netdev,
2178			    struct ethtool_test *eth_test, u64 *data)
2179{
2180	struct ixgbe_adapter *adapter = netdev_priv(netdev);
2181	bool if_running = netif_running(netdev);
2182
2183	if (ixgbe_removed(adapter->hw.hw_addr)) {
2184		e_err(hw, "Adapter removed - test blocked\n");
2185		data[0] = 1;
2186		data[1] = 1;
2187		data[2] = 1;
2188		data[3] = 1;
2189		data[4] = 1;
2190		eth_test->flags |= ETH_TEST_FL_FAILED;
2191		return;
2192	}
2193	set_bit(__IXGBE_TESTING, &adapter->state);
2194	if (eth_test->flags == ETH_TEST_FL_OFFLINE) {
2195		struct ixgbe_hw *hw = &adapter->hw;
 
 
 
 
 
 
 
2196
2197		if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
2198			int i;
2199			for (i = 0; i < adapter->num_vfs; i++) {
2200				if (adapter->vfinfo[i].clear_to_send) {
2201					netdev_warn(netdev, "offline diagnostic is not supported when VFs are present\n");
 
 
 
2202					data[0] = 1;
2203					data[1] = 1;
2204					data[2] = 1;
2205					data[3] = 1;
2206					data[4] = 1;
2207					eth_test->flags |= ETH_TEST_FL_FAILED;
2208					clear_bit(__IXGBE_TESTING,
2209						  &adapter->state);
2210					return;
2211				}
2212			}
2213		}
2214
2215		/* Offline tests */
2216		e_info(hw, "offline testing starting\n");
2217
2218		/* Link test performed before hardware reset so autoneg doesn't
2219		 * interfere with test result
2220		 */
2221		if (ixgbe_link_test(adapter, &data[4]))
2222			eth_test->flags |= ETH_TEST_FL_FAILED;
2223
2224		if (if_running)
2225			/* indicate we're in test mode */
2226			ixgbe_close(netdev);
2227		else
2228			ixgbe_reset(adapter);
2229
2230		e_info(hw, "register testing starting\n");
2231		if (ixgbe_reg_test(adapter, &data[0]))
2232			eth_test->flags |= ETH_TEST_FL_FAILED;
2233
2234		ixgbe_reset(adapter);
2235		e_info(hw, "eeprom testing starting\n");
2236		if (ixgbe_eeprom_test(adapter, &data[1]))
2237			eth_test->flags |= ETH_TEST_FL_FAILED;
2238
2239		ixgbe_reset(adapter);
2240		e_info(hw, "interrupt testing starting\n");
2241		if (ixgbe_intr_test(adapter, &data[2]))
2242			eth_test->flags |= ETH_TEST_FL_FAILED;
2243
2244		/* If SRIOV or VMDq is enabled then skip MAC
2245		 * loopback diagnostic. */
2246		if (adapter->flags & (IXGBE_FLAG_SRIOV_ENABLED |
2247				      IXGBE_FLAG_VMDQ_ENABLED)) {
2248			e_info(hw, "Skip MAC loopback diagnostic in VT mode\n");
 
2249			data[3] = 0;
2250			goto skip_loopback;
2251		}
2252
2253		ixgbe_reset(adapter);
2254		e_info(hw, "loopback testing starting\n");
2255		if (ixgbe_loopback_test(adapter, &data[3]))
2256			eth_test->flags |= ETH_TEST_FL_FAILED;
2257
2258skip_loopback:
2259		ixgbe_reset(adapter);
2260
2261		/* clear testing bit and return adapter to previous state */
2262		clear_bit(__IXGBE_TESTING, &adapter->state);
2263		if (if_running)
2264			ixgbe_open(netdev);
2265		else if (hw->mac.ops.disable_tx_laser)
2266			hw->mac.ops.disable_tx_laser(hw);
2267	} else {
2268		e_info(hw, "online testing starting\n");
2269
2270		/* Online tests */
2271		if (ixgbe_link_test(adapter, &data[4]))
2272			eth_test->flags |= ETH_TEST_FL_FAILED;
2273
2274		/* Offline tests aren't run; pass by default */
2275		data[0] = 0;
2276		data[1] = 0;
2277		data[2] = 0;
2278		data[3] = 0;
2279
2280		clear_bit(__IXGBE_TESTING, &adapter->state);
2281	}
 
 
2282}
2283
2284static int ixgbe_wol_exclusion(struct ixgbe_adapter *adapter,
2285			       struct ethtool_wolinfo *wol)
2286{
2287	struct ixgbe_hw *hw = &adapter->hw;
2288	int retval = 0;
2289
2290	/* WOL not supported for all devices */
2291	if (!ixgbe_wol_supported(adapter, hw->device_id,
2292				 hw->subsystem_device_id)) {
2293		retval = 1;
2294		wol->supported = 0;
2295	}
2296
2297	return retval;
2298}
2299
2300static void ixgbe_get_wol(struct net_device *netdev,
2301			  struct ethtool_wolinfo *wol)
2302{
2303	struct ixgbe_adapter *adapter = netdev_priv(netdev);
2304
2305	wol->supported = WAKE_UCAST | WAKE_MCAST |
2306			 WAKE_BCAST | WAKE_MAGIC;
2307	wol->wolopts = 0;
2308
2309	if (ixgbe_wol_exclusion(adapter, wol) ||
2310	    !device_can_wakeup(&adapter->pdev->dev))
2311		return;
2312
2313	if (adapter->wol & IXGBE_WUFC_EX)
2314		wol->wolopts |= WAKE_UCAST;
2315	if (adapter->wol & IXGBE_WUFC_MC)
2316		wol->wolopts |= WAKE_MCAST;
2317	if (adapter->wol & IXGBE_WUFC_BC)
2318		wol->wolopts |= WAKE_BCAST;
2319	if (adapter->wol & IXGBE_WUFC_MAG)
2320		wol->wolopts |= WAKE_MAGIC;
2321}
2322
2323static int ixgbe_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
2324{
2325	struct ixgbe_adapter *adapter = netdev_priv(netdev);
2326
2327	if (wol->wolopts & (WAKE_PHY | WAKE_ARP | WAKE_MAGICSECURE |
2328			    WAKE_FILTER))
2329		return -EOPNOTSUPP;
2330
2331	if (ixgbe_wol_exclusion(adapter, wol))
2332		return wol->wolopts ? -EOPNOTSUPP : 0;
2333
2334	adapter->wol = 0;
2335
2336	if (wol->wolopts & WAKE_UCAST)
2337		adapter->wol |= IXGBE_WUFC_EX;
2338	if (wol->wolopts & WAKE_MCAST)
2339		adapter->wol |= IXGBE_WUFC_MC;
2340	if (wol->wolopts & WAKE_BCAST)
2341		adapter->wol |= IXGBE_WUFC_BC;
2342	if (wol->wolopts & WAKE_MAGIC)
2343		adapter->wol |= IXGBE_WUFC_MAG;
2344
2345	device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);
2346
2347	return 0;
2348}
2349
2350static int ixgbe_nway_reset(struct net_device *netdev)
2351{
2352	struct ixgbe_adapter *adapter = netdev_priv(netdev);
2353
2354	if (netif_running(netdev))
2355		ixgbe_reinit_locked(adapter);
2356
2357	return 0;
2358}
2359
2360static int ixgbe_set_phys_id(struct net_device *netdev,
2361			     enum ethtool_phys_id_state state)
2362{
2363	struct ixgbe_adapter *adapter = netdev_priv(netdev);
2364	struct ixgbe_hw *hw = &adapter->hw;
2365
2366	if (!hw->mac.ops.led_on || !hw->mac.ops.led_off)
2367		return -EOPNOTSUPP;
2368
2369	switch (state) {
2370	case ETHTOOL_ID_ACTIVE:
2371		adapter->led_reg = IXGBE_READ_REG(hw, IXGBE_LEDCTL);
2372		return 2;
2373
2374	case ETHTOOL_ID_ON:
2375		hw->mac.ops.led_on(hw, hw->mac.led_link_act);
2376		break;
2377
2378	case ETHTOOL_ID_OFF:
2379		hw->mac.ops.led_off(hw, hw->mac.led_link_act);
2380		break;
2381
2382	case ETHTOOL_ID_INACTIVE:
2383		/* Restore LED settings */
2384		IXGBE_WRITE_REG(&adapter->hw, IXGBE_LEDCTL, adapter->led_reg);
2385		break;
2386	}
2387
2388	return 0;
2389}
2390
2391static int ixgbe_get_coalesce(struct net_device *netdev,
2392			      struct ethtool_coalesce *ec,
2393			      struct kernel_ethtool_coalesce *kernel_coal,
2394			      struct netlink_ext_ack *extack)
2395{
2396	struct ixgbe_adapter *adapter = netdev_priv(netdev);
2397
2398	/* only valid if in constant ITR mode */
2399	if (adapter->rx_itr_setting <= 1)
2400		ec->rx_coalesce_usecs = adapter->rx_itr_setting;
2401	else
2402		ec->rx_coalesce_usecs = adapter->rx_itr_setting >> 2;
2403
2404	/* if in mixed tx/rx queues per vector mode, report only rx settings */
2405	if (adapter->q_vector[0]->tx.count && adapter->q_vector[0]->rx.count)
2406		return 0;
2407
2408	/* only valid if in constant ITR mode */
2409	if (adapter->tx_itr_setting <= 1)
2410		ec->tx_coalesce_usecs = adapter->tx_itr_setting;
2411	else
2412		ec->tx_coalesce_usecs = adapter->tx_itr_setting >> 2;
2413
2414	return 0;
2415}
2416
2417/*
2418 * this function must be called before setting the new value of
2419 * rx_itr_setting
2420 */
2421static bool ixgbe_update_rsc(struct ixgbe_adapter *adapter)
2422{
2423	struct net_device *netdev = adapter->netdev;
2424
2425	/* nothing to do if LRO or RSC are not enabled */
2426	if (!(adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE) ||
2427	    !(netdev->features & NETIF_F_LRO))
2428		return false;
2429
2430	/* check the feature flag value and enable RSC if necessary */
2431	if (adapter->rx_itr_setting == 1 ||
2432	    adapter->rx_itr_setting > IXGBE_MIN_RSC_ITR) {
2433		if (!(adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)) {
2434			adapter->flags2 |= IXGBE_FLAG2_RSC_ENABLED;
2435			e_info(probe, "rx-usecs value high enough to re-enable RSC\n");
 
2436			return true;
2437		}
2438	/* if interrupt rate is too high then disable RSC */
2439	} else if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED) {
2440		adapter->flags2 &= ~IXGBE_FLAG2_RSC_ENABLED;
2441		e_info(probe, "rx-usecs set too low, disabling RSC\n");
2442		return true;
2443	}
2444	return false;
2445}
2446
2447static int ixgbe_set_coalesce(struct net_device *netdev,
2448			      struct ethtool_coalesce *ec,
2449			      struct kernel_ethtool_coalesce *kernel_coal,
2450			      struct netlink_ext_ack *extack)
2451{
2452	struct ixgbe_adapter *adapter = netdev_priv(netdev);
2453	struct ixgbe_q_vector *q_vector;
2454	int i;
2455	u16 tx_itr_param, rx_itr_param, tx_itr_prev;
 
2456	bool need_reset = false;
2457
2458	if (adapter->q_vector[0]->tx.count && adapter->q_vector[0]->rx.count) {
2459		/* reject Tx specific changes in case of mixed RxTx vectors */
2460		if (ec->tx_coalesce_usecs)
2461			return -EINVAL;
2462		tx_itr_prev = adapter->rx_itr_setting;
2463	} else {
2464		tx_itr_prev = adapter->tx_itr_setting;
2465	}
2466
2467	if ((ec->rx_coalesce_usecs > (IXGBE_MAX_EITR >> 2)) ||
2468	    (ec->tx_coalesce_usecs > (IXGBE_MAX_EITR >> 2)))
2469		return -EINVAL;
2470
2471	if (ec->rx_coalesce_usecs > 1)
2472		adapter->rx_itr_setting = ec->rx_coalesce_usecs << 2;
2473	else
2474		adapter->rx_itr_setting = ec->rx_coalesce_usecs;
2475
2476	if (adapter->rx_itr_setting == 1)
2477		rx_itr_param = IXGBE_20K_ITR;
2478	else
2479		rx_itr_param = adapter->rx_itr_setting;
2480
2481	if (ec->tx_coalesce_usecs > 1)
2482		adapter->tx_itr_setting = ec->tx_coalesce_usecs << 2;
2483	else
2484		adapter->tx_itr_setting = ec->tx_coalesce_usecs;
2485
2486	if (adapter->tx_itr_setting == 1)
2487		tx_itr_param = IXGBE_12K_ITR;
2488	else
2489		tx_itr_param = adapter->tx_itr_setting;
2490
2491	/* mixed Rx/Tx */
2492	if (adapter->q_vector[0]->tx.count && adapter->q_vector[0]->rx.count)
2493		adapter->tx_itr_setting = adapter->rx_itr_setting;
2494
2495	/* detect ITR changes that require update of TXDCTL.WTHRESH */
2496	if ((adapter->tx_itr_setting != 1) &&
2497	    (adapter->tx_itr_setting < IXGBE_100K_ITR)) {
2498		if ((tx_itr_prev == 1) ||
2499		    (tx_itr_prev >= IXGBE_100K_ITR))
2500			need_reset = true;
2501	} else {
2502		if ((tx_itr_prev != 1) &&
2503		    (tx_itr_prev < IXGBE_100K_ITR))
2504			need_reset = true;
2505	}
2506
2507	/* check the old value and enable RSC if necessary */
2508	need_reset |= ixgbe_update_rsc(adapter);
 
 
 
 
 
2509
2510	for (i = 0; i < adapter->num_q_vectors; i++) {
2511		q_vector = adapter->q_vector[i];
2512		if (q_vector->tx.count && !q_vector->rx.count)
2513			/* tx only */
2514			q_vector->itr = tx_itr_param;
2515		else
2516			/* rx only or mixed */
2517			q_vector->itr = rx_itr_param;
2518		ixgbe_write_eitr(q_vector);
2519	}
2520
2521	/*
2522	 * do reset here at the end to make sure EITR==0 case is handled
2523	 * correctly w.r.t stopping tx, and changing TXDCTL.WTHRESH settings
2524	 * also locks in RSC enable/disable which requires reset
2525	 */
2526	if (need_reset)
2527		ixgbe_do_reset(netdev);
2528
2529	return 0;
2530}
2531
2532static int ixgbe_get_ethtool_fdir_entry(struct ixgbe_adapter *adapter,
2533					struct ethtool_rxnfc *cmd)
2534{
2535	union ixgbe_atr_input *mask = &adapter->fdir_mask;
2536	struct ethtool_rx_flow_spec *fsp =
2537		(struct ethtool_rx_flow_spec *)&cmd->fs;
2538	struct hlist_node *node2;
2539	struct ixgbe_fdir_filter *rule = NULL;
2540
2541	/* report total rule count */
2542	cmd->data = (1024 << adapter->fdir_pballoc) - 2;
2543
2544	hlist_for_each_entry_safe(rule, node2,
2545				  &adapter->fdir_filter_list, fdir_node) {
2546		if (fsp->location <= rule->sw_idx)
2547			break;
2548	}
2549
2550	if (!rule || fsp->location != rule->sw_idx)
2551		return -EINVAL;
2552
2553	/* fill out the flow spec entry */
2554
2555	/* set flow type field */
2556	switch (rule->filter.formatted.flow_type) {
2557	case IXGBE_ATR_FLOW_TYPE_TCPV4:
2558		fsp->flow_type = TCP_V4_FLOW;
2559		break;
2560	case IXGBE_ATR_FLOW_TYPE_UDPV4:
2561		fsp->flow_type = UDP_V4_FLOW;
2562		break;
2563	case IXGBE_ATR_FLOW_TYPE_SCTPV4:
2564		fsp->flow_type = SCTP_V4_FLOW;
2565		break;
2566	case IXGBE_ATR_FLOW_TYPE_IPV4:
2567		fsp->flow_type = IP_USER_FLOW;
2568		fsp->h_u.usr_ip4_spec.ip_ver = ETH_RX_NFC_IP4;
2569		fsp->h_u.usr_ip4_spec.proto = 0;
2570		fsp->m_u.usr_ip4_spec.proto = 0;
2571		break;
2572	default:
2573		return -EINVAL;
2574	}
2575
2576	fsp->h_u.tcp_ip4_spec.psrc = rule->filter.formatted.src_port;
2577	fsp->m_u.tcp_ip4_spec.psrc = mask->formatted.src_port;
2578	fsp->h_u.tcp_ip4_spec.pdst = rule->filter.formatted.dst_port;
2579	fsp->m_u.tcp_ip4_spec.pdst = mask->formatted.dst_port;
2580	fsp->h_u.tcp_ip4_spec.ip4src = rule->filter.formatted.src_ip[0];
2581	fsp->m_u.tcp_ip4_spec.ip4src = mask->formatted.src_ip[0];
2582	fsp->h_u.tcp_ip4_spec.ip4dst = rule->filter.formatted.dst_ip[0];
2583	fsp->m_u.tcp_ip4_spec.ip4dst = mask->formatted.dst_ip[0];
2584	fsp->h_ext.vlan_tci = rule->filter.formatted.vlan_id;
2585	fsp->m_ext.vlan_tci = mask->formatted.vlan_id;
2586	fsp->h_ext.vlan_etype = rule->filter.formatted.flex_bytes;
2587	fsp->m_ext.vlan_etype = mask->formatted.flex_bytes;
2588	fsp->h_ext.data[1] = htonl(rule->filter.formatted.vm_pool);
2589	fsp->m_ext.data[1] = htonl(mask->formatted.vm_pool);
2590	fsp->flow_type |= FLOW_EXT;
2591
2592	/* record action */
2593	if (rule->action == IXGBE_FDIR_DROP_QUEUE)
2594		fsp->ring_cookie = RX_CLS_FLOW_DISC;
2595	else
2596		fsp->ring_cookie = rule->action;
2597
2598	return 0;
2599}
2600
2601static int ixgbe_get_ethtool_fdir_all(struct ixgbe_adapter *adapter,
2602				      struct ethtool_rxnfc *cmd,
2603				      u32 *rule_locs)
2604{
2605	struct hlist_node *node2;
2606	struct ixgbe_fdir_filter *rule;
2607	int cnt = 0;
2608
2609	/* report total rule count */
2610	cmd->data = (1024 << adapter->fdir_pballoc) - 2;
2611
2612	hlist_for_each_entry_safe(rule, node2,
2613				  &adapter->fdir_filter_list, fdir_node) {
2614		if (cnt == cmd->rule_cnt)
2615			return -EMSGSIZE;
2616		rule_locs[cnt] = rule->sw_idx;
2617		cnt++;
2618	}
2619
2620	cmd->rule_cnt = cnt;
2621
2622	return 0;
2623}
2624
2625static int ixgbe_get_rss_hash_opts(struct ixgbe_adapter *adapter,
2626				   struct ethtool_rxnfc *cmd)
2627{
2628	cmd->data = 0;
2629
 
 
 
 
2630	/* Report default options for RSS on ixgbe */
2631	switch (cmd->flow_type) {
2632	case TCP_V4_FLOW:
2633		cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
2634		fallthrough;
2635	case UDP_V4_FLOW:
2636		if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV4_UDP)
2637			cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
2638		fallthrough;
2639	case SCTP_V4_FLOW:
2640	case AH_ESP_V4_FLOW:
2641	case AH_V4_FLOW:
2642	case ESP_V4_FLOW:
2643	case IPV4_FLOW:
2644		cmd->data |= RXH_IP_SRC | RXH_IP_DST;
2645		break;
2646	case TCP_V6_FLOW:
2647		cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
2648		fallthrough;
2649	case UDP_V6_FLOW:
2650		if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV6_UDP)
2651			cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
2652		fallthrough;
2653	case SCTP_V6_FLOW:
2654	case AH_ESP_V6_FLOW:
2655	case AH_V6_FLOW:
2656	case ESP_V6_FLOW:
2657	case IPV6_FLOW:
2658		cmd->data |= RXH_IP_SRC | RXH_IP_DST;
2659		break;
2660	default:
2661		return -EINVAL;
2662	}
2663
2664	return 0;
2665}
2666
2667static int ixgbe_rss_indir_tbl_max(struct ixgbe_adapter *adapter)
2668{
2669	if (adapter->hw.mac.type < ixgbe_mac_X550)
2670		return 16;
2671	else
2672		return 64;
2673}
2674
2675static int ixgbe_get_rxnfc(struct net_device *dev, struct ethtool_rxnfc *cmd,
2676			   u32 *rule_locs)
2677{
2678	struct ixgbe_adapter *adapter = netdev_priv(dev);
2679	int ret = -EOPNOTSUPP;
2680
2681	switch (cmd->cmd) {
2682	case ETHTOOL_GRXRINGS:
2683		cmd->data = min_t(int, adapter->num_rx_queues,
2684				  ixgbe_rss_indir_tbl_max(adapter));
2685		ret = 0;
2686		break;
2687	case ETHTOOL_GRXCLSRLCNT:
2688		cmd->rule_cnt = adapter->fdir_filter_count;
2689		ret = 0;
2690		break;
2691	case ETHTOOL_GRXCLSRULE:
2692		ret = ixgbe_get_ethtool_fdir_entry(adapter, cmd);
2693		break;
2694	case ETHTOOL_GRXCLSRLALL:
2695		ret = ixgbe_get_ethtool_fdir_all(adapter, cmd, rule_locs);
2696		break;
2697	case ETHTOOL_GRXFH:
2698		ret = ixgbe_get_rss_hash_opts(adapter, cmd);
2699		break;
2700	default:
2701		break;
2702	}
2703
2704	return ret;
2705}
2706
2707int ixgbe_update_ethtool_fdir_entry(struct ixgbe_adapter *adapter,
2708				    struct ixgbe_fdir_filter *input,
2709				    u16 sw_idx)
2710{
2711	struct ixgbe_hw *hw = &adapter->hw;
2712	struct hlist_node *node2;
2713	struct ixgbe_fdir_filter *rule, *parent;
2714	int err = -EINVAL;
2715
2716	parent = NULL;
2717	rule = NULL;
2718
2719	hlist_for_each_entry_safe(rule, node2,
2720				  &adapter->fdir_filter_list, fdir_node) {
2721		/* hash found, or no matching entry */
2722		if (rule->sw_idx >= sw_idx)
2723			break;
2724		parent = rule;
2725	}
2726
2727	/* if there is an old rule occupying our place remove it */
2728	if (rule && (rule->sw_idx == sw_idx)) {
2729		if (!input || (rule->filter.formatted.bkt_hash !=
2730			       input->filter.formatted.bkt_hash)) {
2731			err = ixgbe_fdir_erase_perfect_filter_82599(hw,
2732								&rule->filter,
2733								sw_idx);
2734		}
2735
2736		hlist_del(&rule->fdir_node);
2737		kfree(rule);
2738		adapter->fdir_filter_count--;
2739	}
2740
2741	/*
2742	 * If no input this was a delete, err should be 0 if a rule was
2743	 * successfully found and removed from the list else -EINVAL
2744	 */
2745	if (!input)
2746		return err;
2747
2748	/* initialize node and set software index */
2749	INIT_HLIST_NODE(&input->fdir_node);
2750
2751	/* add filter to the list */
2752	if (parent)
2753		hlist_add_behind(&input->fdir_node, &parent->fdir_node);
2754	else
2755		hlist_add_head(&input->fdir_node,
2756			       &adapter->fdir_filter_list);
2757
2758	/* update counts */
2759	adapter->fdir_filter_count++;
2760
2761	return 0;
2762}
2763
2764static int ixgbe_flowspec_to_flow_type(struct ethtool_rx_flow_spec *fsp,
2765				       u8 *flow_type)
2766{
2767	switch (fsp->flow_type & ~FLOW_EXT) {
2768	case TCP_V4_FLOW:
2769		*flow_type = IXGBE_ATR_FLOW_TYPE_TCPV4;
2770		break;
2771	case UDP_V4_FLOW:
2772		*flow_type = IXGBE_ATR_FLOW_TYPE_UDPV4;
2773		break;
2774	case SCTP_V4_FLOW:
2775		*flow_type = IXGBE_ATR_FLOW_TYPE_SCTPV4;
2776		break;
2777	case IP_USER_FLOW:
2778		switch (fsp->h_u.usr_ip4_spec.proto) {
2779		case IPPROTO_TCP:
2780			*flow_type = IXGBE_ATR_FLOW_TYPE_TCPV4;
2781			break;
2782		case IPPROTO_UDP:
2783			*flow_type = IXGBE_ATR_FLOW_TYPE_UDPV4;
2784			break;
2785		case IPPROTO_SCTP:
2786			*flow_type = IXGBE_ATR_FLOW_TYPE_SCTPV4;
2787			break;
2788		case 0:
2789			if (!fsp->m_u.usr_ip4_spec.proto) {
2790				*flow_type = IXGBE_ATR_FLOW_TYPE_IPV4;
2791				break;
2792			}
2793			fallthrough;
2794		default:
2795			return 0;
2796		}
2797		break;
2798	default:
2799		return 0;
2800	}
2801
2802	return 1;
2803}
2804
2805static int ixgbe_add_ethtool_fdir_entry(struct ixgbe_adapter *adapter,
2806					struct ethtool_rxnfc *cmd)
2807{
2808	struct ethtool_rx_flow_spec *fsp =
2809		(struct ethtool_rx_flow_spec *)&cmd->fs;
2810	struct ixgbe_hw *hw = &adapter->hw;
2811	struct ixgbe_fdir_filter *input;
2812	union ixgbe_atr_input mask;
2813	u8 queue;
2814	int err;
2815
2816	if (!(adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE))
2817		return -EOPNOTSUPP;
2818
2819	/* ring_cookie is a masked into a set of queues and ixgbe pools or
2820	 * we use the drop index.
 
2821	 */
2822	if (fsp->ring_cookie == RX_CLS_FLOW_DISC) {
2823		queue = IXGBE_FDIR_DROP_QUEUE;
2824	} else {
2825		u32 ring = ethtool_get_flow_spec_ring(fsp->ring_cookie);
2826		u8 vf = ethtool_get_flow_spec_ring_vf(fsp->ring_cookie);
2827
2828		if (!vf && (ring >= adapter->num_rx_queues))
2829			return -EINVAL;
2830		else if (vf &&
2831			 ((vf > adapter->num_vfs) ||
2832			   ring >= adapter->num_rx_queues_per_pool))
2833			return -EINVAL;
2834
2835		/* Map the ring onto the absolute queue index */
2836		if (!vf)
2837			queue = adapter->rx_ring[ring]->reg_idx;
2838		else
2839			queue = ((vf - 1) *
2840				adapter->num_rx_queues_per_pool) + ring;
2841	}
2842
2843	/* Don't allow indexes to exist outside of available space */
2844	if (fsp->location >= ((1024 << adapter->fdir_pballoc) - 2)) {
2845		e_err(drv, "Location out of range\n");
2846		return -EINVAL;
2847	}
2848
2849	input = kzalloc(sizeof(*input), GFP_ATOMIC);
2850	if (!input)
2851		return -ENOMEM;
2852
2853	memset(&mask, 0, sizeof(union ixgbe_atr_input));
2854
2855	/* set SW index */
2856	input->sw_idx = fsp->location;
2857
2858	/* record flow type */
2859	if (!ixgbe_flowspec_to_flow_type(fsp,
2860					 &input->filter.formatted.flow_type)) {
2861		e_err(drv, "Unrecognized flow type\n");
2862		goto err_out;
2863	}
2864
2865	mask.formatted.flow_type = IXGBE_ATR_L4TYPE_IPV6_MASK |
2866				   IXGBE_ATR_L4TYPE_MASK;
2867
2868	if (input->filter.formatted.flow_type == IXGBE_ATR_FLOW_TYPE_IPV4)
2869		mask.formatted.flow_type &= IXGBE_ATR_L4TYPE_IPV6_MASK;
2870
2871	/* Copy input into formatted structures */
2872	input->filter.formatted.src_ip[0] = fsp->h_u.tcp_ip4_spec.ip4src;
2873	mask.formatted.src_ip[0] = fsp->m_u.tcp_ip4_spec.ip4src;
2874	input->filter.formatted.dst_ip[0] = fsp->h_u.tcp_ip4_spec.ip4dst;
2875	mask.formatted.dst_ip[0] = fsp->m_u.tcp_ip4_spec.ip4dst;
2876	input->filter.formatted.src_port = fsp->h_u.tcp_ip4_spec.psrc;
2877	mask.formatted.src_port = fsp->m_u.tcp_ip4_spec.psrc;
2878	input->filter.formatted.dst_port = fsp->h_u.tcp_ip4_spec.pdst;
2879	mask.formatted.dst_port = fsp->m_u.tcp_ip4_spec.pdst;
2880
2881	if (fsp->flow_type & FLOW_EXT) {
2882		input->filter.formatted.vm_pool =
2883				(unsigned char)ntohl(fsp->h_ext.data[1]);
2884		mask.formatted.vm_pool =
2885				(unsigned char)ntohl(fsp->m_ext.data[1]);
2886		input->filter.formatted.vlan_id = fsp->h_ext.vlan_tci;
2887		mask.formatted.vlan_id = fsp->m_ext.vlan_tci;
2888		input->filter.formatted.flex_bytes =
2889						fsp->h_ext.vlan_etype;
2890		mask.formatted.flex_bytes = fsp->m_ext.vlan_etype;
2891	}
2892
2893	/* determine if we need to drop or route the packet */
2894	if (fsp->ring_cookie == RX_CLS_FLOW_DISC)
2895		input->action = IXGBE_FDIR_DROP_QUEUE;
2896	else
2897		input->action = fsp->ring_cookie;
2898
2899	spin_lock(&adapter->fdir_perfect_lock);
2900
2901	if (hlist_empty(&adapter->fdir_filter_list)) {
2902		/* save mask and program input mask into HW */
2903		memcpy(&adapter->fdir_mask, &mask, sizeof(mask));
2904		err = ixgbe_fdir_set_input_mask_82599(hw, &mask);
2905		if (err) {
2906			e_err(drv, "Error writing mask\n");
2907			goto err_out_w_lock;
2908		}
2909	} else if (memcmp(&adapter->fdir_mask, &mask, sizeof(mask))) {
2910		e_err(drv, "Only one mask supported per port\n");
2911		goto err_out_w_lock;
2912	}
2913
2914	/* apply mask and compute/store hash */
2915	ixgbe_atr_compute_perfect_hash_82599(&input->filter, &mask);
2916
2917	/* program filters to filter memory */
2918	err = ixgbe_fdir_write_perfect_filter_82599(hw,
2919				&input->filter, input->sw_idx, queue);
 
 
 
2920	if (err)
2921		goto err_out_w_lock;
2922
2923	ixgbe_update_ethtool_fdir_entry(adapter, input, input->sw_idx);
2924
2925	spin_unlock(&adapter->fdir_perfect_lock);
2926
2927	return err;
2928err_out_w_lock:
2929	spin_unlock(&adapter->fdir_perfect_lock);
2930err_out:
2931	kfree(input);
2932	return -EINVAL;
2933}
2934
2935static int ixgbe_del_ethtool_fdir_entry(struct ixgbe_adapter *adapter,
2936					struct ethtool_rxnfc *cmd)
2937{
2938	struct ethtool_rx_flow_spec *fsp =
2939		(struct ethtool_rx_flow_spec *)&cmd->fs;
2940	int err;
2941
2942	spin_lock(&adapter->fdir_perfect_lock);
2943	err = ixgbe_update_ethtool_fdir_entry(adapter, NULL, fsp->location);
2944	spin_unlock(&adapter->fdir_perfect_lock);
2945
2946	return err;
2947}
2948
2949#define UDP_RSS_FLAGS (IXGBE_FLAG2_RSS_FIELD_IPV4_UDP | \
2950		       IXGBE_FLAG2_RSS_FIELD_IPV6_UDP)
2951static int ixgbe_set_rss_hash_opt(struct ixgbe_adapter *adapter,
2952				  struct ethtool_rxnfc *nfc)
2953{
2954	u32 flags2 = adapter->flags2;
2955
2956	/*
2957	 * RSS does not support anything other than hashing
2958	 * to queues on src and dst IPs and ports
2959	 */
2960	if (nfc->data & ~(RXH_IP_SRC | RXH_IP_DST |
2961			  RXH_L4_B_0_1 | RXH_L4_B_2_3))
2962		return -EINVAL;
2963
2964	switch (nfc->flow_type) {
2965	case TCP_V4_FLOW:
2966	case TCP_V6_FLOW:
2967		if (!(nfc->data & RXH_IP_SRC) ||
2968		    !(nfc->data & RXH_IP_DST) ||
2969		    !(nfc->data & RXH_L4_B_0_1) ||
2970		    !(nfc->data & RXH_L4_B_2_3))
2971			return -EINVAL;
2972		break;
2973	case UDP_V4_FLOW:
2974		if (!(nfc->data & RXH_IP_SRC) ||
2975		    !(nfc->data & RXH_IP_DST))
2976			return -EINVAL;
2977		switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
2978		case 0:
2979			flags2 &= ~IXGBE_FLAG2_RSS_FIELD_IPV4_UDP;
2980			break;
2981		case (RXH_L4_B_0_1 | RXH_L4_B_2_3):
2982			flags2 |= IXGBE_FLAG2_RSS_FIELD_IPV4_UDP;
2983			break;
2984		default:
2985			return -EINVAL;
2986		}
2987		break;
2988	case UDP_V6_FLOW:
2989		if (!(nfc->data & RXH_IP_SRC) ||
2990		    !(nfc->data & RXH_IP_DST))
2991			return -EINVAL;
2992		switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
2993		case 0:
2994			flags2 &= ~IXGBE_FLAG2_RSS_FIELD_IPV6_UDP;
2995			break;
2996		case (RXH_L4_B_0_1 | RXH_L4_B_2_3):
2997			flags2 |= IXGBE_FLAG2_RSS_FIELD_IPV6_UDP;
2998			break;
2999		default:
3000			return -EINVAL;
3001		}
3002		break;
3003	case AH_ESP_V4_FLOW:
3004	case AH_V4_FLOW:
3005	case ESP_V4_FLOW:
3006	case SCTP_V4_FLOW:
3007	case AH_ESP_V6_FLOW:
3008	case AH_V6_FLOW:
3009	case ESP_V6_FLOW:
3010	case SCTP_V6_FLOW:
3011		if (!(nfc->data & RXH_IP_SRC) ||
3012		    !(nfc->data & RXH_IP_DST) ||
3013		    (nfc->data & RXH_L4_B_0_1) ||
3014		    (nfc->data & RXH_L4_B_2_3))
3015			return -EINVAL;
3016		break;
3017	default:
3018		return -EINVAL;
3019	}
3020
3021	/* if we changed something we need to update flags */
3022	if (flags2 != adapter->flags2) {
3023		struct ixgbe_hw *hw = &adapter->hw;
3024		u32 mrqc;
3025		unsigned int pf_pool = adapter->num_vfs;
3026
3027		if ((hw->mac.type >= ixgbe_mac_X550) &&
3028		    (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
3029			mrqc = IXGBE_READ_REG(hw, IXGBE_PFVFMRQC(pf_pool));
3030		else
3031			mrqc = IXGBE_READ_REG(hw, IXGBE_MRQC);
3032
3033		if ((flags2 & UDP_RSS_FLAGS) &&
3034		    !(adapter->flags2 & UDP_RSS_FLAGS))
3035			e_warn(drv, "enabling UDP RSS: fragmented packets may arrive out of order to the stack above\n");
 
3036
3037		adapter->flags2 = flags2;
3038
3039		/* Perform hash on these packet types */
3040		mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4
3041		      | IXGBE_MRQC_RSS_FIELD_IPV4_TCP
3042		      | IXGBE_MRQC_RSS_FIELD_IPV6
3043		      | IXGBE_MRQC_RSS_FIELD_IPV6_TCP;
3044
3045		mrqc &= ~(IXGBE_MRQC_RSS_FIELD_IPV4_UDP |
3046			  IXGBE_MRQC_RSS_FIELD_IPV6_UDP);
3047
3048		if (flags2 & IXGBE_FLAG2_RSS_FIELD_IPV4_UDP)
3049			mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4_UDP;
3050
3051		if (flags2 & IXGBE_FLAG2_RSS_FIELD_IPV6_UDP)
3052			mrqc |= IXGBE_MRQC_RSS_FIELD_IPV6_UDP;
3053
3054		if ((hw->mac.type >= ixgbe_mac_X550) &&
3055		    (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED))
3056			IXGBE_WRITE_REG(hw, IXGBE_PFVFMRQC(pf_pool), mrqc);
3057		else
3058			IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
3059	}
3060
3061	return 0;
3062}
3063
3064static int ixgbe_set_rxnfc(struct net_device *dev, struct ethtool_rxnfc *cmd)
3065{
3066	struct ixgbe_adapter *adapter = netdev_priv(dev);
3067	int ret = -EOPNOTSUPP;
3068
3069	switch (cmd->cmd) {
3070	case ETHTOOL_SRXCLSRLINS:
3071		ret = ixgbe_add_ethtool_fdir_entry(adapter, cmd);
3072		break;
3073	case ETHTOOL_SRXCLSRLDEL:
3074		ret = ixgbe_del_ethtool_fdir_entry(adapter, cmd);
3075		break;
3076	case ETHTOOL_SRXFH:
3077		ret = ixgbe_set_rss_hash_opt(adapter, cmd);
3078		break;
3079	default:
3080		break;
3081	}
3082
3083	return ret;
3084}
3085
3086static u32 ixgbe_get_rxfh_key_size(struct net_device *netdev)
3087{
3088	return IXGBE_RSS_KEY_SIZE;
3089}
3090
3091static u32 ixgbe_rss_indir_size(struct net_device *netdev)
3092{
3093	struct ixgbe_adapter *adapter = netdev_priv(netdev);
3094
3095	return ixgbe_rss_indir_tbl_entries(adapter);
3096}
3097
3098static void ixgbe_get_reta(struct ixgbe_adapter *adapter, u32 *indir)
3099{
3100	int i, reta_size = ixgbe_rss_indir_tbl_entries(adapter);
3101	u16 rss_m = adapter->ring_feature[RING_F_RSS].mask;
3102
3103	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
3104		rss_m = adapter->ring_feature[RING_F_RSS].indices - 1;
3105
3106	for (i = 0; i < reta_size; i++)
3107		indir[i] = adapter->rss_indir_tbl[i] & rss_m;
3108}
3109
3110static int ixgbe_get_rxfh(struct net_device *netdev,
3111			  struct ethtool_rxfh_param *rxfh)
3112{
3113	struct ixgbe_adapter *adapter = netdev_priv(netdev);
3114
3115	rxfh->hfunc = ETH_RSS_HASH_TOP;
3116
3117	if (rxfh->indir)
3118		ixgbe_get_reta(adapter, rxfh->indir);
3119
3120	if (rxfh->key)
3121		memcpy(rxfh->key, adapter->rss_key,
3122		       ixgbe_get_rxfh_key_size(netdev));
3123
3124	return 0;
3125}
3126
3127static int ixgbe_set_rxfh(struct net_device *netdev,
3128			  struct ethtool_rxfh_param *rxfh,
3129			  struct netlink_ext_ack *extack)
3130{
3131	struct ixgbe_adapter *adapter = netdev_priv(netdev);
3132	int i;
3133	u32 reta_entries = ixgbe_rss_indir_tbl_entries(adapter);
3134
3135	if (rxfh->hfunc != ETH_RSS_HASH_NO_CHANGE &&
3136	    rxfh->hfunc != ETH_RSS_HASH_TOP)
3137		return -EOPNOTSUPP;
3138
3139	/* Fill out the redirection table */
3140	if (rxfh->indir) {
3141		int max_queues = min_t(int, adapter->num_rx_queues,
3142				       ixgbe_rss_indir_tbl_max(adapter));
3143
3144		/*Allow at least 2 queues w/ SR-IOV.*/
3145		if ((adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) &&
3146		    (max_queues < 2))
3147			max_queues = 2;
3148
3149		/* Verify user input. */
3150		for (i = 0; i < reta_entries; i++)
3151			if (rxfh->indir[i] >= max_queues)
3152				return -EINVAL;
3153
3154		for (i = 0; i < reta_entries; i++)
3155			adapter->rss_indir_tbl[i] = rxfh->indir[i];
3156
3157		ixgbe_store_reta(adapter);
3158	}
3159
3160	/* Fill out the rss hash key */
3161	if (rxfh->key) {
3162		memcpy(adapter->rss_key, rxfh->key,
3163		       ixgbe_get_rxfh_key_size(netdev));
3164		ixgbe_store_key(adapter);
3165	}
3166
3167	return 0;
3168}
3169
3170static int ixgbe_get_ts_info(struct net_device *dev,
3171			     struct ethtool_ts_info *info)
3172{
3173	struct ixgbe_adapter *adapter = netdev_priv(dev);
3174
3175	/* we always support timestamping disabled */
3176	info->rx_filters = BIT(HWTSTAMP_FILTER_NONE);
3177
3178	switch (adapter->hw.mac.type) {
3179	case ixgbe_mac_X550:
3180	case ixgbe_mac_X550EM_x:
3181	case ixgbe_mac_x550em_a:
3182		info->rx_filters |= BIT(HWTSTAMP_FILTER_ALL);
3183		break;
3184	case ixgbe_mac_X540:
3185	case ixgbe_mac_82599EB:
3186		info->rx_filters |=
3187			BIT(HWTSTAMP_FILTER_PTP_V1_L4_SYNC) |
3188			BIT(HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ) |
3189			BIT(HWTSTAMP_FILTER_PTP_V2_EVENT);
3190		break;
3191	default:
3192		return ethtool_op_get_ts_info(dev, info);
3193	}
3194
3195	info->so_timestamping =
3196		SOF_TIMESTAMPING_TX_SOFTWARE |
3197		SOF_TIMESTAMPING_RX_SOFTWARE |
3198		SOF_TIMESTAMPING_SOFTWARE |
3199		SOF_TIMESTAMPING_TX_HARDWARE |
3200		SOF_TIMESTAMPING_RX_HARDWARE |
3201		SOF_TIMESTAMPING_RAW_HARDWARE;
3202
3203	if (adapter->ptp_clock)
3204		info->phc_index = ptp_clock_index(adapter->ptp_clock);
3205	else
3206		info->phc_index = -1;
3207
3208	info->tx_types =
3209		BIT(HWTSTAMP_TX_OFF) |
3210		BIT(HWTSTAMP_TX_ON);
3211
3212	return 0;
3213}
3214
3215static unsigned int ixgbe_max_channels(struct ixgbe_adapter *adapter)
3216{
3217	unsigned int max_combined;
3218	u8 tcs = adapter->hw_tcs;
3219
3220	if (!(adapter->flags & IXGBE_FLAG_MSIX_ENABLED)) {
3221		/* We only support one q_vector without MSI-X */
3222		max_combined = 1;
3223	} else if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
3224		/* Limit value based on the queue mask */
3225		max_combined = adapter->ring_feature[RING_F_RSS].mask + 1;
3226	} else if (tcs > 1) {
3227		/* For DCB report channels per traffic class */
3228		if (adapter->hw.mac.type == ixgbe_mac_82598EB) {
3229			/* 8 TC w/ 4 queues per TC */
3230			max_combined = 4;
3231		} else if (tcs > 4) {
3232			/* 8 TC w/ 8 queues per TC */
3233			max_combined = 8;
3234		} else {
3235			/* 4 TC w/ 16 queues per TC */
3236			max_combined = 16;
3237		}
3238	} else if (adapter->atr_sample_rate) {
3239		/* support up to 64 queues with ATR */
3240		max_combined = IXGBE_MAX_FDIR_INDICES;
3241	} else {
3242		/* support up to 16 queues with RSS */
3243		max_combined = ixgbe_max_rss_indices(adapter);
3244	}
3245
3246	return min_t(int, max_combined, num_online_cpus());
3247}
3248
3249static void ixgbe_get_channels(struct net_device *dev,
3250			       struct ethtool_channels *ch)
3251{
3252	struct ixgbe_adapter *adapter = netdev_priv(dev);
3253
3254	/* report maximum channels */
3255	ch->max_combined = ixgbe_max_channels(adapter);
3256
3257	/* report info for other vector */
3258	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED) {
3259		ch->max_other = NON_Q_VECTORS;
3260		ch->other_count = NON_Q_VECTORS;
3261	}
3262
3263	/* record RSS queues */
3264	ch->combined_count = adapter->ring_feature[RING_F_RSS].indices;
3265
3266	/* nothing else to report if RSS is disabled */
3267	if (ch->combined_count == 1)
3268		return;
3269
3270	/* we do not support ATR queueing if SR-IOV is enabled */
3271	if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED)
3272		return;
3273
3274	/* same thing goes for being DCB enabled */
3275	if (adapter->hw_tcs > 1)
3276		return;
3277
3278	/* if ATR is disabled we can exit */
3279	if (!adapter->atr_sample_rate)
3280		return;
3281
3282	/* report flow director queues as maximum channels */
3283	ch->combined_count = adapter->ring_feature[RING_F_FDIR].indices;
3284}
3285
3286static int ixgbe_set_channels(struct net_device *dev,
3287			      struct ethtool_channels *ch)
3288{
3289	struct ixgbe_adapter *adapter = netdev_priv(dev);
3290	unsigned int count = ch->combined_count;
3291	u8 max_rss_indices = ixgbe_max_rss_indices(adapter);
3292
3293	/* verify they are not requesting separate vectors */
3294	if (!count || ch->rx_count || ch->tx_count)
3295		return -EINVAL;
3296
3297	/* verify other_count has not changed */
3298	if (ch->other_count != NON_Q_VECTORS)
3299		return -EINVAL;
3300
3301	/* verify the number of channels does not exceed hardware limits */
3302	if (count > ixgbe_max_channels(adapter))
3303		return -EINVAL;
3304
3305	/* update feature limits from largest to smallest supported values */
3306	adapter->ring_feature[RING_F_FDIR].limit = count;
3307
3308	/* cap RSS limit */
3309	if (count > max_rss_indices)
3310		count = max_rss_indices;
3311	adapter->ring_feature[RING_F_RSS].limit = count;
3312
3313#ifdef IXGBE_FCOE
3314	/* cap FCoE limit at 8 */
3315	if (count > IXGBE_FCRETA_SIZE)
3316		count = IXGBE_FCRETA_SIZE;
3317	adapter->ring_feature[RING_F_FCOE].limit = count;
3318
3319#endif
3320	/* use setup TC to update any traffic class queue mapping */
3321	return ixgbe_setup_tc(dev, adapter->hw_tcs);
3322}
3323
3324static int ixgbe_get_module_info(struct net_device *dev,
3325				       struct ethtool_modinfo *modinfo)
3326{
3327	struct ixgbe_adapter *adapter = netdev_priv(dev);
3328	struct ixgbe_hw *hw = &adapter->hw;
3329	s32 status;
3330	u8 sff8472_rev, addr_mode;
3331	bool page_swap = false;
3332
3333	if (hw->phy.type == ixgbe_phy_fw)
3334		return -ENXIO;
3335
3336	/* Check whether we support SFF-8472 or not */
3337	status = hw->phy.ops.read_i2c_eeprom(hw,
3338					     IXGBE_SFF_SFF_8472_COMP,
3339					     &sff8472_rev);
3340	if (status)
3341		return -EIO;
3342
3343	/* addressing mode is not supported */
3344	status = hw->phy.ops.read_i2c_eeprom(hw,
3345					     IXGBE_SFF_SFF_8472_SWAP,
3346					     &addr_mode);
3347	if (status)
3348		return -EIO;
3349
3350	if (addr_mode & IXGBE_SFF_ADDRESSING_MODE) {
3351		e_err(drv, "Address change required to access page 0xA2, but not supported. Please report the module type to the driver maintainers.\n");
3352		page_swap = true;
3353	}
3354
3355	if (sff8472_rev == IXGBE_SFF_SFF_8472_UNSUP || page_swap ||
3356	    !(addr_mode & IXGBE_SFF_DDM_IMPLEMENTED)) {
3357		/* We have a SFP, but it does not support SFF-8472 */
3358		modinfo->type = ETH_MODULE_SFF_8079;
3359		modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN;
3360	} else {
3361		/* We have a SFP which supports a revision of SFF-8472. */
3362		modinfo->type = ETH_MODULE_SFF_8472;
3363		modinfo->eeprom_len = ETH_MODULE_SFF_8472_LEN;
3364	}
3365
3366	return 0;
3367}
3368
3369static int ixgbe_get_module_eeprom(struct net_device *dev,
3370					 struct ethtool_eeprom *ee,
3371					 u8 *data)
3372{
3373	struct ixgbe_adapter *adapter = netdev_priv(dev);
3374	struct ixgbe_hw *hw = &adapter->hw;
3375	s32 status = -EFAULT;
3376	u8 databyte = 0xFF;
3377	int i = 0;
3378
3379	if (ee->len == 0)
3380		return -EINVAL;
3381
3382	if (hw->phy.type == ixgbe_phy_fw)
3383		return -ENXIO;
3384
3385	for (i = ee->offset; i < ee->offset + ee->len; i++) {
3386		/* I2C reads can take long time */
3387		if (test_bit(__IXGBE_IN_SFP_INIT, &adapter->state))
3388			return -EBUSY;
3389
3390		if (i < ETH_MODULE_SFF_8079_LEN)
3391			status = hw->phy.ops.read_i2c_eeprom(hw, i, &databyte);
3392		else
3393			status = hw->phy.ops.read_i2c_sff8472(hw, i, &databyte);
3394
3395		if (status)
3396			return -EIO;
3397
3398		data[i - ee->offset] = databyte;
3399	}
3400
3401	return 0;
3402}
3403
3404static const struct {
3405	ixgbe_link_speed mac_speed;
3406	u32 supported;
3407} ixgbe_ls_map[] = {
3408	{ IXGBE_LINK_SPEED_10_FULL, SUPPORTED_10baseT_Full },
3409	{ IXGBE_LINK_SPEED_100_FULL, SUPPORTED_100baseT_Full },
3410	{ IXGBE_LINK_SPEED_1GB_FULL, SUPPORTED_1000baseT_Full },
3411	{ IXGBE_LINK_SPEED_2_5GB_FULL, SUPPORTED_2500baseX_Full },
3412	{ IXGBE_LINK_SPEED_10GB_FULL, SUPPORTED_10000baseT_Full },
3413};
3414
3415static const struct {
3416	u32 lp_advertised;
3417	u32 mac_speed;
3418} ixgbe_lp_map[] = {
3419	{ FW_PHY_ACT_UD_2_100M_TX_EEE, SUPPORTED_100baseT_Full },
3420	{ FW_PHY_ACT_UD_2_1G_T_EEE, SUPPORTED_1000baseT_Full },
3421	{ FW_PHY_ACT_UD_2_10G_T_EEE, SUPPORTED_10000baseT_Full },
3422	{ FW_PHY_ACT_UD_2_1G_KX_EEE, SUPPORTED_1000baseKX_Full },
3423	{ FW_PHY_ACT_UD_2_10G_KX4_EEE, SUPPORTED_10000baseKX4_Full },
3424	{ FW_PHY_ACT_UD_2_10G_KR_EEE, SUPPORTED_10000baseKR_Full},
3425};
3426
3427static int
3428ixgbe_get_eee_fw(struct ixgbe_adapter *adapter, struct ethtool_eee *edata)
3429{
3430	u32 info[FW_PHY_ACT_DATA_COUNT] = { 0 };
3431	struct ixgbe_hw *hw = &adapter->hw;
3432	s32 rc;
3433	u16 i;
3434
3435	rc = ixgbe_fw_phy_activity(hw, FW_PHY_ACT_UD_2, &info);
3436	if (rc)
3437		return rc;
3438
3439	edata->lp_advertised = 0;
3440	for (i = 0; i < ARRAY_SIZE(ixgbe_lp_map); ++i) {
3441		if (info[0] & ixgbe_lp_map[i].lp_advertised)
3442			edata->lp_advertised |= ixgbe_lp_map[i].mac_speed;
3443	}
3444
3445	edata->supported = 0;
3446	for (i = 0; i < ARRAY_SIZE(ixgbe_ls_map); ++i) {
3447		if (hw->phy.eee_speeds_supported & ixgbe_ls_map[i].mac_speed)
3448			edata->supported |= ixgbe_ls_map[i].supported;
3449	}
3450
3451	edata->advertised = 0;
3452	for (i = 0; i < ARRAY_SIZE(ixgbe_ls_map); ++i) {
3453		if (hw->phy.eee_speeds_advertised & ixgbe_ls_map[i].mac_speed)
3454			edata->advertised |= ixgbe_ls_map[i].supported;
3455	}
3456
3457	edata->eee_enabled = !!edata->advertised;
3458	edata->tx_lpi_enabled = edata->eee_enabled;
3459	if (edata->advertised & edata->lp_advertised)
3460		edata->eee_active = true;
3461
3462	return 0;
3463}
3464
3465static int ixgbe_get_eee(struct net_device *netdev, struct ethtool_eee *edata)
3466{
3467	struct ixgbe_adapter *adapter = netdev_priv(netdev);
3468	struct ixgbe_hw *hw = &adapter->hw;
3469
3470	if (!(adapter->flags2 & IXGBE_FLAG2_EEE_CAPABLE))
3471		return -EOPNOTSUPP;
3472
3473	if (hw->phy.eee_speeds_supported && hw->phy.type == ixgbe_phy_fw)
3474		return ixgbe_get_eee_fw(adapter, edata);
3475
3476	return -EOPNOTSUPP;
3477}
3478
3479static int ixgbe_set_eee(struct net_device *netdev, struct ethtool_eee *edata)
3480{
3481	struct ixgbe_adapter *adapter = netdev_priv(netdev);
3482	struct ixgbe_hw *hw = &adapter->hw;
3483	struct ethtool_eee eee_data;
3484	s32 ret_val;
3485
3486	if (!(adapter->flags2 & IXGBE_FLAG2_EEE_CAPABLE))
3487		return -EOPNOTSUPP;
3488
3489	memset(&eee_data, 0, sizeof(struct ethtool_eee));
3490
3491	ret_val = ixgbe_get_eee(netdev, &eee_data);
3492	if (ret_val)
3493		return ret_val;
3494
3495	if (eee_data.eee_enabled && !edata->eee_enabled) {
3496		if (eee_data.tx_lpi_enabled != edata->tx_lpi_enabled) {
3497			e_err(drv, "Setting EEE tx-lpi is not supported\n");
3498			return -EINVAL;
3499		}
3500
3501		if (eee_data.tx_lpi_timer != edata->tx_lpi_timer) {
3502			e_err(drv,
3503			      "Setting EEE Tx LPI timer is not supported\n");
3504			return -EINVAL;
3505		}
3506
3507		if (eee_data.advertised != edata->advertised) {
3508			e_err(drv,
3509			      "Setting EEE advertised speeds is not supported\n");
3510			return -EINVAL;
3511		}
3512	}
3513
3514	if (eee_data.eee_enabled != edata->eee_enabled) {
3515		if (edata->eee_enabled) {
3516			adapter->flags2 |= IXGBE_FLAG2_EEE_ENABLED;
3517			hw->phy.eee_speeds_advertised =
3518						   hw->phy.eee_speeds_supported;
3519		} else {
3520			adapter->flags2 &= ~IXGBE_FLAG2_EEE_ENABLED;
3521			hw->phy.eee_speeds_advertised = 0;
3522		}
3523
3524		/* reset link */
3525		if (netif_running(netdev))
3526			ixgbe_reinit_locked(adapter);
3527		else
3528			ixgbe_reset(adapter);
3529	}
3530
3531	return 0;
3532}
3533
3534static u32 ixgbe_get_priv_flags(struct net_device *netdev)
3535{
3536	struct ixgbe_adapter *adapter = netdev_priv(netdev);
3537	u32 priv_flags = 0;
3538
3539	if (adapter->flags2 & IXGBE_FLAG2_RX_LEGACY)
3540		priv_flags |= IXGBE_PRIV_FLAGS_LEGACY_RX;
3541
3542	if (adapter->flags2 & IXGBE_FLAG2_VF_IPSEC_ENABLED)
3543		priv_flags |= IXGBE_PRIV_FLAGS_VF_IPSEC_EN;
3544
3545	if (adapter->flags2 & IXGBE_FLAG2_AUTO_DISABLE_VF)
3546		priv_flags |= IXGBE_PRIV_FLAGS_AUTO_DISABLE_VF;
3547
3548	return priv_flags;
3549}
3550
3551static int ixgbe_set_priv_flags(struct net_device *netdev, u32 priv_flags)
3552{
3553	struct ixgbe_adapter *adapter = netdev_priv(netdev);
3554	unsigned int flags2 = adapter->flags2;
3555	unsigned int i;
3556
3557	flags2 &= ~IXGBE_FLAG2_RX_LEGACY;
3558	if (priv_flags & IXGBE_PRIV_FLAGS_LEGACY_RX)
3559		flags2 |= IXGBE_FLAG2_RX_LEGACY;
3560
3561	flags2 &= ~IXGBE_FLAG2_VF_IPSEC_ENABLED;
3562	if (priv_flags & IXGBE_PRIV_FLAGS_VF_IPSEC_EN)
3563		flags2 |= IXGBE_FLAG2_VF_IPSEC_ENABLED;
3564
3565	flags2 &= ~IXGBE_FLAG2_AUTO_DISABLE_VF;
3566	if (priv_flags & IXGBE_PRIV_FLAGS_AUTO_DISABLE_VF) {
3567		if (adapter->hw.mac.type == ixgbe_mac_82599EB) {
3568			/* Reset primary abort counter */
3569			for (i = 0; i < adapter->num_vfs; i++)
3570				adapter->vfinfo[i].primary_abort_count = 0;
3571
3572			flags2 |= IXGBE_FLAG2_AUTO_DISABLE_VF;
3573		} else {
3574			e_info(probe,
3575			       "Cannot set private flags: Operation not supported\n");
3576			return -EOPNOTSUPP;
3577		}
3578	}
3579
3580	if (flags2 != adapter->flags2) {
3581		adapter->flags2 = flags2;
3582
3583		/* reset interface to repopulate queues */
3584		if (netif_running(netdev))
3585			ixgbe_reinit_locked(adapter);
3586	}
3587
3588	return 0;
3589}
3590
3591static const struct ethtool_ops ixgbe_ethtool_ops = {
3592	.supported_coalesce_params = ETHTOOL_COALESCE_USECS,
 
3593	.get_drvinfo            = ixgbe_get_drvinfo,
3594	.get_regs_len           = ixgbe_get_regs_len,
3595	.get_regs               = ixgbe_get_regs,
3596	.get_wol                = ixgbe_get_wol,
3597	.set_wol                = ixgbe_set_wol,
3598	.nway_reset             = ixgbe_nway_reset,
3599	.get_link               = ethtool_op_get_link,
3600	.get_eeprom_len         = ixgbe_get_eeprom_len,
3601	.get_eeprom             = ixgbe_get_eeprom,
3602	.set_eeprom             = ixgbe_set_eeprom,
3603	.get_ringparam          = ixgbe_get_ringparam,
3604	.set_ringparam          = ixgbe_set_ringparam,
3605	.get_pause_stats	= ixgbe_get_pause_stats,
3606	.get_pauseparam         = ixgbe_get_pauseparam,
3607	.set_pauseparam         = ixgbe_set_pauseparam,
3608	.get_msglevel           = ixgbe_get_msglevel,
3609	.set_msglevel           = ixgbe_set_msglevel,
3610	.self_test              = ixgbe_diag_test,
3611	.get_strings            = ixgbe_get_strings,
3612	.set_phys_id            = ixgbe_set_phys_id,
3613	.get_sset_count         = ixgbe_get_sset_count,
3614	.get_ethtool_stats      = ixgbe_get_ethtool_stats,
3615	.get_coalesce           = ixgbe_get_coalesce,
3616	.set_coalesce           = ixgbe_set_coalesce,
3617	.get_rxnfc		= ixgbe_get_rxnfc,
3618	.set_rxnfc		= ixgbe_set_rxnfc,
3619	.get_rxfh_indir_size	= ixgbe_rss_indir_size,
3620	.get_rxfh_key_size	= ixgbe_get_rxfh_key_size,
3621	.get_rxfh		= ixgbe_get_rxfh,
3622	.set_rxfh		= ixgbe_set_rxfh,
3623	.get_eee		= ixgbe_get_eee,
3624	.set_eee		= ixgbe_set_eee,
3625	.get_channels		= ixgbe_get_channels,
3626	.set_channels		= ixgbe_set_channels,
3627	.get_priv_flags		= ixgbe_get_priv_flags,
3628	.set_priv_flags		= ixgbe_set_priv_flags,
3629	.get_ts_info		= ixgbe_get_ts_info,
3630	.get_module_info	= ixgbe_get_module_info,
3631	.get_module_eeprom	= ixgbe_get_module_eeprom,
3632	.get_link_ksettings     = ixgbe_get_link_ksettings,
3633	.set_link_ksettings     = ixgbe_set_link_ksettings,
3634};
3635
3636void ixgbe_set_ethtool_ops(struct net_device *netdev)
3637{
3638	netdev->ethtool_ops = &ixgbe_ethtool_ops;
3639}
v3.5.6
   1/*******************************************************************************
   2
   3  Intel 10 Gigabit PCI Express Linux driver
   4  Copyright(c) 1999 - 2012 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, write to the Free Software Foundation, Inc.,
  17  51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
  18
  19  The full GNU General Public License is included in this distribution in
  20  the file called "COPYING".
  21
  22  Contact Information:
  23  e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
  24  Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  25
  26*******************************************************************************/
  27
  28/* ethtool support for ixgbe */
  29
  30#include <linux/interrupt.h>
  31#include <linux/types.h>
  32#include <linux/module.h>
  33#include <linux/slab.h>
  34#include <linux/pci.h>
  35#include <linux/netdevice.h>
  36#include <linux/ethtool.h>
  37#include <linux/vmalloc.h>
  38#include <linux/highmem.h>
  39#include <linux/uaccess.h>
  40
  41#include "ixgbe.h"
 
  42
  43
  44#define IXGBE_ALL_RAR_ENTRIES 16
  45
  46enum {NETDEV_STATS, IXGBE_STATS};
  47
  48struct ixgbe_stats {
  49	char stat_string[ETH_GSTRING_LEN];
  50	int type;
  51	int sizeof_stat;
  52	int stat_offset;
  53};
  54
  55#define IXGBE_STAT(m)		IXGBE_STATS, \
  56				sizeof(((struct ixgbe_adapter *)0)->m), \
  57				offsetof(struct ixgbe_adapter, m)
  58#define IXGBE_NETDEV_STAT(m)	NETDEV_STATS, \
  59				sizeof(((struct rtnl_link_stats64 *)0)->m), \
  60				offsetof(struct rtnl_link_stats64, m)
  61
  62static const struct ixgbe_stats ixgbe_gstrings_stats[] = {
  63	{"rx_packets", IXGBE_NETDEV_STAT(rx_packets)},
  64	{"tx_packets", IXGBE_NETDEV_STAT(tx_packets)},
  65	{"rx_bytes", IXGBE_NETDEV_STAT(rx_bytes)},
  66	{"tx_bytes", IXGBE_NETDEV_STAT(tx_bytes)},
  67	{"rx_pkts_nic", IXGBE_STAT(stats.gprc)},
  68	{"tx_pkts_nic", IXGBE_STAT(stats.gptc)},
  69	{"rx_bytes_nic", IXGBE_STAT(stats.gorc)},
  70	{"tx_bytes_nic", IXGBE_STAT(stats.gotc)},
  71	{"lsc_int", IXGBE_STAT(lsc_int)},
  72	{"tx_busy", IXGBE_STAT(tx_busy)},
  73	{"non_eop_descs", IXGBE_STAT(non_eop_descs)},
  74	{"rx_errors", IXGBE_NETDEV_STAT(rx_errors)},
  75	{"tx_errors", IXGBE_NETDEV_STAT(tx_errors)},
  76	{"rx_dropped", IXGBE_NETDEV_STAT(rx_dropped)},
  77	{"tx_dropped", IXGBE_NETDEV_STAT(tx_dropped)},
  78	{"multicast", IXGBE_NETDEV_STAT(multicast)},
  79	{"broadcast", IXGBE_STAT(stats.bprc)},
  80	{"rx_no_buffer_count", IXGBE_STAT(stats.rnbc[0]) },
  81	{"collisions", IXGBE_NETDEV_STAT(collisions)},
  82	{"rx_over_errors", IXGBE_NETDEV_STAT(rx_over_errors)},
  83	{"rx_crc_errors", IXGBE_NETDEV_STAT(rx_crc_errors)},
  84	{"rx_frame_errors", IXGBE_NETDEV_STAT(rx_frame_errors)},
  85	{"hw_rsc_aggregated", IXGBE_STAT(rsc_total_count)},
  86	{"hw_rsc_flushed", IXGBE_STAT(rsc_total_flush)},
  87	{"fdir_match", IXGBE_STAT(stats.fdirmatch)},
  88	{"fdir_miss", IXGBE_STAT(stats.fdirmiss)},
  89	{"fdir_overflow", IXGBE_STAT(fdir_overflow)},
  90	{"rx_fifo_errors", IXGBE_NETDEV_STAT(rx_fifo_errors)},
  91	{"rx_missed_errors", IXGBE_NETDEV_STAT(rx_missed_errors)},
  92	{"tx_aborted_errors", IXGBE_NETDEV_STAT(tx_aborted_errors)},
  93	{"tx_carrier_errors", IXGBE_NETDEV_STAT(tx_carrier_errors)},
  94	{"tx_fifo_errors", IXGBE_NETDEV_STAT(tx_fifo_errors)},
  95	{"tx_heartbeat_errors", IXGBE_NETDEV_STAT(tx_heartbeat_errors)},
  96	{"tx_timeout_count", IXGBE_STAT(tx_timeout_count)},
  97	{"tx_restart_queue", IXGBE_STAT(restart_queue)},
 
  98	{"rx_long_length_errors", IXGBE_STAT(stats.roc)},
  99	{"rx_short_length_errors", IXGBE_STAT(stats.ruc)},
 100	{"tx_flow_control_xon", IXGBE_STAT(stats.lxontxc)},
 101	{"rx_flow_control_xon", IXGBE_STAT(stats.lxonrxc)},
 102	{"tx_flow_control_xoff", IXGBE_STAT(stats.lxofftxc)},
 103	{"rx_flow_control_xoff", IXGBE_STAT(stats.lxoffrxc)},
 104	{"rx_csum_offload_errors", IXGBE_STAT(hw_csum_rx_error)},
 
 105	{"alloc_rx_page_failed", IXGBE_STAT(alloc_rx_page_failed)},
 106	{"alloc_rx_buff_failed", IXGBE_STAT(alloc_rx_buff_failed)},
 107	{"rx_no_dma_resources", IXGBE_STAT(hw_rx_no_dma_resources)},
 108	{"os2bmc_rx_by_bmc", IXGBE_STAT(stats.o2bgptc)},
 109	{"os2bmc_tx_by_bmc", IXGBE_STAT(stats.b2ospc)},
 110	{"os2bmc_tx_by_host", IXGBE_STAT(stats.o2bspc)},
 111	{"os2bmc_rx_by_host", IXGBE_STAT(stats.b2ogprc)},
 
 
 
 
 
 112#ifdef IXGBE_FCOE
 113	{"fcoe_bad_fccrc", IXGBE_STAT(stats.fccrc)},
 114	{"rx_fcoe_dropped", IXGBE_STAT(stats.fcoerpdc)},
 115	{"rx_fcoe_packets", IXGBE_STAT(stats.fcoeprc)},
 116	{"rx_fcoe_dwords", IXGBE_STAT(stats.fcoedwrc)},
 117	{"fcoe_noddp", IXGBE_STAT(stats.fcoe_noddp)},
 118	{"fcoe_noddp_ext_buff", IXGBE_STAT(stats.fcoe_noddp_ext_buff)},
 119	{"tx_fcoe_packets", IXGBE_STAT(stats.fcoeptc)},
 120	{"tx_fcoe_dwords", IXGBE_STAT(stats.fcoedwtc)},
 121#endif /* IXGBE_FCOE */
 122};
 123
 124/* ixgbe allocates num_tx_queues and num_rx_queues symmetrically so
 125 * we set the num_rx_queues to evaluate to num_tx_queues. This is
 126 * used because we do not have a good way to get the max number of
 127 * rx queues with CONFIG_RPS disabled.
 128 */
 129#define IXGBE_NUM_RX_QUEUES netdev->num_tx_queues
 130
 131#define IXGBE_QUEUE_STATS_LEN ( \
 132	(netdev->num_tx_queues + IXGBE_NUM_RX_QUEUES) * \
 133	(sizeof(struct ixgbe_queue_stats) / sizeof(u64)))
 134#define IXGBE_GLOBAL_STATS_LEN ARRAY_SIZE(ixgbe_gstrings_stats)
 135#define IXGBE_PB_STATS_LEN ( \
 136			(sizeof(((struct ixgbe_adapter *)0)->stats.pxonrxc) + \
 137			 sizeof(((struct ixgbe_adapter *)0)->stats.pxontxc) + \
 138			 sizeof(((struct ixgbe_adapter *)0)->stats.pxoffrxc) + \
 139			 sizeof(((struct ixgbe_adapter *)0)->stats.pxofftxc)) \
 140			/ sizeof(u64))
 141#define IXGBE_STATS_LEN (IXGBE_GLOBAL_STATS_LEN + \
 142                         IXGBE_PB_STATS_LEN + \
 143                         IXGBE_QUEUE_STATS_LEN)
 144
 145static const char ixgbe_gstrings_test[][ETH_GSTRING_LEN] = {
 146	"Register test  (offline)", "Eeprom test    (offline)",
 147	"Interrupt test (offline)", "Loopback test  (offline)",
 148	"Link test   (on/offline)"
 149};
 150#define IXGBE_TEST_LEN sizeof(ixgbe_gstrings_test) / ETH_GSTRING_LEN
 151
 152static int ixgbe_get_settings(struct net_device *netdev,
 153                              struct ethtool_cmd *ecmd)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 154{
 155	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 156	struct ixgbe_hw *hw = &adapter->hw;
 157	u32 link_speed = 0;
 158	bool link_up;
 159
 160	ecmd->supported = SUPPORTED_10000baseT_Full;
 161	ecmd->autoneg = AUTONEG_ENABLE;
 162	ecmd->transceiver = XCVR_EXTERNAL;
 163	if ((hw->phy.media_type == ixgbe_media_type_copper) ||
 164	    (hw->phy.multispeed_fiber)) {
 165		ecmd->supported |= (SUPPORTED_1000baseT_Full |
 166		                    SUPPORTED_Autoneg);
 167
 168		switch (hw->mac.type) {
 169		case ixgbe_mac_X540:
 170			ecmd->supported |= SUPPORTED_100baseT_Full;
 171			break;
 172		default:
 173			break;
 174		}
 175
 176		ecmd->advertising = ADVERTISED_Autoneg;
 177		if (hw->phy.autoneg_advertised) {
 178			if (hw->phy.autoneg_advertised &
 179			    IXGBE_LINK_SPEED_100_FULL)
 180				ecmd->advertising |= ADVERTISED_100baseT_Full;
 181			if (hw->phy.autoneg_advertised &
 182			    IXGBE_LINK_SPEED_10GB_FULL)
 183				ecmd->advertising |= ADVERTISED_10000baseT_Full;
 184			if (hw->phy.autoneg_advertised &
 185			    IXGBE_LINK_SPEED_1GB_FULL)
 186				ecmd->advertising |= ADVERTISED_1000baseT_Full;
 
 
 
 
 
 
 
 
 187		} else {
 188			/*
 189			 * Default advertised modes in case
 190			 * phy.autoneg_advertised isn't set.
 191			 */
 192			ecmd->advertising |= (ADVERTISED_10000baseT_Full |
 193					      ADVERTISED_1000baseT_Full);
 194			if (hw->mac.type == ixgbe_mac_X540)
 195				ecmd->advertising |= ADVERTISED_100baseT_Full;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 196		}
 
 197
 198		if (hw->phy.media_type == ixgbe_media_type_copper) {
 199			ecmd->supported |= SUPPORTED_TP;
 200			ecmd->advertising |= ADVERTISED_TP;
 201			ecmd->port = PORT_TP;
 202		} else {
 203			ecmd->supported |= SUPPORTED_FIBRE;
 204			ecmd->advertising |= ADVERTISED_FIBRE;
 205			ecmd->port = PORT_FIBRE;
 206		}
 207	} else if (hw->phy.media_type == ixgbe_media_type_backplane) {
 208		/* Set as FIBRE until SERDES defined in kernel */
 209		if (hw->device_id == IXGBE_DEV_ID_82598_BX) {
 210			ecmd->supported = (SUPPORTED_1000baseT_Full |
 211					   SUPPORTED_FIBRE);
 212			ecmd->advertising = (ADVERTISED_1000baseT_Full |
 213					     ADVERTISED_FIBRE);
 214			ecmd->port = PORT_FIBRE;
 215			ecmd->autoneg = AUTONEG_DISABLE;
 216		} else if ((hw->device_id == IXGBE_DEV_ID_82599_COMBO_BACKPLANE) ||
 217			   (hw->device_id == IXGBE_DEV_ID_82599_KX4_MEZZ)) {
 218			ecmd->supported |= (SUPPORTED_1000baseT_Full |
 219					    SUPPORTED_Autoneg |
 220					    SUPPORTED_FIBRE);
 221			ecmd->advertising = (ADVERTISED_10000baseT_Full |
 222					     ADVERTISED_1000baseT_Full |
 223					     ADVERTISED_Autoneg |
 224					     ADVERTISED_FIBRE);
 225			ecmd->port = PORT_FIBRE;
 226		} else {
 227			ecmd->supported |= (SUPPORTED_1000baseT_Full |
 228					    SUPPORTED_FIBRE);
 229			ecmd->advertising = (ADVERTISED_10000baseT_Full |
 230					     ADVERTISED_1000baseT_Full |
 231					     ADVERTISED_FIBRE);
 232			ecmd->port = PORT_FIBRE;
 233		}
 234	} else {
 235		ecmd->supported |= SUPPORTED_FIBRE;
 236		ecmd->advertising = (ADVERTISED_10000baseT_Full |
 237		                     ADVERTISED_FIBRE);
 238		ecmd->port = PORT_FIBRE;
 239		ecmd->autoneg = AUTONEG_DISABLE;
 240	}
 241
 242	/* Get PHY type */
 243	switch (adapter->hw.phy.type) {
 244	case ixgbe_phy_tn:
 245	case ixgbe_phy_aq:
 
 
 246	case ixgbe_phy_cu_unknown:
 247		/* Copper 10G-BASET */
 248		ecmd->port = PORT_TP;
 
 249		break;
 250	case ixgbe_phy_qt:
 251		ecmd->port = PORT_FIBRE;
 
 
 252		break;
 253	case ixgbe_phy_nl:
 254	case ixgbe_phy_sfp_passive_tyco:
 255	case ixgbe_phy_sfp_passive_unknown:
 256	case ixgbe_phy_sfp_ftl:
 257	case ixgbe_phy_sfp_avago:
 258	case ixgbe_phy_sfp_intel:
 259	case ixgbe_phy_sfp_unknown:
 
 
 
 
 
 260		switch (adapter->hw.phy.sfp_type) {
 261		/* SFP+ devices, further checking needed */
 262		case ixgbe_sfp_type_da_cu:
 263		case ixgbe_sfp_type_da_cu_core0:
 264		case ixgbe_sfp_type_da_cu_core1:
 265			ecmd->port = PORT_DA;
 
 
 
 
 266			break;
 267		case ixgbe_sfp_type_sr:
 268		case ixgbe_sfp_type_lr:
 269		case ixgbe_sfp_type_srlr_core0:
 270		case ixgbe_sfp_type_srlr_core1:
 271			ecmd->port = PORT_FIBRE;
 
 
 
 
 
 
 
 
 272			break;
 273		case ixgbe_sfp_type_not_present:
 274			ecmd->port = PORT_NONE;
 
 
 
 
 275			break;
 276		case ixgbe_sfp_type_1g_cu_core0:
 277		case ixgbe_sfp_type_1g_cu_core1:
 278			ecmd->port = PORT_TP;
 279			ecmd->supported = SUPPORTED_TP;
 280			ecmd->advertising = (ADVERTISED_1000baseT_Full |
 281			                     ADVERTISED_TP);
 
 282			break;
 283		case ixgbe_sfp_type_unknown:
 284		default:
 285			ecmd->port = PORT_OTHER;
 
 
 
 
 286			break;
 287		}
 288		break;
 289	case ixgbe_phy_xaui:
 290		ecmd->port = PORT_NONE;
 
 
 
 
 291		break;
 292	case ixgbe_phy_unknown:
 293	case ixgbe_phy_generic:
 294	case ixgbe_phy_sfp_unsupported:
 295	default:
 296		ecmd->port = PORT_OTHER;
 
 
 
 
 297		break;
 298	}
 299
 300	hw->mac.ops.check_link(hw, &link_speed, &link_up, false);
 301	if (link_up) {
 302		switch (link_speed) {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 303		case IXGBE_LINK_SPEED_10GB_FULL:
 304			ethtool_cmd_speed_set(ecmd, SPEED_10000);
 
 
 
 
 
 
 305			break;
 306		case IXGBE_LINK_SPEED_1GB_FULL:
 307			ethtool_cmd_speed_set(ecmd, SPEED_1000);
 308			break;
 309		case IXGBE_LINK_SPEED_100_FULL:
 310			ethtool_cmd_speed_set(ecmd, SPEED_100);
 
 
 
 311			break;
 312		default:
 313			break;
 314		}
 315		ecmd->duplex = DUPLEX_FULL;
 316	} else {
 317		ethtool_cmd_speed_set(ecmd, -1);
 318		ecmd->duplex = -1;
 319	}
 320
 321	return 0;
 322}
 323
 324static int ixgbe_set_settings(struct net_device *netdev,
 325                              struct ethtool_cmd *ecmd)
 326{
 327	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 328	struct ixgbe_hw *hw = &adapter->hw;
 329	u32 advertised, old;
 330	s32 err = 0;
 331
 332	if ((hw->phy.media_type == ixgbe_media_type_copper) ||
 333	    (hw->phy.multispeed_fiber)) {
 334		/*
 335		 * this function does not support duplex forcing, but can
 336		 * limit the advertising of the adapter to the specified speed
 337		 */
 338		if (ecmd->autoneg == AUTONEG_DISABLE)
 
 339			return -EINVAL;
 340
 341		if (ecmd->advertising & ~ecmd->supported)
 342			return -EINVAL;
 
 
 
 
 
 
 343
 344		old = hw->phy.autoneg_advertised;
 345		advertised = 0;
 346		if (ecmd->advertising & ADVERTISED_10000baseT_Full)
 
 347			advertised |= IXGBE_LINK_SPEED_10GB_FULL;
 348
 349		if (ecmd->advertising & ADVERTISED_1000baseT_Full)
 
 
 
 
 
 
 350			advertised |= IXGBE_LINK_SPEED_1GB_FULL;
 351
 352		if (ecmd->advertising & ADVERTISED_100baseT_Full)
 
 353			advertised |= IXGBE_LINK_SPEED_100_FULL;
 354
 
 
 
 
 355		if (old == advertised)
 356			return err;
 357		/* this sets the link speed and restarts auto-neg */
 
 
 
 358		hw->mac.autotry_restart = true;
 359		err = hw->mac.ops.setup_link(hw, advertised, true, true);
 360		if (err) {
 361			e_info(probe, "setup link failed with code %d\n", err);
 362			hw->mac.ops.setup_link(hw, old, true, true);
 363		}
 
 364	} else {
 365		/* in this case we currently only support 10Gb/FULL */
 366		u32 speed = ethtool_cmd_speed(ecmd);
 367		if ((ecmd->autoneg == AUTONEG_ENABLE) ||
 368		    (ecmd->advertising != ADVERTISED_10000baseT_Full) ||
 369		    (speed + ecmd->duplex != SPEED_10000 + DUPLEX_FULL))
 
 
 370			return -EINVAL;
 371	}
 372
 373	return err;
 374}
 375
 
 
 
 
 
 
 
 
 
 
 376static void ixgbe_get_pauseparam(struct net_device *netdev,
 377                                 struct ethtool_pauseparam *pause)
 378{
 379	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 380	struct ixgbe_hw *hw = &adapter->hw;
 381
 382	if (hw->fc.disable_fc_autoneg)
 
 
 
 383		pause->autoneg = 0;
 384	else
 385		pause->autoneg = 1;
 386
 387	if (hw->fc.current_mode == ixgbe_fc_rx_pause) {
 388		pause->rx_pause = 1;
 389	} else if (hw->fc.current_mode == ixgbe_fc_tx_pause) {
 390		pause->tx_pause = 1;
 391	} else if (hw->fc.current_mode == ixgbe_fc_full) {
 392		pause->rx_pause = 1;
 393		pause->tx_pause = 1;
 394	}
 395}
 396
 397static int ixgbe_set_pauseparam(struct net_device *netdev,
 398                                struct ethtool_pauseparam *pause)
 399{
 400	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 401	struct ixgbe_hw *hw = &adapter->hw;
 402	struct ixgbe_fc_info fc = hw->fc;
 403
 404	/* 82598 does no support link flow control with DCB enabled */
 405	if ((hw->mac.type == ixgbe_mac_82598EB) &&
 406	    (adapter->flags & IXGBE_FLAG_DCB_ENABLED))
 407		return -EINVAL;
 408
 
 
 
 
 
 409	fc.disable_fc_autoneg = (pause->autoneg != AUTONEG_ENABLE);
 410
 411	if ((pause->rx_pause && pause->tx_pause) || pause->autoneg)
 412		fc.requested_mode = ixgbe_fc_full;
 413	else if (pause->rx_pause && !pause->tx_pause)
 414		fc.requested_mode = ixgbe_fc_rx_pause;
 415	else if (!pause->rx_pause && pause->tx_pause)
 416		fc.requested_mode = ixgbe_fc_tx_pause;
 417	else
 418		fc.requested_mode = ixgbe_fc_none;
 419
 420	/* if the thing changed then we'll update and use new autoneg */
 421	if (memcmp(&fc, &hw->fc, sizeof(struct ixgbe_fc_info))) {
 422		hw->fc = fc;
 423		if (netif_running(netdev))
 424			ixgbe_reinit_locked(adapter);
 425		else
 426			ixgbe_reset(adapter);
 427	}
 428
 429	return 0;
 430}
 431
 432static u32 ixgbe_get_msglevel(struct net_device *netdev)
 433{
 434	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 435	return adapter->msg_enable;
 436}
 437
 438static void ixgbe_set_msglevel(struct net_device *netdev, u32 data)
 439{
 440	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 441	adapter->msg_enable = data;
 442}
 443
 444static int ixgbe_get_regs_len(struct net_device *netdev)
 445{
 446#define IXGBE_REGS_LEN  1129
 447	return IXGBE_REGS_LEN * sizeof(u32);
 448}
 449
 450#define IXGBE_GET_STAT(_A_, _R_) _A_->stats._R_
 451
 452static void ixgbe_get_regs(struct net_device *netdev,
 453                           struct ethtool_regs *regs, void *p)
 454{
 455	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 456	struct ixgbe_hw *hw = &adapter->hw;
 457	u32 *regs_buff = p;
 458	u8 i;
 459
 460	memset(p, 0, IXGBE_REGS_LEN * sizeof(u32));
 461
 462	regs->version = (1 << 24) | hw->revision_id << 16 | hw->device_id;
 
 463
 464	/* General Registers */
 465	regs_buff[0] = IXGBE_READ_REG(hw, IXGBE_CTRL);
 466	regs_buff[1] = IXGBE_READ_REG(hw, IXGBE_STATUS);
 467	regs_buff[2] = IXGBE_READ_REG(hw, IXGBE_CTRL_EXT);
 468	regs_buff[3] = IXGBE_READ_REG(hw, IXGBE_ESDP);
 469	regs_buff[4] = IXGBE_READ_REG(hw, IXGBE_EODSDP);
 470	regs_buff[5] = IXGBE_READ_REG(hw, IXGBE_LEDCTL);
 471	regs_buff[6] = IXGBE_READ_REG(hw, IXGBE_FRTIMER);
 472	regs_buff[7] = IXGBE_READ_REG(hw, IXGBE_TCPTIMER);
 473
 474	/* NVM Register */
 475	regs_buff[8] = IXGBE_READ_REG(hw, IXGBE_EEC);
 476	regs_buff[9] = IXGBE_READ_REG(hw, IXGBE_EERD);
 477	regs_buff[10] = IXGBE_READ_REG(hw, IXGBE_FLA);
 478	regs_buff[11] = IXGBE_READ_REG(hw, IXGBE_EEMNGCTL);
 479	regs_buff[12] = IXGBE_READ_REG(hw, IXGBE_EEMNGDATA);
 480	regs_buff[13] = IXGBE_READ_REG(hw, IXGBE_FLMNGCTL);
 481	regs_buff[14] = IXGBE_READ_REG(hw, IXGBE_FLMNGDATA);
 482	regs_buff[15] = IXGBE_READ_REG(hw, IXGBE_FLMNGCNT);
 483	regs_buff[16] = IXGBE_READ_REG(hw, IXGBE_FLOP);
 484	regs_buff[17] = IXGBE_READ_REG(hw, IXGBE_GRC);
 485
 486	/* Interrupt */
 487	/* don't read EICR because it can clear interrupt causes, instead
 488	 * read EICS which is a shadow but doesn't clear EICR */
 489	regs_buff[18] = IXGBE_READ_REG(hw, IXGBE_EICS);
 490	regs_buff[19] = IXGBE_READ_REG(hw, IXGBE_EICS);
 491	regs_buff[20] = IXGBE_READ_REG(hw, IXGBE_EIMS);
 492	regs_buff[21] = IXGBE_READ_REG(hw, IXGBE_EIMC);
 493	regs_buff[22] = IXGBE_READ_REG(hw, IXGBE_EIAC);
 494	regs_buff[23] = IXGBE_READ_REG(hw, IXGBE_EIAM);
 495	regs_buff[24] = IXGBE_READ_REG(hw, IXGBE_EITR(0));
 496	regs_buff[25] = IXGBE_READ_REG(hw, IXGBE_IVAR(0));
 497	regs_buff[26] = IXGBE_READ_REG(hw, IXGBE_MSIXT);
 498	regs_buff[27] = IXGBE_READ_REG(hw, IXGBE_MSIXPBA);
 499	regs_buff[28] = IXGBE_READ_REG(hw, IXGBE_PBACL(0));
 500	regs_buff[29] = IXGBE_READ_REG(hw, IXGBE_GPIE);
 501
 502	/* Flow Control */
 503	regs_buff[30] = IXGBE_READ_REG(hw, IXGBE_PFCTOP);
 504	regs_buff[31] = IXGBE_READ_REG(hw, IXGBE_FCTTV(0));
 505	regs_buff[32] = IXGBE_READ_REG(hw, IXGBE_FCTTV(1));
 506	regs_buff[33] = IXGBE_READ_REG(hw, IXGBE_FCTTV(2));
 507	regs_buff[34] = IXGBE_READ_REG(hw, IXGBE_FCTTV(3));
 508	for (i = 0; i < 8; i++) {
 509		switch (hw->mac.type) {
 510		case ixgbe_mac_82598EB:
 511			regs_buff[35 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTL(i));
 512			regs_buff[43 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTH(i));
 513			break;
 514		case ixgbe_mac_82599EB:
 515		case ixgbe_mac_X540:
 
 
 
 516			regs_buff[35 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTL_82599(i));
 517			regs_buff[43 + i] = IXGBE_READ_REG(hw, IXGBE_FCRTH_82599(i));
 518			break;
 519		default:
 520			break;
 521		}
 522	}
 523	regs_buff[51] = IXGBE_READ_REG(hw, IXGBE_FCRTV);
 524	regs_buff[52] = IXGBE_READ_REG(hw, IXGBE_TFCS);
 525
 526	/* Receive DMA */
 527	for (i = 0; i < 64; i++)
 528		regs_buff[53 + i] = IXGBE_READ_REG(hw, IXGBE_RDBAL(i));
 529	for (i = 0; i < 64; i++)
 530		regs_buff[117 + i] = IXGBE_READ_REG(hw, IXGBE_RDBAH(i));
 531	for (i = 0; i < 64; i++)
 532		regs_buff[181 + i] = IXGBE_READ_REG(hw, IXGBE_RDLEN(i));
 533	for (i = 0; i < 64; i++)
 534		regs_buff[245 + i] = IXGBE_READ_REG(hw, IXGBE_RDH(i));
 535	for (i = 0; i < 64; i++)
 536		regs_buff[309 + i] = IXGBE_READ_REG(hw, IXGBE_RDT(i));
 537	for (i = 0; i < 64; i++)
 538		regs_buff[373 + i] = IXGBE_READ_REG(hw, IXGBE_RXDCTL(i));
 539	for (i = 0; i < 16; i++)
 540		regs_buff[437 + i] = IXGBE_READ_REG(hw, IXGBE_SRRCTL(i));
 541	for (i = 0; i < 16; i++)
 542		regs_buff[453 + i] = IXGBE_READ_REG(hw, IXGBE_DCA_RXCTRL(i));
 543	regs_buff[469] = IXGBE_READ_REG(hw, IXGBE_RDRXCTL);
 544	for (i = 0; i < 8; i++)
 545		regs_buff[470 + i] = IXGBE_READ_REG(hw, IXGBE_RXPBSIZE(i));
 546	regs_buff[478] = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
 547	regs_buff[479] = IXGBE_READ_REG(hw, IXGBE_DROPEN);
 548
 549	/* Receive */
 550	regs_buff[480] = IXGBE_READ_REG(hw, IXGBE_RXCSUM);
 551	regs_buff[481] = IXGBE_READ_REG(hw, IXGBE_RFCTL);
 552	for (i = 0; i < 16; i++)
 553		regs_buff[482 + i] = IXGBE_READ_REG(hw, IXGBE_RAL(i));
 554	for (i = 0; i < 16; i++)
 555		regs_buff[498 + i] = IXGBE_READ_REG(hw, IXGBE_RAH(i));
 556	regs_buff[514] = IXGBE_READ_REG(hw, IXGBE_PSRTYPE(0));
 557	regs_buff[515] = IXGBE_READ_REG(hw, IXGBE_FCTRL);
 558	regs_buff[516] = IXGBE_READ_REG(hw, IXGBE_VLNCTRL);
 559	regs_buff[517] = IXGBE_READ_REG(hw, IXGBE_MCSTCTRL);
 560	regs_buff[518] = IXGBE_READ_REG(hw, IXGBE_MRQC);
 561	regs_buff[519] = IXGBE_READ_REG(hw, IXGBE_VMD_CTL);
 562	for (i = 0; i < 8; i++)
 563		regs_buff[520 + i] = IXGBE_READ_REG(hw, IXGBE_IMIR(i));
 564	for (i = 0; i < 8; i++)
 565		regs_buff[528 + i] = IXGBE_READ_REG(hw, IXGBE_IMIREXT(i));
 566	regs_buff[536] = IXGBE_READ_REG(hw, IXGBE_IMIRVP);
 567
 568	/* Transmit */
 569	for (i = 0; i < 32; i++)
 570		regs_buff[537 + i] = IXGBE_READ_REG(hw, IXGBE_TDBAL(i));
 571	for (i = 0; i < 32; i++)
 572		regs_buff[569 + i] = IXGBE_READ_REG(hw, IXGBE_TDBAH(i));
 573	for (i = 0; i < 32; i++)
 574		regs_buff[601 + i] = IXGBE_READ_REG(hw, IXGBE_TDLEN(i));
 575	for (i = 0; i < 32; i++)
 576		regs_buff[633 + i] = IXGBE_READ_REG(hw, IXGBE_TDH(i));
 577	for (i = 0; i < 32; i++)
 578		regs_buff[665 + i] = IXGBE_READ_REG(hw, IXGBE_TDT(i));
 579	for (i = 0; i < 32; i++)
 580		regs_buff[697 + i] = IXGBE_READ_REG(hw, IXGBE_TXDCTL(i));
 581	for (i = 0; i < 32; i++)
 582		regs_buff[729 + i] = IXGBE_READ_REG(hw, IXGBE_TDWBAL(i));
 583	for (i = 0; i < 32; i++)
 584		regs_buff[761 + i] = IXGBE_READ_REG(hw, IXGBE_TDWBAH(i));
 585	regs_buff[793] = IXGBE_READ_REG(hw, IXGBE_DTXCTL);
 586	for (i = 0; i < 16; i++)
 587		regs_buff[794 + i] = IXGBE_READ_REG(hw, IXGBE_DCA_TXCTRL(i));
 588	regs_buff[810] = IXGBE_READ_REG(hw, IXGBE_TIPG);
 589	for (i = 0; i < 8; i++)
 590		regs_buff[811 + i] = IXGBE_READ_REG(hw, IXGBE_TXPBSIZE(i));
 591	regs_buff[819] = IXGBE_READ_REG(hw, IXGBE_MNGTXMAP);
 592
 593	/* Wake Up */
 594	regs_buff[820] = IXGBE_READ_REG(hw, IXGBE_WUC);
 595	regs_buff[821] = IXGBE_READ_REG(hw, IXGBE_WUFC);
 596	regs_buff[822] = IXGBE_READ_REG(hw, IXGBE_WUS);
 597	regs_buff[823] = IXGBE_READ_REG(hw, IXGBE_IPAV);
 598	regs_buff[824] = IXGBE_READ_REG(hw, IXGBE_IP4AT);
 599	regs_buff[825] = IXGBE_READ_REG(hw, IXGBE_IP6AT);
 600	regs_buff[826] = IXGBE_READ_REG(hw, IXGBE_WUPL);
 601	regs_buff[827] = IXGBE_READ_REG(hw, IXGBE_WUPM);
 602	regs_buff[828] = IXGBE_READ_REG(hw, IXGBE_FHFT(0));
 603
 604	/* DCB */
 605	regs_buff[829] = IXGBE_READ_REG(hw, IXGBE_RMCS);
 606	regs_buff[830] = IXGBE_READ_REG(hw, IXGBE_DPMCS);
 607	regs_buff[831] = IXGBE_READ_REG(hw, IXGBE_PDPMCS);
 608	regs_buff[832] = IXGBE_READ_REG(hw, IXGBE_RUPPBMR);
 609	for (i = 0; i < 8; i++)
 610		regs_buff[833 + i] = IXGBE_READ_REG(hw, IXGBE_RT2CR(i));
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 611	for (i = 0; i < 8; i++)
 612		regs_buff[841 + i] = IXGBE_READ_REG(hw, IXGBE_RT2SR(i));
 
 613	for (i = 0; i < 8; i++)
 614		regs_buff[849 + i] = IXGBE_READ_REG(hw, IXGBE_TDTQ2TCCR(i));
 615	for (i = 0; i < 8; i++)
 616		regs_buff[857 + i] = IXGBE_READ_REG(hw, IXGBE_TDTQ2TCSR(i));
 617	for (i = 0; i < 8; i++)
 618		regs_buff[865 + i] = IXGBE_READ_REG(hw, IXGBE_TDPT2TCCR(i));
 619	for (i = 0; i < 8; i++)
 620		regs_buff[873 + i] = IXGBE_READ_REG(hw, IXGBE_TDPT2TCSR(i));
 621
 622	/* Statistics */
 623	regs_buff[881] = IXGBE_GET_STAT(adapter, crcerrs);
 624	regs_buff[882] = IXGBE_GET_STAT(adapter, illerrc);
 625	regs_buff[883] = IXGBE_GET_STAT(adapter, errbc);
 626	regs_buff[884] = IXGBE_GET_STAT(adapter, mspdc);
 627	for (i = 0; i < 8; i++)
 628		regs_buff[885 + i] = IXGBE_GET_STAT(adapter, mpc[i]);
 629	regs_buff[893] = IXGBE_GET_STAT(adapter, mlfc);
 630	regs_buff[894] = IXGBE_GET_STAT(adapter, mrfc);
 631	regs_buff[895] = IXGBE_GET_STAT(adapter, rlec);
 632	regs_buff[896] = IXGBE_GET_STAT(adapter, lxontxc);
 633	regs_buff[897] = IXGBE_GET_STAT(adapter, lxonrxc);
 634	regs_buff[898] = IXGBE_GET_STAT(adapter, lxofftxc);
 635	regs_buff[899] = IXGBE_GET_STAT(adapter, lxoffrxc);
 636	for (i = 0; i < 8; i++)
 637		regs_buff[900 + i] = IXGBE_GET_STAT(adapter, pxontxc[i]);
 638	for (i = 0; i < 8; i++)
 639		regs_buff[908 + i] = IXGBE_GET_STAT(adapter, pxonrxc[i]);
 640	for (i = 0; i < 8; i++)
 641		regs_buff[916 + i] = IXGBE_GET_STAT(adapter, pxofftxc[i]);
 642	for (i = 0; i < 8; i++)
 643		regs_buff[924 + i] = IXGBE_GET_STAT(adapter, pxoffrxc[i]);
 644	regs_buff[932] = IXGBE_GET_STAT(adapter, prc64);
 645	regs_buff[933] = IXGBE_GET_STAT(adapter, prc127);
 646	regs_buff[934] = IXGBE_GET_STAT(adapter, prc255);
 647	regs_buff[935] = IXGBE_GET_STAT(adapter, prc511);
 648	regs_buff[936] = IXGBE_GET_STAT(adapter, prc1023);
 649	regs_buff[937] = IXGBE_GET_STAT(adapter, prc1522);
 650	regs_buff[938] = IXGBE_GET_STAT(adapter, gprc);
 651	regs_buff[939] = IXGBE_GET_STAT(adapter, bprc);
 652	regs_buff[940] = IXGBE_GET_STAT(adapter, mprc);
 653	regs_buff[941] = IXGBE_GET_STAT(adapter, gptc);
 654	regs_buff[942] = IXGBE_GET_STAT(adapter, gorc);
 655	regs_buff[944] = IXGBE_GET_STAT(adapter, gotc);
 
 
 656	for (i = 0; i < 8; i++)
 657		regs_buff[946 + i] = IXGBE_GET_STAT(adapter, rnbc[i]);
 658	regs_buff[954] = IXGBE_GET_STAT(adapter, ruc);
 659	regs_buff[955] = IXGBE_GET_STAT(adapter, rfc);
 660	regs_buff[956] = IXGBE_GET_STAT(adapter, roc);
 661	regs_buff[957] = IXGBE_GET_STAT(adapter, rjc);
 662	regs_buff[958] = IXGBE_GET_STAT(adapter, mngprc);
 663	regs_buff[959] = IXGBE_GET_STAT(adapter, mngpdc);
 664	regs_buff[960] = IXGBE_GET_STAT(adapter, mngptc);
 665	regs_buff[961] = IXGBE_GET_STAT(adapter, tor);
 
 666	regs_buff[963] = IXGBE_GET_STAT(adapter, tpr);
 667	regs_buff[964] = IXGBE_GET_STAT(adapter, tpt);
 668	regs_buff[965] = IXGBE_GET_STAT(adapter, ptc64);
 669	regs_buff[966] = IXGBE_GET_STAT(adapter, ptc127);
 670	regs_buff[967] = IXGBE_GET_STAT(adapter, ptc255);
 671	regs_buff[968] = IXGBE_GET_STAT(adapter, ptc511);
 672	regs_buff[969] = IXGBE_GET_STAT(adapter, ptc1023);
 673	regs_buff[970] = IXGBE_GET_STAT(adapter, ptc1522);
 674	regs_buff[971] = IXGBE_GET_STAT(adapter, mptc);
 675	regs_buff[972] = IXGBE_GET_STAT(adapter, bptc);
 676	regs_buff[973] = IXGBE_GET_STAT(adapter, xec);
 677	for (i = 0; i < 16; i++)
 678		regs_buff[974 + i] = IXGBE_GET_STAT(adapter, qprc[i]);
 679	for (i = 0; i < 16; i++)
 680		regs_buff[990 + i] = IXGBE_GET_STAT(adapter, qptc[i]);
 681	for (i = 0; i < 16; i++)
 682		regs_buff[1006 + i] = IXGBE_GET_STAT(adapter, qbrc[i]);
 683	for (i = 0; i < 16; i++)
 684		regs_buff[1022 + i] = IXGBE_GET_STAT(adapter, qbtc[i]);
 685
 686	/* MAC */
 687	regs_buff[1038] = IXGBE_READ_REG(hw, IXGBE_PCS1GCFIG);
 688	regs_buff[1039] = IXGBE_READ_REG(hw, IXGBE_PCS1GLCTL);
 689	regs_buff[1040] = IXGBE_READ_REG(hw, IXGBE_PCS1GLSTA);
 690	regs_buff[1041] = IXGBE_READ_REG(hw, IXGBE_PCS1GDBG0);
 691	regs_buff[1042] = IXGBE_READ_REG(hw, IXGBE_PCS1GDBG1);
 692	regs_buff[1043] = IXGBE_READ_REG(hw, IXGBE_PCS1GANA);
 693	regs_buff[1044] = IXGBE_READ_REG(hw, IXGBE_PCS1GANLP);
 694	regs_buff[1045] = IXGBE_READ_REG(hw, IXGBE_PCS1GANNP);
 695	regs_buff[1046] = IXGBE_READ_REG(hw, IXGBE_PCS1GANLPNP);
 696	regs_buff[1047] = IXGBE_READ_REG(hw, IXGBE_HLREG0);
 697	regs_buff[1048] = IXGBE_READ_REG(hw, IXGBE_HLREG1);
 698	regs_buff[1049] = IXGBE_READ_REG(hw, IXGBE_PAP);
 699	regs_buff[1050] = IXGBE_READ_REG(hw, IXGBE_MACA);
 700	regs_buff[1051] = IXGBE_READ_REG(hw, IXGBE_APAE);
 701	regs_buff[1052] = IXGBE_READ_REG(hw, IXGBE_ARD);
 702	regs_buff[1053] = IXGBE_READ_REG(hw, IXGBE_AIS);
 703	regs_buff[1054] = IXGBE_READ_REG(hw, IXGBE_MSCA);
 704	regs_buff[1055] = IXGBE_READ_REG(hw, IXGBE_MSRWD);
 705	regs_buff[1056] = IXGBE_READ_REG(hw, IXGBE_MLADD);
 706	regs_buff[1057] = IXGBE_READ_REG(hw, IXGBE_MHADD);
 707	regs_buff[1058] = IXGBE_READ_REG(hw, IXGBE_TREG);
 708	regs_buff[1059] = IXGBE_READ_REG(hw, IXGBE_PCSS1);
 709	regs_buff[1060] = IXGBE_READ_REG(hw, IXGBE_PCSS2);
 710	regs_buff[1061] = IXGBE_READ_REG(hw, IXGBE_XPCSS);
 711	regs_buff[1062] = IXGBE_READ_REG(hw, IXGBE_SERDESC);
 712	regs_buff[1063] = IXGBE_READ_REG(hw, IXGBE_MACS);
 713	regs_buff[1064] = IXGBE_READ_REG(hw, IXGBE_AUTOC);
 714	regs_buff[1065] = IXGBE_READ_REG(hw, IXGBE_LINKS);
 715	regs_buff[1066] = IXGBE_READ_REG(hw, IXGBE_AUTOC2);
 716	regs_buff[1067] = IXGBE_READ_REG(hw, IXGBE_AUTOC3);
 717	regs_buff[1068] = IXGBE_READ_REG(hw, IXGBE_ANLP1);
 718	regs_buff[1069] = IXGBE_READ_REG(hw, IXGBE_ANLP2);
 719	regs_buff[1070] = IXGBE_READ_REG(hw, IXGBE_ATLASCTL);
 720
 721	/* Diagnostic */
 722	regs_buff[1071] = IXGBE_READ_REG(hw, IXGBE_RDSTATCTL);
 723	for (i = 0; i < 8; i++)
 724		regs_buff[1072 + i] = IXGBE_READ_REG(hw, IXGBE_RDSTAT(i));
 725	regs_buff[1080] = IXGBE_READ_REG(hw, IXGBE_RDHMPN);
 726	for (i = 0; i < 4; i++)
 727		regs_buff[1081 + i] = IXGBE_READ_REG(hw, IXGBE_RIC_DW(i));
 728	regs_buff[1085] = IXGBE_READ_REG(hw, IXGBE_RDPROBE);
 729	regs_buff[1086] = IXGBE_READ_REG(hw, IXGBE_TDSTATCTL);
 730	for (i = 0; i < 8; i++)
 731		regs_buff[1087 + i] = IXGBE_READ_REG(hw, IXGBE_TDSTAT(i));
 732	regs_buff[1095] = IXGBE_READ_REG(hw, IXGBE_TDHMPN);
 733	for (i = 0; i < 4; i++)
 734		regs_buff[1096 + i] = IXGBE_READ_REG(hw, IXGBE_TIC_DW(i));
 735	regs_buff[1100] = IXGBE_READ_REG(hw, IXGBE_TDPROBE);
 736	regs_buff[1101] = IXGBE_READ_REG(hw, IXGBE_TXBUFCTRL);
 737	regs_buff[1102] = IXGBE_READ_REG(hw, IXGBE_TXBUFDATA0);
 738	regs_buff[1103] = IXGBE_READ_REG(hw, IXGBE_TXBUFDATA1);
 739	regs_buff[1104] = IXGBE_READ_REG(hw, IXGBE_TXBUFDATA2);
 740	regs_buff[1105] = IXGBE_READ_REG(hw, IXGBE_TXBUFDATA3);
 741	regs_buff[1106] = IXGBE_READ_REG(hw, IXGBE_RXBUFCTRL);
 742	regs_buff[1107] = IXGBE_READ_REG(hw, IXGBE_RXBUFDATA0);
 743	regs_buff[1108] = IXGBE_READ_REG(hw, IXGBE_RXBUFDATA1);
 744	regs_buff[1109] = IXGBE_READ_REG(hw, IXGBE_RXBUFDATA2);
 745	regs_buff[1110] = IXGBE_READ_REG(hw, IXGBE_RXBUFDATA3);
 746	for (i = 0; i < 8; i++)
 747		regs_buff[1111 + i] = IXGBE_READ_REG(hw, IXGBE_PCIE_DIAG(i));
 748	regs_buff[1119] = IXGBE_READ_REG(hw, IXGBE_RFVAL);
 749	regs_buff[1120] = IXGBE_READ_REG(hw, IXGBE_MDFTC1);
 750	regs_buff[1121] = IXGBE_READ_REG(hw, IXGBE_MDFTC2);
 751	regs_buff[1122] = IXGBE_READ_REG(hw, IXGBE_MDFTFIFO1);
 752	regs_buff[1123] = IXGBE_READ_REG(hw, IXGBE_MDFTFIFO2);
 753	regs_buff[1124] = IXGBE_READ_REG(hw, IXGBE_MDFTS);
 754	regs_buff[1125] = IXGBE_READ_REG(hw, IXGBE_PCIEECCCTL);
 755	regs_buff[1126] = IXGBE_READ_REG(hw, IXGBE_PBTXECC);
 756	regs_buff[1127] = IXGBE_READ_REG(hw, IXGBE_PBRXECC);
 757
 758	/* 82599 X540 specific registers  */
 759	regs_buff[1128] = IXGBE_READ_REG(hw, IXGBE_MFLCN);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 760}
 761
 762static int ixgbe_get_eeprom_len(struct net_device *netdev)
 763{
 764	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 765	return adapter->hw.eeprom.word_size * 2;
 766}
 767
 768static int ixgbe_get_eeprom(struct net_device *netdev,
 769                            struct ethtool_eeprom *eeprom, u8 *bytes)
 770{
 771	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 772	struct ixgbe_hw *hw = &adapter->hw;
 773	u16 *eeprom_buff;
 774	int first_word, last_word, eeprom_len;
 775	int ret_val = 0;
 776	u16 i;
 777
 778	if (eeprom->len == 0)
 779		return -EINVAL;
 780
 781	eeprom->magic = hw->vendor_id | (hw->device_id << 16);
 782
 783	first_word = eeprom->offset >> 1;
 784	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
 785	eeprom_len = last_word - first_word + 1;
 786
 787	eeprom_buff = kmalloc(sizeof(u16) * eeprom_len, GFP_KERNEL);
 788	if (!eeprom_buff)
 789		return -ENOMEM;
 790
 791	ret_val = hw->eeprom.ops.read_buffer(hw, first_word, eeprom_len,
 792					     eeprom_buff);
 793
 794	/* Device's eeprom is always little-endian, word addressable */
 795	for (i = 0; i < eeprom_len; i++)
 796		le16_to_cpus(&eeprom_buff[i]);
 797
 798	memcpy(bytes, (u8 *)eeprom_buff + (eeprom->offset & 1), eeprom->len);
 799	kfree(eeprom_buff);
 800
 801	return ret_val;
 802}
 803
 804static int ixgbe_set_eeprom(struct net_device *netdev,
 805			    struct ethtool_eeprom *eeprom, u8 *bytes)
 806{
 807	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 808	struct ixgbe_hw *hw = &adapter->hw;
 809	u16 *eeprom_buff;
 810	void *ptr;
 811	int max_len, first_word, last_word, ret_val = 0;
 812	u16 i;
 813
 814	if (eeprom->len == 0)
 815		return -EINVAL;
 816
 817	if (eeprom->magic != (hw->vendor_id | (hw->device_id << 16)))
 818		return -EINVAL;
 819
 820	max_len = hw->eeprom.word_size * 2;
 821
 822	first_word = eeprom->offset >> 1;
 823	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
 824	eeprom_buff = kmalloc(max_len, GFP_KERNEL);
 825	if (!eeprom_buff)
 826		return -ENOMEM;
 827
 828	ptr = eeprom_buff;
 829
 830	if (eeprom->offset & 1) {
 831		/*
 832		 * need read/modify/write of first changed EEPROM word
 833		 * only the second byte of the word is being modified
 834		 */
 835		ret_val = hw->eeprom.ops.read(hw, first_word, &eeprom_buff[0]);
 836		if (ret_val)
 837			goto err;
 838
 839		ptr++;
 840	}
 841	if ((eeprom->offset + eeprom->len) & 1) {
 842		/*
 843		 * need read/modify/write of last changed EEPROM word
 844		 * only the first byte of the word is being modified
 845		 */
 846		ret_val = hw->eeprom.ops.read(hw, last_word,
 847					  &eeprom_buff[last_word - first_word]);
 848		if (ret_val)
 849			goto err;
 850	}
 851
 852	/* Device's eeprom is always little-endian, word addressable */
 853	for (i = 0; i < last_word - first_word + 1; i++)
 854		le16_to_cpus(&eeprom_buff[i]);
 855
 856	memcpy(ptr, bytes, eeprom->len);
 857
 858	for (i = 0; i < last_word - first_word + 1; i++)
 859		cpu_to_le16s(&eeprom_buff[i]);
 860
 861	ret_val = hw->eeprom.ops.write_buffer(hw, first_word,
 862					      last_word - first_word + 1,
 863					      eeprom_buff);
 864
 865	/* Update the checksum */
 866	if (ret_val == 0)
 867		hw->eeprom.ops.update_checksum(hw);
 868
 869err:
 870	kfree(eeprom_buff);
 871	return ret_val;
 872}
 873
 874static void ixgbe_get_drvinfo(struct net_device *netdev,
 875                              struct ethtool_drvinfo *drvinfo)
 876{
 877	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 878	u32 nvm_track_id;
 879
 880	strlcpy(drvinfo->driver, ixgbe_driver_name, sizeof(drvinfo->driver));
 881	strlcpy(drvinfo->version, ixgbe_driver_version,
 882		sizeof(drvinfo->version));
 883
 884	nvm_track_id = (adapter->eeprom_verh << 16) |
 885			adapter->eeprom_verl;
 886	snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version), "0x%08x",
 887		 nvm_track_id);
 888
 889	strlcpy(drvinfo->bus_info, pci_name(adapter->pdev),
 890		sizeof(drvinfo->bus_info));
 891	drvinfo->n_stats = IXGBE_STATS_LEN;
 892	drvinfo->testinfo_len = IXGBE_TEST_LEN;
 893	drvinfo->regdump_len = ixgbe_get_regs_len(netdev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 894}
 895
 896static void ixgbe_get_ringparam(struct net_device *netdev,
 897                                struct ethtool_ringparam *ring)
 
 
 898{
 899	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 900	struct ixgbe_ring *tx_ring = adapter->tx_ring[0];
 901	struct ixgbe_ring *rx_ring = adapter->rx_ring[0];
 902
 903	ring->rx_max_pending = IXGBE_MAX_RXD;
 904	ring->tx_max_pending = IXGBE_MAX_TXD;
 905	ring->rx_pending = rx_ring->count;
 906	ring->tx_pending = tx_ring->count;
 907}
 908
 909static int ixgbe_set_ringparam(struct net_device *netdev,
 910                               struct ethtool_ringparam *ring)
 
 
 911{
 912	struct ixgbe_adapter *adapter = netdev_priv(netdev);
 913	struct ixgbe_ring *temp_tx_ring, *temp_rx_ring;
 914	int i, err = 0;
 915	u32 new_rx_count, new_tx_count;
 916	bool need_update = false;
 917
 918	if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending))
 919		return -EINVAL;
 920
 921	new_rx_count = max_t(u32, ring->rx_pending, IXGBE_MIN_RXD);
 922	new_rx_count = min_t(u32, new_rx_count, IXGBE_MAX_RXD);
 
 
 
 
 923	new_rx_count = ALIGN(new_rx_count, IXGBE_REQ_RX_DESCRIPTOR_MULTIPLE);
 924
 925	new_tx_count = max_t(u32, ring->tx_pending, IXGBE_MIN_TXD);
 926	new_tx_count = min_t(u32, new_tx_count, IXGBE_MAX_TXD);
 927	new_tx_count = ALIGN(new_tx_count, IXGBE_REQ_TX_DESCRIPTOR_MULTIPLE);
 928
 929	if ((new_tx_count == adapter->tx_ring[0]->count) &&
 930	    (new_rx_count == adapter->rx_ring[0]->count)) {
 931		/* nothing to do */
 932		return 0;
 933	}
 934
 935	while (test_and_set_bit(__IXGBE_RESETTING, &adapter->state))
 936		usleep_range(1000, 2000);
 937
 938	if (!netif_running(adapter->netdev)) {
 939		for (i = 0; i < adapter->num_tx_queues; i++)
 940			adapter->tx_ring[i]->count = new_tx_count;
 
 
 941		for (i = 0; i < adapter->num_rx_queues; i++)
 942			adapter->rx_ring[i]->count = new_rx_count;
 943		adapter->tx_ring_count = new_tx_count;
 
 944		adapter->rx_ring_count = new_rx_count;
 945		goto clear_reset;
 946	}
 947
 948	temp_tx_ring = vmalloc(adapter->num_tx_queues * sizeof(struct ixgbe_ring));
 949	if (!temp_tx_ring) {
 
 
 
 
 950		err = -ENOMEM;
 951		goto clear_reset;
 952	}
 953
 
 
 
 
 
 
 
 
 954	if (new_tx_count != adapter->tx_ring_count) {
 955		for (i = 0; i < adapter->num_tx_queues; i++) {
 956			memcpy(&temp_tx_ring[i], adapter->tx_ring[i],
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 957			       sizeof(struct ixgbe_ring));
 958			temp_tx_ring[i].count = new_tx_count;
 959			err = ixgbe_setup_tx_resources(&temp_tx_ring[i]);
 
 960			if (err) {
 961				while (i) {
 962					i--;
 963					ixgbe_free_tx_resources(&temp_tx_ring[i]);
 964				}
 965				goto clear_reset;
 966			}
 967		}
 968		need_update = true;
 969	}
 970
 971	temp_rx_ring = vmalloc(adapter->num_rx_queues * sizeof(struct ixgbe_ring));
 972	if (!temp_rx_ring) {
 973		err = -ENOMEM;
 974		goto err_setup;
 
 
 
 
 
 
 
 
 
 
 975	}
 976
 
 977	if (new_rx_count != adapter->rx_ring_count) {
 978		for (i = 0; i < adapter->num_rx_queues; i++) {
 979			memcpy(&temp_rx_ring[i], adapter->rx_ring[i],
 980			       sizeof(struct ixgbe_ring));
 981			temp_rx_ring[i].count = new_rx_count;
 982			err = ixgbe_setup_rx_resources(&temp_rx_ring[i]);
 
 
 
 
 
 983			if (err) {
 984				while (i) {
 985					i--;
 986					ixgbe_free_rx_resources(&temp_rx_ring[i]);
 987				}
 988				goto err_setup;
 989			}
 
 990		}
 991		need_update = true;
 992	}
 993
 994	/* if rings need to be updated, here's the place to do it in one shot */
 995	if (need_update) {
 996		ixgbe_down(adapter);
 997
 998		/* tx */
 999		if (new_tx_count != adapter->tx_ring_count) {
1000			for (i = 0; i < adapter->num_tx_queues; i++) {
1001				ixgbe_free_tx_resources(adapter->tx_ring[i]);
1002				memcpy(adapter->tx_ring[i], &temp_tx_ring[i],
1003				       sizeof(struct ixgbe_ring));
1004			}
1005			adapter->tx_ring_count = new_tx_count;
1006		}
1007
1008		/* rx */
1009		if (new_rx_count != adapter->rx_ring_count) {
1010			for (i = 0; i < adapter->num_rx_queues; i++) {
1011				ixgbe_free_rx_resources(adapter->rx_ring[i]);
1012				memcpy(adapter->rx_ring[i], &temp_rx_ring[i],
1013				       sizeof(struct ixgbe_ring));
1014			}
1015			adapter->rx_ring_count = new_rx_count;
1016		}
1017		ixgbe_up(adapter);
1018	}
1019
1020	vfree(temp_rx_ring);
1021err_setup:
1022	vfree(temp_tx_ring);
 
1023clear_reset:
1024	clear_bit(__IXGBE_RESETTING, &adapter->state);
1025	return err;
1026}
1027
1028static int ixgbe_get_sset_count(struct net_device *netdev, int sset)
1029{
1030	switch (sset) {
1031	case ETH_SS_TEST:
1032		return IXGBE_TEST_LEN;
1033	case ETH_SS_STATS:
1034		return IXGBE_STATS_LEN;
 
 
1035	default:
1036		return -EOPNOTSUPP;
1037	}
1038}
1039
1040static void ixgbe_get_ethtool_stats(struct net_device *netdev,
1041                                    struct ethtool_stats *stats, u64 *data)
1042{
1043	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1044	struct rtnl_link_stats64 temp;
1045	const struct rtnl_link_stats64 *net_stats;
1046	unsigned int start;
1047	struct ixgbe_ring *ring;
1048	int i, j;
1049	char *p = NULL;
1050
1051	ixgbe_update_stats(adapter);
1052	net_stats = dev_get_stats(netdev, &temp);
1053	for (i = 0; i < IXGBE_GLOBAL_STATS_LEN; i++) {
1054		switch (ixgbe_gstrings_stats[i].type) {
1055		case NETDEV_STATS:
1056			p = (char *) net_stats +
1057					ixgbe_gstrings_stats[i].stat_offset;
1058			break;
1059		case IXGBE_STATS:
1060			p = (char *) adapter +
1061					ixgbe_gstrings_stats[i].stat_offset;
1062			break;
 
 
 
1063		}
1064
1065		data[i] = (ixgbe_gstrings_stats[i].sizeof_stat ==
1066		           sizeof(u64)) ? *(u64 *)p : *(u32 *)p;
1067	}
1068	for (j = 0; j < IXGBE_NUM_RX_QUEUES; j++) {
1069		ring = adapter->tx_ring[j];
1070		if (!ring) {
1071			data[i] = 0;
1072			data[i+1] = 0;
1073			i += 2;
1074			continue;
1075		}
1076
1077		do {
1078			start = u64_stats_fetch_begin_bh(&ring->syncp);
1079			data[i]   = ring->stats.packets;
1080			data[i+1] = ring->stats.bytes;
1081		} while (u64_stats_fetch_retry_bh(&ring->syncp, start));
1082		i += 2;
1083	}
1084	for (j = 0; j < IXGBE_NUM_RX_QUEUES; j++) {
1085		ring = adapter->rx_ring[j];
1086		if (!ring) {
1087			data[i] = 0;
1088			data[i+1] = 0;
1089			i += 2;
1090			continue;
1091		}
1092
1093		do {
1094			start = u64_stats_fetch_begin_bh(&ring->syncp);
1095			data[i]   = ring->stats.packets;
1096			data[i+1] = ring->stats.bytes;
1097		} while (u64_stats_fetch_retry_bh(&ring->syncp, start));
1098		i += 2;
1099	}
1100
1101	for (j = 0; j < IXGBE_MAX_PACKET_BUFFERS; j++) {
1102		data[i++] = adapter->stats.pxontxc[j];
1103		data[i++] = adapter->stats.pxofftxc[j];
1104	}
1105	for (j = 0; j < IXGBE_MAX_PACKET_BUFFERS; j++) {
1106		data[i++] = adapter->stats.pxonrxc[j];
1107		data[i++] = adapter->stats.pxoffrxc[j];
1108	}
1109}
1110
1111static void ixgbe_get_strings(struct net_device *netdev, u32 stringset,
1112                              u8 *data)
1113{
1114	char *p = (char *)data;
1115	int i;
1116
1117	switch (stringset) {
1118	case ETH_SS_TEST:
1119		memcpy(data, *ixgbe_gstrings_test,
1120		       IXGBE_TEST_LEN * ETH_GSTRING_LEN);
1121		break;
1122	case ETH_SS_STATS:
1123		for (i = 0; i < IXGBE_GLOBAL_STATS_LEN; i++) {
1124			memcpy(p, ixgbe_gstrings_stats[i].stat_string,
1125			       ETH_GSTRING_LEN);
1126			p += ETH_GSTRING_LEN;
1127		}
1128		for (i = 0; i < netdev->num_tx_queues; i++) {
1129			sprintf(p, "tx_queue_%u_packets", i);
1130			p += ETH_GSTRING_LEN;
1131			sprintf(p, "tx_queue_%u_bytes", i);
1132			p += ETH_GSTRING_LEN;
1133		}
1134		for (i = 0; i < IXGBE_NUM_RX_QUEUES; i++) {
1135			sprintf(p, "rx_queue_%u_packets", i);
1136			p += ETH_GSTRING_LEN;
1137			sprintf(p, "rx_queue_%u_bytes", i);
1138			p += ETH_GSTRING_LEN;
1139		}
1140		for (i = 0; i < IXGBE_MAX_PACKET_BUFFERS; i++) {
1141			sprintf(p, "tx_pb_%u_pxon", i);
1142			p += ETH_GSTRING_LEN;
1143			sprintf(p, "tx_pb_%u_pxoff", i);
1144			p += ETH_GSTRING_LEN;
1145		}
1146		for (i = 0; i < IXGBE_MAX_PACKET_BUFFERS; i++) {
1147			sprintf(p, "rx_pb_%u_pxon", i);
1148			p += ETH_GSTRING_LEN;
1149			sprintf(p, "rx_pb_%u_pxoff", i);
1150			p += ETH_GSTRING_LEN;
1151		}
1152		/* BUG_ON(p - data != IXGBE_STATS_LEN * ETH_GSTRING_LEN); */
1153		break;
 
 
 
1154	}
1155}
1156
1157static int ixgbe_link_test(struct ixgbe_adapter *adapter, u64 *data)
1158{
1159	struct ixgbe_hw *hw = &adapter->hw;
1160	bool link_up;
1161	u32 link_speed = 0;
 
 
 
 
 
1162	*data = 0;
1163
1164	hw->mac.ops.check_link(hw, &link_speed, &link_up, true);
1165	if (link_up)
1166		return *data;
1167	else
1168		*data = 1;
1169	return *data;
1170}
1171
1172/* ethtool register test data */
1173struct ixgbe_reg_test {
1174	u16 reg;
1175	u8  array_len;
1176	u8  test_type;
1177	u32 mask;
1178	u32 write;
1179};
1180
1181/* In the hardware, registers are laid out either singly, in arrays
1182 * spaced 0x40 bytes apart, or in contiguous tables.  We assume
1183 * most tests take place on arrays or single registers (handled
1184 * as a single-element array) and special-case the tables.
1185 * Table tests are always pattern tests.
1186 *
1187 * We also make provision for some required setup steps by specifying
1188 * registers to be written without any read-back testing.
1189 */
1190
1191#define PATTERN_TEST	1
1192#define SET_READ_TEST	2
1193#define WRITE_NO_TEST	3
1194#define TABLE32_TEST	4
1195#define TABLE64_TEST_LO	5
1196#define TABLE64_TEST_HI	6
1197
1198/* default 82599 register test */
1199static const struct ixgbe_reg_test reg_test_82599[] = {
1200	{ IXGBE_FCRTL_82599(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1201	{ IXGBE_FCRTH_82599(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1202	{ IXGBE_PFCTOP, 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1203	{ IXGBE_VLNCTRL, 1, PATTERN_TEST, 0x00000000, 0x00000000 },
1204	{ IXGBE_RDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFF80 },
1205	{ IXGBE_RDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1206	{ IXGBE_RDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFFFF },
1207	{ IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, IXGBE_RXDCTL_ENABLE },
1208	{ IXGBE_RDT(0), 4, PATTERN_TEST, 0x0000FFFF, 0x0000FFFF },
1209	{ IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, 0 },
1210	{ IXGBE_FCRTH(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1211	{ IXGBE_FCTTV(0), 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1212	{ IXGBE_TDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFFFF },
1213	{ IXGBE_TDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1214	{ IXGBE_TDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFF80 },
1215	{ IXGBE_RXCTRL, 1, SET_READ_TEST, 0x00000001, 0x00000001 },
1216	{ IXGBE_RAL(0), 16, TABLE64_TEST_LO, 0xFFFFFFFF, 0xFFFFFFFF },
1217	{ IXGBE_RAL(0), 16, TABLE64_TEST_HI, 0x8001FFFF, 0x800CFFFF },
1218	{ IXGBE_MTA(0), 128, TABLE32_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1219	{ 0, 0, 0, 0 }
1220};
1221
1222/* default 82598 register test */
1223static const struct ixgbe_reg_test reg_test_82598[] = {
1224	{ IXGBE_FCRTL(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1225	{ IXGBE_FCRTH(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1226	{ IXGBE_PFCTOP, 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1227	{ IXGBE_VLNCTRL, 1, PATTERN_TEST, 0x00000000, 0x00000000 },
1228	{ IXGBE_RDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFFFF },
1229	{ IXGBE_RDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1230	{ IXGBE_RDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFFFF },
1231	/* Enable all four RX queues before testing. */
1232	{ IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, IXGBE_RXDCTL_ENABLE },
1233	/* RDH is read-only for 82598, only test RDT. */
1234	{ IXGBE_RDT(0), 4, PATTERN_TEST, 0x0000FFFF, 0x0000FFFF },
1235	{ IXGBE_RXDCTL(0), 4, WRITE_NO_TEST, 0, 0 },
1236	{ IXGBE_FCRTH(0), 1, PATTERN_TEST, 0x8007FFF0, 0x8007FFF0 },
1237	{ IXGBE_FCTTV(0), 1, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1238	{ IXGBE_TIPG, 1, PATTERN_TEST, 0x000000FF, 0x000000FF },
1239	{ IXGBE_TDBAL(0), 4, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFFFF },
1240	{ IXGBE_TDBAH(0), 4, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1241	{ IXGBE_TDLEN(0), 4, PATTERN_TEST, 0x000FFF80, 0x000FFFFF },
1242	{ IXGBE_RXCTRL, 1, SET_READ_TEST, 0x00000003, 0x00000003 },
1243	{ IXGBE_DTXCTL, 1, SET_READ_TEST, 0x00000005, 0x00000005 },
1244	{ IXGBE_RAL(0), 16, TABLE64_TEST_LO, 0xFFFFFFFF, 0xFFFFFFFF },
1245	{ IXGBE_RAL(0), 16, TABLE64_TEST_HI, 0x800CFFFF, 0x800CFFFF },
1246	{ IXGBE_MTA(0), 128, TABLE32_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
1247	{ 0, 0, 0, 0 }
1248};
1249
1250static bool reg_pattern_test(struct ixgbe_adapter *adapter, u64 *data, int reg,
1251			     u32 mask, u32 write)
1252{
1253	u32 pat, val, before;
1254	static const u32 test_pattern[] = {
1255		0x5A5A5A5A, 0xA5A5A5A5, 0x00000000, 0xFFFFFFFF};
1256
 
 
 
 
1257	for (pat = 0; pat < ARRAY_SIZE(test_pattern); pat++) {
1258		before = readl(adapter->hw.hw_addr + reg);
1259		writel((test_pattern[pat] & write),
1260		       (adapter->hw.hw_addr + reg));
1261		val = readl(adapter->hw.hw_addr + reg);
1262		if (val != (test_pattern[pat] & write & mask)) {
1263			e_err(drv, "pattern test reg %04X failed: got "
1264			      "0x%08X expected 0x%08X\n",
1265			      reg, val, (test_pattern[pat] & write & mask));
1266			*data = reg;
1267			writel(before, adapter->hw.hw_addr + reg);
1268			return 1;
1269		}
1270		writel(before, adapter->hw.hw_addr + reg);
1271	}
1272	return 0;
1273}
1274
1275static bool reg_set_and_check(struct ixgbe_adapter *adapter, u64 *data, int reg,
1276			      u32 mask, u32 write)
1277{
1278	u32 val, before;
1279	before = readl(adapter->hw.hw_addr + reg);
1280	writel((write & mask), (adapter->hw.hw_addr + reg));
1281	val = readl(adapter->hw.hw_addr + reg);
 
 
 
 
 
1282	if ((write & mask) != (val & mask)) {
1283		e_err(drv, "set/check reg %04X test failed: got 0x%08X "
1284		      "expected 0x%08X\n", reg, (val & mask), (write & mask));
1285		*data = reg;
1286		writel(before, (adapter->hw.hw_addr + reg));
1287		return 1;
1288	}
1289	writel(before, (adapter->hw.hw_addr + reg));
1290	return 0;
1291}
1292
1293#define REG_PATTERN_TEST(reg, mask, write)				      \
1294	do {								      \
1295		if (reg_pattern_test(adapter, data, reg, mask, write))	      \
1296			return 1;					      \
1297	} while (0)							      \
1298
1299
1300#define REG_SET_AND_CHECK(reg, mask, write)				      \
1301	do {								      \
1302		if (reg_set_and_check(adapter, data, reg, mask, write))	      \
1303			return 1;					      \
1304	} while (0)							      \
1305
1306static int ixgbe_reg_test(struct ixgbe_adapter *adapter, u64 *data)
1307{
1308	const struct ixgbe_reg_test *test;
1309	u32 value, before, after;
1310	u32 i, toggle;
1311
 
 
 
 
 
1312	switch (adapter->hw.mac.type) {
1313	case ixgbe_mac_82598EB:
1314		toggle = 0x7FFFF3FF;
1315		test = reg_test_82598;
1316		break;
1317	case ixgbe_mac_82599EB:
1318	case ixgbe_mac_X540:
 
 
 
1319		toggle = 0x7FFFF30F;
1320		test = reg_test_82599;
1321		break;
1322	default:
1323		*data = 1;
1324		return 1;
1325		break;
1326	}
1327
1328	/*
1329	 * Because the status register is such a special case,
1330	 * we handle it separately from the rest of the register
1331	 * tests.  Some bits are read-only, some toggle, and some
1332	 * are writeable on newer MACs.
1333	 */
1334	before = IXGBE_READ_REG(&adapter->hw, IXGBE_STATUS);
1335	value = (IXGBE_READ_REG(&adapter->hw, IXGBE_STATUS) & toggle);
1336	IXGBE_WRITE_REG(&adapter->hw, IXGBE_STATUS, toggle);
1337	after = IXGBE_READ_REG(&adapter->hw, IXGBE_STATUS) & toggle;
1338	if (value != after) {
1339		e_err(drv, "failed STATUS register test got: 0x%08X "
1340		      "expected: 0x%08X\n", after, value);
1341		*data = 1;
1342		return 1;
1343	}
1344	/* restore previous status */
1345	IXGBE_WRITE_REG(&adapter->hw, IXGBE_STATUS, before);
1346
1347	/*
1348	 * Perform the remainder of the register test, looping through
1349	 * the test table until we either fail or reach the null entry.
1350	 */
1351	while (test->reg) {
1352		for (i = 0; i < test->array_len; i++) {
 
 
1353			switch (test->test_type) {
1354			case PATTERN_TEST:
1355				REG_PATTERN_TEST(test->reg + (i * 0x40),
1356						 test->mask,
1357						 test->write);
 
1358				break;
1359			case SET_READ_TEST:
1360				REG_SET_AND_CHECK(test->reg + (i * 0x40),
1361						  test->mask,
1362						  test->write);
 
1363				break;
1364			case WRITE_NO_TEST:
1365				writel(test->write,
1366				       (adapter->hw.hw_addr + test->reg)
1367				       + (i * 0x40));
1368				break;
1369			case TABLE32_TEST:
1370				REG_PATTERN_TEST(test->reg + (i * 4),
1371						 test->mask,
1372						 test->write);
 
1373				break;
1374			case TABLE64_TEST_LO:
1375				REG_PATTERN_TEST(test->reg + (i * 8),
1376						 test->mask,
1377						 test->write);
 
1378				break;
1379			case TABLE64_TEST_HI:
1380				REG_PATTERN_TEST((test->reg + 4) + (i * 8),
1381						 test->mask,
1382						 test->write);
 
1383				break;
1384			}
 
 
1385		}
1386		test++;
1387	}
1388
1389	*data = 0;
1390	return 0;
1391}
1392
1393static int ixgbe_eeprom_test(struct ixgbe_adapter *adapter, u64 *data)
1394{
1395	struct ixgbe_hw *hw = &adapter->hw;
1396	if (hw->eeprom.ops.validate_checksum(hw, NULL))
1397		*data = 1;
1398	else
1399		*data = 0;
1400	return *data;
1401}
1402
1403static irqreturn_t ixgbe_test_intr(int irq, void *data)
1404{
1405	struct net_device *netdev = (struct net_device *) data;
1406	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1407
1408	adapter->test_icr |= IXGBE_READ_REG(&adapter->hw, IXGBE_EICR);
1409
1410	return IRQ_HANDLED;
1411}
1412
1413static int ixgbe_intr_test(struct ixgbe_adapter *adapter, u64 *data)
1414{
1415	struct net_device *netdev = adapter->netdev;
1416	u32 mask, i = 0, shared_int = true;
1417	u32 irq = adapter->pdev->irq;
1418
1419	*data = 0;
1420
1421	/* Hook up test interrupt handler just for this test */
1422	if (adapter->msix_entries) {
1423		/* NOTE: we don't test MSI-X interrupts here, yet */
1424		return 0;
1425	} else if (adapter->flags & IXGBE_FLAG_MSI_ENABLED) {
1426		shared_int = false;
1427		if (request_irq(irq, ixgbe_test_intr, 0, netdev->name,
1428				netdev)) {
1429			*data = 1;
1430			return -1;
1431		}
1432	} else if (!request_irq(irq, ixgbe_test_intr, IRQF_PROBE_SHARED,
1433	                        netdev->name, netdev)) {
1434		shared_int = false;
1435	} else if (request_irq(irq, ixgbe_test_intr, IRQF_SHARED,
1436	                       netdev->name, netdev)) {
1437		*data = 1;
1438		return -1;
1439	}
1440	e_info(hw, "testing %s interrupt\n", shared_int ?
1441	       "shared" : "unshared");
1442
1443	/* Disable all the interrupts */
1444	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFFFFFF);
1445	IXGBE_WRITE_FLUSH(&adapter->hw);
1446	usleep_range(10000, 20000);
1447
1448	/* Test each interrupt */
1449	for (; i < 10; i++) {
1450		/* Interrupt to test */
1451		mask = 1 << i;
1452
1453		if (!shared_int) {
1454			/*
1455			 * Disable the interrupts to be reported in
1456			 * the cause register and then force the same
1457			 * interrupt and see if one gets posted.  If
1458			 * an interrupt was posted to the bus, the
1459			 * test failed.
1460			 */
1461			adapter->test_icr = 0;
1462			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC,
1463			                ~mask & 0x00007FFF);
1464			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS,
1465			                ~mask & 0x00007FFF);
1466			IXGBE_WRITE_FLUSH(&adapter->hw);
1467			usleep_range(10000, 20000);
1468
1469			if (adapter->test_icr & mask) {
1470				*data = 3;
1471				break;
1472			}
1473		}
1474
1475		/*
1476		 * Enable the interrupt to be reported in the cause
1477		 * register and then force the same interrupt and see
1478		 * if one gets posted.  If an interrupt was not posted
1479		 * to the bus, the test failed.
1480		 */
1481		adapter->test_icr = 0;
1482		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMS, mask);
1483		IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS, mask);
1484		IXGBE_WRITE_FLUSH(&adapter->hw);
1485		usleep_range(10000, 20000);
1486
1487		if (!(adapter->test_icr &mask)) {
1488			*data = 4;
1489			break;
1490		}
1491
1492		if (!shared_int) {
1493			/*
1494			 * Disable the other interrupts to be reported in
1495			 * the cause register and then force the other
1496			 * interrupts and see if any get posted.  If
1497			 * an interrupt was posted to the bus, the
1498			 * test failed.
1499			 */
1500			adapter->test_icr = 0;
1501			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC,
1502			                ~mask & 0x00007FFF);
1503			IXGBE_WRITE_REG(&adapter->hw, IXGBE_EICS,
1504			                ~mask & 0x00007FFF);
1505			IXGBE_WRITE_FLUSH(&adapter->hw);
1506			usleep_range(10000, 20000);
1507
1508			if (adapter->test_icr) {
1509				*data = 5;
1510				break;
1511			}
1512		}
1513	}
1514
1515	/* Disable all the interrupts */
1516	IXGBE_WRITE_REG(&adapter->hw, IXGBE_EIMC, 0xFFFFFFFF);
1517	IXGBE_WRITE_FLUSH(&adapter->hw);
1518	usleep_range(10000, 20000);
1519
1520	/* Unhook test interrupt handler */
1521	free_irq(irq, netdev);
1522
1523	return *data;
1524}
1525
1526static void ixgbe_free_desc_rings(struct ixgbe_adapter *adapter)
1527{
1528	struct ixgbe_ring *tx_ring = &adapter->test_tx_ring;
1529	struct ixgbe_ring *rx_ring = &adapter->test_rx_ring;
1530	struct ixgbe_hw *hw = &adapter->hw;
1531	u32 reg_ctl;
1532
1533	/* shut down the DMA engines now so they can be reinitialized later */
1534
1535	/* first Rx */
1536	reg_ctl = IXGBE_READ_REG(hw, IXGBE_RXCTRL);
1537	reg_ctl &= ~IXGBE_RXCTRL_RXEN;
1538	IXGBE_WRITE_REG(hw, IXGBE_RXCTRL, reg_ctl);
1539	ixgbe_disable_rx_queue(adapter, rx_ring);
1540
1541	/* now Tx */
1542	reg_ctl = IXGBE_READ_REG(hw, IXGBE_TXDCTL(tx_ring->reg_idx));
1543	reg_ctl &= ~IXGBE_TXDCTL_ENABLE;
1544	IXGBE_WRITE_REG(hw, IXGBE_TXDCTL(tx_ring->reg_idx), reg_ctl);
1545
1546	switch (hw->mac.type) {
1547	case ixgbe_mac_82599EB:
1548	case ixgbe_mac_X540:
1549		reg_ctl = IXGBE_READ_REG(hw, IXGBE_DMATXCTL);
1550		reg_ctl &= ~IXGBE_DMATXCTL_TE;
1551		IXGBE_WRITE_REG(hw, IXGBE_DMATXCTL, reg_ctl);
1552		break;
1553	default:
1554		break;
1555	}
1556
1557	ixgbe_reset(adapter);
1558
1559	ixgbe_free_tx_resources(&adapter->test_tx_ring);
1560	ixgbe_free_rx_resources(&adapter->test_rx_ring);
1561}
1562
1563static int ixgbe_setup_desc_rings(struct ixgbe_adapter *adapter)
1564{
1565	struct ixgbe_ring *tx_ring = &adapter->test_tx_ring;
1566	struct ixgbe_ring *rx_ring = &adapter->test_rx_ring;
 
1567	u32 rctl, reg_data;
1568	int ret_val;
1569	int err;
1570
1571	/* Setup Tx descriptor ring and Tx buffers */
1572	tx_ring->count = IXGBE_DEFAULT_TXD;
1573	tx_ring->queue_index = 0;
1574	tx_ring->dev = &adapter->pdev->dev;
1575	tx_ring->netdev = adapter->netdev;
1576	tx_ring->reg_idx = adapter->tx_ring[0]->reg_idx;
1577
1578	err = ixgbe_setup_tx_resources(tx_ring);
1579	if (err)
1580		return 1;
1581
1582	switch (adapter->hw.mac.type) {
1583	case ixgbe_mac_82599EB:
1584	case ixgbe_mac_X540:
 
 
 
1585		reg_data = IXGBE_READ_REG(&adapter->hw, IXGBE_DMATXCTL);
1586		reg_data |= IXGBE_DMATXCTL_TE;
1587		IXGBE_WRITE_REG(&adapter->hw, IXGBE_DMATXCTL, reg_data);
1588		break;
1589	default:
1590		break;
1591	}
1592
1593	ixgbe_configure_tx_ring(adapter, tx_ring);
1594
1595	/* Setup Rx Descriptor ring and Rx buffers */
1596	rx_ring->count = IXGBE_DEFAULT_RXD;
1597	rx_ring->queue_index = 0;
1598	rx_ring->dev = &adapter->pdev->dev;
1599	rx_ring->netdev = adapter->netdev;
1600	rx_ring->reg_idx = adapter->rx_ring[0]->reg_idx;
1601
1602	err = ixgbe_setup_rx_resources(rx_ring);
1603	if (err) {
1604		ret_val = 4;
1605		goto err_nomem;
1606	}
1607
1608	rctl = IXGBE_READ_REG(&adapter->hw, IXGBE_RXCTRL);
1609	IXGBE_WRITE_REG(&adapter->hw, IXGBE_RXCTRL, rctl & ~IXGBE_RXCTRL_RXEN);
1610
1611	ixgbe_configure_rx_ring(adapter, rx_ring);
1612
1613	rctl |= IXGBE_RXCTRL_RXEN | IXGBE_RXCTRL_DMBYPS;
 
1614	IXGBE_WRITE_REG(&adapter->hw, IXGBE_RXCTRL, rctl);
1615
 
 
1616	return 0;
1617
1618err_nomem:
1619	ixgbe_free_desc_rings(adapter);
1620	return ret_val;
1621}
1622
1623static int ixgbe_setup_loopback_test(struct ixgbe_adapter *adapter)
1624{
1625	struct ixgbe_hw *hw = &adapter->hw;
1626	u32 reg_data;
1627
1628	/* X540 needs to set the MACC.FLU bit to force link up */
1629	if (adapter->hw.mac.type == ixgbe_mac_X540) {
1630		reg_data = IXGBE_READ_REG(hw, IXGBE_MACC);
1631		reg_data |= IXGBE_MACC_FLU;
1632		IXGBE_WRITE_REG(hw, IXGBE_MACC, reg_data);
1633	}
1634
1635	/* right now we only support MAC loopback in the driver */
1636	reg_data = IXGBE_READ_REG(hw, IXGBE_HLREG0);
1637	/* Setup MAC loopback */
1638	reg_data |= IXGBE_HLREG0_LPBK;
1639	IXGBE_WRITE_REG(hw, IXGBE_HLREG0, reg_data);
1640
1641	reg_data = IXGBE_READ_REG(hw, IXGBE_FCTRL);
1642	reg_data |= IXGBE_FCTRL_BAM | IXGBE_FCTRL_SBP | IXGBE_FCTRL_MPE;
1643	IXGBE_WRITE_REG(hw, IXGBE_FCTRL, reg_data);
1644
1645	reg_data = IXGBE_READ_REG(hw, IXGBE_AUTOC);
1646	reg_data &= ~IXGBE_AUTOC_LMS_MASK;
1647	reg_data |= IXGBE_AUTOC_LMS_10G_LINK_NO_AN | IXGBE_AUTOC_FLU;
1648	IXGBE_WRITE_REG(hw, IXGBE_AUTOC, reg_data);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1649	IXGBE_WRITE_FLUSH(hw);
1650	usleep_range(10000, 20000);
1651
1652	/* Disable Atlas Tx lanes; re-enabled in reset path */
1653	if (hw->mac.type == ixgbe_mac_82598EB) {
1654		u8 atlas;
1655
1656		hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_LPBK, &atlas);
1657		atlas |= IXGBE_ATLAS_PDN_TX_REG_EN;
1658		hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_LPBK, atlas);
1659
1660		hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_10G, &atlas);
1661		atlas |= IXGBE_ATLAS_PDN_TX_10G_QL_ALL;
1662		hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_10G, atlas);
1663
1664		hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_1G, &atlas);
1665		atlas |= IXGBE_ATLAS_PDN_TX_1G_QL_ALL;
1666		hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_1G, atlas);
1667
1668		hw->mac.ops.read_analog_reg8(hw, IXGBE_ATLAS_PDN_AN, &atlas);
1669		atlas |= IXGBE_ATLAS_PDN_TX_AN_QL_ALL;
1670		hw->mac.ops.write_analog_reg8(hw, IXGBE_ATLAS_PDN_AN, atlas);
1671	}
1672
1673	return 0;
1674}
1675
1676static void ixgbe_loopback_cleanup(struct ixgbe_adapter *adapter)
1677{
1678	u32 reg_data;
1679
1680	reg_data = IXGBE_READ_REG(&adapter->hw, IXGBE_HLREG0);
1681	reg_data &= ~IXGBE_HLREG0_LPBK;
1682	IXGBE_WRITE_REG(&adapter->hw, IXGBE_HLREG0, reg_data);
1683}
1684
1685static void ixgbe_create_lbtest_frame(struct sk_buff *skb,
1686				      unsigned int frame_size)
1687{
1688	memset(skb->data, 0xFF, frame_size);
1689	frame_size >>= 1;
1690	memset(&skb->data[frame_size], 0xAA, frame_size / 2 - 1);
1691	memset(&skb->data[frame_size + 10], 0xBE, 1);
1692	memset(&skb->data[frame_size + 12], 0xAF, 1);
1693}
1694
1695static bool ixgbe_check_lbtest_frame(struct ixgbe_rx_buffer *rx_buffer,
1696				     unsigned int frame_size)
1697{
1698	unsigned char *data;
1699	bool match = true;
1700
1701	frame_size >>= 1;
1702
1703	data = kmap(rx_buffer->page) + rx_buffer->page_offset;
1704
1705	if (data[3] != 0xFF ||
1706	    data[frame_size + 10] != 0xBE ||
1707	    data[frame_size + 12] != 0xAF)
1708		match = false;
1709
1710	kunmap(rx_buffer->page);
1711
1712	return match;
 
1713}
1714
1715static u16 ixgbe_clean_test_rings(struct ixgbe_ring *rx_ring,
1716				  struct ixgbe_ring *tx_ring,
1717				  unsigned int size)
1718{
1719	union ixgbe_adv_rx_desc *rx_desc;
1720	struct ixgbe_rx_buffer *rx_buffer;
1721	struct ixgbe_tx_buffer *tx_buffer;
1722	u16 rx_ntc, tx_ntc, count = 0;
1723
1724	/* initialize next to clean and descriptor values */
1725	rx_ntc = rx_ring->next_to_clean;
1726	tx_ntc = tx_ring->next_to_clean;
1727	rx_desc = IXGBE_RX_DESC(rx_ring, rx_ntc);
1728
1729	while (ixgbe_test_staterr(rx_desc, IXGBE_RXD_STAT_DD)) {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1730		/* check Rx buffer */
1731		rx_buffer = &rx_ring->rx_buffer_info[rx_ntc];
1732
1733		/* sync Rx buffer for CPU read */
1734		dma_sync_single_for_cpu(rx_ring->dev,
1735					rx_buffer->dma,
1736					ixgbe_rx_bufsz(rx_ring),
1737					DMA_FROM_DEVICE);
1738
1739		/* verify contents of skb */
1740		if (ixgbe_check_lbtest_frame(rx_buffer, size))
1741			count++;
 
 
1742
1743		/* sync Rx buffer for device write */
1744		dma_sync_single_for_device(rx_ring->dev,
1745					   rx_buffer->dma,
1746					   ixgbe_rx_bufsz(rx_ring),
1747					   DMA_FROM_DEVICE);
1748
1749		/* unmap buffer on Tx side */
1750		tx_buffer = &tx_ring->tx_buffer_info[tx_ntc];
1751		ixgbe_unmap_and_free_tx_resource(tx_ring, tx_buffer);
1752
1753		/* increment Rx/Tx next to clean counters */
1754		rx_ntc++;
1755		if (rx_ntc == rx_ring->count)
1756			rx_ntc = 0;
1757		tx_ntc++;
1758		if (tx_ntc == tx_ring->count)
1759			tx_ntc = 0;
1760
1761		/* fetch next descriptor */
1762		rx_desc = IXGBE_RX_DESC(rx_ring, rx_ntc);
1763	}
1764
1765	netdev_tx_reset_queue(txring_txq(tx_ring));
1766
1767	/* re-map buffers to ring, store next to clean values */
1768	ixgbe_alloc_rx_buffers(rx_ring, count);
1769	rx_ring->next_to_clean = rx_ntc;
1770	tx_ring->next_to_clean = tx_ntc;
1771
1772	return count;
1773}
1774
1775static int ixgbe_run_loopback_test(struct ixgbe_adapter *adapter)
1776{
1777	struct ixgbe_ring *tx_ring = &adapter->test_tx_ring;
1778	struct ixgbe_ring *rx_ring = &adapter->test_rx_ring;
1779	int i, j, lc, good_cnt, ret_val = 0;
1780	unsigned int size = 1024;
1781	netdev_tx_t tx_ret_val;
1782	struct sk_buff *skb;
 
 
 
 
1783
1784	/* allocate test skb */
1785	skb = alloc_skb(size, GFP_KERNEL);
1786	if (!skb)
1787		return 11;
1788
1789	/* place data into test skb */
1790	ixgbe_create_lbtest_frame(skb, size);
1791	skb_put(skb, size);
1792
1793	/*
1794	 * Calculate the loop count based on the largest descriptor ring
1795	 * The idea is to wrap the largest ring a number of times using 64
1796	 * send/receive pairs during each loop
1797	 */
1798
1799	if (rx_ring->count <= tx_ring->count)
1800		lc = ((tx_ring->count / 64) * 2) + 1;
1801	else
1802		lc = ((rx_ring->count / 64) * 2) + 1;
1803
1804	for (j = 0; j <= lc; j++) {
1805		/* reset count of good packets */
1806		good_cnt = 0;
1807
1808		/* place 64 packets on the transmit queue*/
1809		for (i = 0; i < 64; i++) {
1810			skb_get(skb);
1811			tx_ret_val = ixgbe_xmit_frame_ring(skb,
1812							   adapter,
1813							   tx_ring);
1814			if (tx_ret_val == NETDEV_TX_OK)
1815				good_cnt++;
1816		}
1817
1818		if (good_cnt != 64) {
1819			ret_val = 12;
1820			break;
1821		}
1822
1823		/* allow 200 milliseconds for packets to go from Tx to Rx */
1824		msleep(200);
1825
1826		good_cnt = ixgbe_clean_test_rings(rx_ring, tx_ring, size);
1827		if (good_cnt != 64) {
1828			ret_val = 13;
1829			break;
1830		}
1831	}
1832
1833	/* free the original skb */
1834	kfree_skb(skb);
 
1835
1836	return ret_val;
1837}
1838
1839static int ixgbe_loopback_test(struct ixgbe_adapter *adapter, u64 *data)
1840{
1841	*data = ixgbe_setup_desc_rings(adapter);
1842	if (*data)
1843		goto out;
1844	*data = ixgbe_setup_loopback_test(adapter);
1845	if (*data)
1846		goto err_loopback;
1847	*data = ixgbe_run_loopback_test(adapter);
1848	ixgbe_loopback_cleanup(adapter);
1849
1850err_loopback:
1851	ixgbe_free_desc_rings(adapter);
1852out:
1853	return *data;
1854}
1855
1856static void ixgbe_diag_test(struct net_device *netdev,
1857                            struct ethtool_test *eth_test, u64 *data)
1858{
1859	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1860	bool if_running = netif_running(netdev);
1861
 
 
 
 
 
 
 
 
 
 
1862	set_bit(__IXGBE_TESTING, &adapter->state);
1863	if (eth_test->flags == ETH_TEST_FL_OFFLINE) {
1864		/* Offline tests */
1865
1866		e_info(hw, "offline testing starting\n");
1867
1868		/* Link test performed before hardware reset so autoneg doesn't
1869		 * interfere with test result */
1870		if (ixgbe_link_test(adapter, &data[4]))
1871			eth_test->flags |= ETH_TEST_FL_FAILED;
1872
1873		if (adapter->flags & IXGBE_FLAG_SRIOV_ENABLED) {
1874			int i;
1875			for (i = 0; i < adapter->num_vfs; i++) {
1876				if (adapter->vfinfo[i].clear_to_send) {
1877					netdev_warn(netdev, "%s",
1878						    "offline diagnostic is not "
1879						    "supported when VFs are "
1880						    "present\n");
1881					data[0] = 1;
1882					data[1] = 1;
1883					data[2] = 1;
1884					data[3] = 1;
 
1885					eth_test->flags |= ETH_TEST_FL_FAILED;
1886					clear_bit(__IXGBE_TESTING,
1887						  &adapter->state);
1888					goto skip_ol_tests;
1889				}
1890			}
1891		}
1892
 
 
 
 
 
 
 
 
 
1893		if (if_running)
1894			/* indicate we're in test mode */
1895			dev_close(netdev);
1896		else
1897			ixgbe_reset(adapter);
1898
1899		e_info(hw, "register testing starting\n");
1900		if (ixgbe_reg_test(adapter, &data[0]))
1901			eth_test->flags |= ETH_TEST_FL_FAILED;
1902
1903		ixgbe_reset(adapter);
1904		e_info(hw, "eeprom testing starting\n");
1905		if (ixgbe_eeprom_test(adapter, &data[1]))
1906			eth_test->flags |= ETH_TEST_FL_FAILED;
1907
1908		ixgbe_reset(adapter);
1909		e_info(hw, "interrupt testing starting\n");
1910		if (ixgbe_intr_test(adapter, &data[2]))
1911			eth_test->flags |= ETH_TEST_FL_FAILED;
1912
1913		/* If SRIOV or VMDq is enabled then skip MAC
1914		 * loopback diagnostic. */
1915		if (adapter->flags & (IXGBE_FLAG_SRIOV_ENABLED |
1916				      IXGBE_FLAG_VMDQ_ENABLED)) {
1917			e_info(hw, "Skip MAC loopback diagnostic in VT "
1918			       "mode\n");
1919			data[3] = 0;
1920			goto skip_loopback;
1921		}
1922
1923		ixgbe_reset(adapter);
1924		e_info(hw, "loopback testing starting\n");
1925		if (ixgbe_loopback_test(adapter, &data[3]))
1926			eth_test->flags |= ETH_TEST_FL_FAILED;
1927
1928skip_loopback:
1929		ixgbe_reset(adapter);
1930
 
1931		clear_bit(__IXGBE_TESTING, &adapter->state);
1932		if (if_running)
1933			dev_open(netdev);
 
 
1934	} else {
1935		e_info(hw, "online testing starting\n");
 
1936		/* Online tests */
1937		if (ixgbe_link_test(adapter, &data[4]))
1938			eth_test->flags |= ETH_TEST_FL_FAILED;
1939
1940		/* Online tests aren't run; pass by default */
1941		data[0] = 0;
1942		data[1] = 0;
1943		data[2] = 0;
1944		data[3] = 0;
1945
1946		clear_bit(__IXGBE_TESTING, &adapter->state);
1947	}
1948skip_ol_tests:
1949	msleep_interruptible(4 * 1000);
1950}
1951
1952static int ixgbe_wol_exclusion(struct ixgbe_adapter *adapter,
1953                               struct ethtool_wolinfo *wol)
1954{
1955	struct ixgbe_hw *hw = &adapter->hw;
1956	int retval = 0;
1957
1958	/* WOL not supported for all devices */
1959	if (!ixgbe_wol_supported(adapter, hw->device_id,
1960				 hw->subsystem_device_id)) {
1961		retval = 1;
1962		wol->supported = 0;
1963	}
1964
1965	return retval;
1966}
1967
1968static void ixgbe_get_wol(struct net_device *netdev,
1969                          struct ethtool_wolinfo *wol)
1970{
1971	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1972
1973	wol->supported = WAKE_UCAST | WAKE_MCAST |
1974	                 WAKE_BCAST | WAKE_MAGIC;
1975	wol->wolopts = 0;
1976
1977	if (ixgbe_wol_exclusion(adapter, wol) ||
1978	    !device_can_wakeup(&adapter->pdev->dev))
1979		return;
1980
1981	if (adapter->wol & IXGBE_WUFC_EX)
1982		wol->wolopts |= WAKE_UCAST;
1983	if (adapter->wol & IXGBE_WUFC_MC)
1984		wol->wolopts |= WAKE_MCAST;
1985	if (adapter->wol & IXGBE_WUFC_BC)
1986		wol->wolopts |= WAKE_BCAST;
1987	if (adapter->wol & IXGBE_WUFC_MAG)
1988		wol->wolopts |= WAKE_MAGIC;
1989}
1990
1991static int ixgbe_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
1992{
1993	struct ixgbe_adapter *adapter = netdev_priv(netdev);
1994
1995	if (wol->wolopts & (WAKE_PHY | WAKE_ARP | WAKE_MAGICSECURE))
 
1996		return -EOPNOTSUPP;
1997
1998	if (ixgbe_wol_exclusion(adapter, wol))
1999		return wol->wolopts ? -EOPNOTSUPP : 0;
2000
2001	adapter->wol = 0;
2002
2003	if (wol->wolopts & WAKE_UCAST)
2004		adapter->wol |= IXGBE_WUFC_EX;
2005	if (wol->wolopts & WAKE_MCAST)
2006		adapter->wol |= IXGBE_WUFC_MC;
2007	if (wol->wolopts & WAKE_BCAST)
2008		adapter->wol |= IXGBE_WUFC_BC;
2009	if (wol->wolopts & WAKE_MAGIC)
2010		adapter->wol |= IXGBE_WUFC_MAG;
2011
2012	device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);
2013
2014	return 0;
2015}
2016
2017static int ixgbe_nway_reset(struct net_device *netdev)
2018{
2019	struct ixgbe_adapter *adapter = netdev_priv(netdev);
2020
2021	if (netif_running(netdev))
2022		ixgbe_reinit_locked(adapter);
2023
2024	return 0;
2025}
2026
2027static int ixgbe_set_phys_id(struct net_device *netdev,
2028			     enum ethtool_phys_id_state state)
2029{
2030	struct ixgbe_adapter *adapter = netdev_priv(netdev);
2031	struct ixgbe_hw *hw = &adapter->hw;
2032
 
 
 
2033	switch (state) {
2034	case ETHTOOL_ID_ACTIVE:
2035		adapter->led_reg = IXGBE_READ_REG(hw, IXGBE_LEDCTL);
2036		return 2;
2037
2038	case ETHTOOL_ID_ON:
2039		hw->mac.ops.led_on(hw, IXGBE_LED_ON);
2040		break;
2041
2042	case ETHTOOL_ID_OFF:
2043		hw->mac.ops.led_off(hw, IXGBE_LED_ON);
2044		break;
2045
2046	case ETHTOOL_ID_INACTIVE:
2047		/* Restore LED settings */
2048		IXGBE_WRITE_REG(&adapter->hw, IXGBE_LEDCTL, adapter->led_reg);
2049		break;
2050	}
2051
2052	return 0;
2053}
2054
2055static int ixgbe_get_coalesce(struct net_device *netdev,
2056                              struct ethtool_coalesce *ec)
 
 
2057{
2058	struct ixgbe_adapter *adapter = netdev_priv(netdev);
2059
2060	/* only valid if in constant ITR mode */
2061	if (adapter->rx_itr_setting <= 1)
2062		ec->rx_coalesce_usecs = adapter->rx_itr_setting;
2063	else
2064		ec->rx_coalesce_usecs = adapter->rx_itr_setting >> 2;
2065
2066	/* if in mixed tx/rx queues per vector mode, report only rx settings */
2067	if (adapter->q_vector[0]->tx.count && adapter->q_vector[0]->rx.count)
2068		return 0;
2069
2070	/* only valid if in constant ITR mode */
2071	if (adapter->tx_itr_setting <= 1)
2072		ec->tx_coalesce_usecs = adapter->tx_itr_setting;
2073	else
2074		ec->tx_coalesce_usecs = adapter->tx_itr_setting >> 2;
2075
2076	return 0;
2077}
2078
2079/*
2080 * this function must be called before setting the new value of
2081 * rx_itr_setting
2082 */
2083static bool ixgbe_update_rsc(struct ixgbe_adapter *adapter)
2084{
2085	struct net_device *netdev = adapter->netdev;
2086
2087	/* nothing to do if LRO or RSC are not enabled */
2088	if (!(adapter->flags2 & IXGBE_FLAG2_RSC_CAPABLE) ||
2089	    !(netdev->features & NETIF_F_LRO))
2090		return false;
2091
2092	/* check the feature flag value and enable RSC if necessary */
2093	if (adapter->rx_itr_setting == 1 ||
2094	    adapter->rx_itr_setting > IXGBE_MIN_RSC_ITR) {
2095		if (!(adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED)) {
2096			adapter->flags2 |= IXGBE_FLAG2_RSC_ENABLED;
2097			e_info(probe, "rx-usecs value high enough "
2098				      "to re-enable RSC\n");
2099			return true;
2100		}
2101	/* if interrupt rate is too high then disable RSC */
2102	} else if (adapter->flags2 & IXGBE_FLAG2_RSC_ENABLED) {
2103		adapter->flags2 &= ~IXGBE_FLAG2_RSC_ENABLED;
2104		e_info(probe, "rx-usecs set too low, disabling RSC\n");
2105		return true;
2106	}
2107	return false;
2108}
2109
2110static int ixgbe_set_coalesce(struct net_device *netdev,
2111                              struct ethtool_coalesce *ec)
 
 
2112{
2113	struct ixgbe_adapter *adapter = netdev_priv(netdev);
2114	struct ixgbe_q_vector *q_vector;
2115	int i;
2116	int num_vectors;
2117	u16 tx_itr_param, rx_itr_param;
2118	bool need_reset = false;
2119
2120	/* don't accept tx specific changes if we've got mixed RxTx vectors */
2121	if (adapter->q_vector[0]->tx.count && adapter->q_vector[0]->rx.count
2122	    && ec->tx_coalesce_usecs)
2123		return -EINVAL;
 
 
 
 
2124
2125	if ((ec->rx_coalesce_usecs > (IXGBE_MAX_EITR >> 2)) ||
2126	    (ec->tx_coalesce_usecs > (IXGBE_MAX_EITR >> 2)))
2127		return -EINVAL;
2128
2129	if (ec->rx_coalesce_usecs > 1)
2130		adapter->rx_itr_setting = ec->rx_coalesce_usecs << 2;
2131	else
2132		adapter->rx_itr_setting = ec->rx_coalesce_usecs;
2133
2134	if (adapter->rx_itr_setting == 1)
2135		rx_itr_param = IXGBE_20K_ITR;
2136	else
2137		rx_itr_param = adapter->rx_itr_setting;
2138
2139	if (ec->tx_coalesce_usecs > 1)
2140		adapter->tx_itr_setting = ec->tx_coalesce_usecs << 2;
2141	else
2142		adapter->tx_itr_setting = ec->tx_coalesce_usecs;
2143
2144	if (adapter->tx_itr_setting == 1)
2145		tx_itr_param = IXGBE_10K_ITR;
2146	else
2147		tx_itr_param = adapter->tx_itr_setting;
2148
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2149	/* check the old value and enable RSC if necessary */
2150	need_reset = ixgbe_update_rsc(adapter);
2151
2152	if (adapter->flags & IXGBE_FLAG_MSIX_ENABLED)
2153		num_vectors = adapter->num_msix_vectors - NON_Q_VECTORS;
2154	else
2155		num_vectors = 1;
2156
2157	for (i = 0; i < num_vectors; i++) {
2158		q_vector = adapter->q_vector[i];
2159		if (q_vector->tx.count && !q_vector->rx.count)
2160			/* tx only */
2161			q_vector->itr = tx_itr_param;
2162		else
2163			/* rx only or mixed */
2164			q_vector->itr = rx_itr_param;
2165		ixgbe_write_eitr(q_vector);
2166	}
2167
2168	/*
2169	 * do reset here at the end to make sure EITR==0 case is handled
2170	 * correctly w.r.t stopping tx, and changing TXDCTL.WTHRESH settings
2171	 * also locks in RSC enable/disable which requires reset
2172	 */
2173	if (need_reset)
2174		ixgbe_do_reset(netdev);
2175
2176	return 0;
2177}
2178
2179static int ixgbe_get_ethtool_fdir_entry(struct ixgbe_adapter *adapter,
2180					struct ethtool_rxnfc *cmd)
2181{
2182	union ixgbe_atr_input *mask = &adapter->fdir_mask;
2183	struct ethtool_rx_flow_spec *fsp =
2184		(struct ethtool_rx_flow_spec *)&cmd->fs;
2185	struct hlist_node *node, *node2;
2186	struct ixgbe_fdir_filter *rule = NULL;
2187
2188	/* report total rule count */
2189	cmd->data = (1024 << adapter->fdir_pballoc) - 2;
2190
2191	hlist_for_each_entry_safe(rule, node, node2,
2192				  &adapter->fdir_filter_list, fdir_node) {
2193		if (fsp->location <= rule->sw_idx)
2194			break;
2195	}
2196
2197	if (!rule || fsp->location != rule->sw_idx)
2198		return -EINVAL;
2199
2200	/* fill out the flow spec entry */
2201
2202	/* set flow type field */
2203	switch (rule->filter.formatted.flow_type) {
2204	case IXGBE_ATR_FLOW_TYPE_TCPV4:
2205		fsp->flow_type = TCP_V4_FLOW;
2206		break;
2207	case IXGBE_ATR_FLOW_TYPE_UDPV4:
2208		fsp->flow_type = UDP_V4_FLOW;
2209		break;
2210	case IXGBE_ATR_FLOW_TYPE_SCTPV4:
2211		fsp->flow_type = SCTP_V4_FLOW;
2212		break;
2213	case IXGBE_ATR_FLOW_TYPE_IPV4:
2214		fsp->flow_type = IP_USER_FLOW;
2215		fsp->h_u.usr_ip4_spec.ip_ver = ETH_RX_NFC_IP4;
2216		fsp->h_u.usr_ip4_spec.proto = 0;
2217		fsp->m_u.usr_ip4_spec.proto = 0;
2218		break;
2219	default:
2220		return -EINVAL;
2221	}
2222
2223	fsp->h_u.tcp_ip4_spec.psrc = rule->filter.formatted.src_port;
2224	fsp->m_u.tcp_ip4_spec.psrc = mask->formatted.src_port;
2225	fsp->h_u.tcp_ip4_spec.pdst = rule->filter.formatted.dst_port;
2226	fsp->m_u.tcp_ip4_spec.pdst = mask->formatted.dst_port;
2227	fsp->h_u.tcp_ip4_spec.ip4src = rule->filter.formatted.src_ip[0];
2228	fsp->m_u.tcp_ip4_spec.ip4src = mask->formatted.src_ip[0];
2229	fsp->h_u.tcp_ip4_spec.ip4dst = rule->filter.formatted.dst_ip[0];
2230	fsp->m_u.tcp_ip4_spec.ip4dst = mask->formatted.dst_ip[0];
2231	fsp->h_ext.vlan_tci = rule->filter.formatted.vlan_id;
2232	fsp->m_ext.vlan_tci = mask->formatted.vlan_id;
2233	fsp->h_ext.vlan_etype = rule->filter.formatted.flex_bytes;
2234	fsp->m_ext.vlan_etype = mask->formatted.flex_bytes;
2235	fsp->h_ext.data[1] = htonl(rule->filter.formatted.vm_pool);
2236	fsp->m_ext.data[1] = htonl(mask->formatted.vm_pool);
2237	fsp->flow_type |= FLOW_EXT;
2238
2239	/* record action */
2240	if (rule->action == IXGBE_FDIR_DROP_QUEUE)
2241		fsp->ring_cookie = RX_CLS_FLOW_DISC;
2242	else
2243		fsp->ring_cookie = rule->action;
2244
2245	return 0;
2246}
2247
2248static int ixgbe_get_ethtool_fdir_all(struct ixgbe_adapter *adapter,
2249				      struct ethtool_rxnfc *cmd,
2250				      u32 *rule_locs)
2251{
2252	struct hlist_node *node, *node2;
2253	struct ixgbe_fdir_filter *rule;
2254	int cnt = 0;
2255
2256	/* report total rule count */
2257	cmd->data = (1024 << adapter->fdir_pballoc) - 2;
2258
2259	hlist_for_each_entry_safe(rule, node, node2,
2260				  &adapter->fdir_filter_list, fdir_node) {
2261		if (cnt == cmd->rule_cnt)
2262			return -EMSGSIZE;
2263		rule_locs[cnt] = rule->sw_idx;
2264		cnt++;
2265	}
2266
2267	cmd->rule_cnt = cnt;
2268
2269	return 0;
2270}
2271
2272static int ixgbe_get_rss_hash_opts(struct ixgbe_adapter *adapter,
2273				   struct ethtool_rxnfc *cmd)
2274{
2275	cmd->data = 0;
2276
2277	/* if RSS is disabled then report no hashing */
2278	if (!(adapter->flags & IXGBE_FLAG_RSS_ENABLED))
2279		return 0;
2280
2281	/* Report default options for RSS on ixgbe */
2282	switch (cmd->flow_type) {
2283	case TCP_V4_FLOW:
2284		cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
 
2285	case UDP_V4_FLOW:
2286		if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV4_UDP)
2287			cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
 
2288	case SCTP_V4_FLOW:
2289	case AH_ESP_V4_FLOW:
2290	case AH_V4_FLOW:
2291	case ESP_V4_FLOW:
2292	case IPV4_FLOW:
2293		cmd->data |= RXH_IP_SRC | RXH_IP_DST;
2294		break;
2295	case TCP_V6_FLOW:
2296		cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
 
2297	case UDP_V6_FLOW:
2298		if (adapter->flags2 & IXGBE_FLAG2_RSS_FIELD_IPV6_UDP)
2299			cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
 
2300	case SCTP_V6_FLOW:
2301	case AH_ESP_V6_FLOW:
2302	case AH_V6_FLOW:
2303	case ESP_V6_FLOW:
2304	case IPV6_FLOW:
2305		cmd->data |= RXH_IP_SRC | RXH_IP_DST;
2306		break;
2307	default:
2308		return -EINVAL;
2309	}
2310
2311	return 0;
2312}
2313
 
 
 
 
 
 
 
 
2314static int ixgbe_get_rxnfc(struct net_device *dev, struct ethtool_rxnfc *cmd,
2315			   u32 *rule_locs)
2316{
2317	struct ixgbe_adapter *adapter = netdev_priv(dev);
2318	int ret = -EOPNOTSUPP;
2319
2320	switch (cmd->cmd) {
2321	case ETHTOOL_GRXRINGS:
2322		cmd->data = adapter->num_rx_queues;
 
2323		ret = 0;
2324		break;
2325	case ETHTOOL_GRXCLSRLCNT:
2326		cmd->rule_cnt = adapter->fdir_filter_count;
2327		ret = 0;
2328		break;
2329	case ETHTOOL_GRXCLSRULE:
2330		ret = ixgbe_get_ethtool_fdir_entry(adapter, cmd);
2331		break;
2332	case ETHTOOL_GRXCLSRLALL:
2333		ret = ixgbe_get_ethtool_fdir_all(adapter, cmd, rule_locs);
2334		break;
2335	case ETHTOOL_GRXFH:
2336		ret = ixgbe_get_rss_hash_opts(adapter, cmd);
2337		break;
2338	default:
2339		break;
2340	}
2341
2342	return ret;
2343}
2344
2345static int ixgbe_update_ethtool_fdir_entry(struct ixgbe_adapter *adapter,
2346					   struct ixgbe_fdir_filter *input,
2347					   u16 sw_idx)
2348{
2349	struct ixgbe_hw *hw = &adapter->hw;
2350	struct hlist_node *node, *node2, *parent;
2351	struct ixgbe_fdir_filter *rule;
2352	int err = -EINVAL;
2353
2354	parent = NULL;
2355	rule = NULL;
2356
2357	hlist_for_each_entry_safe(rule, node, node2,
2358				  &adapter->fdir_filter_list, fdir_node) {
2359		/* hash found, or no matching entry */
2360		if (rule->sw_idx >= sw_idx)
2361			break;
2362		parent = node;
2363	}
2364
2365	/* if there is an old rule occupying our place remove it */
2366	if (rule && (rule->sw_idx == sw_idx)) {
2367		if (!input || (rule->filter.formatted.bkt_hash !=
2368			       input->filter.formatted.bkt_hash)) {
2369			err = ixgbe_fdir_erase_perfect_filter_82599(hw,
2370								&rule->filter,
2371								sw_idx);
2372		}
2373
2374		hlist_del(&rule->fdir_node);
2375		kfree(rule);
2376		adapter->fdir_filter_count--;
2377	}
2378
2379	/*
2380	 * If no input this was a delete, err should be 0 if a rule was
2381	 * successfully found and removed from the list else -EINVAL
2382	 */
2383	if (!input)
2384		return err;
2385
2386	/* initialize node and set software index */
2387	INIT_HLIST_NODE(&input->fdir_node);
2388
2389	/* add filter to the list */
2390	if (parent)
2391		hlist_add_after(parent, &input->fdir_node);
2392	else
2393		hlist_add_head(&input->fdir_node,
2394			       &adapter->fdir_filter_list);
2395
2396	/* update counts */
2397	adapter->fdir_filter_count++;
2398
2399	return 0;
2400}
2401
2402static int ixgbe_flowspec_to_flow_type(struct ethtool_rx_flow_spec *fsp,
2403				       u8 *flow_type)
2404{
2405	switch (fsp->flow_type & ~FLOW_EXT) {
2406	case TCP_V4_FLOW:
2407		*flow_type = IXGBE_ATR_FLOW_TYPE_TCPV4;
2408		break;
2409	case UDP_V4_FLOW:
2410		*flow_type = IXGBE_ATR_FLOW_TYPE_UDPV4;
2411		break;
2412	case SCTP_V4_FLOW:
2413		*flow_type = IXGBE_ATR_FLOW_TYPE_SCTPV4;
2414		break;
2415	case IP_USER_FLOW:
2416		switch (fsp->h_u.usr_ip4_spec.proto) {
2417		case IPPROTO_TCP:
2418			*flow_type = IXGBE_ATR_FLOW_TYPE_TCPV4;
2419			break;
2420		case IPPROTO_UDP:
2421			*flow_type = IXGBE_ATR_FLOW_TYPE_UDPV4;
2422			break;
2423		case IPPROTO_SCTP:
2424			*flow_type = IXGBE_ATR_FLOW_TYPE_SCTPV4;
2425			break;
2426		case 0:
2427			if (!fsp->m_u.usr_ip4_spec.proto) {
2428				*flow_type = IXGBE_ATR_FLOW_TYPE_IPV4;
2429				break;
2430			}
 
2431		default:
2432			return 0;
2433		}
2434		break;
2435	default:
2436		return 0;
2437	}
2438
2439	return 1;
2440}
2441
2442static int ixgbe_add_ethtool_fdir_entry(struct ixgbe_adapter *adapter,
2443					struct ethtool_rxnfc *cmd)
2444{
2445	struct ethtool_rx_flow_spec *fsp =
2446		(struct ethtool_rx_flow_spec *)&cmd->fs;
2447	struct ixgbe_hw *hw = &adapter->hw;
2448	struct ixgbe_fdir_filter *input;
2449	union ixgbe_atr_input mask;
 
2450	int err;
2451
2452	if (!(adapter->flags & IXGBE_FLAG_FDIR_PERFECT_CAPABLE))
2453		return -EOPNOTSUPP;
2454
2455	/*
2456	 * Don't allow programming if the action is a queue greater than
2457	 * the number of online Rx queues.
2458	 */
2459	if ((fsp->ring_cookie != RX_CLS_FLOW_DISC) &&
2460	    (fsp->ring_cookie >= adapter->num_rx_queues))
2461		return -EINVAL;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2462
2463	/* Don't allow indexes to exist outside of available space */
2464	if (fsp->location >= ((1024 << adapter->fdir_pballoc) - 2)) {
2465		e_err(drv, "Location out of range\n");
2466		return -EINVAL;
2467	}
2468
2469	input = kzalloc(sizeof(*input), GFP_ATOMIC);
2470	if (!input)
2471		return -ENOMEM;
2472
2473	memset(&mask, 0, sizeof(union ixgbe_atr_input));
2474
2475	/* set SW index */
2476	input->sw_idx = fsp->location;
2477
2478	/* record flow type */
2479	if (!ixgbe_flowspec_to_flow_type(fsp,
2480					 &input->filter.formatted.flow_type)) {
2481		e_err(drv, "Unrecognized flow type\n");
2482		goto err_out;
2483	}
2484
2485	mask.formatted.flow_type = IXGBE_ATR_L4TYPE_IPV6_MASK |
2486				   IXGBE_ATR_L4TYPE_MASK;
2487
2488	if (input->filter.formatted.flow_type == IXGBE_ATR_FLOW_TYPE_IPV4)
2489		mask.formatted.flow_type &= IXGBE_ATR_L4TYPE_IPV6_MASK;
2490
2491	/* Copy input into formatted structures */
2492	input->filter.formatted.src_ip[0] = fsp->h_u.tcp_ip4_spec.ip4src;
2493	mask.formatted.src_ip[0] = fsp->m_u.tcp_ip4_spec.ip4src;
2494	input->filter.formatted.dst_ip[0] = fsp->h_u.tcp_ip4_spec.ip4dst;
2495	mask.formatted.dst_ip[0] = fsp->m_u.tcp_ip4_spec.ip4dst;
2496	input->filter.formatted.src_port = fsp->h_u.tcp_ip4_spec.psrc;
2497	mask.formatted.src_port = fsp->m_u.tcp_ip4_spec.psrc;
2498	input->filter.formatted.dst_port = fsp->h_u.tcp_ip4_spec.pdst;
2499	mask.formatted.dst_port = fsp->m_u.tcp_ip4_spec.pdst;
2500
2501	if (fsp->flow_type & FLOW_EXT) {
2502		input->filter.formatted.vm_pool =
2503				(unsigned char)ntohl(fsp->h_ext.data[1]);
2504		mask.formatted.vm_pool =
2505				(unsigned char)ntohl(fsp->m_ext.data[1]);
2506		input->filter.formatted.vlan_id = fsp->h_ext.vlan_tci;
2507		mask.formatted.vlan_id = fsp->m_ext.vlan_tci;
2508		input->filter.formatted.flex_bytes =
2509						fsp->h_ext.vlan_etype;
2510		mask.formatted.flex_bytes = fsp->m_ext.vlan_etype;
2511	}
2512
2513	/* determine if we need to drop or route the packet */
2514	if (fsp->ring_cookie == RX_CLS_FLOW_DISC)
2515		input->action = IXGBE_FDIR_DROP_QUEUE;
2516	else
2517		input->action = fsp->ring_cookie;
2518
2519	spin_lock(&adapter->fdir_perfect_lock);
2520
2521	if (hlist_empty(&adapter->fdir_filter_list)) {
2522		/* save mask and program input mask into HW */
2523		memcpy(&adapter->fdir_mask, &mask, sizeof(mask));
2524		err = ixgbe_fdir_set_input_mask_82599(hw, &mask);
2525		if (err) {
2526			e_err(drv, "Error writing mask\n");
2527			goto err_out_w_lock;
2528		}
2529	} else if (memcmp(&adapter->fdir_mask, &mask, sizeof(mask))) {
2530		e_err(drv, "Only one mask supported per port\n");
2531		goto err_out_w_lock;
2532	}
2533
2534	/* apply mask and compute/store hash */
2535	ixgbe_atr_compute_perfect_hash_82599(&input->filter, &mask);
2536
2537	/* program filters to filter memory */
2538	err = ixgbe_fdir_write_perfect_filter_82599(hw,
2539				&input->filter, input->sw_idx,
2540				(input->action == IXGBE_FDIR_DROP_QUEUE) ?
2541				IXGBE_FDIR_DROP_QUEUE :
2542				adapter->rx_ring[input->action]->reg_idx);
2543	if (err)
2544		goto err_out_w_lock;
2545
2546	ixgbe_update_ethtool_fdir_entry(adapter, input, input->sw_idx);
2547
2548	spin_unlock(&adapter->fdir_perfect_lock);
2549
2550	return err;
2551err_out_w_lock:
2552	spin_unlock(&adapter->fdir_perfect_lock);
2553err_out:
2554	kfree(input);
2555	return -EINVAL;
2556}
2557
2558static int ixgbe_del_ethtool_fdir_entry(struct ixgbe_adapter *adapter,
2559					struct ethtool_rxnfc *cmd)
2560{
2561	struct ethtool_rx_flow_spec *fsp =
2562		(struct ethtool_rx_flow_spec *)&cmd->fs;
2563	int err;
2564
2565	spin_lock(&adapter->fdir_perfect_lock);
2566	err = ixgbe_update_ethtool_fdir_entry(adapter, NULL, fsp->location);
2567	spin_unlock(&adapter->fdir_perfect_lock);
2568
2569	return err;
2570}
2571
2572#define UDP_RSS_FLAGS (IXGBE_FLAG2_RSS_FIELD_IPV4_UDP | \
2573		       IXGBE_FLAG2_RSS_FIELD_IPV6_UDP)
2574static int ixgbe_set_rss_hash_opt(struct ixgbe_adapter *adapter,
2575				  struct ethtool_rxnfc *nfc)
2576{
2577	u32 flags2 = adapter->flags2;
2578
2579	/*
2580	 * RSS does not support anything other than hashing
2581	 * to queues on src and dst IPs and ports
2582	 */
2583	if (nfc->data & ~(RXH_IP_SRC | RXH_IP_DST |
2584			  RXH_L4_B_0_1 | RXH_L4_B_2_3))
2585		return -EINVAL;
2586
2587	switch (nfc->flow_type) {
2588	case TCP_V4_FLOW:
2589	case TCP_V6_FLOW:
2590		if (!(nfc->data & RXH_IP_SRC) ||
2591		    !(nfc->data & RXH_IP_DST) ||
2592		    !(nfc->data & RXH_L4_B_0_1) ||
2593		    !(nfc->data & RXH_L4_B_2_3))
2594			return -EINVAL;
2595		break;
2596	case UDP_V4_FLOW:
2597		if (!(nfc->data & RXH_IP_SRC) ||
2598		    !(nfc->data & RXH_IP_DST))
2599			return -EINVAL;
2600		switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
2601		case 0:
2602			flags2 &= ~IXGBE_FLAG2_RSS_FIELD_IPV4_UDP;
2603			break;
2604		case (RXH_L4_B_0_1 | RXH_L4_B_2_3):
2605			flags2 |= IXGBE_FLAG2_RSS_FIELD_IPV4_UDP;
2606			break;
2607		default:
2608			return -EINVAL;
2609		}
2610		break;
2611	case UDP_V6_FLOW:
2612		if (!(nfc->data & RXH_IP_SRC) ||
2613		    !(nfc->data & RXH_IP_DST))
2614			return -EINVAL;
2615		switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
2616		case 0:
2617			flags2 &= ~IXGBE_FLAG2_RSS_FIELD_IPV6_UDP;
2618			break;
2619		case (RXH_L4_B_0_1 | RXH_L4_B_2_3):
2620			flags2 |= IXGBE_FLAG2_RSS_FIELD_IPV6_UDP;
2621			break;
2622		default:
2623			return -EINVAL;
2624		}
2625		break;
2626	case AH_ESP_V4_FLOW:
2627	case AH_V4_FLOW:
2628	case ESP_V4_FLOW:
2629	case SCTP_V4_FLOW:
2630	case AH_ESP_V6_FLOW:
2631	case AH_V6_FLOW:
2632	case ESP_V6_FLOW:
2633	case SCTP_V6_FLOW:
2634		if (!(nfc->data & RXH_IP_SRC) ||
2635		    !(nfc->data & RXH_IP_DST) ||
2636		    (nfc->data & RXH_L4_B_0_1) ||
2637		    (nfc->data & RXH_L4_B_2_3))
2638			return -EINVAL;
2639		break;
2640	default:
2641		return -EINVAL;
2642	}
2643
2644	/* if we changed something we need to update flags */
2645	if (flags2 != adapter->flags2) {
2646		struct ixgbe_hw *hw = &adapter->hw;
2647		u32 mrqc = IXGBE_READ_REG(hw, IXGBE_MRQC);
 
 
 
 
 
 
 
2648
2649		if ((flags2 & UDP_RSS_FLAGS) &&
2650		    !(adapter->flags2 & UDP_RSS_FLAGS))
2651			e_warn(drv, "enabling UDP RSS: fragmented packets"
2652			       " may arrive out of order to the stack above\n");
2653
2654		adapter->flags2 = flags2;
2655
2656		/* Perform hash on these packet types */
2657		mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4
2658		      | IXGBE_MRQC_RSS_FIELD_IPV4_TCP
2659		      | IXGBE_MRQC_RSS_FIELD_IPV6
2660		      | IXGBE_MRQC_RSS_FIELD_IPV6_TCP;
2661
2662		mrqc &= ~(IXGBE_MRQC_RSS_FIELD_IPV4_UDP |
2663			  IXGBE_MRQC_RSS_FIELD_IPV6_UDP);
2664
2665		if (flags2 & IXGBE_FLAG2_RSS_FIELD_IPV4_UDP)
2666			mrqc |= IXGBE_MRQC_RSS_FIELD_IPV4_UDP;
2667
2668		if (flags2 & IXGBE_FLAG2_RSS_FIELD_IPV6_UDP)
2669			mrqc |= IXGBE_MRQC_RSS_FIELD_IPV6_UDP;
2670
2671		IXGBE_WRITE_REG(hw, IXGBE_MRQC, mrqc);
 
 
 
 
2672	}
2673
2674	return 0;
2675}
2676
2677static int ixgbe_set_rxnfc(struct net_device *dev, struct ethtool_rxnfc *cmd)
2678{
2679	struct ixgbe_adapter *adapter = netdev_priv(dev);
2680	int ret = -EOPNOTSUPP;
2681
2682	switch (cmd->cmd) {
2683	case ETHTOOL_SRXCLSRLINS:
2684		ret = ixgbe_add_ethtool_fdir_entry(adapter, cmd);
2685		break;
2686	case ETHTOOL_SRXCLSRLDEL:
2687		ret = ixgbe_del_ethtool_fdir_entry(adapter, cmd);
2688		break;
2689	case ETHTOOL_SRXFH:
2690		ret = ixgbe_set_rss_hash_opt(adapter, cmd);
2691		break;
2692	default:
2693		break;
2694	}
2695
2696	return ret;
2697}
2698
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2699static int ixgbe_get_ts_info(struct net_device *dev,
2700			     struct ethtool_ts_info *info)
2701{
2702	struct ixgbe_adapter *adapter = netdev_priv(dev);
2703
 
 
 
2704	switch (adapter->hw.mac.type) {
2705#ifdef CONFIG_IXGBE_PTP
 
 
 
 
2706	case ixgbe_mac_X540:
2707	case ixgbe_mac_82599EB:
2708		info->so_timestamping =
2709			SOF_TIMESTAMPING_TX_HARDWARE |
2710			SOF_TIMESTAMPING_RX_HARDWARE |
2711			SOF_TIMESTAMPING_RAW_HARDWARE;
 
 
 
 
 
 
 
 
 
 
 
 
2712
2713		if (adapter->ptp_clock)
2714			info->phc_index = ptp_clock_index(adapter->ptp_clock);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2715		else
2716			info->phc_index = -1;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2717
2718		info->tx_types =
2719			(1 << HWTSTAMP_TX_OFF) |
2720			(1 << HWTSTAMP_TX_ON);
2721
2722		info->rx_filters =
2723			(1 << HWTSTAMP_FILTER_NONE) |
2724			(1 << HWTSTAMP_FILTER_PTP_V1_L4_SYNC) |
2725			(1 << HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ) |
2726			(1 << HWTSTAMP_FILTER_PTP_V2_SYNC) |
2727			(1 << HWTSTAMP_FILTER_PTP_V2_DELAY_REQ) |
2728			(1 << HWTSTAMP_FILTER_PTP_V2_EVENT) |
2729			(1 << HWTSTAMP_FILTER_SOME);
2730		break;
2731#endif /* CONFIG_IXGBE_PTP */
2732	default:
2733		return ethtool_op_get_ts_info(dev, info);
2734		break;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2735	}
 
2736	return 0;
2737}
2738
2739static const struct ethtool_ops ixgbe_ethtool_ops = {
2740	.get_settings           = ixgbe_get_settings,
2741	.set_settings           = ixgbe_set_settings,
2742	.get_drvinfo            = ixgbe_get_drvinfo,
2743	.get_regs_len           = ixgbe_get_regs_len,
2744	.get_regs               = ixgbe_get_regs,
2745	.get_wol                = ixgbe_get_wol,
2746	.set_wol                = ixgbe_set_wol,
2747	.nway_reset             = ixgbe_nway_reset,
2748	.get_link               = ethtool_op_get_link,
2749	.get_eeprom_len         = ixgbe_get_eeprom_len,
2750	.get_eeprom             = ixgbe_get_eeprom,
2751	.set_eeprom             = ixgbe_set_eeprom,
2752	.get_ringparam          = ixgbe_get_ringparam,
2753	.set_ringparam          = ixgbe_set_ringparam,
 
2754	.get_pauseparam         = ixgbe_get_pauseparam,
2755	.set_pauseparam         = ixgbe_set_pauseparam,
2756	.get_msglevel           = ixgbe_get_msglevel,
2757	.set_msglevel           = ixgbe_set_msglevel,
2758	.self_test              = ixgbe_diag_test,
2759	.get_strings            = ixgbe_get_strings,
2760	.set_phys_id            = ixgbe_set_phys_id,
2761	.get_sset_count         = ixgbe_get_sset_count,
2762	.get_ethtool_stats      = ixgbe_get_ethtool_stats,
2763	.get_coalesce           = ixgbe_get_coalesce,
2764	.set_coalesce           = ixgbe_set_coalesce,
2765	.get_rxnfc		= ixgbe_get_rxnfc,
2766	.set_rxnfc		= ixgbe_set_rxnfc,
 
 
 
 
 
 
 
 
 
 
2767	.get_ts_info		= ixgbe_get_ts_info,
 
 
 
 
2768};
2769
2770void ixgbe_set_ethtool_ops(struct net_device *netdev)
2771{
2772	SET_ETHTOOL_OPS(netdev, &ixgbe_ethtool_ops);
2773}