222 lines · c
1// SPDX-License-Identifier: GPL-2.02// Copyright (c) 2020 Facebook3 4#include <linux/debugfs.h>5#include <linux/ethtool.h>6#include <linux/random.h>7 8#include "netdevsim.h"9 10static void11nsim_get_pause_stats(struct net_device *dev,12 struct ethtool_pause_stats *pause_stats)13{14 struct netdevsim *ns = netdev_priv(dev);15 16 if (ns->ethtool.pauseparam.report_stats_rx)17 pause_stats->rx_pause_frames = 1;18 if (ns->ethtool.pauseparam.report_stats_tx)19 pause_stats->tx_pause_frames = 2;20}21 22static void23nsim_get_pauseparam(struct net_device *dev, struct ethtool_pauseparam *pause)24{25 struct netdevsim *ns = netdev_priv(dev);26 27 pause->autoneg = 0; /* We don't support ksettings, so can't pretend */28 pause->rx_pause = ns->ethtool.pauseparam.rx;29 pause->tx_pause = ns->ethtool.pauseparam.tx;30}31 32static int33nsim_set_pauseparam(struct net_device *dev, struct ethtool_pauseparam *pause)34{35 struct netdevsim *ns = netdev_priv(dev);36 37 if (pause->autoneg)38 return -EINVAL;39 40 ns->ethtool.pauseparam.rx = pause->rx_pause;41 ns->ethtool.pauseparam.tx = pause->tx_pause;42 return 0;43}44 45static int nsim_get_coalesce(struct net_device *dev,46 struct ethtool_coalesce *coal,47 struct kernel_ethtool_coalesce *kernel_coal,48 struct netlink_ext_ack *extack)49{50 struct netdevsim *ns = netdev_priv(dev);51 52 memcpy(coal, &ns->ethtool.coalesce, sizeof(ns->ethtool.coalesce));53 return 0;54}55 56static int nsim_set_coalesce(struct net_device *dev,57 struct ethtool_coalesce *coal,58 struct kernel_ethtool_coalesce *kernel_coal,59 struct netlink_ext_ack *extack)60{61 struct netdevsim *ns = netdev_priv(dev);62 63 memcpy(&ns->ethtool.coalesce, coal, sizeof(ns->ethtool.coalesce));64 return 0;65}66 67static void nsim_get_ringparam(struct net_device *dev,68 struct ethtool_ringparam *ring,69 struct kernel_ethtool_ringparam *kernel_ring,70 struct netlink_ext_ack *extack)71{72 struct netdevsim *ns = netdev_priv(dev);73 74 memcpy(ring, &ns->ethtool.ring, sizeof(ns->ethtool.ring));75}76 77static int nsim_set_ringparam(struct net_device *dev,78 struct ethtool_ringparam *ring,79 struct kernel_ethtool_ringparam *kernel_ring,80 struct netlink_ext_ack *extack)81{82 struct netdevsim *ns = netdev_priv(dev);83 84 ns->ethtool.ring.rx_pending = ring->rx_pending;85 ns->ethtool.ring.rx_jumbo_pending = ring->rx_jumbo_pending;86 ns->ethtool.ring.rx_mini_pending = ring->rx_mini_pending;87 ns->ethtool.ring.tx_pending = ring->tx_pending;88 return 0;89}90 91static void92nsim_get_channels(struct net_device *dev, struct ethtool_channels *ch)93{94 struct netdevsim *ns = netdev_priv(dev);95 96 ch->max_combined = ns->nsim_bus_dev->num_queues;97 ch->combined_count = ns->ethtool.channels;98}99 100static int101nsim_set_channels(struct net_device *dev, struct ethtool_channels *ch)102{103 struct netdevsim *ns = netdev_priv(dev);104 int err;105 106 err = netif_set_real_num_queues(dev, ch->combined_count,107 ch->combined_count);108 if (err)109 return err;110 111 ns->ethtool.channels = ch->combined_count;112 return 0;113}114 115static int116nsim_get_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)117{118 struct netdevsim *ns = netdev_priv(dev);119 120 if (ns->ethtool.get_err)121 return -ns->ethtool.get_err;122 memcpy(fecparam, &ns->ethtool.fec, sizeof(ns->ethtool.fec));123 return 0;124}125 126static int127nsim_set_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)128{129 struct netdevsim *ns = netdev_priv(dev);130 u32 fec;131 132 if (ns->ethtool.set_err)133 return -ns->ethtool.set_err;134 memcpy(&ns->ethtool.fec, fecparam, sizeof(ns->ethtool.fec));135 fec = fecparam->fec;136 if (fec == ETHTOOL_FEC_AUTO)137 fec |= ETHTOOL_FEC_OFF;138 fec |= ETHTOOL_FEC_NONE;139 ns->ethtool.fec.active_fec = 1 << (fls(fec) - 1);140 return 0;141}142 143static void144nsim_get_fec_stats(struct net_device *dev, struct ethtool_fec_stats *fec_stats)145{146 fec_stats->corrected_blocks.total = 123;147 fec_stats->uncorrectable_blocks.total = 4;148}149 150static int nsim_get_ts_info(struct net_device *dev,151 struct kernel_ethtool_ts_info *info)152{153 struct netdevsim *ns = netdev_priv(dev);154 155 info->phc_index = mock_phc_index(ns->phc);156 157 return 0;158}159 160static const struct ethtool_ops nsim_ethtool_ops = {161 .supported_coalesce_params = ETHTOOL_COALESCE_ALL_PARAMS,162 .get_pause_stats = nsim_get_pause_stats,163 .get_pauseparam = nsim_get_pauseparam,164 .set_pauseparam = nsim_set_pauseparam,165 .set_coalesce = nsim_set_coalesce,166 .get_coalesce = nsim_get_coalesce,167 .get_ringparam = nsim_get_ringparam,168 .set_ringparam = nsim_set_ringparam,169 .get_channels = nsim_get_channels,170 .set_channels = nsim_set_channels,171 .get_fecparam = nsim_get_fecparam,172 .set_fecparam = nsim_set_fecparam,173 .get_fec_stats = nsim_get_fec_stats,174 .get_ts_info = nsim_get_ts_info,175};176 177static void nsim_ethtool_ring_init(struct netdevsim *ns)178{179 ns->ethtool.ring.rx_max_pending = 4096;180 ns->ethtool.ring.rx_jumbo_max_pending = 4096;181 ns->ethtool.ring.rx_mini_max_pending = 4096;182 ns->ethtool.ring.tx_max_pending = 4096;183}184 185void nsim_ethtool_init(struct netdevsim *ns)186{187 struct dentry *ethtool, *dir;188 189 ns->netdev->ethtool_ops = &nsim_ethtool_ops;190 191 nsim_ethtool_ring_init(ns);192 193 ns->ethtool.pauseparam.report_stats_rx = true;194 ns->ethtool.pauseparam.report_stats_tx = true;195 196 ns->ethtool.fec.fec = ETHTOOL_FEC_NONE;197 ns->ethtool.fec.active_fec = ETHTOOL_FEC_NONE;198 199 ns->ethtool.channels = ns->nsim_bus_dev->num_queues;200 201 ethtool = debugfs_create_dir("ethtool", ns->nsim_dev_port->ddir);202 203 debugfs_create_u32("get_err", 0600, ethtool, &ns->ethtool.get_err);204 debugfs_create_u32("set_err", 0600, ethtool, &ns->ethtool.set_err);205 206 dir = debugfs_create_dir("pause", ethtool);207 debugfs_create_bool("report_stats_rx", 0600, dir,208 &ns->ethtool.pauseparam.report_stats_rx);209 debugfs_create_bool("report_stats_tx", 0600, dir,210 &ns->ethtool.pauseparam.report_stats_tx);211 212 dir = debugfs_create_dir("ring", ethtool);213 debugfs_create_u32("rx_max_pending", 0600, dir,214 &ns->ethtool.ring.rx_max_pending);215 debugfs_create_u32("rx_jumbo_max_pending", 0600, dir,216 &ns->ethtool.ring.rx_jumbo_max_pending);217 debugfs_create_u32("rx_mini_max_pending", 0600, dir,218 &ns->ethtool.ring.rx_mini_max_pending);219 debugfs_create_u32("tx_max_pending", 0600, dir,220 &ns->ethtool.ring.tx_max_pending);221}222