1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * FUJITSU Extended Socket Network Device driver
4 * Copyright (c) 2015 FUJITSU LIMITED
5 */
6
7 /* ethtool support for fjes */
8
9 #include <linux/vmalloc.h>
10 #include <linux/netdevice.h>
11 #include <linux/ethtool.h>
12 #include <linux/platform_device.h>
13
14 #include "fjes.h"
15
16 struct fjes_stats {
17 char stat_string[ETH_GSTRING_LEN];
18 int sizeof_stat;
19 int stat_offset;
20 };
21
22 #define FJES_STAT(name, stat) { \
23 .stat_string = name, \
24 .sizeof_stat = sizeof_field(struct fjes_adapter, stat), \
25 .stat_offset = offsetof(struct fjes_adapter, stat) \
26 }
27
28 static const struct fjes_stats fjes_gstrings_stats[] = {
29 FJES_STAT("rx_packets", stats64.rx_packets),
30 FJES_STAT("tx_packets", stats64.tx_packets),
31 FJES_STAT("rx_bytes", stats64.rx_bytes),
32 FJES_STAT("tx_bytes", stats64.rx_bytes),
33 FJES_STAT("rx_dropped", stats64.rx_dropped),
34 FJES_STAT("tx_dropped", stats64.tx_dropped),
35 };
36
37 #define FJES_EP_STATS_LEN 14
38 #define FJES_STATS_LEN \
39 (ARRAY_SIZE(fjes_gstrings_stats) + \
40 ((&((struct fjes_adapter *)netdev_priv(netdev))->hw)->max_epid - 1) * \
41 FJES_EP_STATS_LEN)
42
fjes_get_ethtool_stats(struct net_device * netdev,struct ethtool_stats * stats,u64 * data)43 static void fjes_get_ethtool_stats(struct net_device *netdev,
44 struct ethtool_stats *stats, u64 *data)
45 {
46 struct fjes_adapter *adapter = netdev_priv(netdev);
47 struct fjes_hw *hw = &adapter->hw;
48 int epidx;
49 char *p;
50 int i;
51
52 for (i = 0; i < ARRAY_SIZE(fjes_gstrings_stats); i++) {
53 p = (char *)adapter + fjes_gstrings_stats[i].stat_offset;
54 data[i] = (fjes_gstrings_stats[i].sizeof_stat == sizeof(u64))
55 ? *(u64 *)p : *(u32 *)p;
56 }
57 for (epidx = 0; epidx < hw->max_epid; epidx++) {
58 if (epidx == hw->my_epid)
59 continue;
60 data[i++] = hw->ep_shm_info[epidx].ep_stats
61 .com_regist_buf_exec;
62 data[i++] = hw->ep_shm_info[epidx].ep_stats
63 .com_unregist_buf_exec;
64 data[i++] = hw->ep_shm_info[epidx].ep_stats.send_intr_rx;
65 data[i++] = hw->ep_shm_info[epidx].ep_stats.send_intr_unshare;
66 data[i++] = hw->ep_shm_info[epidx].ep_stats
67 .send_intr_zoneupdate;
68 data[i++] = hw->ep_shm_info[epidx].ep_stats.recv_intr_rx;
69 data[i++] = hw->ep_shm_info[epidx].ep_stats.recv_intr_unshare;
70 data[i++] = hw->ep_shm_info[epidx].ep_stats.recv_intr_stop;
71 data[i++] = hw->ep_shm_info[epidx].ep_stats
72 .recv_intr_zoneupdate;
73 data[i++] = hw->ep_shm_info[epidx].ep_stats.tx_buffer_full;
74 data[i++] = hw->ep_shm_info[epidx].ep_stats
75 .tx_dropped_not_shared;
76 data[i++] = hw->ep_shm_info[epidx].ep_stats
77 .tx_dropped_ver_mismatch;
78 data[i++] = hw->ep_shm_info[epidx].ep_stats
79 .tx_dropped_buf_size_mismatch;
80 data[i++] = hw->ep_shm_info[epidx].ep_stats
81 .tx_dropped_vlanid_mismatch;
82 }
83 }
84
fjes_get_strings(struct net_device * netdev,u32 stringset,u8 * data)85 static void fjes_get_strings(struct net_device *netdev,
86 u32 stringset, u8 *data)
87 {
88 struct fjes_adapter *adapter = netdev_priv(netdev);
89 struct fjes_hw *hw = &adapter->hw;
90 u8 *p = data;
91 int i;
92
93 switch (stringset) {
94 case ETH_SS_STATS:
95 for (i = 0; i < ARRAY_SIZE(fjes_gstrings_stats); i++) {
96 memcpy(p, fjes_gstrings_stats[i].stat_string,
97 ETH_GSTRING_LEN);
98 p += ETH_GSTRING_LEN;
99 }
100 for (i = 0; i < hw->max_epid; i++) {
101 if (i == hw->my_epid)
102 continue;
103 sprintf(p, "ep%u_com_regist_buf_exec", i);
104 p += ETH_GSTRING_LEN;
105 sprintf(p, "ep%u_com_unregist_buf_exec", i);
106 p += ETH_GSTRING_LEN;
107 sprintf(p, "ep%u_send_intr_rx", i);
108 p += ETH_GSTRING_LEN;
109 sprintf(p, "ep%u_send_intr_unshare", i);
110 p += ETH_GSTRING_LEN;
111 sprintf(p, "ep%u_send_intr_zoneupdate", i);
112 p += ETH_GSTRING_LEN;
113 sprintf(p, "ep%u_recv_intr_rx", i);
114 p += ETH_GSTRING_LEN;
115 sprintf(p, "ep%u_recv_intr_unshare", i);
116 p += ETH_GSTRING_LEN;
117 sprintf(p, "ep%u_recv_intr_stop", i);
118 p += ETH_GSTRING_LEN;
119 sprintf(p, "ep%u_recv_intr_zoneupdate", i);
120 p += ETH_GSTRING_LEN;
121 sprintf(p, "ep%u_tx_buffer_full", i);
122 p += ETH_GSTRING_LEN;
123 sprintf(p, "ep%u_tx_dropped_not_shared", i);
124 p += ETH_GSTRING_LEN;
125 sprintf(p, "ep%u_tx_dropped_ver_mismatch", i);
126 p += ETH_GSTRING_LEN;
127 sprintf(p, "ep%u_tx_dropped_buf_size_mismatch", i);
128 p += ETH_GSTRING_LEN;
129 sprintf(p, "ep%u_tx_dropped_vlanid_mismatch", i);
130 p += ETH_GSTRING_LEN;
131 }
132 break;
133 }
134 }
135
fjes_get_sset_count(struct net_device * netdev,int sset)136 static int fjes_get_sset_count(struct net_device *netdev, int sset)
137 {
138 switch (sset) {
139 case ETH_SS_STATS:
140 return FJES_STATS_LEN;
141 default:
142 return -EOPNOTSUPP;
143 }
144 }
145
fjes_get_drvinfo(struct net_device * netdev,struct ethtool_drvinfo * drvinfo)146 static void fjes_get_drvinfo(struct net_device *netdev,
147 struct ethtool_drvinfo *drvinfo)
148 {
149 struct fjes_adapter *adapter = netdev_priv(netdev);
150 struct platform_device *plat_dev;
151
152 plat_dev = adapter->plat_dev;
153
154 strlcpy(drvinfo->driver, fjes_driver_name, sizeof(drvinfo->driver));
155 strlcpy(drvinfo->version, fjes_driver_version,
156 sizeof(drvinfo->version));
157
158 strlcpy(drvinfo->fw_version, "none", sizeof(drvinfo->fw_version));
159 snprintf(drvinfo->bus_info, sizeof(drvinfo->bus_info),
160 "platform:%s", plat_dev->name);
161 }
162
fjes_get_link_ksettings(struct net_device * netdev,struct ethtool_link_ksettings * ecmd)163 static int fjes_get_link_ksettings(struct net_device *netdev,
164 struct ethtool_link_ksettings *ecmd)
165 {
166 ethtool_link_ksettings_zero_link_mode(ecmd, supported);
167 ethtool_link_ksettings_zero_link_mode(ecmd, advertising);
168 ecmd->base.duplex = DUPLEX_FULL;
169 ecmd->base.autoneg = AUTONEG_DISABLE;
170 ecmd->base.port = PORT_NONE;
171 ecmd->base.speed = 20000; /* 20Gb/s */
172
173 return 0;
174 }
175
fjes_get_regs_len(struct net_device * netdev)176 static int fjes_get_regs_len(struct net_device *netdev)
177 {
178 #define FJES_REGS_LEN 37
179 return FJES_REGS_LEN * sizeof(u32);
180 }
181
fjes_get_regs(struct net_device * netdev,struct ethtool_regs * regs,void * p)182 static void fjes_get_regs(struct net_device *netdev,
183 struct ethtool_regs *regs, void *p)
184 {
185 struct fjes_adapter *adapter = netdev_priv(netdev);
186 struct fjes_hw *hw = &adapter->hw;
187 u32 *regs_buff = p;
188
189 memset(p, 0, FJES_REGS_LEN * sizeof(u32));
190
191 regs->version = 1;
192
193 /* Information registers */
194 regs_buff[0] = rd32(XSCT_OWNER_EPID);
195 regs_buff[1] = rd32(XSCT_MAX_EP);
196
197 /* Device Control registers */
198 regs_buff[4] = rd32(XSCT_DCTL);
199
200 /* Command Control registers */
201 regs_buff[8] = rd32(XSCT_CR);
202 regs_buff[9] = rd32(XSCT_CS);
203 regs_buff[10] = rd32(XSCT_SHSTSAL);
204 regs_buff[11] = rd32(XSCT_SHSTSAH);
205
206 regs_buff[13] = rd32(XSCT_REQBL);
207 regs_buff[14] = rd32(XSCT_REQBAL);
208 regs_buff[15] = rd32(XSCT_REQBAH);
209
210 regs_buff[17] = rd32(XSCT_RESPBL);
211 regs_buff[18] = rd32(XSCT_RESPBAL);
212 regs_buff[19] = rd32(XSCT_RESPBAH);
213
214 /* Interrupt Control registers */
215 regs_buff[32] = rd32(XSCT_IS);
216 regs_buff[33] = rd32(XSCT_IMS);
217 regs_buff[34] = rd32(XSCT_IMC);
218 regs_buff[35] = rd32(XSCT_IG);
219 regs_buff[36] = rd32(XSCT_ICTL);
220 }
221
fjes_set_dump(struct net_device * netdev,struct ethtool_dump * dump)222 static int fjes_set_dump(struct net_device *netdev, struct ethtool_dump *dump)
223 {
224 struct fjes_adapter *adapter = netdev_priv(netdev);
225 struct fjes_hw *hw = &adapter->hw;
226 int ret = 0;
227
228 if (dump->flag) {
229 if (hw->debug_mode)
230 return -EPERM;
231
232 hw->debug_mode = dump->flag;
233
234 /* enable debug mode */
235 mutex_lock(&hw->hw_info.lock);
236 ret = fjes_hw_start_debug(hw);
237 mutex_unlock(&hw->hw_info.lock);
238
239 if (ret)
240 hw->debug_mode = 0;
241 } else {
242 if (!hw->debug_mode)
243 return -EPERM;
244
245 /* disable debug mode */
246 mutex_lock(&hw->hw_info.lock);
247 ret = fjes_hw_stop_debug(hw);
248 mutex_unlock(&hw->hw_info.lock);
249 }
250
251 return ret;
252 }
253
fjes_get_dump_flag(struct net_device * netdev,struct ethtool_dump * dump)254 static int fjes_get_dump_flag(struct net_device *netdev,
255 struct ethtool_dump *dump)
256 {
257 struct fjes_adapter *adapter = netdev_priv(netdev);
258 struct fjes_hw *hw = &adapter->hw;
259
260 dump->len = hw->hw_info.trace_size;
261 dump->version = 1;
262 dump->flag = hw->debug_mode;
263
264 return 0;
265 }
266
fjes_get_dump_data(struct net_device * netdev,struct ethtool_dump * dump,void * buf)267 static int fjes_get_dump_data(struct net_device *netdev,
268 struct ethtool_dump *dump, void *buf)
269 {
270 struct fjes_adapter *adapter = netdev_priv(netdev);
271 struct fjes_hw *hw = &adapter->hw;
272 int ret = 0;
273
274 if (hw->hw_info.trace)
275 memcpy(buf, hw->hw_info.trace, hw->hw_info.trace_size);
276 else
277 ret = -EPERM;
278
279 return ret;
280 }
281
282 static const struct ethtool_ops fjes_ethtool_ops = {
283 .get_drvinfo = fjes_get_drvinfo,
284 .get_ethtool_stats = fjes_get_ethtool_stats,
285 .get_strings = fjes_get_strings,
286 .get_sset_count = fjes_get_sset_count,
287 .get_regs = fjes_get_regs,
288 .get_regs_len = fjes_get_regs_len,
289 .set_dump = fjes_set_dump,
290 .get_dump_flag = fjes_get_dump_flag,
291 .get_dump_data = fjes_get_dump_data,
292 .get_link_ksettings = fjes_get_link_ksettings,
293 };
294
fjes_set_ethtool_ops(struct net_device * netdev)295 void fjes_set_ethtool_ops(struct net_device *netdev)
296 {
297 netdev->ethtool_ops = &fjes_ethtool_ops;
298 }
299