Quelle  ethtool.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-only
/****************************************************************************
 * Driver for Solarflare network controllers and boards
 * Copyright 2005-2006 Fen Systems Ltd.
 * Copyright 2006-2013 Solarflare Communications Inc.
 */

#include <linux/netdevice.h>
#include <linux/ethtool.h>
#include <linux/rtnetlink.h>
#include <linux/in.h>
#include "net_driver.h"
#include "workarounds.h"
#include "selftest.h"
#include "efx.h"
#include "efx_channels.h"
#include "rx_common.h"
#include "tx_common.h"
#include "ethtool_common.h"
#include "filter.h"
#include "nic.h"

#define EFX_ETHTOOL_EEPROM_MAGIC 0xEFAB

/**************************************************************************
 *
 * Ethtool operations
 *
 **************************************************************************
 */

/* Identify device by flashing LEDs */
static int efx_ethtool_phys_id(struct net_device *net_dev,
          enum ethtool_phys_id_state state)
{
 struct efx_nic *efx = efx_netdev_priv(net_dev);
 enum efx_led_mode mode = EFX_LED_DEFAULT;

 switch (state) {
 case ETHTOOL_ID_ON:
  mode = EFX_LED_ON;
  break;
 case ETHTOOL_ID_OFF:
  mode = EFX_LED_OFF;
  break;
 case ETHTOOL_ID_INACTIVE:
  mode = EFX_LED_DEFAULT;
  break;
 case ETHTOOL_ID_ACTIVE:
  return 1; /* cycle on/off once per second */
 }

 return efx_mcdi_set_id_led(efx, mode);
}

static int efx_ethtool_get_regs_len(struct net_device *net_dev)
{
 return efx_nic_get_regs_len(efx_netdev_priv(net_dev));
}

static void efx_ethtool_get_regs(struct net_device *net_dev,
     struct ethtool_regs *regs, void *buf)
{
 struct efx_nic *efx = efx_netdev_priv(net_dev);

 regs->version = efx->type->revision;
 efx_nic_get_regs(efx, buf);
}

/*
 * Each channel has a single IRQ and moderation timer, started by any
 * completion (or other event).  Unless the module parameter
 * separate_tx_channels is set, IRQs and moderation are therefore
 * shared between RX and TX completions.  In this case, when RX IRQ
 * moderation is explicitly changed then TX IRQ moderation is
 * automatically changed too, but otherwise we fail if the two values
 * are requested to be different.
 *
 * The hardware does not support a limit on the number of completions
 * before an IRQ, so we do not use the max_frames fields.  We should
 * report and require that max_frames == (usecs != 0), but this would
 * invalidate existing user documentation.
 *
 * The hardware does not have distinct settings for interrupt
 * moderation while the previous IRQ is being handled, so we should
 * not use the 'irq' fields.  However, an earlier developer
 * misunderstood the meaning of the 'irq' fields and the driver did
 * not support the standard fields.  To avoid invalidating existing
 * user documentation, we report and accept changes through either the
 * standard or 'irq' fields.  If both are changed at the same time, we
 * prefer the standard field.
 *
 * We implement adaptive IRQ moderation, but use a different algorithm
 * from that assumed in the definition of struct ethtool_coalesce.
 * Therefore we do not use any of the adaptive moderation parameters
 * in it.
 */

static int efx_ethtool_get_coalesce(struct net_device *net_dev,
        struct ethtool_coalesce *coalesce,
        struct kernel_ethtool_coalesce *kernel_coal,
        struct netlink_ext_ack *extack)
{
 struct efx_nic *efx = efx_netdev_priv(net_dev);
 unsigned int tx_usecs, rx_usecs;
 bool rx_adaptive;

 efx_get_irq_moderation(efx, &tx_usecs, &rx_usecs, &rx_adaptive);

