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