1 // SPDX-License-Identifier: GPL-2.0 2 /* Copyright(c) 2017 - 2019 Pensando Systems, Inc */ 3 4 #include <linux/module.h> 5 #include <linux/netdevice.h> 6 7 #include "ionic.h" 8 #include "ionic_bus.h" 9 #include "ionic_lif.h" 10 #include "ionic_ethtool.h" 11 #include "ionic_stats.h" 12 13 static const char ionic_priv_flags_strings[][ETH_GSTRING_LEN] = { 14 #define PRIV_F_SW_DBG_STATS BIT(0) 15 "sw-dbg-stats", 16 }; 17 #define PRIV_FLAGS_COUNT ARRAY_SIZE(ionic_priv_flags_strings) 18 19 static void ionic_get_stats_strings(struct ionic_lif *lif, u8 *buf) 20 { 21 u32 i; 22 23 for (i = 0; i < ionic_num_stats_grps; i++) 24 ionic_stats_groups[i].get_strings(lif, &buf); 25 } 26 27 static void ionic_get_stats(struct net_device *netdev, 28 struct ethtool_stats *stats, u64 *buf) 29 { 30 struct ionic_lif *lif; 31 u32 i; 32 33 lif = netdev_priv(netdev); 34 35 memset(buf, 0, stats->n_stats * sizeof(*buf)); 36 for (i = 0; i < ionic_num_stats_grps; i++) 37 ionic_stats_groups[i].get_values(lif, &buf); 38 } 39 40 static int ionic_get_stats_count(struct ionic_lif *lif) 41 { 42 int i, num_stats = 0; 43 44 for (i = 0; i < ionic_num_stats_grps; i++) 45 num_stats += ionic_stats_groups[i].get_count(lif); 46 47 return num_stats; 48 } 49 50 static int ionic_get_sset_count(struct net_device *netdev, int sset) 51 { 52 struct ionic_lif *lif = netdev_priv(netdev); 53 int count = 0; 54 55 switch (sset) { 56 case ETH_SS_STATS: 57 count = ionic_get_stats_count(lif); 58 break; 59 case ETH_SS_PRIV_FLAGS: 60 count = PRIV_FLAGS_COUNT; 61 break; 62 } 63 return count; 64 } 65 66 static void ionic_get_strings(struct net_device *netdev, 67 u32 sset, u8 *buf) 68 { 69 struct ionic_lif *lif = netdev_priv(netdev); 70 71 switch (sset) { 72 case ETH_SS_STATS: 73 ionic_get_stats_strings(lif, buf); 74 break; 75 case ETH_SS_PRIV_FLAGS: 76 memcpy(buf, ionic_priv_flags_strings, 77 PRIV_FLAGS_COUNT * ETH_GSTRING_LEN); 78 break; 79 } 80 } 81 82 static void ionic_get_drvinfo(struct net_device *netdev, 83 struct ethtool_drvinfo *drvinfo) 84 { 85 struct ionic_lif *lif = netdev_priv(netdev); 86 struct ionic *ionic = lif->ionic; 87 88 strlcpy(drvinfo->driver, IONIC_DRV_NAME, sizeof(drvinfo->driver)); 89 strlcpy(drvinfo->version, IONIC_DRV_VERSION, sizeof(drvinfo->version)); 90 strlcpy(drvinfo->fw_version, ionic->idev.dev_info.fw_version, 91 sizeof(drvinfo->fw_version)); 92 strlcpy(drvinfo->bus_info, ionic_bus_info(ionic), 93 sizeof(drvinfo->bus_info)); 94 } 95 96 static int ionic_get_regs_len(struct net_device *netdev) 97 { 98 return (IONIC_DEV_INFO_REG_COUNT + IONIC_DEV_CMD_REG_COUNT) * sizeof(u32); 99 } 100 101 static void ionic_get_regs(struct net_device *netdev, struct ethtool_regs *regs, 102 void *p) 103 { 104 struct ionic_lif *lif = netdev_priv(netdev); 105 unsigned int size; 106 107 regs->version = IONIC_DEV_CMD_REG_VERSION; 108 109 size = IONIC_DEV_INFO_REG_COUNT * sizeof(u32); 110 memcpy_fromio(p, lif->ionic->idev.dev_info_regs->words, size); 111 112 size = IONIC_DEV_CMD_REG_COUNT * sizeof(u32); 113 memcpy_fromio(p, lif->ionic->idev.dev_cmd_regs->words, size); 114 } 115 116 static int ionic_get_link_ksettings(struct net_device *netdev, 117 struct ethtool_link_ksettings *ks) 118 { 119 struct ionic_lif *lif = netdev_priv(netdev); 120 struct ionic_dev *idev = &lif->ionic->idev; 121 int copper_seen = 0; 122 123 ethtool_link_ksettings_zero_link_mode(ks, supported); 124 125 /* The port_info data is found in a DMA space that the NIC keeps 126 * up-to-date, so there's no need to request the data from the 127 * NIC, we already have it in our memory space. 128 */ 129 130 switch (le16_to_cpu(idev->port_info->status.xcvr.pid)) { 131 /* Copper */ 132 case IONIC_XCVR_PID_QSFP_100G_CR4: 133 ethtool_link_ksettings_add_link_mode(ks, supported, 134 100000baseCR4_Full); 135 copper_seen++; 136 break; 137 case IONIC_XCVR_PID_QSFP_40GBASE_CR4: 138 ethtool_link_ksettings_add_link_mode(ks, supported, 139 40000baseCR4_Full); 140 copper_seen++; 141 break; 142 case IONIC_XCVR_PID_SFP_25GBASE_CR_S: 143 case IONIC_XCVR_PID_SFP_25GBASE_CR_L: 144 case IONIC_XCVR_PID_SFP_25GBASE_CR_N: 145 ethtool_link_ksettings_add_link_mode(ks, supported, 146 25000baseCR_Full); 147 copper_seen++; 148 break; 149 case IONIC_XCVR_PID_SFP_10GBASE_AOC: 150 case IONIC_XCVR_PID_SFP_10GBASE_CU: 151 ethtool_link_ksettings_add_link_mode(ks, supported, 152 10000baseCR_Full); 153 copper_seen++; 154 break; 155 156 /* Fibre */ 157 case IONIC_XCVR_PID_QSFP_100G_SR4: 158 case IONIC_XCVR_PID_QSFP_100G_AOC: 159 ethtool_link_ksettings_add_link_mode(ks, supported, 160 100000baseSR4_Full); 161 break; 162 case IONIC_XCVR_PID_QSFP_100G_LR4: 163 ethtool_link_ksettings_add_link_mode(ks, supported, 164 100000baseLR4_ER4_Full); 165 break; 166 case IONIC_XCVR_PID_QSFP_100G_ER4: 167 ethtool_link_ksettings_add_link_mode(ks, supported, 168 100000baseLR4_ER4_Full); 169 break; 170 case IONIC_XCVR_PID_QSFP_40GBASE_SR4: 171 case IONIC_XCVR_PID_QSFP_40GBASE_AOC: 172 ethtool_link_ksettings_add_link_mode(ks, supported, 173 40000baseSR4_Full); 174 break; 175 case IONIC_XCVR_PID_QSFP_40GBASE_LR4: 176 ethtool_link_ksettings_add_link_mode(ks, supported, 177 40000baseLR4_Full); 178 break; 179 case IONIC_XCVR_PID_SFP_25GBASE_SR: 180 case IONIC_XCVR_PID_SFP_25GBASE_AOC: 181 ethtool_link_ksettings_add_link_mode(ks, supported, 182 25000baseSR_Full); 183 break; 184 case IONIC_XCVR_PID_SFP_10GBASE_SR: 185 ethtool_link_ksettings_add_link_mode(ks, supported, 186 10000baseSR_Full); 187 break; 188 case IONIC_XCVR_PID_SFP_10GBASE_LR: 189 ethtool_link_ksettings_add_link_mode(ks, supported, 190 10000baseLR_Full); 191 break; 192 case IONIC_XCVR_PID_SFP_10GBASE_LRM: 193 ethtool_link_ksettings_add_link_mode(ks, supported, 194 10000baseLRM_Full); 195 break; 196 case IONIC_XCVR_PID_SFP_10GBASE_ER: 197 ethtool_link_ksettings_add_link_mode(ks, supported, 198 10000baseER_Full); 199 break; 200 case IONIC_XCVR_PID_UNKNOWN: 201 /* This means there's no module plugged in */ 202 break; 203 default: 204 dev_info(lif->ionic->dev, "unknown xcvr type pid=%d / 0x%x\n", 205 idev->port_info->status.xcvr.pid, 206 idev->port_info->status.xcvr.pid); 207 break; 208 } 209 210 bitmap_copy(ks->link_modes.advertising, ks->link_modes.supported, 211 __ETHTOOL_LINK_MODE_MASK_NBITS); 212 213 ethtool_link_ksettings_add_link_mode(ks, supported, FEC_BASER); 214 ethtool_link_ksettings_add_link_mode(ks, supported, FEC_RS); 215 if (idev->port_info->config.fec_type == IONIC_PORT_FEC_TYPE_FC) 216 ethtool_link_ksettings_add_link_mode(ks, advertising, FEC_BASER); 217 else if (idev->port_info->config.fec_type == IONIC_PORT_FEC_TYPE_RS) 218 ethtool_link_ksettings_add_link_mode(ks, advertising, FEC_RS); 219 220 ethtool_link_ksettings_add_link_mode(ks, supported, FIBRE); 221 ethtool_link_ksettings_add_link_mode(ks, supported, Pause); 222 223 if (idev->port_info->status.xcvr.phy == IONIC_PHY_TYPE_COPPER || 224 copper_seen) 225 ks->base.port = PORT_DA; 226 else if (idev->port_info->status.xcvr.phy == IONIC_PHY_TYPE_FIBER) 227 ks->base.port = PORT_FIBRE; 228 else 229 ks->base.port = PORT_NONE; 230 231 if (ks->base.port != PORT_NONE) { 232 ks->base.speed = le32_to_cpu(lif->info->status.link_speed); 233 234 if (le16_to_cpu(lif->info->status.link_status)) 235 ks->base.duplex = DUPLEX_FULL; 236 else 237 ks->base.duplex = DUPLEX_UNKNOWN; 238 239 ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg); 240 241 if (idev->port_info->config.an_enable) { 242 ethtool_link_ksettings_add_link_mode(ks, advertising, 243 Autoneg); 244 ks->base.autoneg = AUTONEG_ENABLE; 245 } 246 } 247 248 return 0; 249 } 250 251 static int ionic_set_link_ksettings(struct net_device *netdev, 252 const struct ethtool_link_ksettings *ks) 253 { 254 struct ionic_lif *lif = netdev_priv(netdev); 255 struct ionic *ionic = lif->ionic; 256 struct ionic_dev *idev; 257 u32 req_rs, req_fc; 258 u8 fec_type; 259 int err = 0; 260 261 idev = &lif->ionic->idev; 262 fec_type = IONIC_PORT_FEC_TYPE_NONE; 263 264 /* set autoneg */ 265 if (ks->base.autoneg != idev->port_info->config.an_enable) { 266 mutex_lock(&ionic->dev_cmd_lock); 267 ionic_dev_cmd_port_autoneg(idev, ks->base.autoneg); 268 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 269 mutex_unlock(&ionic->dev_cmd_lock); 270 if (err) 271 return err; 272 } 273 274 /* set speed */ 275 if (ks->base.speed != le32_to_cpu(idev->port_info->config.speed)) { 276 mutex_lock(&ionic->dev_cmd_lock); 277 ionic_dev_cmd_port_speed(idev, ks->base.speed); 278 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 279 mutex_unlock(&ionic->dev_cmd_lock); 280 if (err) 281 return err; 282 } 283 284 /* set FEC */ 285 req_rs = ethtool_link_ksettings_test_link_mode(ks, advertising, FEC_RS); 286 req_fc = ethtool_link_ksettings_test_link_mode(ks, advertising, FEC_BASER); 287 if (req_rs && req_fc) { 288 netdev_info(netdev, "Only select one FEC mode at a time\n"); 289 return -EINVAL; 290 } else if (req_fc) { 291 fec_type = IONIC_PORT_FEC_TYPE_FC; 292 } else if (req_rs) { 293 fec_type = IONIC_PORT_FEC_TYPE_RS; 294 } else if (!(req_rs | req_fc)) { 295 fec_type = IONIC_PORT_FEC_TYPE_NONE; 296 } 297 298 if (fec_type != idev->port_info->config.fec_type) { 299 mutex_lock(&ionic->dev_cmd_lock); 300 ionic_dev_cmd_port_fec(idev, fec_type); 301 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 302 mutex_unlock(&ionic->dev_cmd_lock); 303 if (err) 304 return err; 305 } 306 307 return 0; 308 } 309 310 static void ionic_get_pauseparam(struct net_device *netdev, 311 struct ethtool_pauseparam *pause) 312 { 313 struct ionic_lif *lif = netdev_priv(netdev); 314 u8 pause_type; 315 316 pause->autoneg = 0; 317 318 pause_type = lif->ionic->idev.port_info->config.pause_type; 319 if (pause_type) { 320 pause->rx_pause = pause_type & IONIC_PAUSE_F_RX ? 1 : 0; 321 pause->tx_pause = pause_type & IONIC_PAUSE_F_TX ? 1 : 0; 322 } 323 } 324 325 static int ionic_set_pauseparam(struct net_device *netdev, 326 struct ethtool_pauseparam *pause) 327 { 328 struct ionic_lif *lif = netdev_priv(netdev); 329 struct ionic *ionic = lif->ionic; 330 u32 requested_pause; 331 int err; 332 333 if (pause->autoneg) 334 return -EOPNOTSUPP; 335 336 /* change both at the same time */ 337 requested_pause = IONIC_PORT_PAUSE_TYPE_LINK; 338 if (pause->rx_pause) 339 requested_pause |= IONIC_PAUSE_F_RX; 340 if (pause->tx_pause) 341 requested_pause |= IONIC_PAUSE_F_TX; 342 343 if (requested_pause == lif->ionic->idev.port_info->config.pause_type) 344 return 0; 345 346 mutex_lock(&ionic->dev_cmd_lock); 347 ionic_dev_cmd_port_pause(&lif->ionic->idev, requested_pause); 348 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 349 mutex_unlock(&ionic->dev_cmd_lock); 350 if (err) 351 return err; 352 353 return 0; 354 } 355 356 static int ionic_get_coalesce(struct net_device *netdev, 357 struct ethtool_coalesce *coalesce) 358 { 359 struct ionic_lif *lif = netdev_priv(netdev); 360 361 /* Tx uses Rx interrupt */ 362 coalesce->tx_coalesce_usecs = lif->rx_coalesce_usecs; 363 coalesce->rx_coalesce_usecs = lif->rx_coalesce_usecs; 364 365 return 0; 366 } 367 368 static int ionic_set_coalesce(struct net_device *netdev, 369 struct ethtool_coalesce *coalesce) 370 { 371 struct ionic_lif *lif = netdev_priv(netdev); 372 struct ionic_identity *ident; 373 struct ionic_qcq *qcq; 374 unsigned int i; 375 u32 usecs; 376 u32 coal; 377 378 if (coalesce->rx_max_coalesced_frames || 379 coalesce->rx_coalesce_usecs_irq || 380 coalesce->rx_max_coalesced_frames_irq || 381 coalesce->tx_max_coalesced_frames || 382 coalesce->tx_coalesce_usecs_irq || 383 coalesce->tx_max_coalesced_frames_irq || 384 coalesce->stats_block_coalesce_usecs || 385 coalesce->use_adaptive_rx_coalesce || 386 coalesce->use_adaptive_tx_coalesce || 387 coalesce->pkt_rate_low || 388 coalesce->rx_coalesce_usecs_low || 389 coalesce->rx_max_coalesced_frames_low || 390 coalesce->tx_coalesce_usecs_low || 391 coalesce->tx_max_coalesced_frames_low || 392 coalesce->pkt_rate_high || 393 coalesce->rx_coalesce_usecs_high || 394 coalesce->rx_max_coalesced_frames_high || 395 coalesce->tx_coalesce_usecs_high || 396 coalesce->tx_max_coalesced_frames_high || 397 coalesce->rate_sample_interval) 398 return -EINVAL; 399 400 ident = &lif->ionic->ident; 401 if (ident->dev.intr_coal_div == 0) { 402 netdev_warn(netdev, "bad HW value in dev.intr_coal_div = %d\n", 403 ident->dev.intr_coal_div); 404 return -EIO; 405 } 406 407 /* Tx uses Rx interrupt, so only change Rx */ 408 if (coalesce->tx_coalesce_usecs != lif->rx_coalesce_usecs) { 409 netdev_warn(netdev, "only the rx-usecs can be changed\n"); 410 return -EINVAL; 411 } 412 413 coal = ionic_coal_usec_to_hw(lif->ionic, coalesce->rx_coalesce_usecs); 414 415 if (coal > IONIC_INTR_CTRL_COAL_MAX) 416 return -ERANGE; 417 418 /* If they asked for non-zero and it resolved to zero, bump it up */ 419 if (!coal && coalesce->rx_coalesce_usecs) 420 coal = 1; 421 422 /* Convert it back to get device resolution */ 423 usecs = ionic_coal_hw_to_usec(lif->ionic, coal); 424 425 if (usecs != lif->rx_coalesce_usecs) { 426 lif->rx_coalesce_usecs = usecs; 427 428 if (test_bit(IONIC_LIF_UP, lif->state)) { 429 for (i = 0; i < lif->nxqs; i++) { 430 qcq = lif->rxqcqs[i].qcq; 431 ionic_intr_coal_init(lif->ionic->idev.intr_ctrl, 432 qcq->intr.index, coal); 433 } 434 } 435 } 436 437 return 0; 438 } 439 440 static void ionic_get_ringparam(struct net_device *netdev, 441 struct ethtool_ringparam *ring) 442 { 443 struct ionic_lif *lif = netdev_priv(netdev); 444 445 ring->tx_max_pending = IONIC_MAX_TXRX_DESC; 446 ring->tx_pending = lif->ntxq_descs; 447 ring->rx_max_pending = IONIC_MAX_TXRX_DESC; 448 ring->rx_pending = lif->nrxq_descs; 449 } 450 451 static int ionic_set_ringparam(struct net_device *netdev, 452 struct ethtool_ringparam *ring) 453 { 454 struct ionic_lif *lif = netdev_priv(netdev); 455 bool running; 456 457 if (ring->rx_mini_pending || ring->rx_jumbo_pending) { 458 netdev_info(netdev, "Changing jumbo or mini descriptors not supported\n"); 459 return -EINVAL; 460 } 461 462 if (!is_power_of_2(ring->tx_pending) || 463 !is_power_of_2(ring->rx_pending)) { 464 netdev_info(netdev, "Descriptor count must be a power of 2\n"); 465 return -EINVAL; 466 } 467 468 /* if nothing to do return success */ 469 if (ring->tx_pending == lif->ntxq_descs && 470 ring->rx_pending == lif->nrxq_descs) 471 return 0; 472 473 if (!ionic_wait_for_bit(lif, IONIC_LIF_QUEUE_RESET)) 474 return -EBUSY; 475 476 running = test_bit(IONIC_LIF_UP, lif->state); 477 if (running) 478 ionic_stop(netdev); 479 480 lif->ntxq_descs = ring->tx_pending; 481 lif->nrxq_descs = ring->rx_pending; 482 483 if (running) 484 ionic_open(netdev); 485 clear_bit(IONIC_LIF_QUEUE_RESET, lif->state); 486 487 return 0; 488 } 489 490 static void ionic_get_channels(struct net_device *netdev, 491 struct ethtool_channels *ch) 492 { 493 struct ionic_lif *lif = netdev_priv(netdev); 494 495 /* report maximum channels */ 496 ch->max_combined = lif->ionic->ntxqs_per_lif; 497 498 /* report current channels */ 499 ch->combined_count = lif->nxqs; 500 } 501 502 static int ionic_set_channels(struct net_device *netdev, 503 struct ethtool_channels *ch) 504 { 505 struct ionic_lif *lif = netdev_priv(netdev); 506 bool running; 507 508 if (!ch->combined_count || ch->other_count || 509 ch->rx_count || ch->tx_count) 510 return -EINVAL; 511 512 if (ch->combined_count == lif->nxqs) 513 return 0; 514 515 if (!ionic_wait_for_bit(lif, IONIC_LIF_QUEUE_RESET)) 516 return -EBUSY; 517 518 running = test_bit(IONIC_LIF_UP, lif->state); 519 if (running) 520 ionic_stop(netdev); 521 522 lif->nxqs = ch->combined_count; 523 524 if (running) 525 ionic_open(netdev); 526 clear_bit(IONIC_LIF_QUEUE_RESET, lif->state); 527 528 return 0; 529 } 530 531 static u32 ionic_get_priv_flags(struct net_device *netdev) 532 { 533 struct ionic_lif *lif = netdev_priv(netdev); 534 u32 priv_flags = 0; 535 536 if (test_bit(IONIC_LIF_SW_DEBUG_STATS, lif->state)) 537 priv_flags |= PRIV_F_SW_DBG_STATS; 538 539 return priv_flags; 540 } 541 542 static int ionic_set_priv_flags(struct net_device *netdev, u32 priv_flags) 543 { 544 struct ionic_lif *lif = netdev_priv(netdev); 545 u32 flags = lif->flags; 546 547 clear_bit(IONIC_LIF_SW_DEBUG_STATS, lif->state); 548 if (priv_flags & PRIV_F_SW_DBG_STATS) 549 set_bit(IONIC_LIF_SW_DEBUG_STATS, lif->state); 550 551 if (flags != lif->flags) 552 lif->flags = flags; 553 554 return 0; 555 } 556 557 static int ionic_get_rxnfc(struct net_device *netdev, 558 struct ethtool_rxnfc *info, u32 *rules) 559 { 560 struct ionic_lif *lif = netdev_priv(netdev); 561 int err = 0; 562 563 switch (info->cmd) { 564 case ETHTOOL_GRXRINGS: 565 info->data = lif->nxqs; 566 break; 567 default: 568 netdev_err(netdev, "Command parameter %d is not supported\n", 569 info->cmd); 570 err = -EOPNOTSUPP; 571 } 572 573 return err; 574 } 575 576 static u32 ionic_get_rxfh_indir_size(struct net_device *netdev) 577 { 578 struct ionic_lif *lif = netdev_priv(netdev); 579 580 return le16_to_cpu(lif->ionic->ident.lif.eth.rss_ind_tbl_sz); 581 } 582 583 static u32 ionic_get_rxfh_key_size(struct net_device *netdev) 584 { 585 return IONIC_RSS_HASH_KEY_SIZE; 586 } 587 588 static int ionic_get_rxfh(struct net_device *netdev, u32 *indir, u8 *key, 589 u8 *hfunc) 590 { 591 struct ionic_lif *lif = netdev_priv(netdev); 592 unsigned int i, tbl_sz; 593 594 if (indir) { 595 tbl_sz = le16_to_cpu(lif->ionic->ident.lif.eth.rss_ind_tbl_sz); 596 for (i = 0; i < tbl_sz; i++) 597 indir[i] = lif->rss_ind_tbl[i]; 598 } 599 600 if (key) 601 memcpy(key, lif->rss_hash_key, IONIC_RSS_HASH_KEY_SIZE); 602 603 if (hfunc) 604 *hfunc = ETH_RSS_HASH_TOP; 605 606 return 0; 607 } 608 609 static int ionic_set_rxfh(struct net_device *netdev, const u32 *indir, 610 const u8 *key, const u8 hfunc) 611 { 612 struct ionic_lif *lif = netdev_priv(netdev); 613 int err; 614 615 if (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP) 616 return -EOPNOTSUPP; 617 618 err = ionic_lif_rss_config(lif, lif->rss_types, key, indir); 619 if (err) 620 return err; 621 622 return 0; 623 } 624 625 static int ionic_set_tunable(struct net_device *dev, 626 const struct ethtool_tunable *tuna, 627 const void *data) 628 { 629 struct ionic_lif *lif = netdev_priv(dev); 630 631 switch (tuna->id) { 632 case ETHTOOL_RX_COPYBREAK: 633 lif->rx_copybreak = *(u32 *)data; 634 break; 635 default: 636 return -EOPNOTSUPP; 637 } 638 639 return 0; 640 } 641 642 static int ionic_get_tunable(struct net_device *netdev, 643 const struct ethtool_tunable *tuna, void *data) 644 { 645 struct ionic_lif *lif = netdev_priv(netdev); 646 647 switch (tuna->id) { 648 case ETHTOOL_RX_COPYBREAK: 649 *(u32 *)data = lif->rx_copybreak; 650 break; 651 default: 652 return -EOPNOTSUPP; 653 } 654 655 return 0; 656 } 657 658 static int ionic_get_module_info(struct net_device *netdev, 659 struct ethtool_modinfo *modinfo) 660 661 { 662 struct ionic_lif *lif = netdev_priv(netdev); 663 struct ionic_dev *idev = &lif->ionic->idev; 664 struct ionic_xcvr_status *xcvr; 665 666 xcvr = &idev->port_info->status.xcvr; 667 668 /* report the module data type and length */ 669 switch (xcvr->sprom[0]) { 670 case 0x03: /* SFP */ 671 modinfo->type = ETH_MODULE_SFF_8079; 672 modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN; 673 break; 674 case 0x0D: /* QSFP */ 675 case 0x11: /* QSFP28 */ 676 modinfo->type = ETH_MODULE_SFF_8436; 677 modinfo->eeprom_len = ETH_MODULE_SFF_8436_LEN; 678 break; 679 default: 680 netdev_info(netdev, "unknown xcvr type 0x%02x\n", 681 xcvr->sprom[0]); 682 break; 683 } 684 685 return 0; 686 } 687 688 static int ionic_get_module_eeprom(struct net_device *netdev, 689 struct ethtool_eeprom *ee, 690 u8 *data) 691 { 692 struct ionic_lif *lif = netdev_priv(netdev); 693 struct ionic_dev *idev = &lif->ionic->idev; 694 struct ionic_xcvr_status *xcvr; 695 char tbuf[sizeof(xcvr->sprom)]; 696 int count = 10; 697 u32 len; 698 699 /* The NIC keeps the module prom up-to-date in the DMA space 700 * so we can simply copy the module bytes into the data buffer. 701 */ 702 xcvr = &idev->port_info->status.xcvr; 703 len = min_t(u32, sizeof(xcvr->sprom), ee->len); 704 705 do { 706 memcpy(data, xcvr->sprom, len); 707 memcpy(tbuf, xcvr->sprom, len); 708 709 /* Let's make sure we got a consistent copy */ 710 if (!memcmp(data, tbuf, len)) 711 break; 712 713 } while (--count); 714 715 if (!count) 716 return -ETIMEDOUT; 717 718 return 0; 719 } 720 721 static int ionic_nway_reset(struct net_device *netdev) 722 { 723 struct ionic_lif *lif = netdev_priv(netdev); 724 struct ionic *ionic = lif->ionic; 725 int err = 0; 726 727 /* flap the link to force auto-negotiation */ 728 729 mutex_lock(&ionic->dev_cmd_lock); 730 731 ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_DOWN); 732 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 733 734 if (!err) { 735 ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_UP); 736 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 737 } 738 739 mutex_unlock(&ionic->dev_cmd_lock); 740 741 return err; 742 } 743 744 static const struct ethtool_ops ionic_ethtool_ops = { 745 .get_drvinfo = ionic_get_drvinfo, 746 .get_regs_len = ionic_get_regs_len, 747 .get_regs = ionic_get_regs, 748 .get_link = ethtool_op_get_link, 749 .get_link_ksettings = ionic_get_link_ksettings, 750 .get_coalesce = ionic_get_coalesce, 751 .set_coalesce = ionic_set_coalesce, 752 .get_ringparam = ionic_get_ringparam, 753 .set_ringparam = ionic_set_ringparam, 754 .get_channels = ionic_get_channels, 755 .set_channels = ionic_set_channels, 756 .get_strings = ionic_get_strings, 757 .get_ethtool_stats = ionic_get_stats, 758 .get_sset_count = ionic_get_sset_count, 759 .get_priv_flags = ionic_get_priv_flags, 760 .set_priv_flags = ionic_set_priv_flags, 761 .get_rxnfc = ionic_get_rxnfc, 762 .get_rxfh_indir_size = ionic_get_rxfh_indir_size, 763 .get_rxfh_key_size = ionic_get_rxfh_key_size, 764 .get_rxfh = ionic_get_rxfh, 765 .set_rxfh = ionic_set_rxfh, 766 .get_tunable = ionic_get_tunable, 767 .set_tunable = ionic_set_tunable, 768 .get_module_info = ionic_get_module_info, 769 .get_module_eeprom = ionic_get_module_eeprom, 770 .get_pauseparam = ionic_get_pauseparam, 771 .set_pauseparam = ionic_set_pauseparam, 772 .set_link_ksettings = ionic_set_link_ksettings, 773 .nway_reset = ionic_nway_reset, 774 }; 775 776 void ionic_ethtool_set_ops(struct net_device *netdev) 777 { 778 netdev->ethtool_ops = &ionic_ethtool_ops; 779 } 780