 coalesce->tx_coalesce_usecs = tx_usecs;
 coalesce->tx_coalesce_usecs_irq = tx_usecs;
 coalesce->rx_coalesce_usecs = rx_usecs;
 coalesce->rx_coalesce_usecs_irq = rx_usecs;
 coalesce->use_adaptive_rx_coalesce = rx_adaptive;

 return 0;
}

static int efx_ethtool_set_coalesce(struct net_device *net_dev,
        struct ethtool_coalesce *coalesce,
        struct kernel_ethtool_coalesce *kernel_coal,
        struct netlink_ext_ack *extack)
{
 struct efx_nic *efx = efx_netdev_priv(net_dev);
 struct efx_channel *channel;
 unsigned int tx_usecs, rx_usecs;
 bool adaptive, rx_may_override_tx;
 int rc;

 efx_get_irq_moderation(efx, &tx_usecs, &rx_usecs, &adaptive);

 if (coalesce->rx_coalesce_usecs != rx_usecs)
  rx_usecs = coalesce->rx_coalesce_usecs;
 else
  rx_usecs = coalesce->rx_coalesce_usecs_irq;

 adaptive = coalesce->use_adaptive_rx_coalesce;

 /* If channels are shared, TX IRQ moderation can be quietly
 * overridden unless it is changed from its old value.
 */
 rx_may_override_tx = (coalesce->tx_coalesce_usecs == tx_usecs &&
         coalesce->tx_coalesce_usecs_irq == tx_usecs);
 if (coalesce->tx_coalesce_usecs != tx_usecs)
  tx_usecs = coalesce->tx_coalesce_usecs;
 else
  tx_usecs = coalesce->tx_coalesce_usecs_irq;

 rc = efx_init_irq_moderation(efx, tx_usecs, rx_usecs, adaptive,
         rx_may_override_tx);
 if (rc != 0)
  return rc;

 efx_for_each_channel(channel, efx)
  efx->type->push_irq_moderation(channel);

 return 0;
}

static void
efx_ethtool_get_ringparam(struct net_device *net_dev,
     struct ethtool_ringparam *ring,
     struct kernel_ethtool_ringparam *kernel_ring,
     struct netlink_ext_ack *extack)
{
 struct efx_nic *efx = efx_netdev_priv(net_dev);

 ring->rx_max_pending = EFX_MAX_DMAQ_SIZE;
 ring->tx_max_pending = EFX_TXQ_MAX_ENT(efx);
 ring->rx_pending = efx->rxq_entries;
 ring->tx_pending = efx->txq_entries;
}

static int
efx_ethtool_set_ringparam(struct net_device *net_dev,
     struct ethtool_ringparam *ring,
     struct kernel_ethtool_ringparam *kernel_ring,
     struct netlink_ext_ack *extack)
{
 struct efx_nic *efx = efx_netdev_priv(net_dev);
 u32 txq_entries;

 if (ring->rx_mini_pending || ring->rx_jumbo_pending ||
     ring->rx_pending > EFX_MAX_DMAQ_SIZE ||
     ring->tx_pending > EFX_TXQ_MAX_ENT(efx))
  return -EINVAL;

 if (ring->rx_pending < EFX_RXQ_MIN_ENT) {
  netif_err(efx, drv, efx->net_dev,
     "RX queues cannot be smaller than %u\n",
     EFX_RXQ_MIN_ENT);
  return -EINVAL;
 }

 txq_entries = max(ring->tx_pending, EFX_TXQ_MIN_ENT(efx));
 if (txq_entries != ring->tx_pending)
  netif_warn(efx, drv, efx->net_dev,
      "increasing TX queue size to minimum of %u\n",
      txq_entries);

 return efx_realloc_channels(efx, ring->rx_pending, txq_entries);
}

static void efx_ethtool_get_wol(struct net_device *net_dev,
    struct ethtool_wolinfo *wol)
{
 struct efx_nic *efx = efx_netdev_priv(net_dev);
 return efx->type->get_wol(efx, wol);
}


