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