[PATCH net-next 2/3] netdevsim: add FEC settings support

[Jakub Kicinski]

Add support for ethtool FEC and some ethtool error injection.

Signed-off-by: Jakub Kicinski <k...@kernel.org>
---
 drivers/net/netdevsim/ethtool.c   | 36 +++++++++++++++++++++++++++++++
 drivers/net/netdevsim/netdevsim.h |  3 +++
 2 files changed, 39 insertions(+)

diff --git a/drivers/net/netdevsim/ethtool.c b/drivers/net/netdevsim/ethtool.c
index 166f0d6cbcf7..c9ae52595a8f 100644
--- a/drivers/net/netdevsim/ethtool.c
+++ b/drivers/net/netdevsim/ethtool.c
@@ -77,6 +77,34 @@ static int nsim_set_ringparam(struct net_device *dev,
        return 0;
 }
 
+static int
+nsim_get_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
+{
+       struct netdevsim *ns = netdev_priv(dev);
+
+       if (ns->ethtool.get_err)
+               return -ns->ethtool.get_err;
+       memcpy(fecparam, &ns->ethtool.fec, sizeof(ns->ethtool.fec));
+       return 0;
+}
+
+static int
+nsim_set_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
+{
+       struct netdevsim *ns = netdev_priv(dev);
+       u32 fec;
+
+       if (ns->ethtool.set_err)
+               return -ns->ethtool.set_err;
+       memcpy(&ns->ethtool.fec, fecparam, sizeof(ns->ethtool.fec));
+       fec = fecparam->fec;
+       if (fec == ETHTOOL_FEC_AUTO)
+               fec |= ETHTOOL_FEC_OFF;
+       fec |= ETHTOOL_FEC_NONE;
+       ns->ethtool.fec.active_fec = 1 << (fls(fec) - 1);
+       return 0;
+}
+
 static const struct ethtool_ops nsim_ethtool_ops = {
        .supported_coalesce_params      = ETHTOOL_COALESCE_ALL_PARAMS,
        .get_pause_stats                = nsim_get_pause_stats,
@@ -86,6 +114,8 @@ static const struct ethtool_ops nsim_ethtool_ops = {
        .get_coalesce                   = nsim_get_coalesce,
        .get_ringparam                  = nsim_get_ringparam,
        .set_ringparam                  = nsim_set_ringparam,
+       .get_fecparam                   = nsim_get_fecparam,
+       .set_fecparam                   = nsim_set_fecparam,
 };
 
 static void nsim_ethtool_ring_init(struct netdevsim *ns)
@@ -104,8 +134,14 @@ void nsim_ethtool_init(struct netdevsim *ns)
 
        nsim_ethtool_ring_init(ns);
 
+       ns->ethtool.fec.fec = ETHTOOL_FEC_NONE;
+       ns->ethtool.fec.active_fec = ETHTOOL_FEC_NONE;
+
        ethtool = debugfs_create_dir("ethtool", ns->nsim_dev_port->ddir);
 
+       debugfs_create_u32("get_err", 0600, ethtool, &ns->ethtool.get_err);
+       debugfs_create_u32("set_err", 0600, ethtool, &ns->ethtool.set_err);
+
        dir = debugfs_create_dir("pause", ethtool);
        debugfs_create_bool("report_stats_rx", 0600, dir,
                            &ns->ethtool.pauseparam.report_stats_rx);
diff --git a/drivers/net/netdevsim/netdevsim.h 
b/drivers/net/netdevsim/netdevsim.h
index d735c21def4b..7ff24e03577b 100644
--- a/drivers/net/netdevsim/netdevsim.h
+++ b/drivers/net/netdevsim/netdevsim.h
@@ -60,9 +60,12 @@ struct nsim_ethtool_pauseparam {
 };
 
 struct nsim_ethtool {
+       u32 get_err;
+       u32 set_err;
        struct nsim_ethtool_pauseparam pauseparam;
        struct ethtool_coalesce coalesce;
        struct ethtool_ringparam ring;
+       struct ethtool_fecparam fec;
 };
 
 struct netdevsim {
-- 
2.30.2