static int efx_ethtool_set_wol(struct net_device *net_dev,
          struct ethtool_wolinfo *wol)
{
 struct efx_nic *efx = efx_netdev_priv(net_dev);
 return efx->type->set_wol(efx, wol->wolopts);
}

static void efx_ethtool_get_fec_stats(struct net_device *net_dev,
          struct ethtool_fec_stats *fec_stats)
{
 struct efx_nic *efx = efx_netdev_priv(net_dev);

 if (efx->type->get_fec_stats)
  efx->type->get_fec_stats(efx, fec_stats);
}

static int efx_ethtool_get_ts_info(struct net_device *net_dev,
       struct kernel_ethtool_ts_info *ts_info)
{
 struct efx_nic *efx = efx_netdev_priv(net_dev);

 efx_ptp_get_ts_info(efx, ts_info);
 return 0;
}

const struct ethtool_ops efx_ethtool_ops = {
 .supported_coalesce_params = ETHTOOL_COALESCE_USECS |
         ETHTOOL_COALESCE_USECS_IRQ |
         ETHTOOL_COALESCE_USE_ADAPTIVE_RX,
 .get_drvinfo  = efx_ethtool_get_drvinfo,
 .get_regs_len  = efx_ethtool_get_regs_len,
 .get_regs  = efx_ethtool_get_regs,
 .get_msglevel  = efx_ethtool_get_msglevel,
 .set_msglevel  = efx_ethtool_set_msglevel,
 .get_link  = ethtool_op_get_link,
 .get_coalesce  = efx_ethtool_get_coalesce,
 .set_coalesce  = efx_ethtool_set_coalesce,
 .get_ringparam  = efx_ethtool_get_ringparam,
 .set_ringparam  = efx_ethtool_set_ringparam,
 .get_pauseparam         = efx_ethtool_get_pauseparam,
 .set_pauseparam         = efx_ethtool_set_pauseparam,
 .get_sset_count  = efx_ethtool_get_sset_count,
 .self_test  = efx_ethtool_self_test,
 .get_strings  = efx_ethtool_get_strings,
 .set_phys_id  = efx_ethtool_phys_id,
 .get_ethtool_stats = efx_ethtool_get_stats,
 .get_wol                = efx_ethtool_get_wol,
 .set_wol                = efx_ethtool_set_wol,
 .reset   = efx_ethtool_reset,
 .get_rxnfc  = efx_ethtool_get_rxnfc,
 .set_rxnfc  = efx_ethtool_set_rxnfc,
 .get_rxfh_indir_size = efx_ethtool_get_rxfh_indir_size,
 .get_rxfh_key_size = efx_ethtool_get_rxfh_key_size,
 .rxfh_per_ctx_fields = true,
 .rxfh_per_ctx_key = true,
 .cap_rss_rxnfc_adds = true,
 .rxfh_priv_size  = sizeof(struct efx_rss_context_priv),
 .get_rxfh  = efx_ethtool_get_rxfh,
 .set_rxfh  = efx_ethtool_set_rxfh,
 .get_rxfh_fields = efx_ethtool_get_rxfh_fields,
 .create_rxfh_context = efx_ethtool_create_rxfh_context,
 .modify_rxfh_context = efx_ethtool_modify_rxfh_context,
 .remove_rxfh_context = efx_ethtool_remove_rxfh_context,
 .get_ts_info  = efx_ethtool_get_ts_info,
 .get_module_info = efx_ethtool_get_module_info,
 .get_module_eeprom = efx_ethtool_get_module_eeprom,
 .get_link_ksettings = efx_ethtool_get_link_ksettings,
 .set_link_ksettings = efx_ethtool_set_link_ksettings,
 .get_fec_stats  = efx_ethtool_get_fec_stats,
 .get_fecparam  = efx_ethtool_get_fecparam,
 .set_fecparam  = efx_ethtool_set_fecparam,
};