drivers/net/netdevsim/ethtool.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 // Copyright (c) 2020 Facebook
   3
   4 #include <linux/debugfs.h>
   5 #include <linux/ethtool.h>
   6 #include <linux/random.h>
   7
   8 #include "netdevsim.h"
   9
  10 static void
  11 nsim_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
  22 static void
  23 nsim_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
  32 static int
  33 nsim_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
  45 static int nsim_get_coalesce(struct net_device *dev,
  46                              struct ethtool_coalesce *coal)
  47 {
  48         struct netdevsim *ns = netdev_priv(dev);
  49
  50         memcpy(coal, &ns->ethtool.coalesce, sizeof(ns->ethtool.coalesce));
  51         return 0;
  52 }
  53
  54 static int nsim_set_coalesce(struct net_device *dev,
  55                              struct ethtool_coalesce *coal)
  56 {
  57         struct netdevsim *ns = netdev_priv(dev);
  58
  59         memcpy(&ns->ethtool.coalesce, coal, sizeof(ns->ethtool.coalesce));
  60         return 0;
  61 }
  62
  63 static void nsim_get_ringparam(struct net_device *dev,
  64                                struct ethtool_ringparam *ring)
  65 {
  66         struct netdevsim *ns = netdev_priv(dev);
  67
  68         memcpy(ring, &ns->ethtool.ring, sizeof(ns->ethtool.ring));
  69 }
  70
  71 static int nsim_set_ringparam(struct net_device *dev,
  72                               struct ethtool_ringparam *ring)
  73 {
  74         struct netdevsim *ns = netdev_priv(dev);
  75
  76         memcpy(&ns->ethtool.ring, ring, sizeof(ns->ethtool.ring));
  77         return 0;
  78 }
  79
  80 static int
  81 nsim_get_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
  82 {
  83         struct netdevsim *ns = netdev_priv(dev);
  84
  85         if (ns->ethtool.get_err)
  86                 return -ns->ethtool.get_err;
  87         memcpy(fecparam, &ns->ethtool.fec, sizeof(ns->ethtool.fec));
  88         return 0;
  89 }
  90
  91 static int
  92 nsim_set_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
  93 {
  94         struct netdevsim *ns = netdev_priv(dev);
  95         u32 fec;
  96
  97         if (ns->ethtool.set_err)
  98                 return -ns->ethtool.set_err;
  99         memcpy(&ns->ethtool.fec, fecparam, sizeof(ns->ethtool.fec));
 100         fec = fecparam->fec;
 101         if (fec == ETHTOOL_FEC_AUTO)
 102                 fec |= ETHTOOL_FEC_OFF;
 103         fec |= ETHTOOL_FEC_NONE;
 104         ns->ethtool.fec.active_fec = 1 << (fls(fec) - 1);
 105         return 0;
 106 }
 107
 108 static const struct ethtool_ops nsim_ethtool_ops = {
 109         .supported_coalesce_params      = ETHTOOL_COALESCE_ALL_PARAMS,
 110         .get_pause_stats                = nsim_get_pause_stats,
 111         .get_pauseparam                 = nsim_get_pauseparam,
 112         .set_pauseparam                 = nsim_set_pauseparam,
 113         .set_coalesce                   = nsim_set_coalesce,
 114         .get_coalesce                   = nsim_get_coalesce,
 115         .get_ringparam                  = nsim_get_ringparam,
 116         .set_ringparam                  = nsim_set_ringparam,
 117         .get_fecparam                   = nsim_get_fecparam,
 118         .set_fecparam                   = nsim_set_fecparam,
 119 };
 120
 121 static void nsim_ethtool_ring_init(struct netdevsim *ns)
 122 {
 123         ns->ethtool.ring.rx_max_pending = 4096;
 124         ns->ethtool.ring.rx_jumbo_max_pending = 4096;
 125         ns->ethtool.ring.rx_mini_max_pending = 4096;
 126         ns->ethtool.ring.tx_max_pending = 4096;
 127 }
 128
 129 void nsim_ethtool_init(struct netdevsim *ns)
 130 {
 131         struct dentry *ethtool, *dir;
 132
 133         ns->netdev->ethtool_ops = &nsim_ethtool_ops;
 134
 135         nsim_ethtool_ring_init(ns);
 136
 137         ns->ethtool.fec.fec = ETHTOOL_FEC_NONE;
 138         ns->ethtool.fec.active_fec = ETHTOOL_FEC_NONE;
 139
 140         ethtool = debugfs_create_dir("ethtool", ns->nsim_dev_port->ddir);
 141
 142         debugfs_create_u32("get_err", 0600, ethtool, &ns->ethtool.get_err);
 143         debugfs_create_u32("set_err", 0600, ethtool, &ns->ethtool.set_err);
 144
 145         dir = debugfs_create_dir("pause", ethtool);
 146         debugfs_create_bool("report_stats_rx", 0600, dir,
 147                             &ns->ethtool.pauseparam.report_stats_rx);
 148         debugfs_create_bool("report_stats_tx", 0600, dir,
 149                             &ns->ethtool.pauseparam.report_stats_tx);
 150
 151         dir = debugfs_create_dir("ring", ethtool);
 152         debugfs_create_u32("rx_max_pending", 0600, dir,
 153                            &ns->ethtool.ring.rx_max_pending);
 154         debugfs_create_u32("rx_jumbo_max_pending", 0600, dir,
 155                            &ns->ethtool.ring.rx_jumbo_max_pending);
 156         debugfs_create_u32("rx_mini_max_pending", 0600, dir,
 157                            &ns->ethtool.ring.rx_mini_max_pending);
 158         debugfs_create_u32("tx_max_pending", 0600, dir,
 159                            &ns->ethtool.ring.tx_max_pending);
 160 }