mirror of https://gitee.com/openkylin/linux.git
263 lines
7.0 KiB
C
263 lines
7.0 KiB
C
/*
|
|
* aQuantia Corporation Network Driver
|
|
* Copyright (C) 2014-2017 aQuantia Corporation. All rights reserved
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms and conditions of the GNU General Public License,
|
|
* version 2, as published by the Free Software Foundation.
|
|
*/
|
|
|
|
/* File aq_ethtool.c: Definition of ethertool related functions. */
|
|
|
|
#include "aq_ethtool.h"
|
|
#include "aq_nic.h"
|
|
|
|
static void aq_ethtool_get_regs(struct net_device *ndev,
|
|
struct ethtool_regs *regs, void *p)
|
|
{
|
|
struct aq_nic_s *aq_nic = netdev_priv(ndev);
|
|
u32 regs_count = aq_nic_get_regs_count(aq_nic);
|
|
|
|
memset(p, 0, regs_count * sizeof(u32));
|
|
aq_nic_get_regs(aq_nic, regs, p);
|
|
}
|
|
|
|
static int aq_ethtool_get_regs_len(struct net_device *ndev)
|
|
{
|
|
struct aq_nic_s *aq_nic = netdev_priv(ndev);
|
|
u32 regs_count = aq_nic_get_regs_count(aq_nic);
|
|
|
|
return regs_count * sizeof(u32);
|
|
}
|
|
|
|
static u32 aq_ethtool_get_link(struct net_device *ndev)
|
|
{
|
|
return ethtool_op_get_link(ndev);
|
|
}
|
|
|
|
static int aq_ethtool_get_link_ksettings(struct net_device *ndev,
|
|
struct ethtool_link_ksettings *cmd)
|
|
{
|
|
struct aq_nic_s *aq_nic = netdev_priv(ndev);
|
|
|
|
aq_nic_get_link_ksettings(aq_nic, cmd);
|
|
cmd->base.speed = netif_carrier_ok(ndev) ?
|
|
aq_nic_get_link_speed(aq_nic) : 0U;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
aq_ethtool_set_link_ksettings(struct net_device *ndev,
|
|
const struct ethtool_link_ksettings *cmd)
|
|
{
|
|
struct aq_nic_s *aq_nic = netdev_priv(ndev);
|
|
|
|
return aq_nic_set_link_ksettings(aq_nic, cmd);
|
|
}
|
|
|
|
/* there "5U" is number of queue[#] stats lines (InPackets+...+InErrors) */
|
|
static const unsigned int aq_ethtool_stat_queue_lines = 5U;
|
|
static const unsigned int aq_ethtool_stat_queue_chars =
|
|
5U * ETH_GSTRING_LEN;
|
|
static const char aq_ethtool_stat_names[][ETH_GSTRING_LEN] = {
|
|
"InPackets",
|
|
"InUCast",
|
|
"InMCast",
|
|
"InBCast",
|
|
"InErrors",
|
|
"OutPackets",
|
|
"OutUCast",
|
|
"OutMCast",
|
|
"OutBCast",
|
|
"InUCastOctects",
|
|
"OutUCastOctects",
|
|
"InMCastOctects",
|
|
"OutMCastOctects",
|
|
"InBCastOctects",
|
|
"OutBCastOctects",
|
|
"InOctects",
|
|
"OutOctects",
|
|
"InPacketsDma",
|
|
"OutPacketsDma",
|
|
"InOctetsDma",
|
|
"OutOctetsDma",
|
|
"InDroppedDma",
|
|
"Queue[0] InPackets",
|
|
"Queue[0] OutPackets",
|
|
"Queue[0] InJumboPackets",
|
|
"Queue[0] InLroPackets",
|
|
"Queue[0] InErrors",
|
|
"Queue[1] InPackets",
|
|
"Queue[1] OutPackets",
|
|
"Queue[1] InJumboPackets",
|
|
"Queue[1] InLroPackets",
|
|
"Queue[1] InErrors",
|
|
"Queue[2] InPackets",
|
|
"Queue[2] OutPackets",
|
|
"Queue[2] InJumboPackets",
|
|
"Queue[2] InLroPackets",
|
|
"Queue[2] InErrors",
|
|
"Queue[3] InPackets",
|
|
"Queue[3] OutPackets",
|
|
"Queue[3] InJumboPackets",
|
|
"Queue[3] InLroPackets",
|
|
"Queue[3] InErrors",
|
|
"Queue[4] InPackets",
|
|
"Queue[4] OutPackets",
|
|
"Queue[4] InJumboPackets",
|
|
"Queue[4] InLroPackets",
|
|
"Queue[4] InErrors",
|
|
"Queue[5] InPackets",
|
|
"Queue[5] OutPackets",
|
|
"Queue[5] InJumboPackets",
|
|
"Queue[5] InLroPackets",
|
|
"Queue[5] InErrors",
|
|
"Queue[6] InPackets",
|
|
"Queue[6] OutPackets",
|
|
"Queue[6] InJumboPackets",
|
|
"Queue[6] InLroPackets",
|
|
"Queue[6] InErrors",
|
|
"Queue[7] InPackets",
|
|
"Queue[7] OutPackets",
|
|
"Queue[7] InJumboPackets",
|
|
"Queue[7] InLroPackets",
|
|
"Queue[7] InErrors",
|
|
};
|
|
|
|
static void aq_ethtool_stats(struct net_device *ndev,
|
|
struct ethtool_stats *stats, u64 *data)
|
|
{
|
|
struct aq_nic_s *aq_nic = netdev_priv(ndev);
|
|
|
|
/* ASSERT: Need add lines to aq_ethtool_stat_names if AQ_CFG_VECS_MAX > 8 */
|
|
BUILD_BUG_ON(AQ_CFG_VECS_MAX > 8);
|
|
memset(data, 0, ARRAY_SIZE(aq_ethtool_stat_names) * sizeof(u64));
|
|
aq_nic_get_stats(aq_nic, data);
|
|
}
|
|
|
|
static void aq_ethtool_get_drvinfo(struct net_device *ndev,
|
|
struct ethtool_drvinfo *drvinfo)
|
|
{
|
|
struct aq_nic_s *aq_nic = netdev_priv(ndev);
|
|
struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
|
|
struct pci_dev *pdev = to_pci_dev(ndev->dev.parent);
|
|
u32 firmware_version = aq_nic_get_fw_version(aq_nic);
|
|
u32 regs_count = aq_nic_get_regs_count(aq_nic);
|
|
|
|
strlcat(drvinfo->driver, AQ_CFG_DRV_NAME, sizeof(drvinfo->driver));
|
|
strlcat(drvinfo->version, AQ_CFG_DRV_VERSION, sizeof(drvinfo->version));
|
|
|
|
snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version),
|
|
"%u.%u.%u", firmware_version >> 24,
|
|
(firmware_version >> 16) & 0xFFU, firmware_version & 0xFFFFU);
|
|
|
|
strlcpy(drvinfo->bus_info, pdev ? pci_name(pdev) : "",
|
|
sizeof(drvinfo->bus_info));
|
|
drvinfo->n_stats = ARRAY_SIZE(aq_ethtool_stat_names) -
|
|
(AQ_CFG_VECS_MAX - cfg->vecs) * aq_ethtool_stat_queue_lines;
|
|
drvinfo->testinfo_len = 0;
|
|
drvinfo->regdump_len = regs_count;
|
|
drvinfo->eedump_len = 0;
|
|
}
|
|
|
|
static void aq_ethtool_get_strings(struct net_device *ndev,
|
|
u32 stringset, u8 *data)
|
|
{
|
|
struct aq_nic_s *aq_nic = netdev_priv(ndev);
|
|
struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
|
|
|
|
if (stringset == ETH_SS_STATS)
|
|
memcpy(data, *aq_ethtool_stat_names,
|
|
sizeof(aq_ethtool_stat_names) -
|
|
(AQ_CFG_VECS_MAX - cfg->vecs) *
|
|
aq_ethtool_stat_queue_chars);
|
|
}
|
|
|
|
static int aq_ethtool_get_sset_count(struct net_device *ndev, int stringset)
|
|
{
|
|
int ret = 0;
|
|
struct aq_nic_s *aq_nic = netdev_priv(ndev);
|
|
struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
|
|
|
|
switch (stringset) {
|
|
case ETH_SS_STATS:
|
|
ret = ARRAY_SIZE(aq_ethtool_stat_names) -
|
|
(AQ_CFG_VECS_MAX - cfg->vecs) *
|
|
aq_ethtool_stat_queue_lines;
|
|
break;
|
|
default:
|
|
ret = -EOPNOTSUPP;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static u32 aq_ethtool_get_rss_indir_size(struct net_device *ndev)
|
|
{
|
|
return AQ_CFG_RSS_INDIRECTION_TABLE_MAX;
|
|
}
|
|
|
|
static u32 aq_ethtool_get_rss_key_size(struct net_device *ndev)
|
|
{
|
|
struct aq_nic_s *aq_nic = netdev_priv(ndev);
|
|
struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
|
|
|
|
return sizeof(cfg->aq_rss.hash_secret_key);
|
|
}
|
|
|
|
static int aq_ethtool_get_rss(struct net_device *ndev, u32 *indir, u8 *key,
|
|
u8 *hfunc)
|
|
{
|
|
struct aq_nic_s *aq_nic = netdev_priv(ndev);
|
|
struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
|
|
unsigned int i = 0U;
|
|
|
|
if (hfunc)
|
|
*hfunc = ETH_RSS_HASH_TOP; /* Toeplitz */
|
|
if (indir) {
|
|
for (i = 0; i < AQ_CFG_RSS_INDIRECTION_TABLE_MAX; i++)
|
|
indir[i] = cfg->aq_rss.indirection_table[i];
|
|
}
|
|
if (key)
|
|
memcpy(key, cfg->aq_rss.hash_secret_key,
|
|
sizeof(cfg->aq_rss.hash_secret_key));
|
|
return 0;
|
|
}
|
|
|
|
static int aq_ethtool_get_rxnfc(struct net_device *ndev,
|
|
struct ethtool_rxnfc *cmd,
|
|
u32 *rule_locs)
|
|
{
|
|
struct aq_nic_s *aq_nic = netdev_priv(ndev);
|
|
struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
|
|
int err = 0;
|
|
|
|
switch (cmd->cmd) {
|
|
case ETHTOOL_GRXRINGS:
|
|
cmd->data = cfg->vecs;
|
|
break;
|
|
|
|
default:
|
|
err = -EOPNOTSUPP;
|
|
break;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
const struct ethtool_ops aq_ethtool_ops = {
|
|
.get_link = aq_ethtool_get_link,
|
|
.get_regs_len = aq_ethtool_get_regs_len,
|
|
.get_regs = aq_ethtool_get_regs,
|
|
.get_drvinfo = aq_ethtool_get_drvinfo,
|
|
.get_strings = aq_ethtool_get_strings,
|
|
.get_rxfh_indir_size = aq_ethtool_get_rss_indir_size,
|
|
.get_rxfh_key_size = aq_ethtool_get_rss_key_size,
|
|
.get_rxfh = aq_ethtool_get_rss,
|
|
.get_rxnfc = aq_ethtool_get_rxnfc,
|
|
.get_sset_count = aq_ethtool_get_sset_count,
|
|
.get_ethtool_stats = aq_ethtool_stats,
|
|
.get_link_ksettings = aq_ethtool_get_link_ksettings,
|
|
.set_link_ksettings = aq_ethtool_set_link_ksettings,
|
|
};
|