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