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/random.h>
   6 #include <net/netdev_queues.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                              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
  56 static 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
  67 static 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         kernel_ring->hds_thresh_max = NSIM_HDS_THRESHOLD_MAX;
  76
  77         if (dev->cfg->hds_config == ETHTOOL_TCP_DATA_SPLIT_UNKNOWN)
  78                 kernel_ring->tcp_data_split = ETHTOOL_TCP_DATA_SPLIT_ENABLED;
  79 }
  80
  81 static int nsim_set_ringparam(struct net_device *dev,
  82                               struct ethtool_ringparam *ring,
  83                               struct kernel_ethtool_ringparam *kernel_ring,
  84                               struct netlink_ext_ack *extack)
  85 {
  86         struct netdevsim *ns = netdev_priv(dev);
  87
  88         ns->ethtool.ring.rx_pending = ring->rx_pending;
  89         ns->ethtool.ring.rx_jumbo_pending = ring->rx_jumbo_pending;
  90         ns->ethtool.ring.rx_mini_pending = ring->rx_mini_pending;
  91         ns->ethtool.ring.tx_pending = ring->tx_pending;
  92         return 0;
  93 }
  94
  95 static void
  96 nsim_get_channels(struct net_device *dev, struct ethtool_channels *ch)
  97 {
  98         struct netdevsim *ns = netdev_priv(dev);
  99
 100         ch->max_combined = ns->nsim_bus_dev->num_queues;
 101         ch->combined_count = ns->ethtool.channels;
 102 }
 103
 104 static int
 105 nsim_set_channels(struct net_device *dev, struct ethtool_channels *ch)
 106 {
 107         struct netdevsim *ns = netdev_priv(dev);
 108         int err;
 109
 110         netdev_lock(dev);
 111         err = netif_set_real_num_queues(dev, ch->combined_count,
 112                                         ch->combined_count);
 113         netdev_unlock(dev);
 114         if (err)
 115                 return err;
 116
 117         ns->ethtool.channels = ch->combined_count;
 118         return 0;
 119 }
 120
 121 static int
 122 nsim_get_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
 123 {
 124         struct netdevsim *ns = netdev_priv(dev);
 125
 126         if (ns->ethtool.get_err)
 127                 return -ns->ethtool.get_err;
 128         memcpy(fecparam, &ns->ethtool.fec, sizeof(ns->ethtool.fec));
 129         return 0;
 130 }
 131
 132 static int
 133 nsim_set_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
 134 {
 135         struct netdevsim *ns = netdev_priv(dev);
 136         u32 fec;
 137
 138         if (ns->ethtool.set_err)
 139                 return -ns->ethtool.set_err;
 140         memcpy(&ns->ethtool.fec, fecparam, sizeof(ns->ethtool.fec));
 141         fec = fecparam->fec;
 142         if (fec == ETHTOOL_FEC_AUTO)
 143                 fec |= ETHTOOL_FEC_OFF;
 144         fec |= ETHTOOL_FEC_NONE;
 145         ns->ethtool.fec.active_fec = 1 << (fls(fec) - 1);
 146         return 0;
 147 }
 148
 149 static void
 150 nsim_get_fec_stats(struct net_device *dev, struct ethtool_fec_stats *fec_stats)
 151 {
 152         fec_stats->corrected_blocks.total = 123;
 153         fec_stats->uncorrectable_blocks.total = 4;
 154 }
 155
 156 static int nsim_get_ts_info(struct net_device *dev,
 157                             struct kernel_ethtool_ts_info *info)
 158 {
 159         struct netdevsim *ns = netdev_priv(dev);
 160
 161         info->phc_index = mock_phc_index(ns->phc);
 162
 163         return 0;
 164 }
 165
 166 static const struct ethtool_ops nsim_ethtool_ops = {
 167         .supported_coalesce_params      = ETHTOOL_COALESCE_ALL_PARAMS,
 168         .supported_ring_params          = ETHTOOL_RING_USE_TCP_DATA_SPLIT |
 169                                           ETHTOOL_RING_USE_HDS_THRS,
 170         .get_pause_stats                = nsim_get_pause_stats,
 171         .get_pauseparam                 = nsim_get_pauseparam,
 172         .set_pauseparam                 = nsim_set_pauseparam,
 173         .set_coalesce                   = nsim_set_coalesce,
 174         .get_coalesce                   = nsim_get_coalesce,
 175         .get_ringparam                  = nsim_get_ringparam,
 176         .set_ringparam                  = nsim_set_ringparam,
 177         .get_channels                   = nsim_get_channels,
 178         .set_channels                   = nsim_set_channels,
 179         .get_fecparam                   = nsim_get_fecparam,
 180         .set_fecparam                   = nsim_set_fecparam,
 181         .get_fec_stats                  = nsim_get_fec_stats,
 182         .get_ts_info                    = nsim_get_ts_info,
 183 };
 184
 185 static void nsim_ethtool_ring_init(struct netdevsim *ns)
 186 {
 187         ns->ethtool.ring.rx_max_pending = 4096;
 188         ns->ethtool.ring.rx_jumbo_max_pending = 4096;
 189         ns->ethtool.ring.rx_mini_max_pending = 4096;
 190         ns->ethtool.ring.tx_max_pending = 4096;
 191 }
 192
 193 void nsim_ethtool_init(struct netdevsim *ns)
 194 {
 195         struct dentry *ethtool, *dir;
 196
 197         ns->netdev->ethtool_ops = &nsim_ethtool_ops;
 198
 199         nsim_ethtool_ring_init(ns);
 200
 201         ns->ethtool.pauseparam.report_stats_rx = true;
 202         ns->ethtool.pauseparam.report_stats_tx = true;
 203
 204         ns->ethtool.fec.fec = ETHTOOL_FEC_NONE;
 205         ns->ethtool.fec.active_fec = ETHTOOL_FEC_NONE;
 206
 207         ns->ethtool.channels = ns->nsim_bus_dev->num_queues;
 208
 209         ethtool = debugfs_create_dir("ethtool", ns->nsim_dev_port->ddir);
 210
 211         debugfs_create_u32("get_err", 0600, ethtool, &ns->ethtool.get_err);
 212         debugfs_create_u32("set_err", 0600, ethtool, &ns->ethtool.set_err);
 213
 214         dir = debugfs_create_dir("pause", ethtool);
 215         debugfs_create_bool("report_stats_rx", 0600, dir,
 216                             &ns->ethtool.pauseparam.report_stats_rx);
 217         debugfs_create_bool("report_stats_tx", 0600, dir,
 218                             &ns->ethtool.pauseparam.report_stats_tx);
 219
 220         dir = debugfs_create_dir("ring", ethtool);
 221         debugfs_create_u32("rx_max_pending", 0600, dir,
 222                            &ns->ethtool.ring.rx_max_pending);
 223         debugfs_create_u32("rx_jumbo_max_pending", 0600, dir,
 224                            &ns->ethtool.ring.rx_jumbo_max_pending);
 225         debugfs_create_u32("rx_mini_max_pending", 0600, dir,
 226                            &ns->ethtool.ring.rx_mini_max_pending);
 227         debugfs_create_u32("tx_max_pending", 0600, dir,
 228                            &ns->ethtool.ring.tx_max_pending);
 229 }