Linux Audio

Check our new training course

Loading...
Note: File does not exist in v3.1.
   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
  14static const char ionic_priv_flags_strings[][ETH_GSTRING_LEN] = {
  15#define IONIC_PRIV_F_SW_DBG_STATS	BIT(0)
  16	"sw-dbg-stats",
  17};
  18
  19#define IONIC_PRIV_FLAGS_COUNT ARRAY_SIZE(ionic_priv_flags_strings)
  20
  21static void ionic_get_stats_strings(struct ionic_lif *lif, u8 *buf)
  22{
  23	u32 i;
  24
  25	for (i = 0; i < ionic_num_stats_grps; i++)
  26		ionic_stats_groups[i].get_strings(lif, &buf);
  27}
  28
  29static void ionic_get_stats(struct net_device *netdev,
  30			    struct ethtool_stats *stats, u64 *buf)
  31{
  32	struct ionic_lif *lif = netdev_priv(netdev);
  33	u32 i;
  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
  40static 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
  50static 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 = IONIC_PRIV_FLAGS_COUNT;
  61		break;
  62	}
  63	return count;
  64}
  65
  66static 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		       IONIC_PRIV_FLAGS_COUNT * ETH_GSTRING_LEN);
  78		break;
  79	}
  80}
  81
  82static 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->fw_version, ionic->idev.dev_info.fw_version,
  90		sizeof(drvinfo->fw_version));
  91	strlcpy(drvinfo->bus_info, ionic_bus_info(ionic),
  92		sizeof(drvinfo->bus_info));
  93}
  94
  95static int ionic_get_regs_len(struct net_device *netdev)
  96{
  97	return (IONIC_DEV_INFO_REG_COUNT + IONIC_DEV_CMD_REG_COUNT) * sizeof(u32);
  98}
  99
 100static void ionic_get_regs(struct net_device *netdev, struct ethtool_regs *regs,
 101			   void *p)
 102{
 103	struct ionic_lif *lif = netdev_priv(netdev);
 104	unsigned int offset;
 105	unsigned int size;
 106
 107	regs->version = IONIC_DEV_CMD_REG_VERSION;
 108
 109	offset = 0;
 110	size = IONIC_DEV_INFO_REG_COUNT * sizeof(u32);
 111	memcpy_fromio(p + offset, lif->ionic->idev.dev_info_regs->words, size);
 112
 113	offset += size;
 114	size = IONIC_DEV_CMD_REG_COUNT * sizeof(u32);
 115	memcpy_fromio(p + offset, lif->ionic->idev.dev_cmd_regs->words, size);
 116}
 117
 118static int ionic_get_link_ksettings(struct net_device *netdev,
 119				    struct ethtool_link_ksettings *ks)
 120{
 121	struct ionic_lif *lif = netdev_priv(netdev);
 122	struct ionic_dev *idev = &lif->ionic->idev;
 123	int copper_seen = 0;
 124
 125	ethtool_link_ksettings_zero_link_mode(ks, supported);
 126
 127	if (!idev->port_info) {
 128		netdev_err(netdev, "port_info not initialized\n");
 129		return -EOPNOTSUPP;
 130	}
 131
 132	/* The port_info data is found in a DMA space that the NIC keeps
 133	 * up-to-date, so there's no need to request the data from the
 134	 * NIC, we already have it in our memory space.
 135	 */
 136
 137	switch (le16_to_cpu(idev->port_info->status.xcvr.pid)) {
 138		/* Copper */
 139	case IONIC_XCVR_PID_QSFP_100G_CR4:
 140		ethtool_link_ksettings_add_link_mode(ks, supported,
 141						     100000baseCR4_Full);
 142		copper_seen++;
 143		break;
 144	case IONIC_XCVR_PID_QSFP_40GBASE_CR4:
 145		ethtool_link_ksettings_add_link_mode(ks, supported,
 146						     40000baseCR4_Full);
 147		copper_seen++;
 148		break;
 149	case IONIC_XCVR_PID_SFP_25GBASE_CR_S:
 150	case IONIC_XCVR_PID_SFP_25GBASE_CR_L:
 151	case IONIC_XCVR_PID_SFP_25GBASE_CR_N:
 152		ethtool_link_ksettings_add_link_mode(ks, supported,
 153						     25000baseCR_Full);
 154		copper_seen++;
 155		break;
 156	case IONIC_XCVR_PID_SFP_10GBASE_AOC:
 157	case IONIC_XCVR_PID_SFP_10GBASE_CU:
 158		ethtool_link_ksettings_add_link_mode(ks, supported,
 159						     10000baseCR_Full);
 160		copper_seen++;
 161		break;
 162
 163		/* Fibre */
 164	case IONIC_XCVR_PID_QSFP_100G_SR4:
 165	case IONIC_XCVR_PID_QSFP_100G_AOC:
 166		ethtool_link_ksettings_add_link_mode(ks, supported,
 167						     100000baseSR4_Full);
 168		break;
 169	case IONIC_XCVR_PID_QSFP_100G_CWDM4:
 170	case IONIC_XCVR_PID_QSFP_100G_PSM4:
 171	case IONIC_XCVR_PID_QSFP_100G_LR4:
 172		ethtool_link_ksettings_add_link_mode(ks, supported,
 173						     100000baseLR4_ER4_Full);
 174		break;
 175	case IONIC_XCVR_PID_QSFP_100G_ER4:
 176		ethtool_link_ksettings_add_link_mode(ks, supported,
 177						     100000baseLR4_ER4_Full);
 178		break;
 179	case IONIC_XCVR_PID_QSFP_40GBASE_SR4:
 180	case IONIC_XCVR_PID_QSFP_40GBASE_AOC:
 181		ethtool_link_ksettings_add_link_mode(ks, supported,
 182						     40000baseSR4_Full);
 183		break;
 184	case IONIC_XCVR_PID_QSFP_40GBASE_LR4:
 185		ethtool_link_ksettings_add_link_mode(ks, supported,
 186						     40000baseLR4_Full);
 187		break;
 188	case IONIC_XCVR_PID_SFP_25GBASE_SR:
 189	case IONIC_XCVR_PID_SFP_25GBASE_AOC:
 190	case IONIC_XCVR_PID_SFP_25GBASE_ACC:
 191		ethtool_link_ksettings_add_link_mode(ks, supported,
 192						     25000baseSR_Full);
 193		break;
 194	case IONIC_XCVR_PID_SFP_10GBASE_SR:
 195		ethtool_link_ksettings_add_link_mode(ks, supported,
 196						     10000baseSR_Full);
 197		break;
 198	case IONIC_XCVR_PID_SFP_10GBASE_LR:
 199		ethtool_link_ksettings_add_link_mode(ks, supported,
 200						     10000baseLR_Full);
 201		break;
 202	case IONIC_XCVR_PID_SFP_10GBASE_LRM:
 203		ethtool_link_ksettings_add_link_mode(ks, supported,
 204						     10000baseLRM_Full);
 205		break;
 206	case IONIC_XCVR_PID_SFP_10GBASE_ER:
 207		ethtool_link_ksettings_add_link_mode(ks, supported,
 208						     10000baseER_Full);
 209		break;
 210	case IONIC_XCVR_PID_SFP_10GBASE_T:
 211		ethtool_link_ksettings_add_link_mode(ks, supported,
 212						     10000baseT_Full);
 213		break;
 214	case IONIC_XCVR_PID_SFP_1000BASE_T:
 215		ethtool_link_ksettings_add_link_mode(ks, supported,
 216						     1000baseT_Full);
 217		break;
 218	case IONIC_XCVR_PID_UNKNOWN:
 219		/* This means there's no module plugged in */
 220		break;
 221	default:
 222		dev_info(lif->ionic->dev, "unknown xcvr type pid=%d / 0x%x\n",
 223			 idev->port_info->status.xcvr.pid,
 224			 idev->port_info->status.xcvr.pid);
 225		break;
 226	}
 227
 228	bitmap_copy(ks->link_modes.advertising, ks->link_modes.supported,
 229		    __ETHTOOL_LINK_MODE_MASK_NBITS);
 230
 231	ethtool_link_ksettings_add_link_mode(ks, supported, FEC_BASER);
 232	ethtool_link_ksettings_add_link_mode(ks, supported, FEC_RS);
 233	if (idev->port_info->config.fec_type == IONIC_PORT_FEC_TYPE_FC)
 234		ethtool_link_ksettings_add_link_mode(ks, advertising, FEC_BASER);
 235	else if (idev->port_info->config.fec_type == IONIC_PORT_FEC_TYPE_RS)
 236		ethtool_link_ksettings_add_link_mode(ks, advertising, FEC_RS);
 237
 238	ethtool_link_ksettings_add_link_mode(ks, supported, FIBRE);
 239	ethtool_link_ksettings_add_link_mode(ks, supported, Pause);
 240
 241	if (idev->port_info->status.xcvr.phy == IONIC_PHY_TYPE_COPPER ||
 242	    copper_seen)
 243		ks->base.port = PORT_DA;
 244	else if (idev->port_info->status.xcvr.phy == IONIC_PHY_TYPE_FIBER)
 245		ks->base.port = PORT_FIBRE;
 246	else
 247		ks->base.port = PORT_NONE;
 248
 249	if (ks->base.port != PORT_NONE) {
 250		ks->base.speed = le32_to_cpu(lif->info->status.link_speed);
 251
 252		if (le16_to_cpu(lif->info->status.link_status))
 253			ks->base.duplex = DUPLEX_FULL;
 254		else
 255			ks->base.duplex = DUPLEX_UNKNOWN;
 256
 257		ethtool_link_ksettings_add_link_mode(ks, supported, Autoneg);
 258
 259		if (idev->port_info->config.an_enable) {
 260			ethtool_link_ksettings_add_link_mode(ks, advertising,
 261							     Autoneg);
 262			ks->base.autoneg = AUTONEG_ENABLE;
 263		}
 264	}
 265
 266	return 0;
 267}
 268
 269static int ionic_set_link_ksettings(struct net_device *netdev,
 270				    const struct ethtool_link_ksettings *ks)
 271{
 272	struct ionic_lif *lif = netdev_priv(netdev);
 273	struct ionic_dev *idev = &lif->ionic->idev;
 274	struct ionic *ionic = lif->ionic;
 275	int err = 0;
 276
 277	/* set autoneg */
 278	if (ks->base.autoneg != idev->port_info->config.an_enable) {
 279		mutex_lock(&ionic->dev_cmd_lock);
 280		ionic_dev_cmd_port_autoneg(idev, ks->base.autoneg);
 281		err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
 282		mutex_unlock(&ionic->dev_cmd_lock);
 283		if (err)
 284			return err;
 285	}
 286
 287	/* set speed */
 288	if (ks->base.speed != le32_to_cpu(idev->port_info->config.speed)) {
 289		mutex_lock(&ionic->dev_cmd_lock);
 290		ionic_dev_cmd_port_speed(idev, ks->base.speed);
 291		err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
 292		mutex_unlock(&ionic->dev_cmd_lock);
 293		if (err)
 294			return err;
 295	}
 296
 297	return 0;
 298}
 299
 300static void ionic_get_pauseparam(struct net_device *netdev,
 301				 struct ethtool_pauseparam *pause)
 302{
 303	struct ionic_lif *lif = netdev_priv(netdev);
 304	u8 pause_type;
 305
 306	pause->autoneg = 0;
 307
 308	pause_type = lif->ionic->idev.port_info->config.pause_type;
 309	if (pause_type) {
 310		pause->rx_pause = (pause_type & IONIC_PAUSE_F_RX) ? 1 : 0;
 311		pause->tx_pause = (pause_type & IONIC_PAUSE_F_TX) ? 1 : 0;
 312	}
 313}
 314
 315static int ionic_set_pauseparam(struct net_device *netdev,
 316				struct ethtool_pauseparam *pause)
 317{
 318	struct ionic_lif *lif = netdev_priv(netdev);
 319	struct ionic *ionic = lif->ionic;
 320	u32 requested_pause;
 321	int err;
 322
 323	if (pause->autoneg)
 324		return -EOPNOTSUPP;
 325
 326	/* change both at the same time */
 327	requested_pause = IONIC_PORT_PAUSE_TYPE_LINK;
 328	if (pause->rx_pause)
 329		requested_pause |= IONIC_PAUSE_F_RX;
 330	if (pause->tx_pause)
 331		requested_pause |= IONIC_PAUSE_F_TX;
 332
 333	if (requested_pause == lif->ionic->idev.port_info->config.pause_type)
 334		return 0;
 335
 336	mutex_lock(&ionic->dev_cmd_lock);
 337	ionic_dev_cmd_port_pause(&lif->ionic->idev, requested_pause);
 338	err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
 339	mutex_unlock(&ionic->dev_cmd_lock);
 340	if (err)
 341		return err;
 342
 343	return 0;
 344}
 345
 346static int ionic_get_fecparam(struct net_device *netdev,
 347			      struct ethtool_fecparam *fec)
 348{
 349	struct ionic_lif *lif = netdev_priv(netdev);
 350
 351	switch (lif->ionic->idev.port_info->config.fec_type) {
 352	case IONIC_PORT_FEC_TYPE_NONE:
 353		fec->active_fec = ETHTOOL_FEC_OFF;
 354		break;
 355	case IONIC_PORT_FEC_TYPE_RS:
 356		fec->active_fec = ETHTOOL_FEC_RS;
 357		break;
 358	case IONIC_PORT_FEC_TYPE_FC:
 359		fec->active_fec = ETHTOOL_FEC_BASER;
 360		break;
 361	}
 362
 363	fec->fec = ETHTOOL_FEC_OFF | ETHTOOL_FEC_RS | ETHTOOL_FEC_BASER;
 364
 365	return 0;
 366}
 367
 368static int ionic_set_fecparam(struct net_device *netdev,
 369			      struct ethtool_fecparam *fec)
 370{
 371	struct ionic_lif *lif = netdev_priv(netdev);
 372	u8 fec_type;
 373	int ret = 0;
 374
 375	if (lif->ionic->idev.port_info->config.an_enable) {
 376		netdev_err(netdev, "FEC request not allowed while autoneg is enabled\n");
 377		return -EINVAL;
 378	}
 379
 380	switch (fec->fec) {
 381	case ETHTOOL_FEC_NONE:
 382		fec_type = IONIC_PORT_FEC_TYPE_NONE;
 383		break;
 384	case ETHTOOL_FEC_OFF:
 385		fec_type = IONIC_PORT_FEC_TYPE_NONE;
 386		break;
 387	case ETHTOOL_FEC_RS:
 388		fec_type = IONIC_PORT_FEC_TYPE_RS;
 389		break;
 390	case ETHTOOL_FEC_BASER:
 391		fec_type = IONIC_PORT_FEC_TYPE_FC;
 392		break;
 393	case ETHTOOL_FEC_AUTO:
 394	default:
 395		netdev_err(netdev, "FEC request 0x%04x not supported\n",
 396			   fec->fec);
 397		return -EINVAL;
 398	}
 399
 400	if (fec_type != lif->ionic->idev.port_info->config.fec_type) {
 401		mutex_lock(&lif->ionic->dev_cmd_lock);
 402		ionic_dev_cmd_port_fec(&lif->ionic->idev, fec_type);
 403		ret = ionic_dev_cmd_wait(lif->ionic, DEVCMD_TIMEOUT);
 404		mutex_unlock(&lif->ionic->dev_cmd_lock);
 405	}
 406
 407	return ret;
 408}
 409
 410static int ionic_get_coalesce(struct net_device *netdev,
 411			      struct ethtool_coalesce *coalesce)
 412{
 413	struct ionic_lif *lif = netdev_priv(netdev);
 414
 415	coalesce->tx_coalesce_usecs = lif->tx_coalesce_usecs;
 416	coalesce->rx_coalesce_usecs = lif->rx_coalesce_usecs;
 417
 418	if (test_bit(IONIC_LIF_F_SPLIT_INTR, lif->state))
 419		coalesce->use_adaptive_tx_coalesce = test_bit(IONIC_LIF_F_TX_DIM_INTR, lif->state);
 420	else
 421		coalesce->use_adaptive_tx_coalesce = 0;
 422
 423	coalesce->use_adaptive_rx_coalesce = test_bit(IONIC_LIF_F_RX_DIM_INTR, lif->state);
 424
 425	return 0;
 426}
 427
 428static int ionic_set_coalesce(struct net_device *netdev,
 429			      struct ethtool_coalesce *coalesce)
 430{
 431	struct ionic_lif *lif = netdev_priv(netdev);
 432	struct ionic_identity *ident;
 433	u32 rx_coal, rx_dim;
 434	u32 tx_coal, tx_dim;
 435	unsigned int i;
 436
 437	ident = &lif->ionic->ident;
 438	if (ident->dev.intr_coal_div == 0) {
 439		netdev_warn(netdev, "bad HW value in dev.intr_coal_div = %d\n",
 440			    ident->dev.intr_coal_div);
 441		return -EIO;
 442	}
 443
 444	/* Tx normally shares Rx interrupt, so only change Rx if not split */
 445	if (!test_bit(IONIC_LIF_F_SPLIT_INTR, lif->state) &&
 446	    (coalesce->tx_coalesce_usecs != lif->rx_coalesce_usecs ||
 447	     coalesce->use_adaptive_tx_coalesce)) {
 448		netdev_warn(netdev, "only rx parameters can be changed\n");
 449		return -EINVAL;
 450	}
 451
 452	/* Convert the usec request to a HW usable value.  If they asked
 453	 * for non-zero and it resolved to zero, bump it up
 454	 */
 455	rx_coal = ionic_coal_usec_to_hw(lif->ionic, coalesce->rx_coalesce_usecs);
 456	if (!rx_coal && coalesce->rx_coalesce_usecs)
 457		rx_coal = 1;
 458	tx_coal = ionic_coal_usec_to_hw(lif->ionic, coalesce->tx_coalesce_usecs);
 459	if (!tx_coal && coalesce->tx_coalesce_usecs)
 460		tx_coal = 1;
 461
 462	if (rx_coal > IONIC_INTR_CTRL_COAL_MAX ||
 463	    tx_coal > IONIC_INTR_CTRL_COAL_MAX)
 464		return -ERANGE;
 465
 466	/* Save the new values */
 467	lif->rx_coalesce_usecs = coalesce->rx_coalesce_usecs;
 468	lif->rx_coalesce_hw = rx_coal;
 469
 470	if (test_bit(IONIC_LIF_F_SPLIT_INTR, lif->state))
 471		lif->tx_coalesce_usecs = coalesce->tx_coalesce_usecs;
 472	else
 473		lif->tx_coalesce_usecs = coalesce->rx_coalesce_usecs;
 474	lif->tx_coalesce_hw = tx_coal;
 475
 476	if (coalesce->use_adaptive_rx_coalesce) {
 477		set_bit(IONIC_LIF_F_RX_DIM_INTR, lif->state);
 478		rx_dim = rx_coal;
 479	} else {
 480		clear_bit(IONIC_LIF_F_RX_DIM_INTR, lif->state);
 481		rx_dim = 0;
 482	}
 483
 484	if (coalesce->use_adaptive_tx_coalesce) {
 485		set_bit(IONIC_LIF_F_TX_DIM_INTR, lif->state);
 486		tx_dim = tx_coal;
 487	} else {
 488		clear_bit(IONIC_LIF_F_TX_DIM_INTR, lif->state);
 489		tx_dim = 0;
 490	}
 491
 492	if (test_bit(IONIC_LIF_F_UP, lif->state)) {
 493		for (i = 0; i < lif->nxqs; i++) {
 494			if (lif->rxqcqs[i]->flags & IONIC_QCQ_F_INTR) {
 495				ionic_intr_coal_init(lif->ionic->idev.intr_ctrl,
 496						     lif->rxqcqs[i]->intr.index,
 497						     lif->rx_coalesce_hw);
 498				lif->rxqcqs[i]->intr.dim_coal_hw = rx_dim;
 499			}
 500
 501			if (lif->txqcqs[i]->flags & IONIC_QCQ_F_INTR) {
 502				ionic_intr_coal_init(lif->ionic->idev.intr_ctrl,
 503						     lif->txqcqs[i]->intr.index,
 504						     lif->tx_coalesce_hw);
 505				lif->txqcqs[i]->intr.dim_coal_hw = tx_dim;
 506			}
 507		}
 508	}
 509
 510	return 0;
 511}
 512
 513static void ionic_get_ringparam(struct net_device *netdev,
 514				struct ethtool_ringparam *ring)
 515{
 516	struct ionic_lif *lif = netdev_priv(netdev);
 517
 518	ring->tx_max_pending = IONIC_MAX_TX_DESC;
 519	ring->tx_pending = lif->ntxq_descs;
 520	ring->rx_max_pending = IONIC_MAX_RX_DESC;
 521	ring->rx_pending = lif->nrxq_descs;
 522}
 523
 524static int ionic_set_ringparam(struct net_device *netdev,
 525			       struct ethtool_ringparam *ring)
 526{
 527	struct ionic_lif *lif = netdev_priv(netdev);
 528	struct ionic_queue_params qparam;
 529	int err;
 530
 531	ionic_init_queue_params(lif, &qparam);
 532
 533	if (ring->rx_mini_pending || ring->rx_jumbo_pending) {
 534		netdev_info(netdev, "Changing jumbo or mini descriptors not supported\n");
 535		return -EINVAL;
 536	}
 537
 538	if (!is_power_of_2(ring->tx_pending) ||
 539	    !is_power_of_2(ring->rx_pending)) {
 540		netdev_info(netdev, "Descriptor count must be a power of 2\n");
 541		return -EINVAL;
 542	}
 543
 544	/* if nothing to do return success */
 545	if (ring->tx_pending == lif->ntxq_descs &&
 546	    ring->rx_pending == lif->nrxq_descs)
 547		return 0;
 548
 549	if (ring->tx_pending != lif->ntxq_descs)
 550		netdev_info(netdev, "Changing Tx ring size from %d to %d\n",
 551			    lif->ntxq_descs, ring->tx_pending);
 552
 553	if (ring->rx_pending != lif->nrxq_descs)
 554		netdev_info(netdev, "Changing Rx ring size from %d to %d\n",
 555			    lif->nrxq_descs, ring->rx_pending);
 556
 557	/* if we're not running, just set the values and return */
 558	if (!netif_running(lif->netdev)) {
 559		lif->ntxq_descs = ring->tx_pending;
 560		lif->nrxq_descs = ring->rx_pending;
 561		return 0;
 562	}
 563
 564	qparam.ntxq_descs = ring->tx_pending;
 565	qparam.nrxq_descs = ring->rx_pending;
 566	err = ionic_reconfigure_queues(lif, &qparam);
 567	if (err)
 568		netdev_info(netdev, "Ring reconfiguration failed, changes canceled: %d\n", err);
 569
 570	return err;
 571}
 572
 573static void ionic_get_channels(struct net_device *netdev,
 574			       struct ethtool_channels *ch)
 575{
 576	struct ionic_lif *lif = netdev_priv(netdev);
 577
 578	/* report maximum channels */
 579	ch->max_combined = lif->ionic->ntxqs_per_lif;
 580	ch->max_rx = lif->ionic->ntxqs_per_lif / 2;
 581	ch->max_tx = lif->ionic->ntxqs_per_lif / 2;
 582
 583	/* report current channels */
 584	if (test_bit(IONIC_LIF_F_SPLIT_INTR, lif->state)) {
 585		ch->rx_count = lif->nxqs;
 586		ch->tx_count = lif->nxqs;
 587	} else {
 588		ch->combined_count = lif->nxqs;
 589	}
 590}
 591
 592static int ionic_set_channels(struct net_device *netdev,
 593			      struct ethtool_channels *ch)
 594{
 595	struct ionic_lif *lif = netdev_priv(netdev);
 596	struct ionic_queue_params qparam;
 597	int max_cnt;
 598	int err;
 599
 600	ionic_init_queue_params(lif, &qparam);
 601
 602	if (ch->rx_count != ch->tx_count) {
 603		netdev_info(netdev, "The rx and tx count must be equal\n");
 604		return -EINVAL;
 605	}
 606
 607	if (ch->combined_count && ch->rx_count) {
 608		netdev_info(netdev, "Use either combined or rx and tx, not both\n");
 609		return -EINVAL;
 610	}
 611
 612	max_cnt = lif->ionic->ntxqs_per_lif;
 613	if (ch->combined_count) {
 614		if (ch->combined_count > max_cnt)
 615			return -EINVAL;
 616
 617		if (test_bit(IONIC_LIF_F_SPLIT_INTR, lif->state))
 618			netdev_info(lif->netdev, "Sharing queue interrupts\n");
 619		else if (ch->combined_count == lif->nxqs)
 620			return 0;
 621
 622		if (lif->nxqs != ch->combined_count)
 623			netdev_info(netdev, "Changing queue count from %d to %d\n",
 624				    lif->nxqs, ch->combined_count);
 625
 626		qparam.nxqs = ch->combined_count;
 627		qparam.intr_split = 0;
 628	} else {
 629		max_cnt /= 2;
 630		if (ch->rx_count > max_cnt)
 631			return -EINVAL;
 632
 633		if (!test_bit(IONIC_LIF_F_SPLIT_INTR, lif->state))
 634			netdev_info(lif->netdev, "Splitting queue interrupts\n");
 635		else if (ch->rx_count == lif->nxqs)
 636			return 0;
 637
 638		if (lif->nxqs != ch->rx_count)
 639			netdev_info(netdev, "Changing queue count from %d to %d\n",
 640				    lif->nxqs, ch->rx_count);
 641
 642		qparam.nxqs = ch->rx_count;
 643		qparam.intr_split = 1;
 644	}
 645
 646	/* if we're not running, just set the values and return */
 647	if (!netif_running(lif->netdev)) {
 648		lif->nxqs = qparam.nxqs;
 649
 650		if (qparam.intr_split) {
 651			set_bit(IONIC_LIF_F_SPLIT_INTR, lif->state);
 652		} else {
 653			clear_bit(IONIC_LIF_F_SPLIT_INTR, lif->state);
 654			lif->tx_coalesce_usecs = lif->rx_coalesce_usecs;
 655			lif->tx_coalesce_hw = lif->rx_coalesce_hw;
 656		}
 657		return 0;
 658	}
 659
 660	err = ionic_reconfigure_queues(lif, &qparam);
 661	if (err)
 662		netdev_info(netdev, "Queue reconfiguration failed, changes canceled: %d\n", err);
 663
 664	return err;
 665}
 666
 667static u32 ionic_get_priv_flags(struct net_device *netdev)
 668{
 669	struct ionic_lif *lif = netdev_priv(netdev);
 670	u32 priv_flags = 0;
 671
 672	if (test_bit(IONIC_LIF_F_SW_DEBUG_STATS, lif->state))
 673		priv_flags |= IONIC_PRIV_F_SW_DBG_STATS;
 674
 675	return priv_flags;
 676}
 677
 678static int ionic_set_priv_flags(struct net_device *netdev, u32 priv_flags)
 679{
 680	struct ionic_lif *lif = netdev_priv(netdev);
 681
 682	clear_bit(IONIC_LIF_F_SW_DEBUG_STATS, lif->state);
 683	if (priv_flags & IONIC_PRIV_F_SW_DBG_STATS)
 684		set_bit(IONIC_LIF_F_SW_DEBUG_STATS, lif->state);
 685
 686	return 0;
 687}
 688
 689static int ionic_get_rxnfc(struct net_device *netdev,
 690			   struct ethtool_rxnfc *info, u32 *rules)
 691{
 692	struct ionic_lif *lif = netdev_priv(netdev);
 693	int err = 0;
 694
 695	switch (info->cmd) {
 696	case ETHTOOL_GRXRINGS:
 697		info->data = lif->nxqs;
 698		break;
 699	default:
 700		netdev_err(netdev, "Command parameter %d is not supported\n",
 701			   info->cmd);
 702		err = -EOPNOTSUPP;
 703	}
 704
 705	return err;
 706}
 707
 708static u32 ionic_get_rxfh_indir_size(struct net_device *netdev)
 709{
 710	struct ionic_lif *lif = netdev_priv(netdev);
 711
 712	return le16_to_cpu(lif->ionic->ident.lif.eth.rss_ind_tbl_sz);
 713}
 714
 715static u32 ionic_get_rxfh_key_size(struct net_device *netdev)
 716{
 717	return IONIC_RSS_HASH_KEY_SIZE;
 718}
 719
 720static int ionic_get_rxfh(struct net_device *netdev, u32 *indir, u8 *key,
 721			  u8 *hfunc)
 722{
 723	struct ionic_lif *lif = netdev_priv(netdev);
 724	unsigned int i, tbl_sz;
 725
 726	if (indir) {
 727		tbl_sz = le16_to_cpu(lif->ionic->ident.lif.eth.rss_ind_tbl_sz);
 728		for (i = 0; i < tbl_sz; i++)
 729			indir[i] = lif->rss_ind_tbl[i];
 730	}
 731
 732	if (key)
 733		memcpy(key, lif->rss_hash_key, IONIC_RSS_HASH_KEY_SIZE);
 734
 735	if (hfunc)
 736		*hfunc = ETH_RSS_HASH_TOP;
 737
 738	return 0;
 739}
 740
 741static int ionic_set_rxfh(struct net_device *netdev, const u32 *indir,
 742			  const u8 *key, const u8 hfunc)
 743{
 744	struct ionic_lif *lif = netdev_priv(netdev);
 745
 746	if (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP)
 747		return -EOPNOTSUPP;
 748
 749	return ionic_lif_rss_config(lif, lif->rss_types, key, indir);
 750}
 751
 752static int ionic_set_tunable(struct net_device *dev,
 753			     const struct ethtool_tunable *tuna,
 754			     const void *data)
 755{
 756	struct ionic_lif *lif = netdev_priv(dev);
 757
 758	switch (tuna->id) {
 759	case ETHTOOL_RX_COPYBREAK:
 760		lif->rx_copybreak = *(u32 *)data;
 761		break;
 762	default:
 763		return -EOPNOTSUPP;
 764	}
 765
 766	return 0;
 767}
 768
 769static int ionic_get_tunable(struct net_device *netdev,
 770			     const struct ethtool_tunable *tuna, void *data)
 771{
 772	struct ionic_lif *lif = netdev_priv(netdev);
 773
 774	switch (tuna->id) {
 775	case ETHTOOL_RX_COPYBREAK:
 776		*(u32 *)data = lif->rx_copybreak;
 777		break;
 778	default:
 779		return -EOPNOTSUPP;
 780	}
 781
 782	return 0;
 783}
 784
 785static int ionic_get_module_info(struct net_device *netdev,
 786				 struct ethtool_modinfo *modinfo)
 787
 788{
 789	struct ionic_lif *lif = netdev_priv(netdev);
 790	struct ionic_dev *idev = &lif->ionic->idev;
 791	struct ionic_xcvr_status *xcvr;
 792	struct sfp_eeprom_base *sfp;
 793
 794	xcvr = &idev->port_info->status.xcvr;
 795	sfp = (struct sfp_eeprom_base *) xcvr->sprom;
 796
 797	/* report the module data type and length */
 798	switch (sfp->phys_id) {
 799	case SFF8024_ID_SFP:
 800		modinfo->type = ETH_MODULE_SFF_8079;
 801		modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN;
 802		break;
 803	case SFF8024_ID_QSFP_8436_8636:
 804	case SFF8024_ID_QSFP28_8636:
 805		modinfo->type = ETH_MODULE_SFF_8436;
 806		modinfo->eeprom_len = ETH_MODULE_SFF_8436_LEN;
 807		break;
 808	default:
 809		netdev_info(netdev, "unknown xcvr type 0x%02x\n",
 810			    xcvr->sprom[0]);
 811		modinfo->type = 0;
 812		modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN;
 813		break;
 814	}
 815
 816	return 0;
 817}
 818
 819static int ionic_get_module_eeprom(struct net_device *netdev,
 820				   struct ethtool_eeprom *ee,
 821				   u8 *data)
 822{
 823	struct ionic_lif *lif = netdev_priv(netdev);
 824	struct ionic_dev *idev = &lif->ionic->idev;
 825	struct ionic_xcvr_status *xcvr;
 826	char tbuf[sizeof(xcvr->sprom)];
 827	int count = 10;
 828	u32 len;
 829
 830	/* The NIC keeps the module prom up-to-date in the DMA space
 831	 * so we can simply copy the module bytes into the data buffer.
 832	 */
 833	xcvr = &idev->port_info->status.xcvr;
 834	len = min_t(u32, sizeof(xcvr->sprom), ee->len);
 835
 836	do {
 837		memcpy(data, xcvr->sprom, len);
 838		memcpy(tbuf, xcvr->sprom, len);
 839
 840		/* Let's make sure we got a consistent copy */
 841		if (!memcmp(data, tbuf, len))
 842			break;
 843
 844	} while (--count);
 845
 846	if (!count)
 847		return -ETIMEDOUT;
 848
 849	return 0;
 850}
 851
 852static int ionic_get_ts_info(struct net_device *netdev,
 853			     struct ethtool_ts_info *info)
 854{
 855	struct ionic_lif *lif = netdev_priv(netdev);
 856	struct ionic *ionic = lif->ionic;
 857	__le64 mask;
 858
 859	if (!lif->phc || !lif->phc->ptp)
 860		return ethtool_op_get_ts_info(netdev, info);
 861
 862	info->phc_index = ptp_clock_index(lif->phc->ptp);
 863
 864	info->so_timestamping = SOF_TIMESTAMPING_TX_SOFTWARE |
 865				SOF_TIMESTAMPING_RX_SOFTWARE |
 866				SOF_TIMESTAMPING_SOFTWARE |
 867				SOF_TIMESTAMPING_TX_HARDWARE |
 868				SOF_TIMESTAMPING_RX_HARDWARE |
 869				SOF_TIMESTAMPING_RAW_HARDWARE;
 870
 871	/* tx modes */
 872
 873	info->tx_types = BIT(HWTSTAMP_TX_OFF) |
 874			 BIT(HWTSTAMP_TX_ON);
 875
 876	mask = cpu_to_le64(BIT_ULL(IONIC_TXSTAMP_ONESTEP_SYNC));
 877	if (ionic->ident.lif.eth.hwstamp_tx_modes & mask)
 878		info->tx_types |= BIT(HWTSTAMP_TX_ONESTEP_SYNC);
 879
 880	mask = cpu_to_le64(BIT_ULL(IONIC_TXSTAMP_ONESTEP_P2P));
 881	if (ionic->ident.lif.eth.hwstamp_tx_modes & mask)
 882		info->tx_types |= BIT(HWTSTAMP_TX_ONESTEP_P2P);
 883
 884	/* rx filters */
 885
 886	info->rx_filters = BIT(HWTSTAMP_FILTER_NONE) |
 887			   BIT(HWTSTAMP_FILTER_ALL);
 888
 889	mask = cpu_to_le64(IONIC_PKT_CLS_NTP_ALL);
 890	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 891		info->rx_filters |= BIT(HWTSTAMP_FILTER_NTP_ALL);
 892
 893	mask = cpu_to_le64(IONIC_PKT_CLS_PTP1_SYNC);
 894	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 895		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V1_L4_SYNC);
 896
 897	mask = cpu_to_le64(IONIC_PKT_CLS_PTP1_DREQ);
 898	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 899		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ);
 900
 901	mask = cpu_to_le64(IONIC_PKT_CLS_PTP1_ALL);
 902	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 903		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V1_L4_EVENT);
 904
 905	mask = cpu_to_le64(IONIC_PKT_CLS_PTP2_L4_SYNC);
 906	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 907		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V2_L4_SYNC);
 908
 909	mask = cpu_to_le64(IONIC_PKT_CLS_PTP2_L4_DREQ);
 910	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 911		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ);
 912
 913	mask = cpu_to_le64(IONIC_PKT_CLS_PTP2_L4_ALL);
 914	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 915		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V2_L4_EVENT);
 916
 917	mask = cpu_to_le64(IONIC_PKT_CLS_PTP2_L2_SYNC);
 918	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 919		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V2_L2_SYNC);
 920
 921	mask = cpu_to_le64(IONIC_PKT_CLS_PTP2_L2_DREQ);
 922	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 923		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ);
 924
 925	mask = cpu_to_le64(IONIC_PKT_CLS_PTP2_L2_ALL);
 926	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 927		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V2_L2_EVENT);
 928
 929	mask = cpu_to_le64(IONIC_PKT_CLS_PTP2_SYNC);
 930	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 931		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V2_SYNC);
 932
 933	mask = cpu_to_le64(IONIC_PKT_CLS_PTP2_DREQ);
 934	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 935		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V2_DELAY_REQ);
 936
 937	mask = cpu_to_le64(IONIC_PKT_CLS_PTP2_ALL);
 938	if ((ionic->ident.lif.eth.hwstamp_rx_filters & mask) == mask)
 939		info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V2_EVENT);
 940
 941	return 0;
 942}
 943
 944static int ionic_nway_reset(struct net_device *netdev)
 945{
 946	struct ionic_lif *lif = netdev_priv(netdev);
 947	struct ionic *ionic = lif->ionic;
 948	int err = 0;
 949
 950	/* flap the link to force auto-negotiation */
 951
 952	mutex_lock(&ionic->dev_cmd_lock);
 953
 954	ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_DOWN);
 955	err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
 956
 957	if (!err) {
 958		ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_UP);
 959		err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
 960	}
 961
 962	mutex_unlock(&ionic->dev_cmd_lock);
 963
 964	return err;
 965}
 966
 967static const struct ethtool_ops ionic_ethtool_ops = {
 968	.supported_coalesce_params = ETHTOOL_COALESCE_USECS |
 969				     ETHTOOL_COALESCE_USE_ADAPTIVE_RX |
 970				     ETHTOOL_COALESCE_USE_ADAPTIVE_TX,
 971	.get_drvinfo		= ionic_get_drvinfo,
 972	.get_regs_len		= ionic_get_regs_len,
 973	.get_regs		= ionic_get_regs,
 974	.get_link		= ethtool_op_get_link,
 975	.get_link_ksettings	= ionic_get_link_ksettings,
 976	.set_link_ksettings	= ionic_set_link_ksettings,
 977	.get_coalesce		= ionic_get_coalesce,
 978	.set_coalesce		= ionic_set_coalesce,
 979	.get_ringparam		= ionic_get_ringparam,
 980	.set_ringparam		= ionic_set_ringparam,
 981	.get_channels		= ionic_get_channels,
 982	.set_channels		= ionic_set_channels,
 983	.get_strings		= ionic_get_strings,
 984	.get_ethtool_stats	= ionic_get_stats,
 985	.get_sset_count		= ionic_get_sset_count,
 986	.get_priv_flags		= ionic_get_priv_flags,
 987	.set_priv_flags		= ionic_set_priv_flags,
 988	.get_rxnfc		= ionic_get_rxnfc,
 989	.get_rxfh_indir_size	= ionic_get_rxfh_indir_size,
 990	.get_rxfh_key_size	= ionic_get_rxfh_key_size,
 991	.get_rxfh		= ionic_get_rxfh,
 992	.set_rxfh		= ionic_set_rxfh,
 993	.get_tunable		= ionic_get_tunable,
 994	.set_tunable		= ionic_set_tunable,
 995	.get_module_info	= ionic_get_module_info,
 996	.get_module_eeprom	= ionic_get_module_eeprom,
 997	.get_pauseparam		= ionic_get_pauseparam,
 998	.set_pauseparam		= ionic_set_pauseparam,
 999	.get_fecparam		= ionic_get_fecparam,
1000	.set_fecparam		= ionic_set_fecparam,
1001	.get_ts_info		= ionic_get_ts_info,
1002	.nway_reset		= ionic_nway_reset,
1003};
1004
1005void ionic_ethtool_set_ops(struct net_device *netdev)
1006{
1007	netdev->ethtool_ops = &ionic_ethtool_ops;
1008}