projects/linux·blob uaccess-cleanups · refs

280 lines · 7.5 KiB

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
10static void
11nsim_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
22static void
23nsim_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
32static int
33nsim_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
45static 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
56static 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
67static 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
81static 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
95static void
96nsim_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
104static void
105nsim_wake_queues(struct net_device *dev)
106{
107 struct netdevsim *ns = netdev_priv(dev);
108 struct netdevsim *peer;
109
110 synchronize_net();
111 netif_tx_wake_all_queues(dev);
112
113 rcu_read_lock();
114 peer = rcu_dereference(ns->peer);
115 if (peer)
116 netif_tx_wake_all_queues(peer->netdev);
117 rcu_read_unlock();
118}
119
120static int
121nsim_set_channels(struct net_device *dev, struct ethtool_channels *ch)
122{
123 struct netdevsim *ns = netdev_priv(dev);
124 int err;
125
126 err = netif_set_real_num_queues(dev, ch->combined_count,
127 ch->combined_count);
128 if (err)
129 return err;
130
131 ns->ethtool.channels = ch->combined_count;
132
133 /* Only wake up queues if devices are linked */
134 if (rcu_access_pointer(ns->peer))
135 nsim_wake_queues(dev);
136
137 return 0;
138}
139
140static int
141nsim_get_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
142{
143 struct netdevsim *ns = netdev_priv(dev);
144
145 if (ns->ethtool.get_err)
146 return -ns->ethtool.get_err;
147 memcpy(fecparam, &ns->ethtool.fec, sizeof(ns->ethtool.fec));
148 return 0;
149}
150
151static int
152nsim_set_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
153{
154 struct netdevsim *ns = netdev_priv(dev);
155 u32 fec;
156
157 if (ns->ethtool.set_err)
158 return -ns->ethtool.set_err;
159 memcpy(&ns->ethtool.fec, fecparam, sizeof(ns->ethtool.fec));
160 fec = fecparam->fec;
161 if (fec == ETHTOOL_FEC_AUTO)
162 fec |= ETHTOOL_FEC_OFF;
163 fec |= ETHTOOL_FEC_NONE;
164 ns->ethtool.fec.active_fec = 1 << (fls(fec) - 1);
165 return 0;
166}
167
168static const struct ethtool_fec_hist_range netdevsim_fec_ranges[] = {
169 { 0, 0},
170 { 1, 3},
171 { 4, 7},
172 { 0, 0}
173};
174
175static void
176nsim_get_fec_stats(struct net_device *dev, struct ethtool_fec_stats *fec_stats,
177 struct ethtool_fec_hist *hist)
178{
179 struct ethtool_fec_hist_value *values = hist->values;
180
181 hist->ranges = netdevsim_fec_ranges;
182
183 fec_stats->corrected_blocks.total = 123;
184 fec_stats->uncorrectable_blocks.total = 4;
185
186 values[0].per_lane[0] = 125;
187 values[0].per_lane[1] = 120;
188 values[0].per_lane[2] = 100;
189 values[0].per_lane[3] = 100;
190 values[1].sum = 12;
191 values[2].sum = 2;
192 values[2].per_lane[0] = 2;
193 values[2].per_lane[1] = 0;
194 values[2].per_lane[2] = 0;
195 values[2].per_lane[3] = 0;
196}
197
198static int nsim_get_ts_info(struct net_device *dev,
199 struct kernel_ethtool_ts_info *info)
200{
201 struct netdevsim *ns = netdev_priv(dev);
202
203 info->phc_index = mock_phc_index(ns->phc);
204
205 return 0;
206}
207
208static const struct ethtool_ops nsim_ethtool_ops = {
209 .supported_coalesce_params = ETHTOOL_COALESCE_ALL_PARAMS,
210 .supported_ring_params = ETHTOOL_RING_USE_TCP_DATA_SPLIT |
211 ETHTOOL_RING_USE_HDS_THRS,
212 .op_needs_rtnl = ETHTOOL_OP_NEEDS_RTNL_SCHANNELS,
213 .get_pause_stats = nsim_get_pause_stats,
214 .get_pauseparam = nsim_get_pauseparam,
215 .set_pauseparam = nsim_set_pauseparam,
216 .set_coalesce = nsim_set_coalesce,
217 .get_coalesce = nsim_get_coalesce,
218 .get_ringparam = nsim_get_ringparam,
219 .set_ringparam = nsim_set_ringparam,
220 .get_channels = nsim_get_channels,
221 .set_channels = nsim_set_channels,
222 .get_fecparam = nsim_get_fecparam,
223 .set_fecparam = nsim_set_fecparam,
224 .get_fec_stats = nsim_get_fec_stats,
225 .get_ts_info = nsim_get_ts_info,
226};
227
228static void nsim_ethtool_ring_init(struct netdevsim *ns)
229{
230 ns->ethtool.ring.rx_pending = 512;
231 ns->ethtool.ring.rx_max_pending = 4096;
232 ns->ethtool.ring.rx_jumbo_max_pending = 4096;
233 ns->ethtool.ring.rx_mini_max_pending = 4096;
234 ns->ethtool.ring.tx_pending = 512;
235 ns->ethtool.ring.tx_max_pending = 4096;
236}
237
238void nsim_ethtool_init(struct netdevsim *ns)
239{
240 struct dentry *ethtool, *dir;
241
242 ns->netdev->ethtool_ops = &nsim_ethtool_ops;
243
244 nsim_ethtool_ring_init(ns);
245
246 ns->ethtool.pauseparam.report_stats_rx = true;
247 ns->ethtool.pauseparam.report_stats_tx = true;
248
249 ns->ethtool.fec.fec = ETHTOOL_FEC_NONE;
250 ns->ethtool.fec.active_fec = ETHTOOL_FEC_NONE;
251
252 ns->ethtool.channels = ns->nsim_bus_dev->num_queues;
253
254 ethtool = debugfs_create_dir("ethtool", ns->nsim_dev_port->ddir);
255 ns->ethtool_ddir = ethtool;
256
257 debugfs_create_u32("get_err", 0600, ethtool, &ns->ethtool.get_err);
258 debugfs_create_u32("set_err", 0600, ethtool, &ns->ethtool.set_err);
259
260 dir = debugfs_create_dir("pause", ethtool);
261 debugfs_create_bool("report_stats_rx", 0600, dir,
262 &ns->ethtool.pauseparam.report_stats_rx);
263 debugfs_create_bool("report_stats_tx", 0600, dir,
264 &ns->ethtool.pauseparam.report_stats_tx);
265
266 dir = debugfs_create_dir("ring", ethtool);
267 debugfs_create_u32("rx_max_pending", 0600, dir,
268 &ns->ethtool.ring.rx_max_pending);
269 debugfs_create_u32("rx_jumbo_max_pending", 0600, dir,
270 &ns->ethtool.ring.rx_jumbo_max_pending);
271 debugfs_create_u32("rx_mini_max_pending", 0600, dir,
272 &ns->ethtool.ring.rx_mini_max_pending);
273 debugfs_create_u32("tx_max_pending", 0600, dir,
274 &ns->ethtool.ring.tx_max_pending);
275}
276
277void nsim_ethtool_fini(struct netdevsim *ns)
278{
279 debugfs_remove(ns->ethtool_ddir);
280}