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 } 161