322 lines
8.7 KiB
C
322 lines
8.7 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/* Texas Instruments ICSSG Ethernet driver
|
|
*
|
|
* Copyright (C) 2018-2022 Texas Instruments Incorporated - https://www.ti.com/
|
|
*
|
|
*/
|
|
|
|
#include "icssg_prueth.h"
|
|
#include "icssg_stats.h"
|
|
|
|
static void emac_get_drvinfo(struct net_device *ndev,
|
|
struct ethtool_drvinfo *info)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
struct prueth *prueth = emac->prueth;
|
|
|
|
strscpy(info->driver, dev_driver_string(prueth->dev),
|
|
sizeof(info->driver));
|
|
strscpy(info->bus_info, dev_name(prueth->dev), sizeof(info->bus_info));
|
|
}
|
|
|
|
static u32 emac_get_msglevel(struct net_device *ndev)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
|
|
return emac->msg_enable;
|
|
}
|
|
|
|
static void emac_set_msglevel(struct net_device *ndev, u32 value)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
|
|
emac->msg_enable = value;
|
|
}
|
|
|
|
static int emac_get_link_ksettings(struct net_device *ndev,
|
|
struct ethtool_link_ksettings *ecmd)
|
|
{
|
|
return phy_ethtool_get_link_ksettings(ndev, ecmd);
|
|
}
|
|
|
|
static int emac_set_link_ksettings(struct net_device *ndev,
|
|
const struct ethtool_link_ksettings *ecmd)
|
|
{
|
|
return phy_ethtool_set_link_ksettings(ndev, ecmd);
|
|
}
|
|
|
|
static int emac_get_eee(struct net_device *ndev, struct ethtool_keee *edata)
|
|
{
|
|
if (!ndev->phydev)
|
|
return -EOPNOTSUPP;
|
|
|
|
return phy_ethtool_get_eee(ndev->phydev, edata);
|
|
}
|
|
|
|
static int emac_set_eee(struct net_device *ndev, struct ethtool_keee *edata)
|
|
{
|
|
if (!ndev->phydev)
|
|
return -EOPNOTSUPP;
|
|
|
|
return phy_ethtool_set_eee(ndev->phydev, edata);
|
|
}
|
|
|
|
static int emac_nway_reset(struct net_device *ndev)
|
|
{
|
|
return phy_ethtool_nway_reset(ndev);
|
|
}
|
|
|
|
static int emac_get_sset_count(struct net_device *ndev, int stringset)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
switch (stringset) {
|
|
case ETH_SS_STATS:
|
|
if (emac->prueth->pa_stats)
|
|
return ICSSG_NUM_ETHTOOL_STATS;
|
|
else
|
|
return ICSSG_NUM_ETHTOOL_STATS - ICSSG_NUM_PA_STATS;
|
|
default:
|
|
return -EOPNOTSUPP;
|
|
}
|
|
}
|
|
|
|
static void emac_get_strings(struct net_device *ndev, u32 stringset, u8 *data)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
u8 *p = data;
|
|
int i;
|
|
|
|
switch (stringset) {
|
|
case ETH_SS_STATS:
|
|
for (i = 0; i < ARRAY_SIZE(icssg_all_miig_stats); i++)
|
|
if (!icssg_all_miig_stats[i].standard_stats)
|
|
ethtool_puts(&p, icssg_all_miig_stats[i].name);
|
|
if (emac->prueth->pa_stats)
|
|
for (i = 0; i < ARRAY_SIZE(icssg_all_pa_stats); i++)
|
|
ethtool_puts(&p, icssg_all_pa_stats[i].name);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void emac_get_ethtool_stats(struct net_device *ndev,
|
|
struct ethtool_stats *stats, u64 *data)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
int i;
|
|
|
|
emac_update_hardware_stats(emac);
|
|
|
|
for (i = 0; i < ARRAY_SIZE(icssg_all_miig_stats); i++)
|
|
if (!icssg_all_miig_stats[i].standard_stats)
|
|
*(data++) = emac->stats[i];
|
|
|
|
if (emac->prueth->pa_stats)
|
|
for (i = 0; i < ARRAY_SIZE(icssg_all_pa_stats); i++)
|
|
*(data++) = emac->pa_stats[i];
|
|
}
|
|
|
|
static int emac_get_ts_info(struct net_device *ndev,
|
|
struct kernel_ethtool_ts_info *info)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
|
|
info->so_timestamping =
|
|
SOF_TIMESTAMPING_TX_HARDWARE |
|
|
SOF_TIMESTAMPING_TX_SOFTWARE |
|
|
SOF_TIMESTAMPING_RX_HARDWARE |
|
|
SOF_TIMESTAMPING_RAW_HARDWARE;
|
|
|
|
info->phc_index = icss_iep_get_ptp_clock_idx(emac->iep);
|
|
info->tx_types = BIT(HWTSTAMP_TX_OFF) | BIT(HWTSTAMP_TX_ON);
|
|
info->rx_filters = BIT(HWTSTAMP_FILTER_NONE) | BIT(HWTSTAMP_FILTER_ALL);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int emac_set_channels(struct net_device *ndev,
|
|
struct ethtool_channels *ch)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
|
|
/* Check if interface is up. Can change the num queues when
|
|
* the interface is down.
|
|
*/
|
|
if (netif_running(emac->ndev))
|
|
return -EBUSY;
|
|
|
|
emac->tx_ch_num = ch->tx_count;
|
|
|
|
if (emac->is_sr1)
|
|
emac->tx_ch_num++;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void emac_get_channels(struct net_device *ndev,
|
|
struct ethtool_channels *ch)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
|
|
ch->max_rx = 1;
|
|
ch->max_tx = PRUETH_MAX_TX_QUEUES;
|
|
|
|
/* Disable multiple TX channels due to timeouts
|
|
* when using more than one queue */
|
|
if (emac->is_sr1)
|
|
ch->max_tx = 1;
|
|
|
|
ch->rx_count = 1;
|
|
ch->tx_count = emac->tx_ch_num;
|
|
|
|
if (emac->is_sr1)
|
|
ch->tx_count--;
|
|
}
|
|
|
|
static const struct ethtool_rmon_hist_range emac_rmon_ranges[] = {
|
|
{ 0, 64},
|
|
{ 65, 128},
|
|
{ 129, 256},
|
|
{ 257, 512},
|
|
{ 513, PRUETH_MAX_PKT_SIZE},
|
|
{}
|
|
};
|
|
|
|
static void emac_get_rmon_stats(struct net_device *ndev,
|
|
struct ethtool_rmon_stats *rmon_stats,
|
|
const struct ethtool_rmon_hist_range **ranges)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
|
|
*ranges = emac_rmon_ranges;
|
|
|
|
rmon_stats->undersize_pkts = emac_get_stat_by_name(emac, "rx_bucket1_frames") -
|
|
emac_get_stat_by_name(emac, "rx_64B_frames");
|
|
|
|
rmon_stats->hist[0] = emac_get_stat_by_name(emac, "rx_bucket1_frames");
|
|
rmon_stats->hist[1] = emac_get_stat_by_name(emac, "rx_bucket2_frames");
|
|
rmon_stats->hist[2] = emac_get_stat_by_name(emac, "rx_bucket3_frames");
|
|
rmon_stats->hist[3] = emac_get_stat_by_name(emac, "rx_bucket4_frames");
|
|
rmon_stats->hist[4] = emac_get_stat_by_name(emac, "rx_bucket5_frames");
|
|
|
|
rmon_stats->hist_tx[0] = emac_get_stat_by_name(emac, "tx_bucket1_frames");
|
|
rmon_stats->hist_tx[1] = emac_get_stat_by_name(emac, "tx_bucket2_frames");
|
|
rmon_stats->hist_tx[2] = emac_get_stat_by_name(emac, "tx_bucket3_frames");
|
|
rmon_stats->hist_tx[3] = emac_get_stat_by_name(emac, "tx_bucket4_frames");
|
|
rmon_stats->hist_tx[4] = emac_get_stat_by_name(emac, "tx_bucket5_frames");
|
|
}
|
|
|
|
static int emac_get_coalesce(struct net_device *ndev,
|
|
struct ethtool_coalesce *coal,
|
|
struct kernel_ethtool_coalesce *kernel_coal,
|
|
struct netlink_ext_ack *extack)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
struct prueth_tx_chn *tx_chn;
|
|
|
|
tx_chn = &emac->tx_chns[0];
|
|
|
|
coal->rx_coalesce_usecs = emac->rx_pace_timeout_ns / 1000;
|
|
coal->tx_coalesce_usecs = tx_chn->tx_pace_timeout_ns / 1000;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int emac_get_per_queue_coalesce(struct net_device *ndev, u32 queue,
|
|
struct ethtool_coalesce *coal)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
struct prueth_tx_chn *tx_chn;
|
|
|
|
if (queue >= PRUETH_MAX_TX_QUEUES)
|
|
return -EINVAL;
|
|
|
|
tx_chn = &emac->tx_chns[queue];
|
|
|
|
coal->tx_coalesce_usecs = tx_chn->tx_pace_timeout_ns / 1000;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int emac_set_coalesce(struct net_device *ndev,
|
|
struct ethtool_coalesce *coal,
|
|
struct kernel_ethtool_coalesce *kernel_coal,
|
|
struct netlink_ext_ack *extack)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
struct prueth *prueth = emac->prueth;
|
|
struct prueth_tx_chn *tx_chn;
|
|
|
|
tx_chn = &emac->tx_chns[0];
|
|
|
|
if (coal->rx_coalesce_usecs &&
|
|
coal->rx_coalesce_usecs < ICSSG_MIN_COALESCE_USECS) {
|
|
dev_info(prueth->dev, "defaulting to min value of %dus for rx-usecs\n",
|
|
ICSSG_MIN_COALESCE_USECS);
|
|
coal->rx_coalesce_usecs = ICSSG_MIN_COALESCE_USECS;
|
|
}
|
|
|
|
if (coal->tx_coalesce_usecs &&
|
|
coal->tx_coalesce_usecs < ICSSG_MIN_COALESCE_USECS) {
|
|
dev_info(prueth->dev, "defaulting to min value of %dus for tx-usecs\n",
|
|
ICSSG_MIN_COALESCE_USECS);
|
|
coal->tx_coalesce_usecs = ICSSG_MIN_COALESCE_USECS;
|
|
}
|
|
|
|
emac->rx_pace_timeout_ns = coal->rx_coalesce_usecs * 1000;
|
|
tx_chn->tx_pace_timeout_ns = coal->tx_coalesce_usecs * 1000;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int emac_set_per_queue_coalesce(struct net_device *ndev, u32 queue,
|
|
struct ethtool_coalesce *coal)
|
|
{
|
|
struct prueth_emac *emac = netdev_priv(ndev);
|
|
struct prueth *prueth = emac->prueth;
|
|
struct prueth_tx_chn *tx_chn;
|
|
|
|
if (queue >= PRUETH_MAX_TX_QUEUES)
|
|
return -EINVAL;
|
|
|
|
tx_chn = &emac->tx_chns[queue];
|
|
|
|
if (coal->tx_coalesce_usecs &&
|
|
coal->tx_coalesce_usecs < ICSSG_MIN_COALESCE_USECS) {
|
|
dev_info(prueth->dev, "defaulting to min value of %dus for tx-usecs for tx-%u\n",
|
|
ICSSG_MIN_COALESCE_USECS, queue);
|
|
coal->tx_coalesce_usecs = ICSSG_MIN_COALESCE_USECS;
|
|
}
|
|
|
|
tx_chn->tx_pace_timeout_ns = coal->tx_coalesce_usecs * 1000;
|
|
|
|
return 0;
|
|
}
|
|
|
|
const struct ethtool_ops icssg_ethtool_ops = {
|
|
.get_drvinfo = emac_get_drvinfo,
|
|
.get_msglevel = emac_get_msglevel,
|
|
.set_msglevel = emac_set_msglevel,
|
|
.get_sset_count = emac_get_sset_count,
|
|
.get_ethtool_stats = emac_get_ethtool_stats,
|
|
.get_strings = emac_get_strings,
|
|
.get_ts_info = emac_get_ts_info,
|
|
.supported_coalesce_params = ETHTOOL_COALESCE_RX_USECS |
|
|
ETHTOOL_COALESCE_TX_USECS,
|
|
.get_coalesce = emac_get_coalesce,
|
|
.set_coalesce = emac_set_coalesce,
|
|
.get_per_queue_coalesce = emac_get_per_queue_coalesce,
|
|
.set_per_queue_coalesce = emac_set_per_queue_coalesce,
|
|
.get_channels = emac_get_channels,
|
|
.set_channels = emac_set_channels,
|
|
.get_link_ksettings = emac_get_link_ksettings,
|
|
.set_link_ksettings = emac_set_link_ksettings,
|
|
.get_link = ethtool_op_get_link,
|
|
.get_eee = emac_get_eee,
|
|
.set_eee = emac_set_eee,
|
|
.nway_reset = emac_nway_reset,
|
|
.get_rmon_stats = emac_get_rmon_stats,
|
|
};
|
|
EXPORT_SYMBOL_GPL(icssg_ethtool_ops);
|