xref: /linux/drivers/net/ethernet/intel/igc/igc_ethtool.c (revision 8664240e303827de2d40f38fc397d1912309359c)
1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (c)  2018 Intel Corporation */
3 
4 /* ethtool support for igc */
5 #include <linux/if_vlan.h>
6 #include <linux/pm_runtime.h>
7 
8 #include "igc.h"
9 #include "igc_diag.h"
10 
11 /* forward declaration */
12 struct igc_stats {
13 	char stat_string[ETH_GSTRING_LEN];
14 	int sizeof_stat;
15 	int stat_offset;
16 };
17 
18 #define IGC_STAT(_name, _stat) { \
19 	.stat_string = _name, \
20 	.sizeof_stat = sizeof_field(struct igc_adapter, _stat), \
21 	.stat_offset = offsetof(struct igc_adapter, _stat) \
22 }
23 
24 static const struct igc_stats igc_gstrings_stats[] = {
25 	IGC_STAT("rx_packets", stats.gprc),
26 	IGC_STAT("tx_packets", stats.gptc),
27 	IGC_STAT("rx_bytes", stats.gorc),
28 	IGC_STAT("tx_bytes", stats.gotc),
29 	IGC_STAT("rx_broadcast", stats.bprc),
30 	IGC_STAT("tx_broadcast", stats.bptc),
31 	IGC_STAT("rx_multicast", stats.mprc),
32 	IGC_STAT("tx_multicast", stats.mptc),
33 	IGC_STAT("multicast", stats.mprc),
34 	IGC_STAT("collisions", stats.colc),
35 	IGC_STAT("rx_crc_errors", stats.crcerrs),
36 	IGC_STAT("rx_no_buffer_count", stats.rnbc),
37 	IGC_STAT("rx_missed_errors", stats.mpc),
38 	IGC_STAT("tx_aborted_errors", stats.ecol),
39 	IGC_STAT("tx_carrier_errors", stats.tncrs),
40 	IGC_STAT("tx_window_errors", stats.latecol),
41 	IGC_STAT("tx_abort_late_coll", stats.latecol),
42 	IGC_STAT("tx_deferred_ok", stats.dc),
43 	IGC_STAT("tx_single_coll_ok", stats.scc),
44 	IGC_STAT("tx_multi_coll_ok", stats.mcc),
45 	IGC_STAT("tx_timeout_count", tx_timeout_count),
46 	IGC_STAT("rx_long_length_errors", stats.roc),
47 	IGC_STAT("rx_short_length_errors", stats.ruc),
48 	IGC_STAT("rx_align_errors", stats.algnerrc),
49 	IGC_STAT("tx_tcp_seg_good", stats.tsctc),
50 	IGC_STAT("tx_tcp_seg_failed", stats.tsctfc),
51 	IGC_STAT("rx_flow_control_xon", stats.xonrxc),
52 	IGC_STAT("rx_flow_control_xoff", stats.xoffrxc),
53 	IGC_STAT("tx_flow_control_xon", stats.xontxc),
54 	IGC_STAT("tx_flow_control_xoff", stats.xofftxc),
55 	IGC_STAT("rx_long_byte_count", stats.gorc),
56 	IGC_STAT("tx_dma_out_of_sync", stats.doosync),
57 	IGC_STAT("tx_smbus", stats.mgptc),
58 	IGC_STAT("rx_smbus", stats.mgprc),
59 	IGC_STAT("dropped_smbus", stats.mgpdc),
60 	IGC_STAT("os2bmc_rx_by_bmc", stats.o2bgptc),
61 	IGC_STAT("os2bmc_tx_by_bmc", stats.b2ospc),
62 	IGC_STAT("os2bmc_tx_by_host", stats.o2bspc),
63 	IGC_STAT("os2bmc_rx_by_host", stats.b2ogprc),
64 	IGC_STAT("tx_hwtstamp_timeouts", tx_hwtstamp_timeouts),
65 	IGC_STAT("tx_hwtstamp_skipped", tx_hwtstamp_skipped),
66 	IGC_STAT("rx_hwtstamp_cleared", rx_hwtstamp_cleared),
67 };
68 
69 #define IGC_NETDEV_STAT(_net_stat) { \
70 	.stat_string = __stringify(_net_stat), \
71 	.sizeof_stat = sizeof_field(struct rtnl_link_stats64, _net_stat), \
72 	.stat_offset = offsetof(struct rtnl_link_stats64, _net_stat) \
73 }
74 
75 static const struct igc_stats igc_gstrings_net_stats[] = {
76 	IGC_NETDEV_STAT(rx_errors),
77 	IGC_NETDEV_STAT(tx_errors),
78 	IGC_NETDEV_STAT(tx_dropped),
79 	IGC_NETDEV_STAT(rx_length_errors),
80 	IGC_NETDEV_STAT(rx_over_errors),
81 	IGC_NETDEV_STAT(rx_frame_errors),
82 	IGC_NETDEV_STAT(rx_fifo_errors),
83 	IGC_NETDEV_STAT(tx_fifo_errors),
84 	IGC_NETDEV_STAT(tx_heartbeat_errors)
85 };
86 
87 enum igc_diagnostics_results {
88 	TEST_REG = 0,
89 	TEST_EEP,
90 	TEST_IRQ,
91 	TEST_LOOP,
92 	TEST_LINK
93 };
94 
95 static const char igc_gstrings_test[][ETH_GSTRING_LEN] = {
96 	[TEST_REG]  = "Register test  (offline)",
97 	[TEST_EEP]  = "Eeprom test    (offline)",
98 	[TEST_IRQ]  = "Interrupt test (offline)",
99 	[TEST_LOOP] = "Loopback test  (offline)",
100 	[TEST_LINK] = "Link test   (on/offline)"
101 };
102 
103 #define IGC_TEST_LEN (sizeof(igc_gstrings_test) / ETH_GSTRING_LEN)
104 
105 #define IGC_GLOBAL_STATS_LEN	\
106 	(sizeof(igc_gstrings_stats) / sizeof(struct igc_stats))
107 #define IGC_NETDEV_STATS_LEN	\
108 	(sizeof(igc_gstrings_net_stats) / sizeof(struct igc_stats))
109 #define IGC_RX_QUEUE_STATS_LEN \
110 	(sizeof(struct igc_rx_queue_stats) / sizeof(u64))
111 #define IGC_TX_QUEUE_STATS_LEN 3 /* packets, bytes, restart_queue */
112 #define IGC_QUEUE_STATS_LEN \
113 	((((struct igc_adapter *)netdev_priv(netdev))->num_rx_queues * \
114 	  IGC_RX_QUEUE_STATS_LEN) + \
115 	 (((struct igc_adapter *)netdev_priv(netdev))->num_tx_queues * \
116 	  IGC_TX_QUEUE_STATS_LEN))
117 #define IGC_STATS_LEN \
118 	(IGC_GLOBAL_STATS_LEN + IGC_NETDEV_STATS_LEN + IGC_QUEUE_STATS_LEN)
119 
120 static const char igc_priv_flags_strings[][ETH_GSTRING_LEN] = {
121 #define IGC_PRIV_FLAGS_LEGACY_RX	BIT(0)
122 	"legacy-rx",
123 };
124 
125 #define IGC_PRIV_FLAGS_STR_LEN ARRAY_SIZE(igc_priv_flags_strings)
126 
127 static void igc_ethtool_get_drvinfo(struct net_device *netdev,
128 				    struct ethtool_drvinfo *drvinfo)
129 {
130 	struct igc_adapter *adapter = netdev_priv(netdev);
131 
132 	strlcpy(drvinfo->driver,  igc_driver_name, sizeof(drvinfo->driver));
133 
134 	/* add fw_version here */
135 	strlcpy(drvinfo->bus_info, pci_name(adapter->pdev),
136 		sizeof(drvinfo->bus_info));
137 
138 	drvinfo->n_priv_flags = IGC_PRIV_FLAGS_STR_LEN;
139 }
140 
141 static int igc_ethtool_get_regs_len(struct net_device *netdev)
142 {
143 	return IGC_REGS_LEN * sizeof(u32);
144 }
145 
146 static void igc_ethtool_get_regs(struct net_device *netdev,
147 				 struct ethtool_regs *regs, void *p)
148 {
149 	struct igc_adapter *adapter = netdev_priv(netdev);
150 	struct igc_hw *hw = &adapter->hw;
151 	u32 *regs_buff = p;
152 	u8 i;
153 
154 	memset(p, 0, IGC_REGS_LEN * sizeof(u32));
155 
156 	regs->version = (2u << 24) | (hw->revision_id << 16) | hw->device_id;
157 
158 	/* General Registers */
159 	regs_buff[0] = rd32(IGC_CTRL);
160 	regs_buff[1] = rd32(IGC_STATUS);
161 	regs_buff[2] = rd32(IGC_CTRL_EXT);
162 	regs_buff[3] = rd32(IGC_MDIC);
163 	regs_buff[4] = rd32(IGC_CONNSW);
164 
165 	/* NVM Register */
166 	regs_buff[5] = rd32(IGC_EECD);
167 
168 	/* Interrupt */
169 	/* Reading EICS for EICR because they read the
170 	 * same but EICS does not clear on read
171 	 */
172 	regs_buff[6] = rd32(IGC_EICS);
173 	regs_buff[7] = rd32(IGC_EICS);
174 	regs_buff[8] = rd32(IGC_EIMS);
175 	regs_buff[9] = rd32(IGC_EIMC);
176 	regs_buff[10] = rd32(IGC_EIAC);
177 	regs_buff[11] = rd32(IGC_EIAM);
178 	/* Reading ICS for ICR because they read the
179 	 * same but ICS does not clear on read
180 	 */
181 	regs_buff[12] = rd32(IGC_ICS);
182 	regs_buff[13] = rd32(IGC_ICS);
183 	regs_buff[14] = rd32(IGC_IMS);
184 	regs_buff[15] = rd32(IGC_IMC);
185 	regs_buff[16] = rd32(IGC_IAC);
186 	regs_buff[17] = rd32(IGC_IAM);
187 
188 	/* Flow Control */
189 	regs_buff[18] = rd32(IGC_FCAL);
190 	regs_buff[19] = rd32(IGC_FCAH);
191 	regs_buff[20] = rd32(IGC_FCTTV);
192 	regs_buff[21] = rd32(IGC_FCRTL);
193 	regs_buff[22] = rd32(IGC_FCRTH);
194 	regs_buff[23] = rd32(IGC_FCRTV);
195 
196 	/* Receive */
197 	regs_buff[24] = rd32(IGC_RCTL);
198 	regs_buff[25] = rd32(IGC_RXCSUM);
199 	regs_buff[26] = rd32(IGC_RLPML);
200 	regs_buff[27] = rd32(IGC_RFCTL);
201 
202 	/* Transmit */
203 	regs_buff[28] = rd32(IGC_TCTL);
204 	regs_buff[29] = rd32(IGC_TIPG);
205 
206 	/* Wake Up */
207 
208 	/* MAC */
209 
210 	/* Statistics */
211 	regs_buff[30] = adapter->stats.crcerrs;
212 	regs_buff[31] = adapter->stats.algnerrc;
213 	regs_buff[32] = adapter->stats.symerrs;
214 	regs_buff[33] = adapter->stats.rxerrc;
215 	regs_buff[34] = adapter->stats.mpc;
216 	regs_buff[35] = adapter->stats.scc;
217 	regs_buff[36] = adapter->stats.ecol;
218 	regs_buff[37] = adapter->stats.mcc;
219 	regs_buff[38] = adapter->stats.latecol;
220 	regs_buff[39] = adapter->stats.colc;
221 	regs_buff[40] = adapter->stats.dc;
222 	regs_buff[41] = adapter->stats.tncrs;
223 	regs_buff[42] = adapter->stats.sec;
224 	regs_buff[43] = adapter->stats.htdpmc;
225 	regs_buff[44] = adapter->stats.rlec;
226 	regs_buff[45] = adapter->stats.xonrxc;
227 	regs_buff[46] = adapter->stats.xontxc;
228 	regs_buff[47] = adapter->stats.xoffrxc;
229 	regs_buff[48] = adapter->stats.xofftxc;
230 	regs_buff[49] = adapter->stats.fcruc;
231 	regs_buff[50] = adapter->stats.prc64;
232 	regs_buff[51] = adapter->stats.prc127;
233 	regs_buff[52] = adapter->stats.prc255;
234 	regs_buff[53] = adapter->stats.prc511;
235 	regs_buff[54] = adapter->stats.prc1023;
236 	regs_buff[55] = adapter->stats.prc1522;
237 	regs_buff[56] = adapter->stats.gprc;
238 	regs_buff[57] = adapter->stats.bprc;
239 	regs_buff[58] = adapter->stats.mprc;
240 	regs_buff[59] = adapter->stats.gptc;
241 	regs_buff[60] = adapter->stats.gorc;
242 	regs_buff[61] = adapter->stats.gotc;
243 	regs_buff[62] = adapter->stats.rnbc;
244 	regs_buff[63] = adapter->stats.ruc;
245 	regs_buff[64] = adapter->stats.rfc;
246 	regs_buff[65] = adapter->stats.roc;
247 	regs_buff[66] = adapter->stats.rjc;
248 	regs_buff[67] = adapter->stats.mgprc;
249 	regs_buff[68] = adapter->stats.mgpdc;
250 	regs_buff[69] = adapter->stats.mgptc;
251 	regs_buff[70] = adapter->stats.tor;
252 	regs_buff[71] = adapter->stats.tot;
253 	regs_buff[72] = adapter->stats.tpr;
254 	regs_buff[73] = adapter->stats.tpt;
255 	regs_buff[74] = adapter->stats.ptc64;
256 	regs_buff[75] = adapter->stats.ptc127;
257 	regs_buff[76] = adapter->stats.ptc255;
258 	regs_buff[77] = adapter->stats.ptc511;
259 	regs_buff[78] = adapter->stats.ptc1023;
260 	regs_buff[79] = adapter->stats.ptc1522;
261 	regs_buff[80] = adapter->stats.mptc;
262 	regs_buff[81] = adapter->stats.bptc;
263 	regs_buff[82] = adapter->stats.tsctc;
264 	regs_buff[83] = adapter->stats.iac;
265 	regs_buff[84] = adapter->stats.rpthc;
266 	regs_buff[85] = adapter->stats.hgptc;
267 	regs_buff[86] = adapter->stats.hgorc;
268 	regs_buff[87] = adapter->stats.hgotc;
269 	regs_buff[88] = adapter->stats.lenerrs;
270 	regs_buff[89] = adapter->stats.scvpc;
271 	regs_buff[90] = adapter->stats.hrmpc;
272 
273 	for (i = 0; i < 4; i++)
274 		regs_buff[91 + i] = rd32(IGC_SRRCTL(i));
275 	for (i = 0; i < 4; i++)
276 		regs_buff[95 + i] = rd32(IGC_PSRTYPE(i));
277 	for (i = 0; i < 4; i++)
278 		regs_buff[99 + i] = rd32(IGC_RDBAL(i));
279 	for (i = 0; i < 4; i++)
280 		regs_buff[103 + i] = rd32(IGC_RDBAH(i));
281 	for (i = 0; i < 4; i++)
282 		regs_buff[107 + i] = rd32(IGC_RDLEN(i));
283 	for (i = 0; i < 4; i++)
284 		regs_buff[111 + i] = rd32(IGC_RDH(i));
285 	for (i = 0; i < 4; i++)
286 		regs_buff[115 + i] = rd32(IGC_RDT(i));
287 	for (i = 0; i < 4; i++)
288 		regs_buff[119 + i] = rd32(IGC_RXDCTL(i));
289 
290 	for (i = 0; i < 10; i++)
291 		regs_buff[123 + i] = rd32(IGC_EITR(i));
292 	for (i = 0; i < 16; i++)
293 		regs_buff[139 + i] = rd32(IGC_RAL(i));
294 	for (i = 0; i < 16; i++)
295 		regs_buff[145 + i] = rd32(IGC_RAH(i));
296 
297 	for (i = 0; i < 4; i++)
298 		regs_buff[149 + i] = rd32(IGC_TDBAL(i));
299 	for (i = 0; i < 4; i++)
300 		regs_buff[152 + i] = rd32(IGC_TDBAH(i));
301 	for (i = 0; i < 4; i++)
302 		regs_buff[156 + i] = rd32(IGC_TDLEN(i));
303 	for (i = 0; i < 4; i++)
304 		regs_buff[160 + i] = rd32(IGC_TDH(i));
305 	for (i = 0; i < 4; i++)
306 		regs_buff[164 + i] = rd32(IGC_TDT(i));
307 	for (i = 0; i < 4; i++)
308 		regs_buff[168 + i] = rd32(IGC_TXDCTL(i));
309 
310 	/* XXX: Due to a bug few lines above, RAL and RAH registers are
311 	 * overwritten. To preserve the ABI, we write these registers again in
312 	 * regs_buff.
313 	 */
314 	for (i = 0; i < 16; i++)
315 		regs_buff[172 + i] = rd32(IGC_RAL(i));
316 	for (i = 0; i < 16; i++)
317 		regs_buff[188 + i] = rd32(IGC_RAH(i));
318 
319 	regs_buff[204] = rd32(IGC_VLANPQF);
320 
321 	for (i = 0; i < 8; i++)
322 		regs_buff[205 + i] = rd32(IGC_ETQF(i));
323 }
324 
325 static void igc_ethtool_get_wol(struct net_device *netdev,
326 				struct ethtool_wolinfo *wol)
327 {
328 	struct igc_adapter *adapter = netdev_priv(netdev);
329 
330 	wol->wolopts = 0;
331 
332 	if (!(adapter->flags & IGC_FLAG_WOL_SUPPORTED))
333 		return;
334 
335 	wol->supported = WAKE_UCAST | WAKE_MCAST |
336 			 WAKE_BCAST | WAKE_MAGIC |
337 			 WAKE_PHY;
338 
339 	/* apply any specific unsupported masks here */
340 	switch (adapter->hw.device_id) {
341 	default:
342 		break;
343 	}
344 
345 	if (adapter->wol & IGC_WUFC_EX)
346 		wol->wolopts |= WAKE_UCAST;
347 	if (adapter->wol & IGC_WUFC_MC)
348 		wol->wolopts |= WAKE_MCAST;
349 	if (adapter->wol & IGC_WUFC_BC)
350 		wol->wolopts |= WAKE_BCAST;
351 	if (adapter->wol & IGC_WUFC_MAG)
352 		wol->wolopts |= WAKE_MAGIC;
353 	if (adapter->wol & IGC_WUFC_LNKC)
354 		wol->wolopts |= WAKE_PHY;
355 }
356 
357 static int igc_ethtool_set_wol(struct net_device *netdev,
358 			       struct ethtool_wolinfo *wol)
359 {
360 	struct igc_adapter *adapter = netdev_priv(netdev);
361 
362 	if (wol->wolopts & (WAKE_ARP | WAKE_MAGICSECURE | WAKE_FILTER))
363 		return -EOPNOTSUPP;
364 
365 	if (!(adapter->flags & IGC_FLAG_WOL_SUPPORTED))
366 		return wol->wolopts ? -EOPNOTSUPP : 0;
367 
368 	/* these settings will always override what we currently have */
369 	adapter->wol = 0;
370 
371 	if (wol->wolopts & WAKE_UCAST)
372 		adapter->wol |= IGC_WUFC_EX;
373 	if (wol->wolopts & WAKE_MCAST)
374 		adapter->wol |= IGC_WUFC_MC;
375 	if (wol->wolopts & WAKE_BCAST)
376 		adapter->wol |= IGC_WUFC_BC;
377 	if (wol->wolopts & WAKE_MAGIC)
378 		adapter->wol |= IGC_WUFC_MAG;
379 	if (wol->wolopts & WAKE_PHY)
380 		adapter->wol |= IGC_WUFC_LNKC;
381 	device_set_wakeup_enable(&adapter->pdev->dev, adapter->wol);
382 
383 	return 0;
384 }
385 
386 static u32 igc_ethtool_get_msglevel(struct net_device *netdev)
387 {
388 	struct igc_adapter *adapter = netdev_priv(netdev);
389 
390 	return adapter->msg_enable;
391 }
392 
393 static void igc_ethtool_set_msglevel(struct net_device *netdev, u32 data)
394 {
395 	struct igc_adapter *adapter = netdev_priv(netdev);
396 
397 	adapter->msg_enable = data;
398 }
399 
400 static int igc_ethtool_nway_reset(struct net_device *netdev)
401 {
402 	struct igc_adapter *adapter = netdev_priv(netdev);
403 
404 	if (netif_running(netdev))
405 		igc_reinit_locked(adapter);
406 	return 0;
407 }
408 
409 static u32 igc_ethtool_get_link(struct net_device *netdev)
410 {
411 	struct igc_adapter *adapter = netdev_priv(netdev);
412 	struct igc_mac_info *mac = &adapter->hw.mac;
413 
414 	/* If the link is not reported up to netdev, interrupts are disabled,
415 	 * and so the physical link state may have changed since we last
416 	 * looked. Set get_link_status to make sure that the true link
417 	 * state is interrogated, rather than pulling a cached and possibly
418 	 * stale link state from the driver.
419 	 */
420 	if (!netif_carrier_ok(netdev))
421 		mac->get_link_status = 1;
422 
423 	return igc_has_link(adapter);
424 }
425 
426 static int igc_ethtool_get_eeprom_len(struct net_device *netdev)
427 {
428 	struct igc_adapter *adapter = netdev_priv(netdev);
429 
430 	return adapter->hw.nvm.word_size * 2;
431 }
432 
433 static int igc_ethtool_get_eeprom(struct net_device *netdev,
434 				  struct ethtool_eeprom *eeprom, u8 *bytes)
435 {
436 	struct igc_adapter *adapter = netdev_priv(netdev);
437 	struct igc_hw *hw = &adapter->hw;
438 	int first_word, last_word;
439 	u16 *eeprom_buff;
440 	int ret_val = 0;
441 	u16 i;
442 
443 	if (eeprom->len == 0)
444 		return -EINVAL;
445 
446 	eeprom->magic = hw->vendor_id | (hw->device_id << 16);
447 
448 	first_word = eeprom->offset >> 1;
449 	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
450 
451 	eeprom_buff = kmalloc_array(last_word - first_word + 1, sizeof(u16),
452 				    GFP_KERNEL);
453 	if (!eeprom_buff)
454 		return -ENOMEM;
455 
456 	if (hw->nvm.type == igc_nvm_eeprom_spi) {
457 		ret_val = hw->nvm.ops.read(hw, first_word,
458 					   last_word - first_word + 1,
459 					   eeprom_buff);
460 	} else {
461 		for (i = 0; i < last_word - first_word + 1; i++) {
462 			ret_val = hw->nvm.ops.read(hw, first_word + i, 1,
463 						   &eeprom_buff[i]);
464 			if (ret_val)
465 				break;
466 		}
467 	}
468 
469 	/* Device's eeprom is always little-endian, word addressable */
470 	for (i = 0; i < last_word - first_word + 1; i++)
471 		le16_to_cpus(&eeprom_buff[i]);
472 
473 	memcpy(bytes, (u8 *)eeprom_buff + (eeprom->offset & 1),
474 	       eeprom->len);
475 	kfree(eeprom_buff);
476 
477 	return ret_val;
478 }
479 
480 static int igc_ethtool_set_eeprom(struct net_device *netdev,
481 				  struct ethtool_eeprom *eeprom, u8 *bytes)
482 {
483 	struct igc_adapter *adapter = netdev_priv(netdev);
484 	struct igc_hw *hw = &adapter->hw;
485 	int max_len, first_word, last_word, ret_val = 0;
486 	u16 *eeprom_buff;
487 	void *ptr;
488 	u16 i;
489 
490 	if (eeprom->len == 0)
491 		return -EOPNOTSUPP;
492 
493 	if (hw->mac.type >= igc_i225 &&
494 	    !igc_get_flash_presence_i225(hw)) {
495 		return -EOPNOTSUPP;
496 	}
497 
498 	if (eeprom->magic != (hw->vendor_id | (hw->device_id << 16)))
499 		return -EFAULT;
500 
501 	max_len = hw->nvm.word_size * 2;
502 
503 	first_word = eeprom->offset >> 1;
504 	last_word = (eeprom->offset + eeprom->len - 1) >> 1;
505 	eeprom_buff = kmalloc(max_len, GFP_KERNEL);
506 	if (!eeprom_buff)
507 		return -ENOMEM;
508 
509 	ptr = (void *)eeprom_buff;
510 
511 	if (eeprom->offset & 1) {
512 		/* need read/modify/write of first changed EEPROM word
513 		 * only the second byte of the word is being modified
514 		 */
515 		ret_val = hw->nvm.ops.read(hw, first_word, 1,
516 					    &eeprom_buff[0]);
517 		ptr++;
518 	}
519 	if (((eeprom->offset + eeprom->len) & 1) && ret_val == 0) {
520 		/* need read/modify/write of last changed EEPROM word
521 		 * only the first byte of the word is being modified
522 		 */
523 		ret_val = hw->nvm.ops.read(hw, last_word, 1,
524 				   &eeprom_buff[last_word - first_word]);
525 	}
526 
527 	/* Device's eeprom is always little-endian, word addressable */
528 	for (i = 0; i < last_word - first_word + 1; i++)
529 		le16_to_cpus(&eeprom_buff[i]);
530 
531 	memcpy(ptr, bytes, eeprom->len);
532 
533 	for (i = 0; i < last_word - first_word + 1; i++)
534 		eeprom_buff[i] = cpu_to_le16(eeprom_buff[i]);
535 
536 	ret_val = hw->nvm.ops.write(hw, first_word,
537 				    last_word - first_word + 1, eeprom_buff);
538 
539 	/* Update the checksum if nvm write succeeded */
540 	if (ret_val == 0)
541 		hw->nvm.ops.update(hw);
542 
543 	/* check if need: igc_set_fw_version(adapter); */
544 	kfree(eeprom_buff);
545 	return ret_val;
546 }
547 
548 static void igc_ethtool_get_ringparam(struct net_device *netdev,
549 				      struct ethtool_ringparam *ring)
550 {
551 	struct igc_adapter *adapter = netdev_priv(netdev);
552 
553 	ring->rx_max_pending = IGC_MAX_RXD;
554 	ring->tx_max_pending = IGC_MAX_TXD;
555 	ring->rx_pending = adapter->rx_ring_count;
556 	ring->tx_pending = adapter->tx_ring_count;
557 }
558 
559 static int igc_ethtool_set_ringparam(struct net_device *netdev,
560 				     struct ethtool_ringparam *ring)
561 {
562 	struct igc_adapter *adapter = netdev_priv(netdev);
563 	struct igc_ring *temp_ring;
564 	u16 new_rx_count, new_tx_count;
565 	int i, err = 0;
566 
567 	if (ring->rx_mini_pending || ring->rx_jumbo_pending)
568 		return -EINVAL;
569 
570 	new_rx_count = min_t(u32, ring->rx_pending, IGC_MAX_RXD);
571 	new_rx_count = max_t(u16, new_rx_count, IGC_MIN_RXD);
572 	new_rx_count = ALIGN(new_rx_count, REQ_RX_DESCRIPTOR_MULTIPLE);
573 
574 	new_tx_count = min_t(u32, ring->tx_pending, IGC_MAX_TXD);
575 	new_tx_count = max_t(u16, new_tx_count, IGC_MIN_TXD);
576 	new_tx_count = ALIGN(new_tx_count, REQ_TX_DESCRIPTOR_MULTIPLE);
577 
578 	if (new_tx_count == adapter->tx_ring_count &&
579 	    new_rx_count == adapter->rx_ring_count) {
580 		/* nothing to do */
581 		return 0;
582 	}
583 
584 	while (test_and_set_bit(__IGC_RESETTING, &adapter->state))
585 		usleep_range(1000, 2000);
586 
587 	if (!netif_running(adapter->netdev)) {
588 		for (i = 0; i < adapter->num_tx_queues; i++)
589 			adapter->tx_ring[i]->count = new_tx_count;
590 		for (i = 0; i < adapter->num_rx_queues; i++)
591 			adapter->rx_ring[i]->count = new_rx_count;
592 		adapter->tx_ring_count = new_tx_count;
593 		adapter->rx_ring_count = new_rx_count;
594 		goto clear_reset;
595 	}
596 
597 	if (adapter->num_tx_queues > adapter->num_rx_queues)
598 		temp_ring = vmalloc(array_size(sizeof(struct igc_ring),
599 					       adapter->num_tx_queues));
600 	else
601 		temp_ring = vmalloc(array_size(sizeof(struct igc_ring),
602 					       adapter->num_rx_queues));
603 
604 	if (!temp_ring) {
605 		err = -ENOMEM;
606 		goto clear_reset;
607 	}
608 
609 	igc_down(adapter);
610 
611 	/* We can't just free everything and then setup again,
612 	 * because the ISRs in MSI-X mode get passed pointers
613 	 * to the Tx and Rx ring structs.
614 	 */
615 	if (new_tx_count != adapter->tx_ring_count) {
616 		for (i = 0; i < adapter->num_tx_queues; i++) {
617 			memcpy(&temp_ring[i], adapter->tx_ring[i],
618 			       sizeof(struct igc_ring));
619 
620 			temp_ring[i].count = new_tx_count;
621 			err = igc_setup_tx_resources(&temp_ring[i]);
622 			if (err) {
623 				while (i) {
624 					i--;
625 					igc_free_tx_resources(&temp_ring[i]);
626 				}
627 				goto err_setup;
628 			}
629 		}
630 
631 		for (i = 0; i < adapter->num_tx_queues; i++) {
632 			igc_free_tx_resources(adapter->tx_ring[i]);
633 
634 			memcpy(adapter->tx_ring[i], &temp_ring[i],
635 			       sizeof(struct igc_ring));
636 		}
637 
638 		adapter->tx_ring_count = new_tx_count;
639 	}
640 
641 	if (new_rx_count != adapter->rx_ring_count) {
642 		for (i = 0; i < adapter->num_rx_queues; i++) {
643 			memcpy(&temp_ring[i], adapter->rx_ring[i],
644 			       sizeof(struct igc_ring));
645 
646 			temp_ring[i].count = new_rx_count;
647 			err = igc_setup_rx_resources(&temp_ring[i]);
648 			if (err) {
649 				while (i) {
650 					i--;
651 					igc_free_rx_resources(&temp_ring[i]);
652 				}
653 				goto err_setup;
654 			}
655 		}
656 
657 		for (i = 0; i < adapter->num_rx_queues; i++) {
658 			igc_free_rx_resources(adapter->rx_ring[i]);
659 
660 			memcpy(adapter->rx_ring[i], &temp_ring[i],
661 			       sizeof(struct igc_ring));
662 		}
663 
664 		adapter->rx_ring_count = new_rx_count;
665 	}
666 err_setup:
667 	igc_up(adapter);
668 	vfree(temp_ring);
669 clear_reset:
670 	clear_bit(__IGC_RESETTING, &adapter->state);
671 	return err;
672 }
673 
674 static void igc_ethtool_get_pauseparam(struct net_device *netdev,
675 				       struct ethtool_pauseparam *pause)
676 {
677 	struct igc_adapter *adapter = netdev_priv(netdev);
678 	struct igc_hw *hw = &adapter->hw;
679 
680 	pause->autoneg =
681 		(adapter->fc_autoneg ? AUTONEG_ENABLE : AUTONEG_DISABLE);
682 
683 	if (hw->fc.current_mode == igc_fc_rx_pause) {
684 		pause->rx_pause = 1;
685 	} else if (hw->fc.current_mode == igc_fc_tx_pause) {
686 		pause->tx_pause = 1;
687 	} else if (hw->fc.current_mode == igc_fc_full) {
688 		pause->rx_pause = 1;
689 		pause->tx_pause = 1;
690 	}
691 }
692 
693 static int igc_ethtool_set_pauseparam(struct net_device *netdev,
694 				      struct ethtool_pauseparam *pause)
695 {
696 	struct igc_adapter *adapter = netdev_priv(netdev);
697 	struct igc_hw *hw = &adapter->hw;
698 	int retval = 0;
699 
700 	adapter->fc_autoneg = pause->autoneg;
701 
702 	while (test_and_set_bit(__IGC_RESETTING, &adapter->state))
703 		usleep_range(1000, 2000);
704 
705 	if (adapter->fc_autoneg == AUTONEG_ENABLE) {
706 		hw->fc.requested_mode = igc_fc_default;
707 		if (netif_running(adapter->netdev)) {
708 			igc_down(adapter);
709 			igc_up(adapter);
710 		} else {
711 			igc_reset(adapter);
712 		}
713 	} else {
714 		if (pause->rx_pause && pause->tx_pause)
715 			hw->fc.requested_mode = igc_fc_full;
716 		else if (pause->rx_pause && !pause->tx_pause)
717 			hw->fc.requested_mode = igc_fc_rx_pause;
718 		else if (!pause->rx_pause && pause->tx_pause)
719 			hw->fc.requested_mode = igc_fc_tx_pause;
720 		else if (!pause->rx_pause && !pause->tx_pause)
721 			hw->fc.requested_mode = igc_fc_none;
722 
723 		hw->fc.current_mode = hw->fc.requested_mode;
724 
725 		retval = ((hw->phy.media_type == igc_media_type_copper) ?
726 			  igc_force_mac_fc(hw) : igc_setup_link(hw));
727 	}
728 
729 	clear_bit(__IGC_RESETTING, &adapter->state);
730 	return retval;
731 }
732 
733 static void igc_ethtool_get_strings(struct net_device *netdev, u32 stringset,
734 				    u8 *data)
735 {
736 	struct igc_adapter *adapter = netdev_priv(netdev);
737 	u8 *p = data;
738 	int i;
739 
740 	switch (stringset) {
741 	case ETH_SS_TEST:
742 		memcpy(data, *igc_gstrings_test,
743 		       IGC_TEST_LEN * ETH_GSTRING_LEN);
744 		break;
745 	case ETH_SS_STATS:
746 		for (i = 0; i < IGC_GLOBAL_STATS_LEN; i++) {
747 			memcpy(p, igc_gstrings_stats[i].stat_string,
748 			       ETH_GSTRING_LEN);
749 			p += ETH_GSTRING_LEN;
750 		}
751 		for (i = 0; i < IGC_NETDEV_STATS_LEN; i++) {
752 			memcpy(p, igc_gstrings_net_stats[i].stat_string,
753 			       ETH_GSTRING_LEN);
754 			p += ETH_GSTRING_LEN;
755 		}
756 		for (i = 0; i < adapter->num_tx_queues; i++) {
757 			sprintf(p, "tx_queue_%u_packets", i);
758 			p += ETH_GSTRING_LEN;
759 			sprintf(p, "tx_queue_%u_bytes", i);
760 			p += ETH_GSTRING_LEN;
761 			sprintf(p, "tx_queue_%u_restart", i);
762 			p += ETH_GSTRING_LEN;
763 		}
764 		for (i = 0; i < adapter->num_rx_queues; i++) {
765 			sprintf(p, "rx_queue_%u_packets", i);
766 			p += ETH_GSTRING_LEN;
767 			sprintf(p, "rx_queue_%u_bytes", i);
768 			p += ETH_GSTRING_LEN;
769 			sprintf(p, "rx_queue_%u_drops", i);
770 			p += ETH_GSTRING_LEN;
771 			sprintf(p, "rx_queue_%u_csum_err", i);
772 			p += ETH_GSTRING_LEN;
773 			sprintf(p, "rx_queue_%u_alloc_failed", i);
774 			p += ETH_GSTRING_LEN;
775 		}
776 		/* BUG_ON(p - data != IGC_STATS_LEN * ETH_GSTRING_LEN); */
777 		break;
778 	case ETH_SS_PRIV_FLAGS:
779 		memcpy(data, igc_priv_flags_strings,
780 		       IGC_PRIV_FLAGS_STR_LEN * ETH_GSTRING_LEN);
781 		break;
782 	}
783 }
784 
785 static int igc_ethtool_get_sset_count(struct net_device *netdev, int sset)
786 {
787 	switch (sset) {
788 	case ETH_SS_STATS:
789 		return IGC_STATS_LEN;
790 	case ETH_SS_TEST:
791 		return IGC_TEST_LEN;
792 	case ETH_SS_PRIV_FLAGS:
793 		return IGC_PRIV_FLAGS_STR_LEN;
794 	default:
795 		return -ENOTSUPP;
796 	}
797 }
798 
799 static void igc_ethtool_get_stats(struct net_device *netdev,
800 				  struct ethtool_stats *stats, u64 *data)
801 {
802 	struct igc_adapter *adapter = netdev_priv(netdev);
803 	struct rtnl_link_stats64 *net_stats = &adapter->stats64;
804 	unsigned int start;
805 	struct igc_ring *ring;
806 	int i, j;
807 	char *p;
808 
809 	spin_lock(&adapter->stats64_lock);
810 	igc_update_stats(adapter);
811 
812 	for (i = 0; i < IGC_GLOBAL_STATS_LEN; i++) {
813 		p = (char *)adapter + igc_gstrings_stats[i].stat_offset;
814 		data[i] = (igc_gstrings_stats[i].sizeof_stat ==
815 			sizeof(u64)) ? *(u64 *)p : *(u32 *)p;
816 	}
817 	for (j = 0; j < IGC_NETDEV_STATS_LEN; j++, i++) {
818 		p = (char *)net_stats + igc_gstrings_net_stats[j].stat_offset;
819 		data[i] = (igc_gstrings_net_stats[j].sizeof_stat ==
820 			sizeof(u64)) ? *(u64 *)p : *(u32 *)p;
821 	}
822 	for (j = 0; j < adapter->num_tx_queues; j++) {
823 		u64	restart2;
824 
825 		ring = adapter->tx_ring[j];
826 		do {
827 			start = u64_stats_fetch_begin_irq(&ring->tx_syncp);
828 			data[i]   = ring->tx_stats.packets;
829 			data[i + 1] = ring->tx_stats.bytes;
830 			data[i + 2] = ring->tx_stats.restart_queue;
831 		} while (u64_stats_fetch_retry_irq(&ring->tx_syncp, start));
832 		do {
833 			start = u64_stats_fetch_begin_irq(&ring->tx_syncp2);
834 			restart2  = ring->tx_stats.restart_queue2;
835 		} while (u64_stats_fetch_retry_irq(&ring->tx_syncp2, start));
836 		data[i + 2] += restart2;
837 
838 		i += IGC_TX_QUEUE_STATS_LEN;
839 	}
840 	for (j = 0; j < adapter->num_rx_queues; j++) {
841 		ring = adapter->rx_ring[j];
842 		do {
843 			start = u64_stats_fetch_begin_irq(&ring->rx_syncp);
844 			data[i]   = ring->rx_stats.packets;
845 			data[i + 1] = ring->rx_stats.bytes;
846 			data[i + 2] = ring->rx_stats.drops;
847 			data[i + 3] = ring->rx_stats.csum_err;
848 			data[i + 4] = ring->rx_stats.alloc_failed;
849 		} while (u64_stats_fetch_retry_irq(&ring->rx_syncp, start));
850 		i += IGC_RX_QUEUE_STATS_LEN;
851 	}
852 	spin_unlock(&adapter->stats64_lock);
853 }
854 
855 static int igc_ethtool_get_coalesce(struct net_device *netdev,
856 				    struct ethtool_coalesce *ec)
857 {
858 	struct igc_adapter *adapter = netdev_priv(netdev);
859 
860 	if (adapter->rx_itr_setting <= 3)
861 		ec->rx_coalesce_usecs = adapter->rx_itr_setting;
862 	else
863 		ec->rx_coalesce_usecs = adapter->rx_itr_setting >> 2;
864 
865 	if (!(adapter->flags & IGC_FLAG_QUEUE_PAIRS)) {
866 		if (adapter->tx_itr_setting <= 3)
867 			ec->tx_coalesce_usecs = adapter->tx_itr_setting;
868 		else
869 			ec->tx_coalesce_usecs = adapter->tx_itr_setting >> 2;
870 	}
871 
872 	return 0;
873 }
874 
875 static int igc_ethtool_set_coalesce(struct net_device *netdev,
876 				    struct ethtool_coalesce *ec)
877 {
878 	struct igc_adapter *adapter = netdev_priv(netdev);
879 	int i;
880 
881 	if (ec->rx_coalesce_usecs > IGC_MAX_ITR_USECS ||
882 	    (ec->rx_coalesce_usecs > 3 &&
883 	     ec->rx_coalesce_usecs < IGC_MIN_ITR_USECS) ||
884 	    ec->rx_coalesce_usecs == 2)
885 		return -EINVAL;
886 
887 	if (ec->tx_coalesce_usecs > IGC_MAX_ITR_USECS ||
888 	    (ec->tx_coalesce_usecs > 3 &&
889 	     ec->tx_coalesce_usecs < IGC_MIN_ITR_USECS) ||
890 	    ec->tx_coalesce_usecs == 2)
891 		return -EINVAL;
892 
893 	if ((adapter->flags & IGC_FLAG_QUEUE_PAIRS) && ec->tx_coalesce_usecs)
894 		return -EINVAL;
895 
896 	/* If ITR is disabled, disable DMAC */
897 	if (ec->rx_coalesce_usecs == 0) {
898 		if (adapter->flags & IGC_FLAG_DMAC)
899 			adapter->flags &= ~IGC_FLAG_DMAC;
900 	}
901 
902 	/* convert to rate of irq's per second */
903 	if (ec->rx_coalesce_usecs && ec->rx_coalesce_usecs <= 3)
904 		adapter->rx_itr_setting = ec->rx_coalesce_usecs;
905 	else
906 		adapter->rx_itr_setting = ec->rx_coalesce_usecs << 2;
907 
908 	/* convert to rate of irq's per second */
909 	if (adapter->flags & IGC_FLAG_QUEUE_PAIRS)
910 		adapter->tx_itr_setting = adapter->rx_itr_setting;
911 	else if (ec->tx_coalesce_usecs && ec->tx_coalesce_usecs <= 3)
912 		adapter->tx_itr_setting = ec->tx_coalesce_usecs;
913 	else
914 		adapter->tx_itr_setting = ec->tx_coalesce_usecs << 2;
915 
916 	for (i = 0; i < adapter->num_q_vectors; i++) {
917 		struct igc_q_vector *q_vector = adapter->q_vector[i];
918 
919 		q_vector->tx.work_limit = adapter->tx_work_limit;
920 		if (q_vector->rx.ring)
921 			q_vector->itr_val = adapter->rx_itr_setting;
922 		else
923 			q_vector->itr_val = adapter->tx_itr_setting;
924 		if (q_vector->itr_val && q_vector->itr_val <= 3)
925 			q_vector->itr_val = IGC_START_ITR;
926 		q_vector->set_itr = 1;
927 	}
928 
929 	return 0;
930 }
931 
932 #define ETHER_TYPE_FULL_MASK ((__force __be16)~0)
933 static int igc_ethtool_get_nfc_rule(struct igc_adapter *adapter,
934 				    struct ethtool_rxnfc *cmd)
935 {
936 	struct ethtool_rx_flow_spec *fsp = &cmd->fs;
937 	struct igc_nfc_rule *rule = NULL;
938 
939 	cmd->data = IGC_MAX_RXNFC_RULES;
940 
941 	mutex_lock(&adapter->nfc_rule_lock);
942 
943 	rule = igc_get_nfc_rule(adapter, fsp->location);
944 	if (!rule)
945 		goto out;
946 
947 	fsp->flow_type = ETHER_FLOW;
948 	fsp->ring_cookie = rule->action;
949 
950 	if (rule->filter.match_flags & IGC_FILTER_FLAG_ETHER_TYPE) {
951 		fsp->h_u.ether_spec.h_proto = htons(rule->filter.etype);
952 		fsp->m_u.ether_spec.h_proto = ETHER_TYPE_FULL_MASK;
953 	}
954 
955 	if (rule->filter.match_flags & IGC_FILTER_FLAG_VLAN_TCI) {
956 		fsp->flow_type |= FLOW_EXT;
957 		fsp->h_ext.vlan_tci = htons(rule->filter.vlan_tci);
958 		fsp->m_ext.vlan_tci = htons(VLAN_PRIO_MASK);
959 	}
960 
961 	if (rule->filter.match_flags & IGC_FILTER_FLAG_DST_MAC_ADDR) {
962 		ether_addr_copy(fsp->h_u.ether_spec.h_dest,
963 				rule->filter.dst_addr);
964 		eth_broadcast_addr(fsp->m_u.ether_spec.h_dest);
965 	}
966 
967 	if (rule->filter.match_flags & IGC_FILTER_FLAG_SRC_MAC_ADDR) {
968 		ether_addr_copy(fsp->h_u.ether_spec.h_source,
969 				rule->filter.src_addr);
970 		eth_broadcast_addr(fsp->m_u.ether_spec.h_source);
971 	}
972 
973 	mutex_unlock(&adapter->nfc_rule_lock);
974 	return 0;
975 
976 out:
977 	mutex_unlock(&adapter->nfc_rule_lock);
978 	return -EINVAL;
979 }
980 
981 static int igc_ethtool_get_nfc_rules(struct igc_adapter *adapter,
982 				     struct ethtool_rxnfc *cmd,
983 				     u32 *rule_locs)
984 {
985 	struct igc_nfc_rule *rule;
986 	int cnt = 0;
987 
988 	cmd->data = IGC_MAX_RXNFC_RULES;
989 
990 	mutex_lock(&adapter->nfc_rule_lock);
991 
992 	list_for_each_entry(rule, &adapter->nfc_rule_list, list) {
993 		if (cnt == cmd->rule_cnt) {
994 			mutex_unlock(&adapter->nfc_rule_lock);
995 			return -EMSGSIZE;
996 		}
997 		rule_locs[cnt] = rule->location;
998 		cnt++;
999 	}
1000 
1001 	mutex_unlock(&adapter->nfc_rule_lock);
1002 
1003 	cmd->rule_cnt = cnt;
1004 
1005 	return 0;
1006 }
1007 
1008 static int igc_ethtool_get_rss_hash_opts(struct igc_adapter *adapter,
1009 					 struct ethtool_rxnfc *cmd)
1010 {
1011 	cmd->data = 0;
1012 
1013 	/* Report default options for RSS on igc */
1014 	switch (cmd->flow_type) {
1015 	case TCP_V4_FLOW:
1016 		cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
1017 		/* Fall through */
1018 	case UDP_V4_FLOW:
1019 		if (adapter->flags & IGC_FLAG_RSS_FIELD_IPV4_UDP)
1020 			cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
1021 		/* Fall through */
1022 	case SCTP_V4_FLOW:
1023 		/* Fall through */
1024 	case AH_ESP_V4_FLOW:
1025 		/* Fall through */
1026 	case AH_V4_FLOW:
1027 		/* Fall through */
1028 	case ESP_V4_FLOW:
1029 		/* Fall through */
1030 	case IPV4_FLOW:
1031 		cmd->data |= RXH_IP_SRC | RXH_IP_DST;
1032 		break;
1033 	case TCP_V6_FLOW:
1034 		cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
1035 		/* Fall through */
1036 	case UDP_V6_FLOW:
1037 		if (adapter->flags & IGC_FLAG_RSS_FIELD_IPV6_UDP)
1038 			cmd->data |= RXH_L4_B_0_1 | RXH_L4_B_2_3;
1039 		/* Fall through */
1040 	case SCTP_V6_FLOW:
1041 		/* Fall through */
1042 	case AH_ESP_V6_FLOW:
1043 		/* Fall through */
1044 	case AH_V6_FLOW:
1045 		/* Fall through */
1046 	case ESP_V6_FLOW:
1047 		/* Fall through */
1048 	case IPV6_FLOW:
1049 		cmd->data |= RXH_IP_SRC | RXH_IP_DST;
1050 		break;
1051 	default:
1052 		return -EINVAL;
1053 	}
1054 
1055 	return 0;
1056 }
1057 
1058 static int igc_ethtool_get_rxnfc(struct net_device *dev,
1059 				 struct ethtool_rxnfc *cmd, u32 *rule_locs)
1060 {
1061 	struct igc_adapter *adapter = netdev_priv(dev);
1062 
1063 	switch (cmd->cmd) {
1064 	case ETHTOOL_GRXRINGS:
1065 		cmd->data = adapter->num_rx_queues;
1066 		return 0;
1067 	case ETHTOOL_GRXCLSRLCNT:
1068 		cmd->rule_cnt = adapter->nfc_rule_count;
1069 		return 0;
1070 	case ETHTOOL_GRXCLSRULE:
1071 		return igc_ethtool_get_nfc_rule(adapter, cmd);
1072 	case ETHTOOL_GRXCLSRLALL:
1073 		return igc_ethtool_get_nfc_rules(adapter, cmd, rule_locs);
1074 	case ETHTOOL_GRXFH:
1075 		return igc_ethtool_get_rss_hash_opts(adapter, cmd);
1076 	default:
1077 		return -EOPNOTSUPP;
1078 	}
1079 }
1080 
1081 #define UDP_RSS_FLAGS (IGC_FLAG_RSS_FIELD_IPV4_UDP | \
1082 		       IGC_FLAG_RSS_FIELD_IPV6_UDP)
1083 static int igc_ethtool_set_rss_hash_opt(struct igc_adapter *adapter,
1084 					struct ethtool_rxnfc *nfc)
1085 {
1086 	u32 flags = adapter->flags;
1087 
1088 	/* RSS does not support anything other than hashing
1089 	 * to queues on src and dst IPs and ports
1090 	 */
1091 	if (nfc->data & ~(RXH_IP_SRC | RXH_IP_DST |
1092 			  RXH_L4_B_0_1 | RXH_L4_B_2_3))
1093 		return -EINVAL;
1094 
1095 	switch (nfc->flow_type) {
1096 	case TCP_V4_FLOW:
1097 	case TCP_V6_FLOW:
1098 		if (!(nfc->data & RXH_IP_SRC) ||
1099 		    !(nfc->data & RXH_IP_DST) ||
1100 		    !(nfc->data & RXH_L4_B_0_1) ||
1101 		    !(nfc->data & RXH_L4_B_2_3))
1102 			return -EINVAL;
1103 		break;
1104 	case UDP_V4_FLOW:
1105 		if (!(nfc->data & RXH_IP_SRC) ||
1106 		    !(nfc->data & RXH_IP_DST))
1107 			return -EINVAL;
1108 		switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
1109 		case 0:
1110 			flags &= ~IGC_FLAG_RSS_FIELD_IPV4_UDP;
1111 			break;
1112 		case (RXH_L4_B_0_1 | RXH_L4_B_2_3):
1113 			flags |= IGC_FLAG_RSS_FIELD_IPV4_UDP;
1114 			break;
1115 		default:
1116 			return -EINVAL;
1117 		}
1118 		break;
1119 	case UDP_V6_FLOW:
1120 		if (!(nfc->data & RXH_IP_SRC) ||
1121 		    !(nfc->data & RXH_IP_DST))
1122 			return -EINVAL;
1123 		switch (nfc->data & (RXH_L4_B_0_1 | RXH_L4_B_2_3)) {
1124 		case 0:
1125 			flags &= ~IGC_FLAG_RSS_FIELD_IPV6_UDP;
1126 			break;
1127 		case (RXH_L4_B_0_1 | RXH_L4_B_2_3):
1128 			flags |= IGC_FLAG_RSS_FIELD_IPV6_UDP;
1129 			break;
1130 		default:
1131 			return -EINVAL;
1132 		}
1133 		break;
1134 	case AH_ESP_V4_FLOW:
1135 	case AH_V4_FLOW:
1136 	case ESP_V4_FLOW:
1137 	case SCTP_V4_FLOW:
1138 	case AH_ESP_V6_FLOW:
1139 	case AH_V6_FLOW:
1140 	case ESP_V6_FLOW:
1141 	case SCTP_V6_FLOW:
1142 		if (!(nfc->data & RXH_IP_SRC) ||
1143 		    !(nfc->data & RXH_IP_DST) ||
1144 		    (nfc->data & RXH_L4_B_0_1) ||
1145 		    (nfc->data & RXH_L4_B_2_3))
1146 			return -EINVAL;
1147 		break;
1148 	default:
1149 		return -EINVAL;
1150 	}
1151 
1152 	/* if we changed something we need to update flags */
1153 	if (flags != adapter->flags) {
1154 		struct igc_hw *hw = &adapter->hw;
1155 		u32 mrqc = rd32(IGC_MRQC);
1156 
1157 		if ((flags & UDP_RSS_FLAGS) &&
1158 		    !(adapter->flags & UDP_RSS_FLAGS))
1159 			netdev_err(adapter->netdev,
1160 				   "Enabling UDP RSS: fragmented packets may arrive out of order to the stack above\n");
1161 
1162 		adapter->flags = flags;
1163 
1164 		/* Perform hash on these packet types */
1165 		mrqc |= IGC_MRQC_RSS_FIELD_IPV4 |
1166 			IGC_MRQC_RSS_FIELD_IPV4_TCP |
1167 			IGC_MRQC_RSS_FIELD_IPV6 |
1168 			IGC_MRQC_RSS_FIELD_IPV6_TCP;
1169 
1170 		mrqc &= ~(IGC_MRQC_RSS_FIELD_IPV4_UDP |
1171 			  IGC_MRQC_RSS_FIELD_IPV6_UDP);
1172 
1173 		if (flags & IGC_FLAG_RSS_FIELD_IPV4_UDP)
1174 			mrqc |= IGC_MRQC_RSS_FIELD_IPV4_UDP;
1175 
1176 		if (flags & IGC_FLAG_RSS_FIELD_IPV6_UDP)
1177 			mrqc |= IGC_MRQC_RSS_FIELD_IPV6_UDP;
1178 
1179 		wr32(IGC_MRQC, mrqc);
1180 	}
1181 
1182 	return 0;
1183 }
1184 
1185 static void igc_ethtool_init_nfc_rule(struct igc_nfc_rule *rule,
1186 				      const struct ethtool_rx_flow_spec *fsp)
1187 {
1188 	INIT_LIST_HEAD(&rule->list);
1189 
1190 	rule->action = fsp->ring_cookie;
1191 	rule->location = fsp->location;
1192 
1193 	if ((fsp->flow_type & FLOW_EXT) && fsp->m_ext.vlan_tci) {
1194 		rule->filter.vlan_tci = ntohs(fsp->h_ext.vlan_tci);
1195 		rule->filter.match_flags |= IGC_FILTER_FLAG_VLAN_TCI;
1196 	}
1197 
1198 	if (fsp->m_u.ether_spec.h_proto == ETHER_TYPE_FULL_MASK) {
1199 		rule->filter.etype = ntohs(fsp->h_u.ether_spec.h_proto);
1200 		rule->filter.match_flags = IGC_FILTER_FLAG_ETHER_TYPE;
1201 	}
1202 
1203 	/* Both source and destination address filters only support the full
1204 	 * mask.
1205 	 */
1206 	if (is_broadcast_ether_addr(fsp->m_u.ether_spec.h_source)) {
1207 		rule->filter.match_flags |= IGC_FILTER_FLAG_SRC_MAC_ADDR;
1208 		ether_addr_copy(rule->filter.src_addr,
1209 				fsp->h_u.ether_spec.h_source);
1210 	}
1211 
1212 	if (is_broadcast_ether_addr(fsp->m_u.ether_spec.h_dest)) {
1213 		rule->filter.match_flags |= IGC_FILTER_FLAG_DST_MAC_ADDR;
1214 		ether_addr_copy(rule->filter.dst_addr,
1215 				fsp->h_u.ether_spec.h_dest);
1216 	}
1217 }
1218 
1219 /**
1220  * igc_ethtool_check_nfc_rule() - Check if NFC rule is valid
1221  * @adapter: Pointer to adapter
1222  * @rule: Rule under evaluation
1223  *
1224  * The driver doesn't support rules with multiple matches so if more than
1225  * one bit in filter flags is set, @rule is considered invalid.
1226  *
1227  * Also, if there is already another rule with the same filter in a different
1228  * location, @rule is considered invalid.
1229  *
1230  * Context: Expects adapter->nfc_rule_lock to be held by caller.
1231  *
1232  * Return: 0 in case of success, negative errno code otherwise.
1233  */
1234 static int igc_ethtool_check_nfc_rule(struct igc_adapter *adapter,
1235 				      struct igc_nfc_rule *rule)
1236 {
1237 	struct net_device *dev = adapter->netdev;
1238 	u8 flags = rule->filter.match_flags;
1239 	struct igc_nfc_rule *tmp;
1240 
1241 	if (!flags) {
1242 		netdev_dbg(dev, "Rule with no match\n");
1243 		return -EINVAL;
1244 	}
1245 
1246 	if (flags & (flags - 1)) {
1247 		netdev_dbg(dev, "Rule with multiple matches not supported\n");
1248 		return -EOPNOTSUPP;
1249 	}
1250 
1251 	list_for_each_entry(tmp, &adapter->nfc_rule_list, list) {
1252 		if (!memcmp(&rule->filter, &tmp->filter,
1253 			    sizeof(rule->filter)) &&
1254 		    tmp->location != rule->location) {
1255 			netdev_dbg(dev, "Rule already exists\n");
1256 			return -EEXIST;
1257 		}
1258 	}
1259 
1260 	return 0;
1261 }
1262 
1263 static int igc_ethtool_add_nfc_rule(struct igc_adapter *adapter,
1264 				    struct ethtool_rxnfc *cmd)
1265 {
1266 	struct net_device *netdev = adapter->netdev;
1267 	struct ethtool_rx_flow_spec *fsp =
1268 		(struct ethtool_rx_flow_spec *)&cmd->fs;
1269 	struct igc_nfc_rule *rule, *old_rule;
1270 	int err;
1271 
1272 	if (!(netdev->hw_features & NETIF_F_NTUPLE)) {
1273 		netdev_dbg(netdev, "N-tuple filters disabled\n");
1274 		return -EOPNOTSUPP;
1275 	}
1276 
1277 	if ((fsp->flow_type & ~FLOW_EXT) != ETHER_FLOW) {
1278 		netdev_dbg(netdev, "Only ethernet flow type is supported\n");
1279 		return -EOPNOTSUPP;
1280 	}
1281 
1282 	if ((fsp->flow_type & FLOW_EXT) &&
1283 	    fsp->m_ext.vlan_tci != htons(VLAN_PRIO_MASK)) {
1284 		netdev_dbg(netdev, "VLAN mask not supported\n");
1285 		return -EOPNOTSUPP;
1286 	}
1287 
1288 	if (fsp->ring_cookie >= adapter->num_rx_queues) {
1289 		netdev_dbg(netdev, "Invalid action\n");
1290 		return -EINVAL;
1291 	}
1292 
1293 	if (fsp->location >= IGC_MAX_RXNFC_RULES) {
1294 		netdev_dbg(netdev, "Invalid location\n");
1295 		return -EINVAL;
1296 	}
1297 
1298 	rule = kzalloc(sizeof(*rule), GFP_KERNEL);
1299 	if (!rule)
1300 		return -ENOMEM;
1301 
1302 	igc_ethtool_init_nfc_rule(rule, fsp);
1303 
1304 	mutex_lock(&adapter->nfc_rule_lock);
1305 
1306 	err = igc_ethtool_check_nfc_rule(adapter, rule);
1307 	if (err)
1308 		goto err;
1309 
1310 	old_rule = igc_get_nfc_rule(adapter, fsp->location);
1311 	if (old_rule)
1312 		igc_del_nfc_rule(adapter, old_rule);
1313 
1314 	err = igc_add_nfc_rule(adapter, rule);
1315 	if (err)
1316 		goto err;
1317 
1318 	mutex_unlock(&adapter->nfc_rule_lock);
1319 	return 0;
1320 
1321 err:
1322 	mutex_unlock(&adapter->nfc_rule_lock);
1323 	kfree(rule);
1324 	return err;
1325 }
1326 
1327 static int igc_ethtool_del_nfc_rule(struct igc_adapter *adapter,
1328 				    struct ethtool_rxnfc *cmd)
1329 {
1330 	struct ethtool_rx_flow_spec *fsp =
1331 		(struct ethtool_rx_flow_spec *)&cmd->fs;
1332 	struct igc_nfc_rule *rule;
1333 
1334 	mutex_lock(&adapter->nfc_rule_lock);
1335 
1336 	rule = igc_get_nfc_rule(adapter, fsp->location);
1337 	if (!rule) {
1338 		mutex_unlock(&adapter->nfc_rule_lock);
1339 		return -EINVAL;
1340 	}
1341 
1342 	igc_del_nfc_rule(adapter, rule);
1343 
1344 	mutex_unlock(&adapter->nfc_rule_lock);
1345 	return 0;
1346 }
1347 
1348 static int igc_ethtool_set_rxnfc(struct net_device *dev,
1349 				 struct ethtool_rxnfc *cmd)
1350 {
1351 	struct igc_adapter *adapter = netdev_priv(dev);
1352 
1353 	switch (cmd->cmd) {
1354 	case ETHTOOL_SRXFH:
1355 		return igc_ethtool_set_rss_hash_opt(adapter, cmd);
1356 	case ETHTOOL_SRXCLSRLINS:
1357 		return igc_ethtool_add_nfc_rule(adapter, cmd);
1358 	case ETHTOOL_SRXCLSRLDEL:
1359 		return igc_ethtool_del_nfc_rule(adapter, cmd);
1360 	default:
1361 		return -EOPNOTSUPP;
1362 	}
1363 }
1364 
1365 void igc_write_rss_indir_tbl(struct igc_adapter *adapter)
1366 {
1367 	struct igc_hw *hw = &adapter->hw;
1368 	u32 reg = IGC_RETA(0);
1369 	u32 shift = 0;
1370 	int i = 0;
1371 
1372 	while (i < IGC_RETA_SIZE) {
1373 		u32 val = 0;
1374 		int j;
1375 
1376 		for (j = 3; j >= 0; j--) {
1377 			val <<= 8;
1378 			val |= adapter->rss_indir_tbl[i + j];
1379 		}
1380 
1381 		wr32(reg, val << shift);
1382 		reg += 4;
1383 		i += 4;
1384 	}
1385 }
1386 
1387 static u32 igc_ethtool_get_rxfh_indir_size(struct net_device *netdev)
1388 {
1389 	return IGC_RETA_SIZE;
1390 }
1391 
1392 static int igc_ethtool_get_rxfh(struct net_device *netdev, u32 *indir, u8 *key,
1393 				u8 *hfunc)
1394 {
1395 	struct igc_adapter *adapter = netdev_priv(netdev);
1396 	int i;
1397 
1398 	if (hfunc)
1399 		*hfunc = ETH_RSS_HASH_TOP;
1400 	if (!indir)
1401 		return 0;
1402 	for (i = 0; i < IGC_RETA_SIZE; i++)
1403 		indir[i] = adapter->rss_indir_tbl[i];
1404 
1405 	return 0;
1406 }
1407 
1408 static int igc_ethtool_set_rxfh(struct net_device *netdev, const u32 *indir,
1409 				const u8 *key, const u8 hfunc)
1410 {
1411 	struct igc_adapter *adapter = netdev_priv(netdev);
1412 	u32 num_queues;
1413 	int i;
1414 
1415 	/* We do not allow change in unsupported parameters */
1416 	if (key ||
1417 	    (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP))
1418 		return -EOPNOTSUPP;
1419 	if (!indir)
1420 		return 0;
1421 
1422 	num_queues = adapter->rss_queues;
1423 
1424 	/* Verify user input. */
1425 	for (i = 0; i < IGC_RETA_SIZE; i++)
1426 		if (indir[i] >= num_queues)
1427 			return -EINVAL;
1428 
1429 	for (i = 0; i < IGC_RETA_SIZE; i++)
1430 		adapter->rss_indir_tbl[i] = indir[i];
1431 
1432 	igc_write_rss_indir_tbl(adapter);
1433 
1434 	return 0;
1435 }
1436 
1437 static void igc_ethtool_get_channels(struct net_device *netdev,
1438 				     struct ethtool_channels *ch)
1439 {
1440 	struct igc_adapter *adapter = netdev_priv(netdev);
1441 
1442 	/* Report maximum channels */
1443 	ch->max_combined = igc_get_max_rss_queues(adapter);
1444 
1445 	/* Report info for other vector */
1446 	if (adapter->flags & IGC_FLAG_HAS_MSIX) {
1447 		ch->max_other = NON_Q_VECTORS;
1448 		ch->other_count = NON_Q_VECTORS;
1449 	}
1450 
1451 	ch->combined_count = adapter->rss_queues;
1452 }
1453 
1454 static int igc_ethtool_set_channels(struct net_device *netdev,
1455 				    struct ethtool_channels *ch)
1456 {
1457 	struct igc_adapter *adapter = netdev_priv(netdev);
1458 	unsigned int count = ch->combined_count;
1459 	unsigned int max_combined = 0;
1460 
1461 	/* Verify they are not requesting separate vectors */
1462 	if (!count || ch->rx_count || ch->tx_count)
1463 		return -EINVAL;
1464 
1465 	/* Verify other_count is valid and has not been changed */
1466 	if (ch->other_count != NON_Q_VECTORS)
1467 		return -EINVAL;
1468 
1469 	/* Verify the number of channels doesn't exceed hw limits */
1470 	max_combined = igc_get_max_rss_queues(adapter);
1471 	if (count > max_combined)
1472 		return -EINVAL;
1473 
1474 	if (count != adapter->rss_queues) {
1475 		adapter->rss_queues = count;
1476 		igc_set_flag_queue_pairs(adapter, max_combined);
1477 
1478 		/* Hardware has to reinitialize queues and interrupts to
1479 		 * match the new configuration.
1480 		 */
1481 		return igc_reinit_queues(adapter);
1482 	}
1483 
1484 	return 0;
1485 }
1486 
1487 static int igc_ethtool_get_ts_info(struct net_device *dev,
1488 				   struct ethtool_ts_info *info)
1489 {
1490 	struct igc_adapter *adapter = netdev_priv(dev);
1491 
1492 	if (adapter->ptp_clock)
1493 		info->phc_index = ptp_clock_index(adapter->ptp_clock);
1494 	else
1495 		info->phc_index = -1;
1496 
1497 	switch (adapter->hw.mac.type) {
1498 	case igc_i225:
1499 		info->so_timestamping =
1500 			SOF_TIMESTAMPING_TX_SOFTWARE |
1501 			SOF_TIMESTAMPING_RX_SOFTWARE |
1502 			SOF_TIMESTAMPING_SOFTWARE |
1503 			SOF_TIMESTAMPING_TX_HARDWARE |
1504 			SOF_TIMESTAMPING_RX_HARDWARE |
1505 			SOF_TIMESTAMPING_RAW_HARDWARE;
1506 
1507 		info->tx_types =
1508 			BIT(HWTSTAMP_TX_OFF) |
1509 			BIT(HWTSTAMP_TX_ON);
1510 
1511 		info->rx_filters = BIT(HWTSTAMP_FILTER_NONE);
1512 		info->rx_filters |= BIT(HWTSTAMP_FILTER_ALL);
1513 
1514 		return 0;
1515 	default:
1516 		return -EOPNOTSUPP;
1517 	}
1518 }
1519 
1520 static u32 igc_ethtool_get_priv_flags(struct net_device *netdev)
1521 {
1522 	struct igc_adapter *adapter = netdev_priv(netdev);
1523 	u32 priv_flags = 0;
1524 
1525 	if (adapter->flags & IGC_FLAG_RX_LEGACY)
1526 		priv_flags |= IGC_PRIV_FLAGS_LEGACY_RX;
1527 
1528 	return priv_flags;
1529 }
1530 
1531 static int igc_ethtool_set_priv_flags(struct net_device *netdev, u32 priv_flags)
1532 {
1533 	struct igc_adapter *adapter = netdev_priv(netdev);
1534 	unsigned int flags = adapter->flags;
1535 
1536 	flags &= ~IGC_FLAG_RX_LEGACY;
1537 	if (priv_flags & IGC_PRIV_FLAGS_LEGACY_RX)
1538 		flags |= IGC_FLAG_RX_LEGACY;
1539 
1540 	if (flags != adapter->flags) {
1541 		adapter->flags = flags;
1542 
1543 		/* reset interface to repopulate queues */
1544 		if (netif_running(netdev))
1545 			igc_reinit_locked(adapter);
1546 	}
1547 
1548 	return 0;
1549 }
1550 
1551 static int igc_ethtool_begin(struct net_device *netdev)
1552 {
1553 	struct igc_adapter *adapter = netdev_priv(netdev);
1554 
1555 	pm_runtime_get_sync(&adapter->pdev->dev);
1556 	return 0;
1557 }
1558 
1559 static void igc_ethtool_complete(struct net_device *netdev)
1560 {
1561 	struct igc_adapter *adapter = netdev_priv(netdev);
1562 
1563 	pm_runtime_put(&adapter->pdev->dev);
1564 }
1565 
1566 static int igc_ethtool_get_link_ksettings(struct net_device *netdev,
1567 					  struct ethtool_link_ksettings *cmd)
1568 {
1569 	struct igc_adapter *adapter = netdev_priv(netdev);
1570 	struct igc_hw *hw = &adapter->hw;
1571 	u32 status;
1572 	u32 speed;
1573 
1574 	ethtool_link_ksettings_zero_link_mode(cmd, supported);
1575 	ethtool_link_ksettings_zero_link_mode(cmd, advertising);
1576 
1577 	/* supported link modes */
1578 	ethtool_link_ksettings_add_link_mode(cmd, supported, 10baseT_Half);
1579 	ethtool_link_ksettings_add_link_mode(cmd, supported, 10baseT_Full);
1580 	ethtool_link_ksettings_add_link_mode(cmd, supported, 100baseT_Half);
1581 	ethtool_link_ksettings_add_link_mode(cmd, supported, 100baseT_Full);
1582 	ethtool_link_ksettings_add_link_mode(cmd, supported, 1000baseT_Full);
1583 	ethtool_link_ksettings_add_link_mode(cmd, supported, 2500baseT_Full);
1584 
1585 	/* twisted pair */
1586 	cmd->base.port = PORT_TP;
1587 	cmd->base.phy_address = hw->phy.addr;
1588 
1589 	/* advertising link modes */
1590 	ethtool_link_ksettings_add_link_mode(cmd, advertising, 10baseT_Half);
1591 	ethtool_link_ksettings_add_link_mode(cmd, advertising, 10baseT_Full);
1592 	ethtool_link_ksettings_add_link_mode(cmd, advertising, 100baseT_Half);
1593 	ethtool_link_ksettings_add_link_mode(cmd, advertising, 100baseT_Full);
1594 	ethtool_link_ksettings_add_link_mode(cmd, advertising, 1000baseT_Full);
1595 	ethtool_link_ksettings_add_link_mode(cmd, advertising, 2500baseT_Full);
1596 
1597 	/* set autoneg settings */
1598 	if (hw->mac.autoneg == 1) {
1599 		ethtool_link_ksettings_add_link_mode(cmd, supported, Autoneg);
1600 		ethtool_link_ksettings_add_link_mode(cmd, advertising,
1601 						     Autoneg);
1602 	}
1603 
1604 	switch (hw->fc.requested_mode) {
1605 	case igc_fc_full:
1606 		ethtool_link_ksettings_add_link_mode(cmd, advertising, Pause);
1607 		break;
1608 	case igc_fc_rx_pause:
1609 		ethtool_link_ksettings_add_link_mode(cmd, advertising, Pause);
1610 		ethtool_link_ksettings_add_link_mode(cmd, advertising,
1611 						     Asym_Pause);
1612 		break;
1613 	case igc_fc_tx_pause:
1614 		ethtool_link_ksettings_add_link_mode(cmd, advertising,
1615 						     Asym_Pause);
1616 		break;
1617 	default:
1618 		ethtool_link_ksettings_add_link_mode(cmd, advertising, Pause);
1619 		ethtool_link_ksettings_add_link_mode(cmd, advertising,
1620 						     Asym_Pause);
1621 	}
1622 
1623 	status = rd32(IGC_STATUS);
1624 
1625 	if (status & IGC_STATUS_LU) {
1626 		if (status & IGC_STATUS_SPEED_1000) {
1627 			/* For I225, STATUS will indicate 1G speed in both
1628 			 * 1 Gbps and 2.5 Gbps link modes.
1629 			 * An additional bit is used
1630 			 * to differentiate between 1 Gbps and 2.5 Gbps.
1631 			 */
1632 			if (hw->mac.type == igc_i225 &&
1633 			    (status & IGC_STATUS_SPEED_2500)) {
1634 				speed = SPEED_2500;
1635 			} else {
1636 				speed = SPEED_1000;
1637 			}
1638 		} else if (status & IGC_STATUS_SPEED_100) {
1639 			speed = SPEED_100;
1640 		} else {
1641 			speed = SPEED_10;
1642 		}
1643 		if ((status & IGC_STATUS_FD) ||
1644 		    hw->phy.media_type != igc_media_type_copper)
1645 			cmd->base.duplex = DUPLEX_FULL;
1646 		else
1647 			cmd->base.duplex = DUPLEX_HALF;
1648 	} else {
1649 		speed = SPEED_UNKNOWN;
1650 		cmd->base.duplex = DUPLEX_UNKNOWN;
1651 	}
1652 	cmd->base.speed = speed;
1653 	if (hw->mac.autoneg)
1654 		cmd->base.autoneg = AUTONEG_ENABLE;
1655 	else
1656 		cmd->base.autoneg = AUTONEG_DISABLE;
1657 
1658 	/* MDI-X => 2; MDI =>1; Invalid =>0 */
1659 	if (hw->phy.media_type == igc_media_type_copper)
1660 		cmd->base.eth_tp_mdix = hw->phy.is_mdix ? ETH_TP_MDI_X :
1661 						      ETH_TP_MDI;
1662 	else
1663 		cmd->base.eth_tp_mdix = ETH_TP_MDI_INVALID;
1664 
1665 	if (hw->phy.mdix == AUTO_ALL_MODES)
1666 		cmd->base.eth_tp_mdix_ctrl = ETH_TP_MDI_AUTO;
1667 	else
1668 		cmd->base.eth_tp_mdix_ctrl = hw->phy.mdix;
1669 
1670 	return 0;
1671 }
1672 
1673 static int
1674 igc_ethtool_set_link_ksettings(struct net_device *netdev,
1675 			       const struct ethtool_link_ksettings *cmd)
1676 {
1677 	struct igc_adapter *adapter = netdev_priv(netdev);
1678 	struct net_device *dev = adapter->netdev;
1679 	struct igc_hw *hw = &adapter->hw;
1680 	u32 advertising;
1681 
1682 	/* When adapter in resetting mode, autoneg/speed/duplex
1683 	 * cannot be changed
1684 	 */
1685 	if (igc_check_reset_block(hw)) {
1686 		netdev_err(dev, "Cannot change link characteristics when reset is active\n");
1687 		return -EINVAL;
1688 	}
1689 
1690 	/* MDI setting is only allowed when autoneg enabled because
1691 	 * some hardware doesn't allow MDI setting when speed or
1692 	 * duplex is forced.
1693 	 */
1694 	if (cmd->base.eth_tp_mdix_ctrl) {
1695 		if (cmd->base.eth_tp_mdix_ctrl != ETH_TP_MDI_AUTO &&
1696 		    cmd->base.autoneg != AUTONEG_ENABLE) {
1697 			netdev_err(dev, "Forcing MDI/MDI-X state is not supported when link speed and/or duplex are forced\n");
1698 			return -EINVAL;
1699 		}
1700 	}
1701 
1702 	while (test_and_set_bit(__IGC_RESETTING, &adapter->state))
1703 		usleep_range(1000, 2000);
1704 
1705 	ethtool_convert_link_mode_to_legacy_u32(&advertising,
1706 						cmd->link_modes.advertising);
1707 
1708 	if (cmd->base.autoneg == AUTONEG_ENABLE) {
1709 		hw->mac.autoneg = 1;
1710 		hw->phy.autoneg_advertised = advertising;
1711 		if (adapter->fc_autoneg)
1712 			hw->fc.requested_mode = igc_fc_default;
1713 	} else {
1714 		netdev_info(dev, "Force mode currently not supported\n");
1715 	}
1716 
1717 	/* MDI-X => 2; MDI => 1; Auto => 3 */
1718 	if (cmd->base.eth_tp_mdix_ctrl) {
1719 		/* fix up the value for auto (3 => 0) as zero is mapped
1720 		 * internally to auto
1721 		 */
1722 		if (cmd->base.eth_tp_mdix_ctrl == ETH_TP_MDI_AUTO)
1723 			hw->phy.mdix = AUTO_ALL_MODES;
1724 		else
1725 			hw->phy.mdix = cmd->base.eth_tp_mdix_ctrl;
1726 	}
1727 
1728 	/* reset the link */
1729 	if (netif_running(adapter->netdev)) {
1730 		igc_down(adapter);
1731 		igc_up(adapter);
1732 	} else {
1733 		igc_reset(adapter);
1734 	}
1735 
1736 	clear_bit(__IGC_RESETTING, &adapter->state);
1737 
1738 	return 0;
1739 }
1740 
1741 static void igc_ethtool_diag_test(struct net_device *netdev,
1742 				  struct ethtool_test *eth_test, u64 *data)
1743 {
1744 	struct igc_adapter *adapter = netdev_priv(netdev);
1745 	bool if_running = netif_running(netdev);
1746 
1747 	if (eth_test->flags == ETH_TEST_FL_OFFLINE) {
1748 		netdev_info(adapter->netdev, "Offline testing starting");
1749 		set_bit(__IGC_TESTING, &adapter->state);
1750 
1751 		/* Link test performed before hardware reset so autoneg doesn't
1752 		 * interfere with test result
1753 		 */
1754 		if (!igc_link_test(adapter, &data[TEST_LINK]))
1755 			eth_test->flags |= ETH_TEST_FL_FAILED;
1756 
1757 		if (if_running)
1758 			igc_close(netdev);
1759 		else
1760 			igc_reset(adapter);
1761 
1762 		netdev_info(adapter->netdev, "Register testing starting");
1763 		if (!igc_reg_test(adapter, &data[TEST_REG]))
1764 			eth_test->flags |= ETH_TEST_FL_FAILED;
1765 
1766 		igc_reset(adapter);
1767 
1768 		netdev_info(adapter->netdev, "EEPROM testing starting");
1769 		if (!igc_eeprom_test(adapter, &data[TEST_EEP]))
1770 			eth_test->flags |= ETH_TEST_FL_FAILED;
1771 
1772 		igc_reset(adapter);
1773 
1774 		/* loopback and interrupt tests
1775 		 * will be implemented in the future
1776 		 */
1777 		data[TEST_LOOP] = 0;
1778 		data[TEST_IRQ] = 0;
1779 
1780 		clear_bit(__IGC_TESTING, &adapter->state);
1781 		if (if_running)
1782 			igc_open(netdev);
1783 	} else {
1784 		netdev_info(adapter->netdev, "Online testing starting");
1785 
1786 		/* register, eeprom, intr and loopback tests not run online */
1787 		data[TEST_REG] = 0;
1788 		data[TEST_EEP] = 0;
1789 		data[TEST_IRQ] = 0;
1790 		data[TEST_LOOP] = 0;
1791 
1792 		if (!igc_link_test(adapter, &data[TEST_LINK]))
1793 			eth_test->flags |= ETH_TEST_FL_FAILED;
1794 	}
1795 
1796 	msleep_interruptible(4 * 1000);
1797 }
1798 
1799 static const struct ethtool_ops igc_ethtool_ops = {
1800 	.supported_coalesce_params = ETHTOOL_COALESCE_USECS,
1801 	.get_drvinfo		= igc_ethtool_get_drvinfo,
1802 	.get_regs_len		= igc_ethtool_get_regs_len,
1803 	.get_regs		= igc_ethtool_get_regs,
1804 	.get_wol		= igc_ethtool_get_wol,
1805 	.set_wol		= igc_ethtool_set_wol,
1806 	.get_msglevel		= igc_ethtool_get_msglevel,
1807 	.set_msglevel		= igc_ethtool_set_msglevel,
1808 	.nway_reset		= igc_ethtool_nway_reset,
1809 	.get_link		= igc_ethtool_get_link,
1810 	.get_eeprom_len		= igc_ethtool_get_eeprom_len,
1811 	.get_eeprom		= igc_ethtool_get_eeprom,
1812 	.set_eeprom		= igc_ethtool_set_eeprom,
1813 	.get_ringparam		= igc_ethtool_get_ringparam,
1814 	.set_ringparam		= igc_ethtool_set_ringparam,
1815 	.get_pauseparam		= igc_ethtool_get_pauseparam,
1816 	.set_pauseparam		= igc_ethtool_set_pauseparam,
1817 	.get_strings		= igc_ethtool_get_strings,
1818 	.get_sset_count		= igc_ethtool_get_sset_count,
1819 	.get_ethtool_stats	= igc_ethtool_get_stats,
1820 	.get_coalesce		= igc_ethtool_get_coalesce,
1821 	.set_coalesce		= igc_ethtool_set_coalesce,
1822 	.get_rxnfc		= igc_ethtool_get_rxnfc,
1823 	.set_rxnfc		= igc_ethtool_set_rxnfc,
1824 	.get_rxfh_indir_size	= igc_ethtool_get_rxfh_indir_size,
1825 	.get_rxfh		= igc_ethtool_get_rxfh,
1826 	.set_rxfh		= igc_ethtool_set_rxfh,
1827 	.get_ts_info		= igc_ethtool_get_ts_info,
1828 	.get_channels		= igc_ethtool_get_channels,
1829 	.set_channels		= igc_ethtool_set_channels,
1830 	.get_priv_flags		= igc_ethtool_get_priv_flags,
1831 	.set_priv_flags		= igc_ethtool_set_priv_flags,
1832 	.begin			= igc_ethtool_begin,
1833 	.complete		= igc_ethtool_complete,
1834 	.get_link_ksettings	= igc_ethtool_get_link_ksettings,
1835 	.set_link_ksettings	= igc_ethtool_set_link_ksettings,
1836 	.self_test		= igc_ethtool_diag_test,
1837 };
1838 
1839 void igc_ethtool_set_ops(struct net_device *netdev)
1840 {
1841 	netdev->ethtool_ops = &igc_ethtool_ops;
1842 }
1843