]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/net/ethernet/intel/ixgbevf/ethtool.c
projects / mirror_ubuntu-artful-kernel.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
ixgbevf: convert to ndo_fix_features
[mirror_ubuntu-artful-kernel.git] / drivers / net / ethernet / intel / ixgbevf / ethtool.c
1 /*******************************************************************************
2
3 Intel 82599 Virtual Function driver
4 Copyright(c) 1999 - 2009 Intel Corporation.
5
6 This program is free software; you can redistribute it and/or modify it
7 under the terms and conditions of the GNU General Public License,
8 version 2, as published by the Free Software Foundation.
9
10 This program is distributed in the hope it will be useful, but WITHOUT
11 ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12 FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
13 more details.
14
15 You should have received a copy of the GNU General Public License along with
16 this program; if not, write to the Free Software Foundation, Inc.,
17 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
18
19 The full GNU General Public License is included in this distribution in
20 the file called "COPYING".
21
22 Contact Information:
23 e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
24 Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
25
26 *******************************************************************************/
27
28 /* ethtool support for ixgbevf */
29
30 #include <linux/types.h>
31 #include <linux/module.h>
32 #include <linux/slab.h>
33 #include <linux/pci.h>
34 #include <linux/netdevice.h>
35 #include <linux/ethtool.h>
36 #include <linux/vmalloc.h>
37 #include <linux/if_vlan.h>
38 #include <linux/uaccess.h>
39
40 #include "ixgbevf.h"
41
42 #define IXGBE_ALL_RAR_ENTRIES 16
43
44 #ifdef ETHTOOL_GSTATS
45 struct ixgbe_stats {
46 char stat_string[ETH_GSTRING_LEN];
47 int sizeof_stat;
48 int stat_offset;
49 int base_stat_offset;
50 int saved_reset_offset;
51 };
52
53 #define IXGBEVF_STAT(m, b, r) sizeof(((struct ixgbevf_adapter *)0)->m), \
54 offsetof(struct ixgbevf_adapter, m), \
55 offsetof(struct ixgbevf_adapter, b), \
56 offsetof(struct ixgbevf_adapter, r)
57 static struct ixgbe_stats ixgbe_gstrings_stats[] = {
58 {"rx_packets", IXGBEVF_STAT(stats.vfgprc, stats.base_vfgprc,
59 stats.saved_reset_vfgprc)},
60 {"tx_packets", IXGBEVF_STAT(stats.vfgptc, stats.base_vfgptc,
61 stats.saved_reset_vfgptc)},
62 {"rx_bytes", IXGBEVF_STAT(stats.vfgorc, stats.base_vfgorc,
63 stats.saved_reset_vfgorc)},
64 {"tx_bytes", IXGBEVF_STAT(stats.vfgotc, stats.base_vfgotc,
65 stats.saved_reset_vfgotc)},
66 {"tx_busy", IXGBEVF_STAT(tx_busy, zero_base, zero_base)},
67 {"multicast", IXGBEVF_STAT(stats.vfmprc, stats.base_vfmprc,
68 stats.saved_reset_vfmprc)},
69 {"rx_csum_offload_good", IXGBEVF_STAT(hw_csum_rx_good, zero_base,
70 zero_base)},
71 {"rx_csum_offload_errors", IXGBEVF_STAT(hw_csum_rx_error, zero_base,
72 zero_base)},
73 {"tx_csum_offload_ctxt", IXGBEVF_STAT(hw_csum_tx_good, zero_base,
74 zero_base)},
75 {"rx_header_split", IXGBEVF_STAT(rx_hdr_split, zero_base, zero_base)},
76 };
77
78 #define IXGBE_QUEUE_STATS_LEN 0
79 #define IXGBE_GLOBAL_STATS_LEN ARRAY_SIZE(ixgbe_gstrings_stats)
80
81 #define IXGBEVF_STATS_LEN (IXGBE_GLOBAL_STATS_LEN + IXGBE_QUEUE_STATS_LEN)
82 #endif /* ETHTOOL_GSTATS */
83 #ifdef ETHTOOL_TEST
84 static const char ixgbe_gstrings_test[][ETH_GSTRING_LEN] = {
85 "Register test (offline)",
86 "Link test (on/offline)"
87 };
88 #define IXGBE_TEST_LEN (sizeof(ixgbe_gstrings_test) / ETH_GSTRING_LEN)
89 #endif /* ETHTOOL_TEST */
90
91 static int ixgbevf_get_settings(struct net_device *netdev,
92 struct ethtool_cmd *ecmd)
93 {
94 struct ixgbevf_adapter *adapter = netdev_priv(netdev);
95 struct ixgbe_hw *hw = &adapter->hw;
96 u32 link_speed = 0;
97 bool link_up;
98
99 ecmd->supported = SUPPORTED_10000baseT_Full;
100 ecmd->autoneg = AUTONEG_DISABLE;
101 ecmd->transceiver = XCVR_DUMMY1;
102 ecmd->port = -1;
103
104 hw->mac.ops.check_link(hw, &link_speed, &link_up, false);
105
106 if (link_up) {
107 ethtool_cmd_speed_set(
108 ecmd,
109 (link_speed == IXGBE_LINK_SPEED_10GB_FULL) ?
110 SPEED_10000 : SPEED_1000);
111 ecmd->duplex = DUPLEX_FULL;
112 } else {
113 ethtool_cmd_speed_set(ecmd, -1);
114 ecmd->duplex = -1;
115 }
116
117 return 0;
118 }
119
120 static u32 ixgbevf_get_msglevel(struct net_device *netdev)
121 {
122 struct ixgbevf_adapter *adapter = netdev_priv(netdev);
123 return adapter->msg_enable;
124 }
125
126 static void ixgbevf_set_msglevel(struct net_device *netdev, u32 data)
127 {
128 struct ixgbevf_adapter *adapter = netdev_priv(netdev);
129 adapter->msg_enable = data;
130 }
131
132 #define IXGBE_GET_STAT(_A_, _R_) (_A_->stats._R_)
133
134 static char *ixgbevf_reg_names[] = {
135 "IXGBE_VFCTRL",
136 "IXGBE_VFSTATUS",
137 "IXGBE_VFLINKS",
138 "IXGBE_VFRXMEMWRAP",
139 "IXGBE_VFFRTIMER",
140 "IXGBE_VTEICR",
141 "IXGBE_VTEICS",
142 "IXGBE_VTEIMS",
143 "IXGBE_VTEIMC",
144 "IXGBE_VTEIAC",
145 "IXGBE_VTEIAM",
146 "IXGBE_VTEITR",
147 "IXGBE_VTIVAR",
148 "IXGBE_VTIVAR_MISC",
149 "IXGBE_VFRDBAL0",
150 "IXGBE_VFRDBAL1",
151 "IXGBE_VFRDBAH0",
152 "IXGBE_VFRDBAH1",
153 "IXGBE_VFRDLEN0",
154 "IXGBE_VFRDLEN1",
155 "IXGBE_VFRDH0",
156 "IXGBE_VFRDH1",
157 "IXGBE_VFRDT0",
158 "IXGBE_VFRDT1",
159 "IXGBE_VFRXDCTL0",
160 "IXGBE_VFRXDCTL1",
161 "IXGBE_VFSRRCTL0",
162 "IXGBE_VFSRRCTL1",
163 "IXGBE_VFPSRTYPE",
164 "IXGBE_VFTDBAL0",
165 "IXGBE_VFTDBAL1",
166 "IXGBE_VFTDBAH0",
167 "IXGBE_VFTDBAH1",
168 "IXGBE_VFTDLEN0",
169 "IXGBE_VFTDLEN1",
170 "IXGBE_VFTDH0",
171 "IXGBE_VFTDH1",
172 "IXGBE_VFTDT0",
173 "IXGBE_VFTDT1",
174 "IXGBE_VFTXDCTL0",
175 "IXGBE_VFTXDCTL1",
176 "IXGBE_VFTDWBAL0",
177 "IXGBE_VFTDWBAL1",
178 "IXGBE_VFTDWBAH0",
179 "IXGBE_VFTDWBAH1"
180 };
181
182
183 static int ixgbevf_get_regs_len(struct net_device *netdev)
184 {
185 return (ARRAY_SIZE(ixgbevf_reg_names)) * sizeof(u32);
186 }
187
188 static void ixgbevf_get_regs(struct net_device *netdev,
189 struct ethtool_regs *regs,
190 void *p)
191 {
192 struct ixgbevf_adapter *adapter = netdev_priv(netdev);
193 struct ixgbe_hw *hw = &adapter->hw;
194 u32 *regs_buff = p;
195 u32 regs_len = ixgbevf_get_regs_len(netdev);
196 u8 i;
197
198 memset(p, 0, regs_len);
199
200 regs->version = (1 << 24) | hw->revision_id << 16 | hw->device_id;
201
202 /* General Registers */
203 regs_buff[0] = IXGBE_READ_REG(hw, IXGBE_VFCTRL);
204 regs_buff[1] = IXGBE_READ_REG(hw, IXGBE_VFSTATUS);
205 regs_buff[2] = IXGBE_READ_REG(hw, IXGBE_VFLINKS);
206 regs_buff[3] = IXGBE_READ_REG(hw, IXGBE_VFRXMEMWRAP);
207 regs_buff[4] = IXGBE_READ_REG(hw, IXGBE_VFFRTIMER);
208
209 /* Interrupt */
210 /* don't read EICR because it can clear interrupt causes, instead
211 * read EICS which is a shadow but doesn't clear EICR */
212 regs_buff[5] = IXGBE_READ_REG(hw, IXGBE_VTEICS);
213 regs_buff[6] = IXGBE_READ_REG(hw, IXGBE_VTEICS);
214 regs_buff[7] = IXGBE_READ_REG(hw, IXGBE_VTEIMS);
215 regs_buff[8] = IXGBE_READ_REG(hw, IXGBE_VTEIMC);
216 regs_buff[9] = IXGBE_READ_REG(hw, IXGBE_VTEIAC);
217 regs_buff[10] = IXGBE_READ_REG(hw, IXGBE_VTEIAM);
218 regs_buff[11] = IXGBE_READ_REG(hw, IXGBE_VTEITR(0));
219 regs_buff[12] = IXGBE_READ_REG(hw, IXGBE_VTIVAR(0));
220 regs_buff[13] = IXGBE_READ_REG(hw, IXGBE_VTIVAR_MISC);
221
222 /* Receive DMA */
223 for (i = 0; i < 2; i++)
224 regs_buff[14 + i] = IXGBE_READ_REG(hw, IXGBE_VFRDBAL(i));
225 for (i = 0; i < 2; i++)
226 regs_buff[16 + i] = IXGBE_READ_REG(hw, IXGBE_VFRDBAH(i));
227 for (i = 0; i < 2; i++)
228 regs_buff[18 + i] = IXGBE_READ_REG(hw, IXGBE_VFRDLEN(i));
229 for (i = 0; i < 2; i++)
230 regs_buff[20 + i] = IXGBE_READ_REG(hw, IXGBE_VFRDH(i));
231 for (i = 0; i < 2; i++)
232 regs_buff[22 + i] = IXGBE_READ_REG(hw, IXGBE_VFRDT(i));
233 for (i = 0; i < 2; i++)
234 regs_buff[24 + i] = IXGBE_READ_REG(hw, IXGBE_VFRXDCTL(i));
235 for (i = 0; i < 2; i++)
236 regs_buff[26 + i] = IXGBE_READ_REG(hw, IXGBE_VFSRRCTL(i));
237
238 /* Receive */
239 regs_buff[28] = IXGBE_READ_REG(hw, IXGBE_VFPSRTYPE);
240
241 /* Transmit */
242 for (i = 0; i < 2; i++)
243 regs_buff[29 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDBAL(i));
244 for (i = 0; i < 2; i++)
245 regs_buff[31 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDBAH(i));
246 for (i = 0; i < 2; i++)
247 regs_buff[33 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDLEN(i));
248 for (i = 0; i < 2; i++)
249 regs_buff[35 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDH(i));
250 for (i = 0; i < 2; i++)
251 regs_buff[37 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDT(i));
252 for (i = 0; i < 2; i++)
253 regs_buff[39 + i] = IXGBE_READ_REG(hw, IXGBE_VFTXDCTL(i));
254 for (i = 0; i < 2; i++)
255 regs_buff[41 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDWBAL(i));
256 for (i = 0; i < 2; i++)
257 regs_buff[43 + i] = IXGBE_READ_REG(hw, IXGBE_VFTDWBAH(i));
258
259 for (i = 0; i < ARRAY_SIZE(ixgbevf_reg_names); i++)
260 hw_dbg(hw, "%s\t%8.8x\n", ixgbevf_reg_names[i], regs_buff[i]);
261 }
262
263 static void ixgbevf_get_drvinfo(struct net_device *netdev,
264 struct ethtool_drvinfo *drvinfo)
265 {
266 struct ixgbevf_adapter *adapter = netdev_priv(netdev);
267
268 strlcpy(drvinfo->driver, ixgbevf_driver_name, 32);
269 strlcpy(drvinfo->version, ixgbevf_driver_version, 32);
270
271 strlcpy(drvinfo->fw_version, "N/A", 4);
272 strlcpy(drvinfo->bus_info, pci_name(adapter->pdev), 32);
273 }
274
275 static void ixgbevf_get_ringparam(struct net_device *netdev,
276 struct ethtool_ringparam *ring)
277 {
278 struct ixgbevf_adapter *adapter = netdev_priv(netdev);
279 struct ixgbevf_ring *tx_ring = adapter->tx_ring;
280 struct ixgbevf_ring *rx_ring = adapter->rx_ring;
281
282 ring->rx_max_pending = IXGBEVF_MAX_RXD;
283 ring->tx_max_pending = IXGBEVF_MAX_TXD;
284 ring->rx_mini_max_pending = 0;
285 ring->rx_jumbo_max_pending = 0;
286 ring->rx_pending = rx_ring->count;
287 ring->tx_pending = tx_ring->count;
288 ring->rx_mini_pending = 0;
289 ring->rx_jumbo_pending = 0;
290 }
291
292 static int ixgbevf_set_ringparam(struct net_device *netdev,
293 struct ethtool_ringparam *ring)
294 {
295 struct ixgbevf_adapter *adapter = netdev_priv(netdev);
296 struct ixgbevf_ring *tx_ring = NULL, *rx_ring = NULL;
297 int i, err = 0;
298 u32 new_rx_count, new_tx_count;
299
300 if ((ring->rx_mini_pending) || (ring->rx_jumbo_pending))
301 return -EINVAL;
302
303 new_rx_count = max(ring->rx_pending, (u32)IXGBEVF_MIN_RXD);
304 new_rx_count = min(new_rx_count, (u32)IXGBEVF_MAX_RXD);
305 new_rx_count = ALIGN(new_rx_count, IXGBE_REQ_RX_DESCRIPTOR_MULTIPLE);
306
307 new_tx_count = max(ring->tx_pending, (u32)IXGBEVF_MIN_TXD);
308 new_tx_count = min(new_tx_count, (u32)IXGBEVF_MAX_TXD);
309 new_tx_count = ALIGN(new_tx_count, IXGBE_REQ_TX_DESCRIPTOR_MULTIPLE);
310
311 if ((new_tx_count == adapter->tx_ring->count) &&
312 (new_rx_count == adapter->rx_ring->count)) {
313 /* nothing to do */
314 return 0;
315 }
316
317 while (test_and_set_bit(__IXGBEVF_RESETTING, &adapter->state))
318 msleep(1);
319
320 /*
321 * If the adapter isn't up and running then just set the
322 * new parameters and scurry for the exits.
323 */
324 if (!netif_running(adapter->netdev)) {
325 for (i = 0; i < adapter->num_tx_queues; i++)
326 adapter->tx_ring[i].count = new_tx_count;
327 for (i = 0; i < adapter->num_rx_queues; i++)
328 adapter->rx_ring[i].count = new_rx_count;
329 adapter->tx_ring_count = new_tx_count;
330 adapter->rx_ring_count = new_rx_count;
331 goto clear_reset;
332 }
333
334 tx_ring = kcalloc(adapter->num_tx_queues,
335 sizeof(struct ixgbevf_ring), GFP_KERNEL);
336 if (!tx_ring) {
337 err = -ENOMEM;
338 goto clear_reset;
339 }
340
341 rx_ring = kcalloc(adapter->num_rx_queues,
342 sizeof(struct ixgbevf_ring), GFP_KERNEL);
343 if (!rx_ring) {
344 err = -ENOMEM;
345 goto err_rx_setup;
346 }
347
348 ixgbevf_down(adapter);
349
350 memcpy(tx_ring, adapter->tx_ring,
351 adapter->num_tx_queues * sizeof(struct ixgbevf_ring));
352 for (i = 0; i < adapter->num_tx_queues; i++) {
353 tx_ring[i].count = new_tx_count;
354 err = ixgbevf_setup_tx_resources(adapter, &tx_ring[i]);
355 if (err) {
356 while (i) {
357 i--;
358 ixgbevf_free_tx_resources(adapter,
359 &tx_ring[i]);
360 }
361 goto err_tx_ring_setup;
362 }
363 tx_ring[i].v_idx = adapter->tx_ring[i].v_idx;
364 }
365
366 memcpy(rx_ring, adapter->rx_ring,
367 adapter->num_rx_queues * sizeof(struct ixgbevf_ring));
368 for (i = 0; i < adapter->num_rx_queues; i++) {
369 rx_ring[i].count = new_rx_count;
370 err = ixgbevf_setup_rx_resources(adapter, &rx_ring[i]);
371 if (err) {
372 while (i) {
373 i--;
374 ixgbevf_free_rx_resources(adapter,
375 &rx_ring[i]);
376 }
377 goto err_rx_ring_setup;
378 }
379 rx_ring[i].v_idx = adapter->rx_ring[i].v_idx;
380 }
381
382 /*
383 * Only switch to new rings if all the prior allocations
384 * and ring setups have succeeded.
385 */
386 kfree(adapter->tx_ring);
387 adapter->tx_ring = tx_ring;
388 adapter->tx_ring_count = new_tx_count;
389
390 kfree(adapter->rx_ring);
391 adapter->rx_ring = rx_ring;
392 adapter->rx_ring_count = new_rx_count;
393
394 /* success! */
395 ixgbevf_up(adapter);
396
397 goto clear_reset;
398
399 err_rx_ring_setup:
400 for(i = 0; i < adapter->num_tx_queues; i++)
401 ixgbevf_free_tx_resources(adapter, &tx_ring[i]);
402
403 err_tx_ring_setup:
404 kfree(rx_ring);
405
406 err_rx_setup:
407 kfree(tx_ring);
408
409 clear_reset:
410 clear_bit(__IXGBEVF_RESETTING, &adapter->state);
411 return err;
412 }
413
414 static int ixgbevf_get_sset_count(struct net_device *dev, int stringset)
415 {
416 switch (stringset) {
417 case ETH_SS_TEST:
418 return IXGBE_TEST_LEN;
419 case ETH_SS_STATS:
420 return IXGBE_GLOBAL_STATS_LEN;
421 default:
422 return -EINVAL;
423 }
424 }
425
426 static void ixgbevf_get_ethtool_stats(struct net_device *netdev,
427 struct ethtool_stats *stats, u64 *data)
428 {
429 struct ixgbevf_adapter *adapter = netdev_priv(netdev);
430 int i;
431
432 ixgbevf_update_stats(adapter);
433 for (i = 0; i < IXGBE_GLOBAL_STATS_LEN; i++) {
434 char *p = (char *)adapter +
435 ixgbe_gstrings_stats[i].stat_offset;
436 char *b = (char *)adapter +
437 ixgbe_gstrings_stats[i].base_stat_offset;
438 char *r = (char *)adapter +
439 ixgbe_gstrings_stats[i].saved_reset_offset;
440 data[i] = ((ixgbe_gstrings_stats[i].sizeof_stat ==
441 sizeof(u64)) ? *(u64 *)p : *(u32 *)p) -
442 ((ixgbe_gstrings_stats[i].sizeof_stat ==
443 sizeof(u64)) ? *(u64 *)b : *(u32 *)b) +
444 ((ixgbe_gstrings_stats[i].sizeof_stat ==
445 sizeof(u64)) ? *(u64 *)r : *(u32 *)r);
446 }
447 }
448
449 static void ixgbevf_get_strings(struct net_device *netdev, u32 stringset,
450 u8 *data)
451 {
452 char *p = (char *)data;
453 int i;
454
455 switch (stringset) {
456 case ETH_SS_TEST:
457 memcpy(data, *ixgbe_gstrings_test,
458 IXGBE_TEST_LEN * ETH_GSTRING_LEN);
459 break;
460 case ETH_SS_STATS:
461 for (i = 0; i < IXGBE_GLOBAL_STATS_LEN; i++) {
462 memcpy(p, ixgbe_gstrings_stats[i].stat_string,
463 ETH_GSTRING_LEN);
464 p += ETH_GSTRING_LEN;
465 }
466 break;
467 }
468 }
469
470 static int ixgbevf_link_test(struct ixgbevf_adapter *adapter, u64 *data)
471 {
472 struct ixgbe_hw *hw = &adapter->hw;
473 bool link_up;
474 u32 link_speed = 0;
475 *data = 0;
476
477 hw->mac.ops.check_link(hw, &link_speed, &link_up, true);
478 if (!link_up)
479 *data = 1;
480
481 return *data;
482 }
483
484 /* ethtool register test data */
485 struct ixgbevf_reg_test {
486 u16 reg;
487 u8 array_len;
488 u8 test_type;
489 u32 mask;
490 u32 write;
491 };
492
493 /* In the hardware, registers are laid out either singly, in arrays
494 * spaced 0x40 bytes apart, or in contiguous tables. We assume
495 * most tests take place on arrays or single registers (handled
496 * as a single-element array) and special-case the tables.
497 * Table tests are always pattern tests.
498 *
499 * We also make provision for some required setup steps by specifying
500 * registers to be written without any read-back testing.
501 */
502
503 #define PATTERN_TEST 1
504 #define SET_READ_TEST 2
505 #define WRITE_NO_TEST 3
506 #define TABLE32_TEST 4
507 #define TABLE64_TEST_LO 5
508 #define TABLE64_TEST_HI 6
509
510 /* default VF register test */
511 static const struct ixgbevf_reg_test reg_test_vf[] = {
512 { IXGBE_VFRDBAL(0), 2, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFF80 },
513 { IXGBE_VFRDBAH(0), 2, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
514 { IXGBE_VFRDLEN(0), 2, PATTERN_TEST, 0x000FFF80, 0x000FFFFF },
515 { IXGBE_VFRXDCTL(0), 2, WRITE_NO_TEST, 0, IXGBE_RXDCTL_ENABLE },
516 { IXGBE_VFRDT(0), 2, PATTERN_TEST, 0x0000FFFF, 0x0000FFFF },
517 { IXGBE_VFRXDCTL(0), 2, WRITE_NO_TEST, 0, 0 },
518 { IXGBE_VFTDBAL(0), 2, PATTERN_TEST, 0xFFFFFF80, 0xFFFFFFFF },
519 { IXGBE_VFTDBAH(0), 2, PATTERN_TEST, 0xFFFFFFFF, 0xFFFFFFFF },
520 { IXGBE_VFTDLEN(0), 2, PATTERN_TEST, 0x000FFF80, 0x000FFF80 },
521 { 0, 0, 0, 0 }
522 };
523
524 static const u32 register_test_patterns[] = {
525 0x5A5A5A5A, 0xA5A5A5A5, 0x00000000, 0xFFFFFFFF
526 };
527
528 #define REG_PATTERN_TEST(R, M, W) \
529 { \
530 u32 pat, val, before; \
531 for (pat = 0; pat < ARRAY_SIZE(register_test_patterns); pat++) { \
532 before = readl(adapter->hw.hw_addr + R); \
533 writel((register_test_patterns[pat] & W), \
534 (adapter->hw.hw_addr + R)); \
535 val = readl(adapter->hw.hw_addr + R); \
536 if (val != (register_test_patterns[pat] & W & M)) { \
537 hw_dbg(&adapter->hw, \
538 "pattern test reg %04X failed: got " \
539 "0x%08X expected 0x%08X\n", \
540 R, val, (register_test_patterns[pat] & W & M)); \
541 *data = R; \
542 writel(before, adapter->hw.hw_addr + R); \
543 return 1; \
544 } \
545 writel(before, adapter->hw.hw_addr + R); \
546 } \
547 }
548
549 #define REG_SET_AND_CHECK(R, M, W) \
550 { \
551 u32 val, before; \
552 before = readl(adapter->hw.hw_addr + R); \
553 writel((W & M), (adapter->hw.hw_addr + R)); \
554 val = readl(adapter->hw.hw_addr + R); \
555 if ((W & M) != (val & M)) { \
556 printk(KERN_ERR "set/check reg %04X test failed: got 0x%08X " \
557 "expected 0x%08X\n", R, (val & M), (W & M)); \
558 *data = R; \
559 writel(before, (adapter->hw.hw_addr + R)); \
560 return 1; \
561 } \
562 writel(before, (adapter->hw.hw_addr + R)); \
563 }
564
565 static int ixgbevf_reg_test(struct ixgbevf_adapter *adapter, u64 *data)
566 {
567 const struct ixgbevf_reg_test *test;
568 u32 i;
569
570 test = reg_test_vf;
571
572 /*
573 * Perform the register test, looping through the test table
574 * until we either fail or reach the null entry.
575 */
576 while (test->reg) {
577 for (i = 0; i < test->array_len; i++) {
578 switch (test->test_type) {
579 case PATTERN_TEST:
580 REG_PATTERN_TEST(test->reg + (i * 0x40),
581 test->mask,
582 test->write);
583 break;
584 case SET_READ_TEST:
585 REG_SET_AND_CHECK(test->reg + (i * 0x40),
586 test->mask,
587 test->write);
588 break;
589 case WRITE_NO_TEST:
590 writel(test->write,
591 (adapter->hw.hw_addr + test->reg)
592 + (i * 0x40));
593 break;
594 case TABLE32_TEST:
595 REG_PATTERN_TEST(test->reg + (i * 4),
596 test->mask,
597 test->write);
598 break;
599 case TABLE64_TEST_LO:
600 REG_PATTERN_TEST(test->reg + (i * 8),
601 test->mask,
602 test->write);
603 break;
604 case TABLE64_TEST_HI:
605 REG_PATTERN_TEST((test->reg + 4) + (i * 8),
606 test->mask,
607 test->write);
608 break;
609 }
610 }
611 test++;
612 }
613
614 *data = 0;
615 return *data;
616 }
617
618 static void ixgbevf_diag_test(struct net_device *netdev,
619 struct ethtool_test *eth_test, u64 *data)
620 {
621 struct ixgbevf_adapter *adapter = netdev_priv(netdev);
622 bool if_running = netif_running(netdev);
623
624 set_bit(__IXGBEVF_TESTING, &adapter->state);
625 if (eth_test->flags == ETH_TEST_FL_OFFLINE) {
626 /* Offline tests */
627
628 hw_dbg(&adapter->hw, "offline testing starting\n");
629
630 /* Link test performed before hardware reset so autoneg doesn't
631 * interfere with test result */
632 if (ixgbevf_link_test(adapter, &data[1]))
633 eth_test->flags |= ETH_TEST_FL_FAILED;
634
635 if (if_running)
636 /* indicate we're in test mode */
637 dev_close(netdev);
638 else
639 ixgbevf_reset(adapter);
640
641 hw_dbg(&adapter->hw, "register testing starting\n");
642 if (ixgbevf_reg_test(adapter, &data[0]))
643 eth_test->flags |= ETH_TEST_FL_FAILED;
644
645 ixgbevf_reset(adapter);
646
647 clear_bit(__IXGBEVF_TESTING, &adapter->state);
648 if (if_running)
649 dev_open(netdev);
650 } else {
651 hw_dbg(&adapter->hw, "online testing starting\n");
652 /* Online tests */
653 if (ixgbevf_link_test(adapter, &data[1]))
654 eth_test->flags |= ETH_TEST_FL_FAILED;
655
656 /* Online tests aren't run; pass by default */
657 data[0] = 0;
658
659 clear_bit(__IXGBEVF_TESTING, &adapter->state);
660 }
661 msleep_interruptible(4 * 1000);
662 }
663
664 static int ixgbevf_nway_reset(struct net_device *netdev)
665 {
666 struct ixgbevf_adapter *adapter = netdev_priv(netdev);
667
668 if (netif_running(netdev)) {
669 if (!adapter->dev_closed)
670 ixgbevf_reinit_locked(adapter);
671 }
672
673 return 0;
674 }
675
676 static struct ethtool_ops ixgbevf_ethtool_ops = {
677 .get_settings = ixgbevf_get_settings,
678 .get_drvinfo = ixgbevf_get_drvinfo,
679 .get_regs_len = ixgbevf_get_regs_len,
680 .get_regs = ixgbevf_get_regs,
681 .nway_reset = ixgbevf_nway_reset,
682 .get_link = ethtool_op_get_link,
683 .get_ringparam = ixgbevf_get_ringparam,
684 .set_ringparam = ixgbevf_set_ringparam,
685 .get_msglevel = ixgbevf_get_msglevel,
686 .set_msglevel = ixgbevf_set_msglevel,
687 .self_test = ixgbevf_diag_test,
688 .get_sset_count = ixgbevf_get_sset_count,
689 .get_strings = ixgbevf_get_strings,
690 .get_ethtool_stats = ixgbevf_get_ethtool_stats,
691 };
692
693 void ixgbevf_set_ethtool_ops(struct net_device *netdev)
694 {
695 SET_ETHTOOL_OPS(netdev, &ixgbevf_ethtool_ops);
696 }
Ubuntu Artful kernel mirror