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
nsim_get_pause_stats(struct net_device * dev,struct ethtool_pause_stats * pause_stats)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
nsim_get_pauseparam(struct net_device * dev,struct ethtool_pauseparam * pause)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
nsim_set_pauseparam(struct net_device * dev,struct ethtool_pauseparam * pause)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
nsim_get_coalesce(struct net_device * dev,struct ethtool_coalesce * coal,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)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
nsim_set_coalesce(struct net_device * dev,struct ethtool_coalesce * coal,struct kernel_ethtool_coalesce * kernel_coal,struct netlink_ext_ack * extack)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
nsim_get_ringparam(struct net_device * dev,struct ethtool_ringparam * ring)67 static void nsim_get_ringparam(struct net_device *dev,
68 struct ethtool_ringparam *ring)
69 {
70 struct netdevsim *ns = netdev_priv(dev);
71
72 memcpy(ring, &ns->ethtool.ring, sizeof(ns->ethtool.ring));
73 }
74
nsim_set_ringparam(struct net_device * dev,struct ethtool_ringparam * ring)75 static int nsim_set_ringparam(struct net_device *dev,
76 struct ethtool_ringparam *ring)
77 {
78 struct netdevsim *ns = netdev_priv(dev);
79
80 memcpy(&ns->ethtool.ring, ring, sizeof(ns->ethtool.ring));
81 return 0;
82 }
83
84 static int
nsim_get_fecparam(struct net_device * dev,struct ethtool_fecparam * fecparam)85 nsim_get_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
86 {
87 struct netdevsim *ns = netdev_priv(dev);
88
89 if (ns->ethtool.get_err)
90 return -ns->ethtool.get_err;
91 memcpy(fecparam, &ns->ethtool.fec, sizeof(ns->ethtool.fec));
92 return 0;
93 }
94
95 static int
nsim_set_fecparam(struct net_device * dev,struct ethtool_fecparam * fecparam)96 nsim_set_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
97 {
98 struct netdevsim *ns = netdev_priv(dev);
99 u32 fec;
100
101 if (ns->ethtool.set_err)
102 return -ns->ethtool.set_err;
103 memcpy(&ns->ethtool.fec, fecparam, sizeof(ns->ethtool.fec));
104 fec = fecparam->fec;
105 if (fec == ETHTOOL_FEC_AUTO)
106 fec |= ETHTOOL_FEC_OFF;
107 fec |= ETHTOOL_FEC_NONE;
108 ns->ethtool.fec.active_fec = 1 << (fls(fec) - 1);
109 return 0;
110 }
111
112 static const struct ethtool_ops nsim_ethtool_ops = {
113 .supported_coalesce_params = ETHTOOL_COALESCE_ALL_PARAMS,
114 .get_pause_stats = nsim_get_pause_stats,
115 .get_pauseparam = nsim_get_pauseparam,
116 .set_pauseparam = nsim_set_pauseparam,
117 .set_coalesce = nsim_set_coalesce,
118 .get_coalesce = nsim_get_coalesce,
119 .get_ringparam = nsim_get_ringparam,
120 .set_ringparam = nsim_set_ringparam,
121 .get_fecparam = nsim_get_fecparam,
122 .set_fecparam = nsim_set_fecparam,
123 };
124
nsim_ethtool_ring_init(struct netdevsim * ns)125 static void nsim_ethtool_ring_init(struct netdevsim *ns)
126 {
127 ns->ethtool.ring.rx_max_pending = 4096;
128 ns->ethtool.ring.rx_jumbo_max_pending = 4096;
129 ns->ethtool.ring.rx_mini_max_pending = 4096;
130 ns->ethtool.ring.tx_max_pending = 4096;
131 }
132
nsim_ethtool_init(struct netdevsim * ns)133 void nsim_ethtool_init(struct netdevsim *ns)
134 {
135 struct dentry *ethtool, *dir;
136
137 ns->netdev->ethtool_ops = &nsim_ethtool_ops;
138
139 nsim_ethtool_ring_init(ns);
140
141 ns->ethtool.fec.fec = ETHTOOL_FEC_NONE;
142 ns->ethtool.fec.active_fec = ETHTOOL_FEC_NONE;
143
144 ethtool = debugfs_create_dir("ethtool", ns->nsim_dev_port->ddir);
145
146 debugfs_create_u32("get_err", 0600, ethtool, &ns->ethtool.get_err);
147 debugfs_create_u32("set_err", 0600, ethtool, &ns->ethtool.set_err);
148
149 dir = debugfs_create_dir("pause", ethtool);
150 debugfs_create_bool("report_stats_rx", 0600, dir,
151 &ns->ethtool.pauseparam.report_stats_rx);
152 debugfs_create_bool("report_stats_tx", 0600, dir,
153 &ns->ethtool.pauseparam.report_stats_tx);
154
155 dir = debugfs_create_dir("ring", ethtool);
156 debugfs_create_u32("rx_max_pending", 0600, dir,
157 &ns->ethtool.ring.rx_max_pending);
158 debugfs_create_u32("rx_jumbo_max_pending", 0600, dir,
159 &ns->ethtool.ring.rx_jumbo_max_pending);
160 debugfs_create_u32("rx_mini_max_pending", 0600, dir,
161 &ns->ethtool.ring.rx_mini_max_pending);
162 debugfs_create_u32("tx_max_pending", 0600, dir,
163 &ns->ethtool.ring.tx_max_pending);
164 }
165
