xref: /openbmc/linux/drivers/net/netdevsim/ethtool.c (revision 0b26ca68)
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 const struct ethtool_ops nsim_ethtool_ops = {
81 	.supported_coalesce_params	= ETHTOOL_COALESCE_ALL_PARAMS,
82 	.get_pause_stats	        = nsim_get_pause_stats,
83 	.get_pauseparam		        = nsim_get_pauseparam,
84 	.set_pauseparam		        = nsim_set_pauseparam,
85 	.set_coalesce			= nsim_set_coalesce,
86 	.get_coalesce			= nsim_get_coalesce,
87 	.get_ringparam			= nsim_get_ringparam,
88 	.set_ringparam			= nsim_set_ringparam,
89 };
90 
91 static void nsim_ethtool_ring_init(struct netdevsim *ns)
92 {
93 	ns->ethtool.ring.rx_max_pending = 4096;
94 	ns->ethtool.ring.rx_jumbo_max_pending = 4096;
95 	ns->ethtool.ring.rx_mini_max_pending = 4096;
96 	ns->ethtool.ring.tx_max_pending = 4096;
97 }
98 
99 void nsim_ethtool_init(struct netdevsim *ns)
100 {
101 	struct dentry *ethtool, *dir;
102 
103 	ns->netdev->ethtool_ops = &nsim_ethtool_ops;
104 
105 	nsim_ethtool_ring_init(ns);
106 
107 	ethtool = debugfs_create_dir("ethtool", ns->nsim_dev_port->ddir);
108 
109 	dir = debugfs_create_dir("pause", ethtool);
110 	debugfs_create_bool("report_stats_rx", 0600, dir,
111 			    &ns->ethtool.pauseparam.report_stats_rx);
112 	debugfs_create_bool("report_stats_tx", 0600, dir,
113 			    &ns->ethtool.pauseparam.report_stats_tx);
114 
115 	dir = debugfs_create_dir("ring", ethtool);
116 	debugfs_create_u32("rx_max_pending", 0600, dir,
117 			   &ns->ethtool.ring.rx_max_pending);
118 	debugfs_create_u32("rx_jumbo_max_pending", 0600, dir,
119 			   &ns->ethtool.ring.rx_jumbo_max_pending);
120 	debugfs_create_u32("rx_mini_max_pending", 0600, dir,
121 			   &ns->ethtool.ring.rx_mini_max_pending);
122 	debugfs_create_u32("tx_max_pending", 0600, dir,
123 			   &ns->ethtool.ring.tx_max_pending);
124 }
125