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