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 #include <linux/sfp.h> 7 8 #include "ionic.h" 9 #include "ionic_bus.h" 10 #include "ionic_lif.h" 11 #include "ionic_ethtool.h" 12 #include "ionic_stats.h" 13 14 static const char ionic_priv_flags_strings[][ETH_GSTRING_LEN] = { 15 #define PRIV_F_SW_DBG_STATS BIT(0) 16 "sw-dbg-stats", 17 }; 18 #define PRIV_FLAGS_COUNT ARRAY_SIZE(ionic_priv_flags_strings) 19 20 static void ionic_get_stats_strings(struct ionic_lif *lif, u8 *buf) 21 { 22 u32 i; 23 24 for (i = 0; i < ionic_num_stats_grps; i++) 25 ionic_stats_groups[i].get_strings(lif, &buf); 26 } 27 28 static void ionic_get_stats(struct net_device *netdev, 29 struct ethtool_stats *stats, u64 *buf) 30 { 31 struct ionic_lif *lif; 32 u32 i; 33 34 lif = netdev_priv(netdev); 35 36 memset(buf, 0, stats->n_stats * sizeof(*buf)); 37 for (i = 0; i < ionic_num_stats_grps; i++) 38 ionic_stats_groups[i].get_values(lif, &buf); 39 } 40 41 static int ionic_get_stats_count(struct ionic_lif *lif) 42 { 43 int i, num_stats = 0; 44 45 for (i = 0; i < ionic_num_stats_grps; i++) 46 num_stats += ionic_stats_groups[i].get_count(lif); 47 48 return num_stats; 49 } 50 51 static int ionic_get_sset_count(struct net_device *netdev, int sset) 52 { 53 struct ionic_lif *lif = netdev_priv(netdev); 54 int count = 0; 55 56 switch (sset) { 57 case ETH_SS_STATS: 58 count = ionic_get_stats_count(lif); 59 break; 60 case ETH_SS_PRIV_FLAGS: 61 count = PRIV_FLAGS_COUNT; 62 break; 63 } 64 return count; 65 } 66 67 static void ionic_get_strings(struct net_device *netdev, 68 u32 sset, u8 *buf) 69 { 70 struct ionic_lif *lif = netdev_priv(netdev); 71 72 switch (sset) { 73 case ETH_SS_STATS: 74 ionic_get_stats_strings(lif, buf); 75 break; 76 case ETH_SS_PRIV_FLAGS: 77 memcpy(buf, ionic_priv_flags_strings, 78 PRIV_FLAGS_COUNT * ETH_GSTRING_LEN); 79 break; 80 } 81 } 82 83 static void ionic_get_drvinfo(struct net_device *netdev, 84 struct ethtool_drvinfo *drvinfo) 85 { 86 struct ionic_lif *lif = netdev_priv(netdev); 87 struct ionic *ionic = lif->ionic; 88 89 strlcpy(drvinfo->driver, IONIC_DRV_NAME, sizeof(drvinfo->driver)); 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 int err = 0; 258 259 idev = &lif->ionic->idev; 260 261 /* set autoneg */ 262 if (ks->base.autoneg != idev->port_info->config.an_enable) { 263 mutex_lock(&ionic->dev_cmd_lock); 264 ionic_dev_cmd_port_autoneg(idev, ks->base.autoneg); 265 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 266 mutex_unlock(&ionic->dev_cmd_lock); 267 if (err) 268 return err; 269 } 270 271 /* set speed */ 272 if (ks->base.speed != le32_to_cpu(idev->port_info->config.speed)) { 273 mutex_lock(&ionic->dev_cmd_lock); 274 ionic_dev_cmd_port_speed(idev, ks->base.speed); 275 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 276 mutex_unlock(&ionic->dev_cmd_lock); 277 if (err) 278 return err; 279 } 280 281 return 0; 282 } 283 284 static void ionic_get_pauseparam(struct net_device *netdev, 285 struct ethtool_pauseparam *pause) 286 { 287 struct ionic_lif *lif = netdev_priv(netdev); 288 u8 pause_type; 289 290 pause->autoneg = 0; 291 292 pause_type = lif->ionic->idev.port_info->config.pause_type; 293 if (pause_type) { 294 pause->rx_pause = pause_type & IONIC_PAUSE_F_RX ? 1 : 0; 295 pause->tx_pause = pause_type & IONIC_PAUSE_F_TX ? 1 : 0; 296 } 297 } 298 299 static int ionic_set_pauseparam(struct net_device *netdev, 300 struct ethtool_pauseparam *pause) 301 { 302 struct ionic_lif *lif = netdev_priv(netdev); 303 struct ionic *ionic = lif->ionic; 304 u32 requested_pause; 305 int err; 306 307 if (pause->autoneg) 308 return -EOPNOTSUPP; 309 310 /* change both at the same time */ 311 requested_pause = IONIC_PORT_PAUSE_TYPE_LINK; 312 if (pause->rx_pause) 313 requested_pause |= IONIC_PAUSE_F_RX; 314 if (pause->tx_pause) 315 requested_pause |= IONIC_PAUSE_F_TX; 316 317 if (requested_pause == lif->ionic->idev.port_info->config.pause_type) 318 return 0; 319 320 mutex_lock(&ionic->dev_cmd_lock); 321 ionic_dev_cmd_port_pause(&lif->ionic->idev, requested_pause); 322 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 323 mutex_unlock(&ionic->dev_cmd_lock); 324 if (err) 325 return err; 326 327 return 0; 328 } 329 330 static int ionic_get_fecparam(struct net_device *netdev, 331 struct ethtool_fecparam *fec) 332 { 333 struct ionic_lif *lif = netdev_priv(netdev); 334 335 switch (lif->ionic->idev.port_info->config.fec_type) { 336 case IONIC_PORT_FEC_TYPE_NONE: 337 fec->active_fec = ETHTOOL_FEC_OFF; 338 break; 339 case IONIC_PORT_FEC_TYPE_RS: 340 fec->active_fec = ETHTOOL_FEC_RS; 341 break; 342 case IONIC_PORT_FEC_TYPE_FC: 343 fec->active_fec = ETHTOOL_FEC_BASER; 344 break; 345 } 346 347 fec->fec = ETHTOOL_FEC_OFF | ETHTOOL_FEC_RS | ETHTOOL_FEC_BASER; 348 349 return 0; 350 } 351 352 static int ionic_set_fecparam(struct net_device *netdev, 353 struct ethtool_fecparam *fec) 354 { 355 struct ionic_lif *lif = netdev_priv(netdev); 356 u8 fec_type; 357 int ret = 0; 358 359 if (lif->ionic->idev.port_info->config.an_enable) { 360 netdev_err(netdev, "FEC request not allowed while autoneg is enabled\n"); 361 return -EINVAL; 362 } 363 364 switch (fec->fec) { 365 case ETHTOOL_FEC_NONE: 366 fec_type = IONIC_PORT_FEC_TYPE_NONE; 367 break; 368 case ETHTOOL_FEC_OFF: 369 fec_type = IONIC_PORT_FEC_TYPE_NONE; 370 break; 371 case ETHTOOL_FEC_RS: 372 fec_type = IONIC_PORT_FEC_TYPE_RS; 373 break; 374 case ETHTOOL_FEC_BASER: 375 fec_type = IONIC_PORT_FEC_TYPE_FC; 376 break; 377 case ETHTOOL_FEC_AUTO: 378 default: 379 netdev_err(netdev, "FEC request 0x%04x not supported\n", 380 fec->fec); 381 return -EINVAL; 382 } 383 384 if (fec_type != lif->ionic->idev.port_info->config.fec_type) { 385 mutex_lock(&lif->ionic->dev_cmd_lock); 386 ionic_dev_cmd_port_fec(&lif->ionic->idev, fec_type); 387 ret = ionic_dev_cmd_wait(lif->ionic, DEVCMD_TIMEOUT); 388 mutex_unlock(&lif->ionic->dev_cmd_lock); 389 } 390 391 return ret; 392 } 393 394 static int ionic_get_coalesce(struct net_device *netdev, 395 struct ethtool_coalesce *coalesce) 396 { 397 struct ionic_lif *lif = netdev_priv(netdev); 398 399 /* Tx uses Rx interrupt */ 400 coalesce->tx_coalesce_usecs = lif->rx_coalesce_usecs; 401 coalesce->rx_coalesce_usecs = lif->rx_coalesce_usecs; 402 403 return 0; 404 } 405 406 static int ionic_set_coalesce(struct net_device *netdev, 407 struct ethtool_coalesce *coalesce) 408 { 409 struct ionic_lif *lif = netdev_priv(netdev); 410 struct ionic_identity *ident; 411 struct ionic_qcq *qcq; 412 unsigned int i; 413 u32 coal; 414 415 ident = &lif->ionic->ident; 416 if (ident->dev.intr_coal_div == 0) { 417 netdev_warn(netdev, "bad HW value in dev.intr_coal_div = %d\n", 418 ident->dev.intr_coal_div); 419 return -EIO; 420 } 421 422 /* Tx uses Rx interrupt, so only change Rx */ 423 if (coalesce->tx_coalesce_usecs != lif->rx_coalesce_usecs) { 424 netdev_warn(netdev, "only the rx-usecs can be changed\n"); 425 return -EINVAL; 426 } 427 428 /* Convert the usec request to a HW useable value. If they asked 429 * for non-zero and it resolved to zero, bump it up 430 */ 431 coal = ionic_coal_usec_to_hw(lif->ionic, coalesce->rx_coalesce_usecs); 432 if (!coal && coalesce->rx_coalesce_usecs) 433 coal = 1; 434 435 if (coal > IONIC_INTR_CTRL_COAL_MAX) 436 return -ERANGE; 437 438 /* Save the new value */ 439 lif->rx_coalesce_usecs = coalesce->rx_coalesce_usecs; 440 if (coal != lif->rx_coalesce_hw) { 441 lif->rx_coalesce_hw = coal; 442 443 if (test_bit(IONIC_LIF_F_UP, lif->state)) { 444 for (i = 0; i < lif->nxqs; i++) { 445 qcq = lif->rxqcqs[i].qcq; 446 ionic_intr_coal_init(lif->ionic->idev.intr_ctrl, 447 qcq->intr.index, 448 lif->rx_coalesce_hw); 449 } 450 } 451 } 452 453 return 0; 454 } 455 456 static void ionic_get_ringparam(struct net_device *netdev, 457 struct ethtool_ringparam *ring) 458 { 459 struct ionic_lif *lif = netdev_priv(netdev); 460 461 ring->tx_max_pending = IONIC_MAX_TXRX_DESC; 462 ring->tx_pending = lif->ntxq_descs; 463 ring->rx_max_pending = IONIC_MAX_TXRX_DESC; 464 ring->rx_pending = lif->nrxq_descs; 465 } 466 467 static int ionic_set_ringparam(struct net_device *netdev, 468 struct ethtool_ringparam *ring) 469 { 470 struct ionic_lif *lif = netdev_priv(netdev); 471 bool running; 472 int err; 473 474 if (ring->rx_mini_pending || ring->rx_jumbo_pending) { 475 netdev_info(netdev, "Changing jumbo or mini descriptors not supported\n"); 476 return -EINVAL; 477 } 478 479 if (!is_power_of_2(ring->tx_pending) || 480 !is_power_of_2(ring->rx_pending)) { 481 netdev_info(netdev, "Descriptor count must be a power of 2\n"); 482 return -EINVAL; 483 } 484 485 /* if nothing to do return success */ 486 if (ring->tx_pending == lif->ntxq_descs && 487 ring->rx_pending == lif->nrxq_descs) 488 return 0; 489 490 err = ionic_wait_for_bit(lif, IONIC_LIF_F_QUEUE_RESET); 491 if (err) 492 return err; 493 494 running = test_bit(IONIC_LIF_F_UP, lif->state); 495 if (running) 496 ionic_stop(netdev); 497 498 lif->ntxq_descs = ring->tx_pending; 499 lif->nrxq_descs = ring->rx_pending; 500 501 if (running) 502 ionic_open(netdev); 503 clear_bit(IONIC_LIF_F_QUEUE_RESET, lif->state); 504 505 return 0; 506 } 507 508 static void ionic_get_channels(struct net_device *netdev, 509 struct ethtool_channels *ch) 510 { 511 struct ionic_lif *lif = netdev_priv(netdev); 512 513 /* report maximum channels */ 514 ch->max_combined = lif->ionic->ntxqs_per_lif; 515 516 /* report current channels */ 517 ch->combined_count = lif->nxqs; 518 } 519 520 static int ionic_set_channels(struct net_device *netdev, 521 struct ethtool_channels *ch) 522 { 523 struct ionic_lif *lif = netdev_priv(netdev); 524 bool running; 525 int err; 526 527 if (!ch->combined_count || ch->other_count || 528 ch->rx_count || ch->tx_count) 529 return -EINVAL; 530 531 if (ch->combined_count == lif->nxqs) 532 return 0; 533 534 err = ionic_wait_for_bit(lif, IONIC_LIF_F_QUEUE_RESET); 535 if (err) 536 return err; 537 538 running = test_bit(IONIC_LIF_F_UP, lif->state); 539 if (running) 540 ionic_stop(netdev); 541 542 lif->nxqs = ch->combined_count; 543 544 if (running) 545 ionic_open(netdev); 546 clear_bit(IONIC_LIF_F_QUEUE_RESET, lif->state); 547 548 return 0; 549 } 550 551 static u32 ionic_get_priv_flags(struct net_device *netdev) 552 { 553 struct ionic_lif *lif = netdev_priv(netdev); 554 u32 priv_flags = 0; 555 556 if (test_bit(IONIC_LIF_F_SW_DEBUG_STATS, lif->state)) 557 priv_flags |= PRIV_F_SW_DBG_STATS; 558 559 return priv_flags; 560 } 561 562 static int ionic_set_priv_flags(struct net_device *netdev, u32 priv_flags) 563 { 564 struct ionic_lif *lif = netdev_priv(netdev); 565 566 clear_bit(IONIC_LIF_F_SW_DEBUG_STATS, lif->state); 567 if (priv_flags & PRIV_F_SW_DBG_STATS) 568 set_bit(IONIC_LIF_F_SW_DEBUG_STATS, lif->state); 569 570 return 0; 571 } 572 573 static int ionic_get_rxnfc(struct net_device *netdev, 574 struct ethtool_rxnfc *info, u32 *rules) 575 { 576 struct ionic_lif *lif = netdev_priv(netdev); 577 int err = 0; 578 579 switch (info->cmd) { 580 case ETHTOOL_GRXRINGS: 581 info->data = lif->nxqs; 582 break; 583 default: 584 netdev_err(netdev, "Command parameter %d is not supported\n", 585 info->cmd); 586 err = -EOPNOTSUPP; 587 } 588 589 return err; 590 } 591 592 static u32 ionic_get_rxfh_indir_size(struct net_device *netdev) 593 { 594 struct ionic_lif *lif = netdev_priv(netdev); 595 596 return le16_to_cpu(lif->ionic->ident.lif.eth.rss_ind_tbl_sz); 597 } 598 599 static u32 ionic_get_rxfh_key_size(struct net_device *netdev) 600 { 601 return IONIC_RSS_HASH_KEY_SIZE; 602 } 603 604 static int ionic_get_rxfh(struct net_device *netdev, u32 *indir, u8 *key, 605 u8 *hfunc) 606 { 607 struct ionic_lif *lif = netdev_priv(netdev); 608 unsigned int i, tbl_sz; 609 610 if (indir) { 611 tbl_sz = le16_to_cpu(lif->ionic->ident.lif.eth.rss_ind_tbl_sz); 612 for (i = 0; i < tbl_sz; i++) 613 indir[i] = lif->rss_ind_tbl[i]; 614 } 615 616 if (key) 617 memcpy(key, lif->rss_hash_key, IONIC_RSS_HASH_KEY_SIZE); 618 619 if (hfunc) 620 *hfunc = ETH_RSS_HASH_TOP; 621 622 return 0; 623 } 624 625 static int ionic_set_rxfh(struct net_device *netdev, const u32 *indir, 626 const u8 *key, const u8 hfunc) 627 { 628 struct ionic_lif *lif = netdev_priv(netdev); 629 int err; 630 631 if (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP) 632 return -EOPNOTSUPP; 633 634 err = ionic_lif_rss_config(lif, lif->rss_types, key, indir); 635 if (err) 636 return err; 637 638 return 0; 639 } 640 641 static int ionic_set_tunable(struct net_device *dev, 642 const struct ethtool_tunable *tuna, 643 const void *data) 644 { 645 struct ionic_lif *lif = netdev_priv(dev); 646 647 switch (tuna->id) { 648 case ETHTOOL_RX_COPYBREAK: 649 lif->rx_copybreak = *(u32 *)data; 650 break; 651 default: 652 return -EOPNOTSUPP; 653 } 654 655 return 0; 656 } 657 658 static int ionic_get_tunable(struct net_device *netdev, 659 const struct ethtool_tunable *tuna, void *data) 660 { 661 struct ionic_lif *lif = netdev_priv(netdev); 662 663 switch (tuna->id) { 664 case ETHTOOL_RX_COPYBREAK: 665 *(u32 *)data = lif->rx_copybreak; 666 break; 667 default: 668 return -EOPNOTSUPP; 669 } 670 671 return 0; 672 } 673 674 static int ionic_get_module_info(struct net_device *netdev, 675 struct ethtool_modinfo *modinfo) 676 677 { 678 struct ionic_lif *lif = netdev_priv(netdev); 679 struct ionic_dev *idev = &lif->ionic->idev; 680 struct ionic_xcvr_status *xcvr; 681 struct sfp_eeprom_base *sfp; 682 683 xcvr = &idev->port_info->status.xcvr; 684 sfp = (struct sfp_eeprom_base *) xcvr->sprom; 685 686 /* report the module data type and length */ 687 switch (sfp->phys_id) { 688 case SFF8024_ID_SFP: 689 modinfo->type = ETH_MODULE_SFF_8079; 690 modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN; 691 break; 692 case SFF8024_ID_QSFP_8436_8636: 693 case SFF8024_ID_QSFP28_8636: 694 modinfo->type = ETH_MODULE_SFF_8436; 695 modinfo->eeprom_len = ETH_MODULE_SFF_8436_LEN; 696 break; 697 default: 698 netdev_info(netdev, "unknown xcvr type 0x%02x\n", 699 xcvr->sprom[0]); 700 modinfo->type = 0; 701 modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN; 702 break; 703 } 704 705 return 0; 706 } 707 708 static int ionic_get_module_eeprom(struct net_device *netdev, 709 struct ethtool_eeprom *ee, 710 u8 *data) 711 { 712 struct ionic_lif *lif = netdev_priv(netdev); 713 struct ionic_dev *idev = &lif->ionic->idev; 714 struct ionic_xcvr_status *xcvr; 715 char tbuf[sizeof(xcvr->sprom)]; 716 int count = 10; 717 u32 len; 718 719 /* The NIC keeps the module prom up-to-date in the DMA space 720 * so we can simply copy the module bytes into the data buffer. 721 */ 722 xcvr = &idev->port_info->status.xcvr; 723 len = min_t(u32, sizeof(xcvr->sprom), ee->len); 724 725 do { 726 memcpy(data, xcvr->sprom, len); 727 memcpy(tbuf, xcvr->sprom, len); 728 729 /* Let's make sure we got a consistent copy */ 730 if (!memcmp(data, tbuf, len)) 731 break; 732 733 } while (--count); 734 735 if (!count) 736 return -ETIMEDOUT; 737 738 return 0; 739 } 740 741 static int ionic_nway_reset(struct net_device *netdev) 742 { 743 struct ionic_lif *lif = netdev_priv(netdev); 744 struct ionic *ionic = lif->ionic; 745 int err = 0; 746 747 /* flap the link to force auto-negotiation */ 748 749 mutex_lock(&ionic->dev_cmd_lock); 750 751 ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_DOWN); 752 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 753 754 if (!err) { 755 ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_UP); 756 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 757 } 758 759 mutex_unlock(&ionic->dev_cmd_lock); 760 761 return err; 762 } 763 764 static const struct ethtool_ops ionic_ethtool_ops = { 765 .supported_coalesce_params = ETHTOOL_COALESCE_USECS, 766 .get_drvinfo = ionic_get_drvinfo, 767 .get_regs_len = ionic_get_regs_len, 768 .get_regs = ionic_get_regs, 769 .get_link = ethtool_op_get_link, 770 .get_link_ksettings = ionic_get_link_ksettings, 771 .set_link_ksettings = ionic_set_link_ksettings, 772 .get_coalesce = ionic_get_coalesce, 773 .set_coalesce = ionic_set_coalesce, 774 .get_ringparam = ionic_get_ringparam, 775 .set_ringparam = ionic_set_ringparam, 776 .get_channels = ionic_get_channels, 777 .set_channels = ionic_set_channels, 778 .get_strings = ionic_get_strings, 779 .get_ethtool_stats = ionic_get_stats, 780 .get_sset_count = ionic_get_sset_count, 781 .get_priv_flags = ionic_get_priv_flags, 782 .set_priv_flags = ionic_set_priv_flags, 783 .get_rxnfc = ionic_get_rxnfc, 784 .get_rxfh_indir_size = ionic_get_rxfh_indir_size, 785 .get_rxfh_key_size = ionic_get_rxfh_key_size, 786 .get_rxfh = ionic_get_rxfh, 787 .set_rxfh = ionic_set_rxfh, 788 .get_tunable = ionic_get_tunable, 789 .set_tunable = ionic_set_tunable, 790 .get_module_info = ionic_get_module_info, 791 .get_module_eeprom = ionic_get_module_eeprom, 792 .get_pauseparam = ionic_get_pauseparam, 793 .set_pauseparam = ionic_set_pauseparam, 794 .get_fecparam = ionic_get_fecparam, 795 .set_fecparam = ionic_set_fecparam, 796 .nway_reset = ionic_nway_reset, 797 }; 798 799 void ionic_ethtool_set_ops(struct net_device *netdev) 800 { 801 netdev->ethtool_ops = &ionic_ethtool_ops; 802 } 803