Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
tjh.dev
kernel
os
linux
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
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{
70 struct netdevsim *ns = netdev_priv(dev);
71
72 memcpy(ring, &ns->ethtool.ring, sizeof(ns->ethtool.ring));
73}
74
75static 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
84static void
85nsim_get_channels(struct net_device *dev, struct ethtool_channels *ch)
86{
87 struct netdevsim *ns = netdev_priv(dev);
88
89 ch->max_combined = ns->nsim_bus_dev->num_queues;
90 ch->combined_count = ns->ethtool.channels;
91}
92
93static int
94nsim_set_channels(struct net_device *dev, struct ethtool_channels *ch)
95{
96 struct netdevsim *ns = netdev_priv(dev);
97 int err;
98
99 err = netif_set_real_num_queues(dev, ch->combined_count,
100 ch->combined_count);
101 if (err)
102 return err;
103
104 ns->ethtool.channels = ch->combined_count;
105 return 0;
106}
107
108static int
109nsim_get_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
110{
111 struct netdevsim *ns = netdev_priv(dev);
112
113 if (ns->ethtool.get_err)
114 return -ns->ethtool.get_err;
115 memcpy(fecparam, &ns->ethtool.fec, sizeof(ns->ethtool.fec));
116 return 0;
117}
118
119static int
120nsim_set_fecparam(struct net_device *dev, struct ethtool_fecparam *fecparam)
121{
122 struct netdevsim *ns = netdev_priv(dev);
123 u32 fec;
124
125 if (ns->ethtool.set_err)
126 return -ns->ethtool.set_err;
127 memcpy(&ns->ethtool.fec, fecparam, sizeof(ns->ethtool.fec));
128 fec = fecparam->fec;
129 if (fec == ETHTOOL_FEC_AUTO)
130 fec |= ETHTOOL_FEC_OFF;
131 fec |= ETHTOOL_FEC_NONE;
132 ns->ethtool.fec.active_fec = 1 << (fls(fec) - 1);
133 return 0;
134}
135
136static const struct ethtool_ops nsim_ethtool_ops = {
137 .supported_coalesce_params = ETHTOOL_COALESCE_ALL_PARAMS,
138 .get_pause_stats = nsim_get_pause_stats,
139 .get_pauseparam = nsim_get_pauseparam,
140 .set_pauseparam = nsim_set_pauseparam,
141 .set_coalesce = nsim_set_coalesce,
142 .get_coalesce = nsim_get_coalesce,
143 .get_ringparam = nsim_get_ringparam,
144 .set_ringparam = nsim_set_ringparam,
145 .get_channels = nsim_get_channels,
146 .set_channels = nsim_set_channels,
147 .get_fecparam = nsim_get_fecparam,
148 .set_fecparam = nsim_set_fecparam,
149};
150
151static void nsim_ethtool_ring_init(struct netdevsim *ns)
152{
153 ns->ethtool.ring.rx_max_pending = 4096;
154 ns->ethtool.ring.rx_jumbo_max_pending = 4096;
155 ns->ethtool.ring.rx_mini_max_pending = 4096;
156 ns->ethtool.ring.tx_max_pending = 4096;
157}
158
159void nsim_ethtool_init(struct netdevsim *ns)
160{
161 struct dentry *ethtool, *dir;
162
163 ns->netdev->ethtool_ops = &nsim_ethtool_ops;
164
165 nsim_ethtool_ring_init(ns);
166
167 ns->ethtool.fec.fec = ETHTOOL_FEC_NONE;
168 ns->ethtool.fec.active_fec = ETHTOOL_FEC_NONE;
169
170 ns->ethtool.channels = ns->nsim_bus_dev->num_queues;
171
172 ethtool = debugfs_create_dir("ethtool", ns->nsim_dev_port->ddir);
173
174 debugfs_create_u32("get_err", 0600, ethtool, &ns->ethtool.get_err);
175 debugfs_create_u32("set_err", 0600, ethtool, &ns->ethtool.set_err);
176
177 dir = debugfs_create_dir("pause", ethtool);
178 debugfs_create_bool("report_stats_rx", 0600, dir,
179 &ns->ethtool.pauseparam.report_stats_rx);
180 debugfs_create_bool("report_stats_tx", 0600, dir,
181 &ns->ethtool.pauseparam.report_stats_tx);
182
183 dir = debugfs_create_dir("ring", ethtool);
184 debugfs_create_u32("rx_max_pending", 0600, dir,
185 &ns->ethtool.ring.rx_max_pending);
186 debugfs_create_u32("rx_jumbo_max_pending", 0600, dir,
187 &ns->ethtool.ring.rx_jumbo_max_pending);
188 debugfs_create_u32("rx_mini_max_pending", 0600, dir,
189 &ns->ethtool.ring.rx_mini_max_pending);
190 debugfs_create_u32("tx_max_pending", 0600, dir,
191 &ns->ethtool.ring.tx_max_pending);
192}