]> git.proxmox.com Git - mirror_ubuntu-jammy-kernel.git/blob - net/core/ethtool.c
projects / mirror_ubuntu-jammy-kernel.git / blob
? search:


43e9add5834043f325b687b2e615ad9e5aca23f9
[mirror_ubuntu-jammy-kernel.git] / net / core / ethtool.c
1 /*
2 * net/core/ethtool.c - Ethtool ioctl handler
3 * Copyright (c) 2003 Matthew Wilcox <matthew@wil.cx>
4 *
5 * This file is where we call all the ethtool_ops commands to get
6 * the information ethtool needs.
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 */
13
14 #include <linux/module.h>
15 #include <linux/types.h>
16 #include <linux/capability.h>
17 #include <linux/errno.h>
18 #include <linux/ethtool.h>
19 #include <linux/netdevice.h>
20 #include <linux/net_tstamp.h>
21 #include <linux/phy.h>
22 #include <linux/bitops.h>
23 #include <linux/uaccess.h>
24 #include <linux/vmalloc.h>
25 #include <linux/sfp.h>
26 #include <linux/slab.h>
27 #include <linux/rtnetlink.h>
28 #include <linux/sched/signal.h>
29 #include <linux/net.h>
30 #include <net/devlink.h>
31 #include <net/xdp_sock.h>
32 #include <net/flow_offload.h>
33
34 /*
35 * Some useful ethtool_ops methods that're device independent.
36 * If we find that all drivers want to do the same thing here,
37 * we can turn these into dev_() function calls.
38 */
39
40 u32 ethtool_op_get_link(struct net_device *dev)
41 {
42 return netif_carrier_ok(dev) ? 1 : 0;
43 }
44 EXPORT_SYMBOL(ethtool_op_get_link);
45
46 int ethtool_op_get_ts_info(struct net_device *dev, struct ethtool_ts_info *info)
47 {
48 info->so_timestamping =
49 SOF_TIMESTAMPING_TX_SOFTWARE |
50 SOF_TIMESTAMPING_RX_SOFTWARE |
51 SOF_TIMESTAMPING_SOFTWARE;
52 info->phc_index = -1;
53 return 0;
54 }
55 EXPORT_SYMBOL(ethtool_op_get_ts_info);
56
57 /* Handlers for each ethtool command */
58
59 #define ETHTOOL_DEV_FEATURE_WORDS ((NETDEV_FEATURE_COUNT + 31) / 32)
60
61 static const char netdev_features_strings[NETDEV_FEATURE_COUNT][ETH_GSTRING_LEN] = {
62 [NETIF_F_SG_BIT] = "tx-scatter-gather",
63 [NETIF_F_IP_CSUM_BIT] = "tx-checksum-ipv4",
64 [NETIF_F_HW_CSUM_BIT] = "tx-checksum-ip-generic",
65 [NETIF_F_IPV6_CSUM_BIT] = "tx-checksum-ipv6",
66 [NETIF_F_HIGHDMA_BIT] = "highdma",
67 [NETIF_F_FRAGLIST_BIT] = "tx-scatter-gather-fraglist",
68 [NETIF_F_HW_VLAN_CTAG_TX_BIT] = "tx-vlan-hw-insert",
69
70 [NETIF_F_HW_VLAN_CTAG_RX_BIT] = "rx-vlan-hw-parse",
71 [NETIF_F_HW_VLAN_CTAG_FILTER_BIT] = "rx-vlan-filter",
72 [NETIF_F_HW_VLAN_STAG_TX_BIT] = "tx-vlan-stag-hw-insert",
73 [NETIF_F_HW_VLAN_STAG_RX_BIT] = "rx-vlan-stag-hw-parse",
74 [NETIF_F_HW_VLAN_STAG_FILTER_BIT] = "rx-vlan-stag-filter",
75 [NETIF_F_VLAN_CHALLENGED_BIT] = "vlan-challenged",
76 [NETIF_F_GSO_BIT] = "tx-generic-segmentation",
77 [NETIF_F_LLTX_BIT] = "tx-lockless",
78 [NETIF_F_NETNS_LOCAL_BIT] = "netns-local",
79 [NETIF_F_GRO_BIT] = "rx-gro",
80 [NETIF_F_GRO_HW_BIT] = "rx-gro-hw",
81 [NETIF_F_LRO_BIT] = "rx-lro",
82
83 [NETIF_F_TSO_BIT] = "tx-tcp-segmentation",
84 [NETIF_F_GSO_ROBUST_BIT] = "tx-gso-robust",
85 [NETIF_F_TSO_ECN_BIT] = "tx-tcp-ecn-segmentation",
86 [NETIF_F_TSO_MANGLEID_BIT] = "tx-tcp-mangleid-segmentation",
87 [NETIF_F_TSO6_BIT] = "tx-tcp6-segmentation",
88 [NETIF_F_FSO_BIT] = "tx-fcoe-segmentation",
89 [NETIF_F_GSO_GRE_BIT] = "tx-gre-segmentation",
90 [NETIF_F_GSO_GRE_CSUM_BIT] = "tx-gre-csum-segmentation",
91 [NETIF_F_GSO_IPXIP4_BIT] = "tx-ipxip4-segmentation",
92 [NETIF_F_GSO_IPXIP6_BIT] = "tx-ipxip6-segmentation",
93 [NETIF_F_GSO_UDP_TUNNEL_BIT] = "tx-udp_tnl-segmentation",
94 [NETIF_F_GSO_UDP_TUNNEL_CSUM_BIT] = "tx-udp_tnl-csum-segmentation",
95 [NETIF_F_GSO_PARTIAL_BIT] = "tx-gso-partial",
96 [NETIF_F_GSO_SCTP_BIT] = "tx-sctp-segmentation",
97 [NETIF_F_GSO_ESP_BIT] = "tx-esp-segmentation",
98 [NETIF_F_GSO_UDP_L4_BIT] = "tx-udp-segmentation",
99
100 [NETIF_F_FCOE_CRC_BIT] = "tx-checksum-fcoe-crc",
101 [NETIF_F_SCTP_CRC_BIT] = "tx-checksum-sctp",
102 [NETIF_F_FCOE_MTU_BIT] = "fcoe-mtu",
103 [NETIF_F_NTUPLE_BIT] = "rx-ntuple-filter",
104 [NETIF_F_RXHASH_BIT] = "rx-hashing",
105 [NETIF_F_RXCSUM_BIT] = "rx-checksum",
106 [NETIF_F_NOCACHE_COPY_BIT] = "tx-nocache-copy",
107 [NETIF_F_LOOPBACK_BIT] = "loopback",
108 [NETIF_F_RXFCS_BIT] = "rx-fcs",
109 [NETIF_F_RXALL_BIT] = "rx-all",
110 [NETIF_F_HW_L2FW_DOFFLOAD_BIT] = "l2-fwd-offload",
111 [NETIF_F_HW_TC_BIT] = "hw-tc-offload",
112 [NETIF_F_HW_ESP_BIT] = "esp-hw-offload",
113 [NETIF_F_HW_ESP_TX_CSUM_BIT] = "esp-tx-csum-hw-offload",
114 [NETIF_F_RX_UDP_TUNNEL_PORT_BIT] = "rx-udp_tunnel-port-offload",
115 [NETIF_F_HW_TLS_RECORD_BIT] = "tls-hw-record",
116 [NETIF_F_HW_TLS_TX_BIT] = "tls-hw-tx-offload",
117 [NETIF_F_HW_TLS_RX_BIT] = "tls-hw-rx-offload",
118 };
119
120 static const char
121 rss_hash_func_strings[ETH_RSS_HASH_FUNCS_COUNT][ETH_GSTRING_LEN] = {
122 [ETH_RSS_HASH_TOP_BIT] = "toeplitz",
123 [ETH_RSS_HASH_XOR_BIT] = "xor",
124 [ETH_RSS_HASH_CRC32_BIT] = "crc32",
125 };
126
127 static const char
128 tunable_strings[__ETHTOOL_TUNABLE_COUNT][ETH_GSTRING_LEN] = {
129 [ETHTOOL_ID_UNSPEC] = "Unspec",
130 [ETHTOOL_RX_COPYBREAK] = "rx-copybreak",
131 [ETHTOOL_TX_COPYBREAK] = "tx-copybreak",
132 [ETHTOOL_PFC_PREVENTION_TOUT] = "pfc-prevention-tout",
133 };
134
135 static const char
136 phy_tunable_strings[__ETHTOOL_PHY_TUNABLE_COUNT][ETH_GSTRING_LEN] = {
137 [ETHTOOL_ID_UNSPEC] = "Unspec",
138 [ETHTOOL_PHY_DOWNSHIFT] = "phy-downshift",
139 [ETHTOOL_PHY_FAST_LINK_DOWN] = "phy-fast-link-down",
140 };
141
142 static int ethtool_get_features(struct net_device *dev, void __user *useraddr)
143 {
144 struct ethtool_gfeatures cmd = {
145 .cmd = ETHTOOL_GFEATURES,
146 .size = ETHTOOL_DEV_FEATURE_WORDS,
147 };
148 struct ethtool_get_features_block features[ETHTOOL_DEV_FEATURE_WORDS];
149 u32 __user *sizeaddr;
150 u32 copy_size;
151 int i;
152
153 /* in case feature bits run out again */
154 BUILD_BUG_ON(ETHTOOL_DEV_FEATURE_WORDS * sizeof(u32) > sizeof(netdev_features_t));
155
156 for (i = 0; i < ETHTOOL_DEV_FEATURE_WORDS; ++i) {
157 features[i].available = (u32)(dev->hw_features >> (32 * i));
158 features[i].requested = (u32)(dev->wanted_features >> (32 * i));
159 features[i].active = (u32)(dev->features >> (32 * i));
160 features[i].never_changed =
161 (u32)(NETIF_F_NEVER_CHANGE >> (32 * i));
162 }
163
164 sizeaddr = useraddr + offsetof(struct ethtool_gfeatures, size);
165 if (get_user(copy_size, sizeaddr))
166 return -EFAULT;
167
168 if (copy_size > ETHTOOL_DEV_FEATURE_WORDS)
169 copy_size = ETHTOOL_DEV_FEATURE_WORDS;
170
171 if (copy_to_user(useraddr, &cmd, sizeof(cmd)))
172 return -EFAULT;
173 useraddr += sizeof(cmd);
174 if (copy_to_user(useraddr, features, copy_size * sizeof(*features)))
175 return -EFAULT;
176
177 return 0;
178 }
179
180 static int ethtool_set_features(struct net_device *dev, void __user *useraddr)
181 {
182 struct ethtool_sfeatures cmd;
183 struct ethtool_set_features_block features[ETHTOOL_DEV_FEATURE_WORDS];
184 netdev_features_t wanted = 0, valid = 0;
185 int i, ret = 0;
186
187 if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
188 return -EFAULT;
189 useraddr += sizeof(cmd);
190
191 if (cmd.size != ETHTOOL_DEV_FEATURE_WORDS)
192 return -EINVAL;
193
194 if (copy_from_user(features, useraddr, sizeof(features)))
195 return -EFAULT;
196
197 for (i = 0; i < ETHTOOL_DEV_FEATURE_WORDS; ++i) {
198 valid |= (netdev_features_t)features[i].valid << (32 * i);
199 wanted |= (netdev_features_t)features[i].requested << (32 * i);
200 }
201
202 if (valid & ~NETIF_F_ETHTOOL_BITS)
203 return -EINVAL;
204
205 if (valid & ~dev->hw_features) {
206 valid &= dev->hw_features;
207 ret |= ETHTOOL_F_UNSUPPORTED;
208 }
209
210 dev->wanted_features &= ~valid;
211 dev->wanted_features |= wanted & valid;
212 __netdev_update_features(dev);
213
214 if ((dev->wanted_features ^ dev->features) & valid)
215 ret |= ETHTOOL_F_WISH;
216
217 return ret;
218 }
219
220 static int __ethtool_get_sset_count(struct net_device *dev, int sset)
221 {
222 const struct ethtool_ops *ops = dev->ethtool_ops;
223
224 if (sset == ETH_SS_FEATURES)
225 return ARRAY_SIZE(netdev_features_strings);
226
227 if (sset == ETH_SS_RSS_HASH_FUNCS)
228 return ARRAY_SIZE(rss_hash_func_strings);
229
230 if (sset == ETH_SS_TUNABLES)
231 return ARRAY_SIZE(tunable_strings);
232
233 if (sset == ETH_SS_PHY_TUNABLES)
234 return ARRAY_SIZE(phy_tunable_strings);
235
236 if (sset == ETH_SS_PHY_STATS && dev->phydev &&
237 !ops->get_ethtool_phy_stats)
238 return phy_ethtool_get_sset_count(dev->phydev);
239
240 if (ops->get_sset_count && ops->get_strings)
241 return ops->get_sset_count(dev, sset);
242 else
243 return -EOPNOTSUPP;
244 }
245
246 static void __ethtool_get_strings(struct net_device *dev,
247 u32 stringset, u8 *data)
248 {
249 const struct ethtool_ops *ops = dev->ethtool_ops;
250
251 if (stringset == ETH_SS_FEATURES)
252 memcpy(data, netdev_features_strings,
253 sizeof(netdev_features_strings));
254 else if (stringset == ETH_SS_RSS_HASH_FUNCS)
255 memcpy(data, rss_hash_func_strings,
256 sizeof(rss_hash_func_strings));
257 else if (stringset == ETH_SS_TUNABLES)
258 memcpy(data, tunable_strings, sizeof(tunable_strings));
259 else if (stringset == ETH_SS_PHY_TUNABLES)
260 memcpy(data, phy_tunable_strings, sizeof(phy_tunable_strings));
261 else if (stringset == ETH_SS_PHY_STATS && dev->phydev &&
262 !ops->get_ethtool_phy_stats)
263 phy_ethtool_get_strings(dev->phydev, data);
264 else
265 /* ops->get_strings is valid because checked earlier */
266 ops->get_strings(dev, stringset, data);
267 }
268
269 static netdev_features_t ethtool_get_feature_mask(u32 eth_cmd)
270 {
271 /* feature masks of legacy discrete ethtool ops */
272
273 switch (eth_cmd) {
274 case ETHTOOL_GTXCSUM:
275 case ETHTOOL_STXCSUM:
276 return NETIF_F_CSUM_MASK | NETIF_F_SCTP_CRC;
277 case ETHTOOL_GRXCSUM:
278 case ETHTOOL_SRXCSUM:
279 return NETIF_F_RXCSUM;
280 case ETHTOOL_GSG:
281 case ETHTOOL_SSG:
282 return NETIF_F_SG;
283 case ETHTOOL_GTSO:
284 case ETHTOOL_STSO:
285 return NETIF_F_ALL_TSO;
286 case ETHTOOL_GGSO:
287 case ETHTOOL_SGSO:
288 return NETIF_F_GSO;
289 case ETHTOOL_GGRO:
290 case ETHTOOL_SGRO:
291 return NETIF_F_GRO;
292 default:
293 BUG();
294 }
295 }
296
297 static int ethtool_get_one_feature(struct net_device *dev,
298 char __user *useraddr, u32 ethcmd)
299 {
300 netdev_features_t mask = ethtool_get_feature_mask(ethcmd);
301 struct ethtool_value edata = {
302 .cmd = ethcmd,
303 .data = !!(dev->features & mask),
304 };
305
306 if (copy_to_user(useraddr, &edata, sizeof(edata)))
307 return -EFAULT;
308 return 0;
309 }
310
311 static int ethtool_set_one_feature(struct net_device *dev,
312 void __user *useraddr, u32 ethcmd)
313 {
314 struct ethtool_value edata;
315 netdev_features_t mask;
316
317 if (copy_from_user(&edata, useraddr, sizeof(edata)))
318 return -EFAULT;
319
320 mask = ethtool_get_feature_mask(ethcmd);
321 mask &= dev->hw_features;
322 if (!mask)
323 return -EOPNOTSUPP;
324
325 if (edata.data)
326 dev->wanted_features |= mask;
327 else
328 dev->wanted_features &= ~mask;
329
330 __netdev_update_features(dev);
331
332 return 0;
333 }
334
335 #define ETH_ALL_FLAGS (ETH_FLAG_LRO | ETH_FLAG_RXVLAN | ETH_FLAG_TXVLAN | \
336 ETH_FLAG_NTUPLE | ETH_FLAG_RXHASH)
337 #define ETH_ALL_FEATURES (NETIF_F_LRO | NETIF_F_HW_VLAN_CTAG_RX | \
338 NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_NTUPLE | \
339 NETIF_F_RXHASH)
340
341 static u32 __ethtool_get_flags(struct net_device *dev)
342 {
343 u32 flags = 0;
344
345 if (dev->features & NETIF_F_LRO)
346 flags |= ETH_FLAG_LRO;
347 if (dev->features & NETIF_F_HW_VLAN_CTAG_RX)
348 flags |= ETH_FLAG_RXVLAN;
349 if (dev->features & NETIF_F_HW_VLAN_CTAG_TX)
350 flags |= ETH_FLAG_TXVLAN;
351 if (dev->features & NETIF_F_NTUPLE)
352 flags |= ETH_FLAG_NTUPLE;
353 if (dev->features & NETIF_F_RXHASH)
354 flags |= ETH_FLAG_RXHASH;
355
356 return flags;
357 }
358
359 static int __ethtool_set_flags(struct net_device *dev, u32 data)
360 {
361 netdev_features_t features = 0, changed;
362
363 if (data & ~ETH_ALL_FLAGS)
364 return -EINVAL;
365
366 if (data & ETH_FLAG_LRO)
367 features |= NETIF_F_LRO;
368 if (data & ETH_FLAG_RXVLAN)
369 features |= NETIF_F_HW_VLAN_CTAG_RX;
370 if (data & ETH_FLAG_TXVLAN)
371 features |= NETIF_F_HW_VLAN_CTAG_TX;
372 if (data & ETH_FLAG_NTUPLE)
373 features |= NETIF_F_NTUPLE;
374 if (data & ETH_FLAG_RXHASH)
375 features |= NETIF_F_RXHASH;
376
377 /* allow changing only bits set in hw_features */
378 changed = (features ^ dev->features) & ETH_ALL_FEATURES;
379 if (changed & ~dev->hw_features)
380 return (changed & dev->hw_features) ? -EINVAL : -EOPNOTSUPP;
381
382 dev->wanted_features =
383 (dev->wanted_features & ~changed) | (features & changed);
384
385 __netdev_update_features(dev);
386
387 return 0;
388 }
389
390 /* Given two link masks, AND them together and save the result in dst. */
391 void ethtool_intersect_link_masks(struct ethtool_link_ksettings *dst,
392 struct ethtool_link_ksettings *src)
393 {
394 unsigned int size = BITS_TO_LONGS(__ETHTOOL_LINK_MODE_MASK_NBITS);
395 unsigned int idx = 0;
396
397 for (; idx < size; idx++) {
398 dst->link_modes.supported[idx] &=
399 src->link_modes.supported[idx];
400 dst->link_modes.advertising[idx] &=
401 src->link_modes.advertising[idx];
402 }
403 }
404 EXPORT_SYMBOL(ethtool_intersect_link_masks);
405
406 void ethtool_convert_legacy_u32_to_link_mode(unsigned long *dst,
407 u32 legacy_u32)
408 {
409 bitmap_zero(dst, __ETHTOOL_LINK_MODE_MASK_NBITS);
410 dst[0] = legacy_u32;
411 }
412 EXPORT_SYMBOL(ethtool_convert_legacy_u32_to_link_mode);
413
414 /* return false if src had higher bits set. lower bits always updated. */
415 bool ethtool_convert_link_mode_to_legacy_u32(u32 *legacy_u32,
416 const unsigned long *src)
417 {
418 bool retval = true;
419
420 /* TODO: following test will soon always be true */
421 if (__ETHTOOL_LINK_MODE_MASK_NBITS > 32) {
422 __ETHTOOL_DECLARE_LINK_MODE_MASK(ext);
423
424 bitmap_zero(ext, __ETHTOOL_LINK_MODE_MASK_NBITS);
425 bitmap_fill(ext, 32);
426 bitmap_complement(ext, ext, __ETHTOOL_LINK_MODE_MASK_NBITS);
427 if (bitmap_intersects(ext, src,
428 __ETHTOOL_LINK_MODE_MASK_NBITS)) {
429 /* src mask goes beyond bit 31 */
430 retval = false;
431 }
432 }
433 *legacy_u32 = src[0];
434 return retval;
435 }
436 EXPORT_SYMBOL(ethtool_convert_link_mode_to_legacy_u32);
437
438 /* return false if legacy contained non-0 deprecated fields
439 * maxtxpkt/maxrxpkt. rest of ksettings always updated
440 */
441 static bool
442 convert_legacy_settings_to_link_ksettings(
443 struct ethtool_link_ksettings *link_ksettings,
444 const struct ethtool_cmd *legacy_settings)
445 {
446 bool retval = true;
447
448 memset(link_ksettings, 0, sizeof(*link_ksettings));
449
450 /* This is used to tell users that driver is still using these
451 * deprecated legacy fields, and they should not use
452 * %ETHTOOL_GLINKSETTINGS/%ETHTOOL_SLINKSETTINGS
453 */
454 if (legacy_settings->maxtxpkt ||
455 legacy_settings->maxrxpkt)
456 retval = false;
457
458 ethtool_convert_legacy_u32_to_link_mode(
459 link_ksettings->link_modes.supported,
460 legacy_settings->supported);
461 ethtool_convert_legacy_u32_to_link_mode(
462 link_ksettings->link_modes.advertising,
463 legacy_settings->advertising);
464 ethtool_convert_legacy_u32_to_link_mode(
465 link_ksettings->link_modes.lp_advertising,
466 legacy_settings->lp_advertising);
467 link_ksettings->base.speed
468 = ethtool_cmd_speed(legacy_settings);
469 link_ksettings->base.duplex
470 = legacy_settings->duplex;
471 link_ksettings->base.port
472 = legacy_settings->port;
473 link_ksettings->base.phy_address
474 = legacy_settings->phy_address;
475 link_ksettings->base.autoneg
476 = legacy_settings->autoneg;
477 link_ksettings->base.mdio_support
478 = legacy_settings->mdio_support;
479 link_ksettings->base.eth_tp_mdix
480 = legacy_settings->eth_tp_mdix;
481 link_ksettings->base.eth_tp_mdix_ctrl
482 = legacy_settings->eth_tp_mdix_ctrl;
483 return retval;
484 }
485
486 /* return false if ksettings link modes had higher bits
487 * set. legacy_settings always updated (best effort)
488 */
489 static bool
490 convert_link_ksettings_to_legacy_settings(
491 struct ethtool_cmd *legacy_settings,
492 const struct ethtool_link_ksettings *link_ksettings)
493 {
494 bool retval = true;
495
496 memset(legacy_settings, 0, sizeof(*legacy_settings));
497 /* this also clears the deprecated fields in legacy structure:
498 * __u8 transceiver;
499 * __u32 maxtxpkt;
500 * __u32 maxrxpkt;
501 */
502
503 retval &= ethtool_convert_link_mode_to_legacy_u32(
504 &legacy_settings->supported,
505 link_ksettings->link_modes.supported);
506 retval &= ethtool_convert_link_mode_to_legacy_u32(
507 &legacy_settings->advertising,
508 link_ksettings->link_modes.advertising);
509 retval &= ethtool_convert_link_mode_to_legacy_u32(
510 &legacy_settings->lp_advertising,
511 link_ksettings->link_modes.lp_advertising);
512 ethtool_cmd_speed_set(legacy_settings, link_ksettings->base.speed);
513 legacy_settings->duplex
514 = link_ksettings->base.duplex;
515 legacy_settings->port
516 = link_ksettings->base.port;
517 legacy_settings->phy_address
518 = link_ksettings->base.phy_address;
519 legacy_settings->autoneg
520 = link_ksettings->base.autoneg;
521 legacy_settings->mdio_support
522 = link_ksettings->base.mdio_support;
523 legacy_settings->eth_tp_mdix
524 = link_ksettings->base.eth_tp_mdix;
525 legacy_settings->eth_tp_mdix_ctrl
526 = link_ksettings->base.eth_tp_mdix_ctrl;
527 legacy_settings->transceiver
528 = link_ksettings->base.transceiver;
529 return retval;
530 }
531
532 /* number of 32-bit words to store the user's link mode bitmaps */
533 #define __ETHTOOL_LINK_MODE_MASK_NU32 \
534 DIV_ROUND_UP(__ETHTOOL_LINK_MODE_MASK_NBITS, 32)
535
536 /* layout of the struct passed from/to userland */
537 struct ethtool_link_usettings {
538 struct ethtool_link_settings base;
539 struct {
540 __u32 supported[__ETHTOOL_LINK_MODE_MASK_NU32];
541 __u32 advertising[__ETHTOOL_LINK_MODE_MASK_NU32];
542 __u32 lp_advertising[__ETHTOOL_LINK_MODE_MASK_NU32];
543 } link_modes;
544 };
545
546 /* Internal kernel helper to query a device ethtool_link_settings. */
547 int __ethtool_get_link_ksettings(struct net_device *dev,
548 struct ethtool_link_ksettings *link_ksettings)
549 {
550 ASSERT_RTNL();
551
552 if (!dev->ethtool_ops->get_link_ksettings)
553 return -EOPNOTSUPP;
554
555 memset(link_ksettings, 0, sizeof(*link_ksettings));
556 return dev->ethtool_ops->get_link_ksettings(dev, link_ksettings);
557 }
558 EXPORT_SYMBOL(__ethtool_get_link_ksettings);
559
560 /* convert ethtool_link_usettings in user space to a kernel internal
561 * ethtool_link_ksettings. return 0 on success, errno on error.
562 */
563 static int load_link_ksettings_from_user(struct ethtool_link_ksettings *to,
564 const void __user *from)
565 {
566 struct ethtool_link_usettings link_usettings;
567
568 if (copy_from_user(&link_usettings, from, sizeof(link_usettings)))
569 return -EFAULT;
570
571 memcpy(&to->base, &link_usettings.base, sizeof(to->base));
572 bitmap_from_arr32(to->link_modes.supported,
573 link_usettings.link_modes.supported,
574 __ETHTOOL_LINK_MODE_MASK_NBITS);
575 bitmap_from_arr32(to->link_modes.advertising,
576 link_usettings.link_modes.advertising,
577 __ETHTOOL_LINK_MODE_MASK_NBITS);
578 bitmap_from_arr32(to->link_modes.lp_advertising,
579 link_usettings.link_modes.lp_advertising,
580 __ETHTOOL_LINK_MODE_MASK_NBITS);
581
582 return 0;
583 }
584
585 /* convert a kernel internal ethtool_link_ksettings to
586 * ethtool_link_usettings in user space. return 0 on success, errno on
587 * error.
588 */
589 static int
590 store_link_ksettings_for_user(void __user *to,
591 const struct ethtool_link_ksettings *from)
592 {
593 struct ethtool_link_usettings link_usettings;
594
595 memcpy(&link_usettings.base, &from->base, sizeof(link_usettings));
596 bitmap_to_arr32(link_usettings.link_modes.supported,
597 from->link_modes.supported,
598 __ETHTOOL_LINK_MODE_MASK_NBITS);
599 bitmap_to_arr32(link_usettings.link_modes.advertising,
600 from->link_modes.advertising,
601 __ETHTOOL_LINK_MODE_MASK_NBITS);
602 bitmap_to_arr32(link_usettings.link_modes.lp_advertising,
603 from->link_modes.lp_advertising,
604 __ETHTOOL_LINK_MODE_MASK_NBITS);
605
606 if (copy_to_user(to, &link_usettings, sizeof(link_usettings)))
607 return -EFAULT;
608
609 return 0;
610 }
611
612 /* Query device for its ethtool_link_settings. */
613 static int ethtool_get_link_ksettings(struct net_device *dev,
614 void __user *useraddr)
615 {
616 int err = 0;
617 struct ethtool_link_ksettings link_ksettings;
618
619 ASSERT_RTNL();
620 if (!dev->ethtool_ops->get_link_ksettings)
621 return -EOPNOTSUPP;
622
623 /* handle bitmap nbits handshake */
624 if (copy_from_user(&link_ksettings.base, useraddr,
625 sizeof(link_ksettings.base)))
626 return -EFAULT;
627
628 if (__ETHTOOL_LINK_MODE_MASK_NU32
629 != link_ksettings.base.link_mode_masks_nwords) {
630 /* wrong link mode nbits requested */
631 memset(&link_ksettings, 0, sizeof(link_ksettings));
632 link_ksettings.base.cmd = ETHTOOL_GLINKSETTINGS;
633 /* send back number of words required as negative val */
634 compiletime_assert(__ETHTOOL_LINK_MODE_MASK_NU32 <= S8_MAX,
635 "need too many bits for link modes!");
636 link_ksettings.base.link_mode_masks_nwords
637 = -((s8)__ETHTOOL_LINK_MODE_MASK_NU32);
638
639 /* copy the base fields back to user, not the link
640 * mode bitmaps
641 */
642 if (copy_to_user(useraddr, &link_ksettings.base,
643 sizeof(link_ksettings.base)))
644 return -EFAULT;
645
646 return 0;
647 }
648
649 /* handshake successful: user/kernel agree on
650 * link_mode_masks_nwords
651 */
652
653 memset(&link_ksettings, 0, sizeof(link_ksettings));
654 err = dev->ethtool_ops->get_link_ksettings(dev, &link_ksettings);
655 if (err < 0)
656 return err;
657
658 /* make sure we tell the right values to user */
659 link_ksettings.base.cmd = ETHTOOL_GLINKSETTINGS;
660 link_ksettings.base.link_mode_masks_nwords
661 = __ETHTOOL_LINK_MODE_MASK_NU32;
662
663 return store_link_ksettings_for_user(useraddr, &link_ksettings);
664 }
665
666 /* Update device ethtool_link_settings. */
667 static int ethtool_set_link_ksettings(struct net_device *dev,
668 void __user *useraddr)
669 {
670 int err;
671 struct ethtool_link_ksettings link_ksettings;
672
673 ASSERT_RTNL();
674
675 if (!dev->ethtool_ops->set_link_ksettings)
676 return -EOPNOTSUPP;
677
678 /* make sure nbits field has expected value */
679 if (copy_from_user(&link_ksettings.base, useraddr,
680 sizeof(link_ksettings.base)))
681 return -EFAULT;
682
683 if (__ETHTOOL_LINK_MODE_MASK_NU32
684 != link_ksettings.base.link_mode_masks_nwords)
685 return -EINVAL;
686
687 /* copy the whole structure, now that we know it has expected
688 * format
689 */
690 err = load_link_ksettings_from_user(&link_ksettings, useraddr);
691 if (err)
692 return err;
693
694 /* re-check nwords field, just in case */
695 if (__ETHTOOL_LINK_MODE_MASK_NU32
696 != link_ksettings.base.link_mode_masks_nwords)
697 return -EINVAL;
698
699 return dev->ethtool_ops->set_link_ksettings(dev, &link_ksettings);
700 }
701
702 /* Query device for its ethtool_cmd settings.
703 *
704 * Backward compatibility note: for compatibility with legacy ethtool, this is
705 * now implemented via get_link_ksettings. When driver reports higher link mode
706 * bits, a kernel warning is logged once (with name of 1st driver/device) to
707 * recommend user to upgrade ethtool, but the command is successful (only the
708 * lower link mode bits reported back to user). Deprecated fields from
709 * ethtool_cmd (transceiver/maxrxpkt/maxtxpkt) are always set to zero.
710 */
711 static int ethtool_get_settings(struct net_device *dev, void __user *useraddr)
712 {
713 struct ethtool_link_ksettings link_ksettings;
714 struct ethtool_cmd cmd;
715 int err;
716
717 ASSERT_RTNL();
718 if (!dev->ethtool_ops->get_link_ksettings)
719 return -EOPNOTSUPP;
720
721 memset(&link_ksettings, 0, sizeof(link_ksettings));
722 err = dev->ethtool_ops->get_link_ksettings(dev, &link_ksettings);
723 if (err < 0)
724 return err;
725 convert_link_ksettings_to_legacy_settings(&cmd, &link_ksettings);
726
727 /* send a sensible cmd tag back to user */
728 cmd.cmd = ETHTOOL_GSET;
729
730 if (copy_to_user(useraddr, &cmd, sizeof(cmd)))
731 return -EFAULT;
732
733 return 0;
734 }
735
736 /* Update device link settings with given ethtool_cmd.
737 *
738 * Backward compatibility note: for compatibility with legacy ethtool, this is
739 * now always implemented via set_link_settings. When user's request updates
740 * deprecated ethtool_cmd fields (transceiver/maxrxpkt/maxtxpkt), a kernel
741 * warning is logged once (with name of 1st driver/device) to recommend user to
742 * upgrade ethtool, and the request is rejected.
743 */
744 static int ethtool_set_settings(struct net_device *dev, void __user *useraddr)
745 {
746 struct ethtool_link_ksettings link_ksettings;
747 struct ethtool_cmd cmd;
748
749 ASSERT_RTNL();
750
751 if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
752 return -EFAULT;
753 if (!dev->ethtool_ops->set_link_ksettings)
754 return -EOPNOTSUPP;
755
756 if (!convert_legacy_settings_to_link_ksettings(&link_ksettings, &cmd))
757 return -EINVAL;
758 link_ksettings.base.link_mode_masks_nwords =
759 __ETHTOOL_LINK_MODE_MASK_NU32;
760 return dev->ethtool_ops->set_link_ksettings(dev, &link_ksettings);
761 }
762
763 static noinline_for_stack int ethtool_get_drvinfo(struct net_device *dev,
764 void __user *useraddr)
765 {
766 struct ethtool_drvinfo info;
767 const struct ethtool_ops *ops = dev->ethtool_ops;
768
769 memset(&info, 0, sizeof(info));
770 info.cmd = ETHTOOL_GDRVINFO;
771 if (ops->get_drvinfo) {
772 ops->get_drvinfo(dev, &info);
773 } else if (dev->dev.parent && dev->dev.parent->driver) {
774 strlcpy(info.bus_info, dev_name(dev->dev.parent),
775 sizeof(info.bus_info));
776 strlcpy(info.driver, dev->dev.parent->driver->name,
777 sizeof(info.driver));
778 } else {
779 return -EOPNOTSUPP;
780 }
781
782 /*
783 * this method of obtaining string set info is deprecated;
784 * Use ETHTOOL_GSSET_INFO instead.
785 */
786 if (ops->get_sset_count) {
787 int rc;
788
789 rc = ops->get_sset_count(dev, ETH_SS_TEST);
790 if (rc >= 0)
791 info.testinfo_len = rc;
792 rc = ops->get_sset_count(dev, ETH_SS_STATS);
793 if (rc >= 0)
794 info.n_stats = rc;
795 rc = ops->get_sset_count(dev, ETH_SS_PRIV_FLAGS);
796 if (rc >= 0)
797 info.n_priv_flags = rc;
798 }
799 if (ops->get_regs_len) {
800 int ret = ops->get_regs_len(dev);
801
802 if (ret > 0)
803 info.regdump_len = ret;
804 }
805
806 if (ops->get_eeprom_len)
807 info.eedump_len = ops->get_eeprom_len(dev);
808
809 if (!info.fw_version[0])
810 devlink_compat_running_version(dev, info.fw_version,
811 sizeof(info.fw_version));
812
813 if (copy_to_user(useraddr, &info, sizeof(info)))
814 return -EFAULT;
815 return 0;
816 }
817
818 static noinline_for_stack int ethtool_get_sset_info(struct net_device *dev,
819 void __user *useraddr)
820 {
821 struct ethtool_sset_info info;
822 u64 sset_mask;
823 int i, idx = 0, n_bits = 0, ret, rc;
824 u32 *info_buf = NULL;
825
826 if (copy_from_user(&info, useraddr, sizeof(info)))
827 return -EFAULT;
828
829 /* store copy of mask, because we zero struct later on */
830 sset_mask = info.sset_mask;
831 if (!sset_mask)
832 return 0;
833
834 /* calculate size of return buffer */
835 n_bits = hweight64(sset_mask);
836
837 memset(&info, 0, sizeof(info));
838 info.cmd = ETHTOOL_GSSET_INFO;
839
840 info_buf = kcalloc(n_bits, sizeof(u32), GFP_USER);
841 if (!info_buf)
842 return -ENOMEM;
843
844 /*
845 * fill return buffer based on input bitmask and successful
846 * get_sset_count return
847 */
848 for (i = 0; i < 64; i++) {
849 if (!(sset_mask & (1ULL << i)))
850 continue;
851
852 rc = __ethtool_get_sset_count(dev, i);
853 if (rc >= 0) {
854 info.sset_mask |= (1ULL << i);
855 info_buf[idx++] = rc;
856 }
857 }
858
859 ret = -EFAULT;
860 if (copy_to_user(useraddr, &info, sizeof(info)))
861 goto out;
862
863 useraddr += offsetof(struct ethtool_sset_info, data);
864 if (copy_to_user(useraddr, info_buf, idx * sizeof(u32)))
865 goto out;
866
867 ret = 0;
868
869 out:
870 kfree(info_buf);
871 return ret;
872 }
873
874 static noinline_for_stack int ethtool_set_rxnfc(struct net_device *dev,
875 u32 cmd, void __user *useraddr)
876 {
877 struct ethtool_rxnfc info;
878 size_t info_size = sizeof(info);
879 int rc;
880
881 if (!dev->ethtool_ops->set_rxnfc)
882 return -EOPNOTSUPP;
883
884 /* struct ethtool_rxnfc was originally defined for
885 * ETHTOOL_{G,S}RXFH with only the cmd, flow_type and data
886 * members. User-space might still be using that
887 * definition. */
888 if (cmd == ETHTOOL_SRXFH)
889 info_size = (offsetof(struct ethtool_rxnfc, data) +
890 sizeof(info.data));
891
892 if (copy_from_user(&info, useraddr, info_size))
893 return -EFAULT;
894
895 rc = dev->ethtool_ops->set_rxnfc(dev, &info);
896 if (rc)
897 return rc;
898
899 if (cmd == ETHTOOL_SRXCLSRLINS &&
900 copy_to_user(useraddr, &info, info_size))
901 return -EFAULT;
902
903 return 0;
904 }
905
906 static noinline_for_stack int ethtool_get_rxnfc(struct net_device *dev,
907 u32 cmd, void __user *useraddr)
908 {
909 struct ethtool_rxnfc info;
910 size_t info_size = sizeof(info);
911 const struct ethtool_ops *ops = dev->ethtool_ops;
912 int ret;
913 void *rule_buf = NULL;
914
915 if (!ops->get_rxnfc)
916 return -EOPNOTSUPP;
917
918 /* struct ethtool_rxnfc was originally defined for
919 * ETHTOOL_{G,S}RXFH with only the cmd, flow_type and data
920 * members. User-space might still be using that
921 * definition. */
922 if (cmd == ETHTOOL_GRXFH)
923 info_size = (offsetof(struct ethtool_rxnfc, data) +
924 sizeof(info.data));
925
926 if (copy_from_user(&info, useraddr, info_size))
927 return -EFAULT;
928
929 /* If FLOW_RSS was requested then user-space must be using the
930 * new definition, as FLOW_RSS is newer.
931 */
932 if (cmd == ETHTOOL_GRXFH && info.flow_type & FLOW_RSS) {
933 info_size = sizeof(info);
934 if (copy_from_user(&info, useraddr, info_size))
935 return -EFAULT;
936 /* Since malicious users may modify the original data,
937 * we need to check whether FLOW_RSS is still requested.
938 */
939 if (!(info.flow_type & FLOW_RSS))
940 return -EINVAL;
941 }
942
943 if (info.cmd != cmd)
944 return -EINVAL;
945
946 if (info.cmd == ETHTOOL_GRXCLSRLALL) {
947 if (info.rule_cnt > 0) {
948 if (info.rule_cnt <= KMALLOC_MAX_SIZE / sizeof(u32))
949 rule_buf = kcalloc(info.rule_cnt, sizeof(u32),
950 GFP_USER);
951 if (!rule_buf)
952 return -ENOMEM;
953 }
954 }
955
956 ret = ops->get_rxnfc(dev, &info, rule_buf);
957 if (ret < 0)
958 goto err_out;
959
960 ret = -EFAULT;
961 if (copy_to_user(useraddr, &info, info_size))
962 goto err_out;
963
964 if (rule_buf) {
965 useraddr += offsetof(struct ethtool_rxnfc, rule_locs);
966 if (copy_to_user(useraddr, rule_buf,
967 info.rule_cnt * sizeof(u32)))
968 goto err_out;
969 }
970 ret = 0;
971
972 err_out:
973 kfree(rule_buf);
974
975 return ret;
976 }
977
978 static int ethtool_copy_validate_indir(u32 *indir, void __user *useraddr,
979 struct ethtool_rxnfc *rx_rings,
980 u32 size)
981 {
982 int i;
983
984 if (copy_from_user(indir, useraddr, size * sizeof(indir[0])))
985 return -EFAULT;
986
987 /* Validate ring indices */
988 for (i = 0; i < size; i++)
989 if (indir[i] >= rx_rings->data)
990 return -EINVAL;
991
992 return 0;
993 }
994
995 u8 netdev_rss_key[NETDEV_RSS_KEY_LEN] __read_mostly;
996
997 void netdev_rss_key_fill(void *buffer, size_t len)
998 {
999 BUG_ON(len > sizeof(netdev_rss_key));
1000 net_get_random_once(netdev_rss_key, sizeof(netdev_rss_key));
1001 memcpy(buffer, netdev_rss_key, len);
1002 }
1003 EXPORT_SYMBOL(netdev_rss_key_fill);
1004
1005 static int ethtool_get_max_rxfh_channel(struct net_device *dev, u32 *max)
1006 {
1007 u32 dev_size, current_max = 0;
1008 u32 *indir;
1009 int ret;
1010
1011 if (!dev->ethtool_ops->get_rxfh_indir_size ||
1012 !dev->ethtool_ops->get_rxfh)
1013 return -EOPNOTSUPP;
1014 dev_size = dev->ethtool_ops->get_rxfh_indir_size(dev);
1015 if (dev_size == 0)
1016 return -EOPNOTSUPP;
1017
1018 indir = kcalloc(dev_size, sizeof(indir[0]), GFP_USER);
1019 if (!indir)
1020 return -ENOMEM;
1021
1022 ret = dev->ethtool_ops->get_rxfh(dev, indir, NULL, NULL);
1023 if (ret)
1024 goto out;
1025
1026 while (dev_size--)
1027 current_max = max(current_max, indir[dev_size]);
1028
1029 *max = current_max;
1030
1031 out:
1032 kfree(indir);
1033 return ret;
1034 }
1035
1036 static noinline_for_stack int ethtool_get_rxfh_indir(struct net_device *dev,
1037 void __user *useraddr)
1038 {
1039 u32 user_size, dev_size;
1040 u32 *indir;
1041 int ret;
1042
1043 if (!dev->ethtool_ops->get_rxfh_indir_size ||
1044 !dev->ethtool_ops->get_rxfh)
1045 return -EOPNOTSUPP;
1046 dev_size = dev->ethtool_ops->get_rxfh_indir_size(dev);
1047 if (dev_size == 0)
1048 return -EOPNOTSUPP;
1049
1050 if (copy_from_user(&user_size,
1051 useraddr + offsetof(struct ethtool_rxfh_indir, size),
1052 sizeof(user_size)))
1053 return -EFAULT;
1054
1055 if (copy_to_user(useraddr + offsetof(struct ethtool_rxfh_indir, size),
1056 &dev_size, sizeof(dev_size)))
1057 return -EFAULT;
1058
1059 /* If the user buffer size is 0, this is just a query for the
1060 * device table size. Otherwise, if it's smaller than the
1061 * device table size it's an error.
1062 */
1063 if (user_size < dev_size)
1064 return user_size == 0 ? 0 : -EINVAL;
1065
1066 indir = kcalloc(dev_size, sizeof(indir[0]), GFP_USER);
1067 if (!indir)
1068 return -ENOMEM;
1069
1070 ret = dev->ethtool_ops->get_rxfh(dev, indir, NULL, NULL);
1071 if (ret)
1072 goto out;
1073
1074 if (copy_to_user(useraddr +
1075 offsetof(struct ethtool_rxfh_indir, ring_index[0]),
1076 indir, dev_size * sizeof(indir[0])))
1077 ret = -EFAULT;
1078
1079 out:
1080 kfree(indir);
1081 return ret;
1082 }
1083
1084 static noinline_for_stack int ethtool_set_rxfh_indir(struct net_device *dev,
1085 void __user *useraddr)
1086 {
1087 struct ethtool_rxnfc rx_rings;
1088 u32 user_size, dev_size, i;
1089 u32 *indir;
1090 const struct ethtool_ops *ops = dev->ethtool_ops;
1091 int ret;
1092 u32 ringidx_offset = offsetof(struct ethtool_rxfh_indir, ring_index[0]);
1093
1094 if (!ops->get_rxfh_indir_size || !ops->set_rxfh ||
1095 !ops->get_rxnfc)
1096 return -EOPNOTSUPP;
1097
1098 dev_size = ops->get_rxfh_indir_size(dev);
1099 if (dev_size == 0)
1100 return -EOPNOTSUPP;
1101
1102 if (copy_from_user(&user_size,
1103 useraddr + offsetof(struct ethtool_rxfh_indir, size),
1104 sizeof(user_size)))
1105 return -EFAULT;
1106
1107 if (user_size != 0 && user_size != dev_size)
1108 return -EINVAL;
1109
1110 indir = kcalloc(dev_size, sizeof(indir[0]), GFP_USER);
1111 if (!indir)
1112 return -ENOMEM;
1113
1114 rx_rings.cmd = ETHTOOL_GRXRINGS;
1115 ret = ops->get_rxnfc(dev, &rx_rings, NULL);
1116 if (ret)
1117 goto out;
1118
1119 if (user_size == 0) {
1120 for (i = 0; i < dev_size; i++)
1121 indir[i] = ethtool_rxfh_indir_default(i, rx_rings.data);
1122 } else {
1123 ret = ethtool_copy_validate_indir(indir,
1124 useraddr + ringidx_offset,
1125 &rx_rings,
1126 dev_size);
1127 if (ret)
1128 goto out;
1129 }
1130
1131 ret = ops->set_rxfh(dev, indir, NULL, ETH_RSS_HASH_NO_CHANGE);
1132 if (ret)
1133 goto out;
1134
1135 /* indicate whether rxfh was set to default */
1136 if (user_size == 0)
1137 dev->priv_flags &= ~IFF_RXFH_CONFIGURED;
1138 else
1139 dev->priv_flags |= IFF_RXFH_CONFIGURED;
1140
1141 out:
1142 kfree(indir);
1143 return ret;
1144 }
1145
1146 static noinline_for_stack int ethtool_get_rxfh(struct net_device *dev,
1147 void __user *useraddr)
1148 {
1149 int ret;
1150 const struct ethtool_ops *ops = dev->ethtool_ops;
1151 u32 user_indir_size, user_key_size;
1152 u32 dev_indir_size = 0, dev_key_size = 0;
1153 struct ethtool_rxfh rxfh;
1154 u32 total_size;
1155 u32 indir_bytes;
1156 u32 *indir = NULL;
1157 u8 dev_hfunc = 0;
1158 u8 *hkey = NULL;
1159 u8 *rss_config;
1160
1161 if (!ops->get_rxfh)
1162 return -EOPNOTSUPP;
1163
1164 if (ops->get_rxfh_indir_size)
1165 dev_indir_size = ops->get_rxfh_indir_size(dev);
1166 if (ops->get_rxfh_key_size)
1167 dev_key_size = ops->get_rxfh_key_size(dev);
1168
1169 if (copy_from_user(&rxfh, useraddr, sizeof(rxfh)))
1170 return -EFAULT;
1171 user_indir_size = rxfh.indir_size;
1172 user_key_size = rxfh.key_size;
1173
1174 /* Check that reserved fields are 0 for now */
1175 if (rxfh.rsvd8[0] || rxfh.rsvd8[1] || rxfh.rsvd8[2] || rxfh.rsvd32)
1176 return -EINVAL;
1177 /* Most drivers don't handle rss_context, check it's 0 as well */
1178 if (rxfh.rss_context && !ops->get_rxfh_context)
1179 return -EOPNOTSUPP;
1180
1181 rxfh.indir_size = dev_indir_size;
1182 rxfh.key_size = dev_key_size;
1183 if (copy_to_user(useraddr, &rxfh, sizeof(rxfh)))
1184 return -EFAULT;
1185
1186 if ((user_indir_size && (user_indir_size != dev_indir_size)) ||
1187 (user_key_size && (user_key_size != dev_key_size)))
1188 return -EINVAL;
1189
1190 indir_bytes = user_indir_size * sizeof(indir[0]);
1191 total_size = indir_bytes + user_key_size;
1192 rss_config = kzalloc(total_size, GFP_USER);
1193 if (!rss_config)
1194 return -ENOMEM;
1195
1196 if (user_indir_size)
1197 indir = (u32 *)rss_config;
1198
1199 if (user_key_size)
1200 hkey = rss_config + indir_bytes;
1201
1202 if (rxfh.rss_context)
1203 ret = dev->ethtool_ops->get_rxfh_context(dev, indir, hkey,
1204 &dev_hfunc,
1205 rxfh.rss_context);
1206 else
1207 ret = dev->ethtool_ops->get_rxfh(dev, indir, hkey, &dev_hfunc);
1208 if (ret)
1209 goto out;
1210
1211 if (copy_to_user(useraddr + offsetof(struct ethtool_rxfh, hfunc),
1212 &dev_hfunc, sizeof(rxfh.hfunc))) {
1213 ret = -EFAULT;
1214 } else if (copy_to_user(useraddr +
1215 offsetof(struct ethtool_rxfh, rss_config[0]),
1216 rss_config, total_size)) {
1217 ret = -EFAULT;
1218 }
1219 out:
1220 kfree(rss_config);
1221
1222 return ret;
1223 }
1224
1225 static noinline_for_stack int ethtool_set_rxfh(struct net_device *dev,
1226 void __user *useraddr)
1227 {
1228 int ret;
1229 const struct ethtool_ops *ops = dev->ethtool_ops;
1230 struct ethtool_rxnfc rx_rings;
1231 struct ethtool_rxfh rxfh;
1232 u32 dev_indir_size = 0, dev_key_size = 0, i;
1233 u32 *indir = NULL, indir_bytes = 0;
1234 u8 *hkey = NULL;
1235 u8 *rss_config;
1236 u32 rss_cfg_offset = offsetof(struct ethtool_rxfh, rss_config[0]);
1237 bool delete = false;
1238
1239 if (!ops->get_rxnfc || !ops->set_rxfh)
1240 return -EOPNOTSUPP;
1241
1242 if (ops->get_rxfh_indir_size)
1243 dev_indir_size = ops->get_rxfh_indir_size(dev);
1244 if (ops->get_rxfh_key_size)
1245 dev_key_size = ops->get_rxfh_key_size(dev);
1246
1247 if (copy_from_user(&rxfh, useraddr, sizeof(rxfh)))
1248 return -EFAULT;
1249
1250 /* Check that reserved fields are 0 for now */
1251 if (rxfh.rsvd8[0] || rxfh.rsvd8[1] || rxfh.rsvd8[2] || rxfh.rsvd32)
1252 return -EINVAL;
1253 /* Most drivers don't handle rss_context, check it's 0 as well */
1254 if (rxfh.rss_context && !ops->set_rxfh_context)
1255 return -EOPNOTSUPP;
1256
1257 /* If either indir, hash key or function is valid, proceed further.
1258 * Must request at least one change: indir size, hash key or function.
1259 */
1260 if ((rxfh.indir_size &&
1261 rxfh.indir_size != ETH_RXFH_INDIR_NO_CHANGE &&
1262 rxfh.indir_size != dev_indir_size) ||
1263 (rxfh.key_size && (rxfh.key_size != dev_key_size)) ||
1264 (rxfh.indir_size == ETH_RXFH_INDIR_NO_CHANGE &&
1265 rxfh.key_size == 0 && rxfh.hfunc == ETH_RSS_HASH_NO_CHANGE))
1266 return -EINVAL;
1267
1268 if (rxfh.indir_size != ETH_RXFH_INDIR_NO_CHANGE)
1269 indir_bytes = dev_indir_size * sizeof(indir[0]);
1270
1271 rss_config = kzalloc(indir_bytes + rxfh.key_size, GFP_USER);
1272 if (!rss_config)
1273 return -ENOMEM;
1274
1275 rx_rings.cmd = ETHTOOL_GRXRINGS;
1276 ret = ops->get_rxnfc(dev, &rx_rings, NULL);
1277 if (ret)
1278 goto out;
1279
1280 /* rxfh.indir_size == 0 means reset the indir table to default (master
1281 * context) or delete the context (other RSS contexts).
1282 * rxfh.indir_size == ETH_RXFH_INDIR_NO_CHANGE means leave it unchanged.
1283 */
1284 if (rxfh.indir_size &&
1285 rxfh.indir_size != ETH_RXFH_INDIR_NO_CHANGE) {
1286 indir = (u32 *)rss_config;
1287 ret = ethtool_copy_validate_indir(indir,
1288 useraddr + rss_cfg_offset,
1289 &rx_rings,
1290 rxfh.indir_size);
1291 if (ret)
1292 goto out;
1293 } else if (rxfh.indir_size == 0) {
1294 if (rxfh.rss_context == 0) {
1295 indir = (u32 *)rss_config;
1296 for (i = 0; i < dev_indir_size; i++)
1297 indir[i] = ethtool_rxfh_indir_default(i, rx_rings.data);
1298 } else {
1299 delete = true;
1300 }
1301 }
1302
1303 if (rxfh.key_size) {
1304 hkey = rss_config + indir_bytes;
1305 if (copy_from_user(hkey,
1306 useraddr + rss_cfg_offset + indir_bytes,
1307 rxfh.key_size)) {
1308 ret = -EFAULT;
1309 goto out;
1310 }
1311 }
1312
1313 if (rxfh.rss_context)
1314 ret = ops->set_rxfh_context(dev, indir, hkey, rxfh.hfunc,
1315 &rxfh.rss_context, delete);
1316 else
1317 ret = ops->set_rxfh(dev, indir, hkey, rxfh.hfunc);
1318 if (ret)
1319 goto out;
1320
1321 if (copy_to_user(useraddr + offsetof(struct ethtool_rxfh, rss_context),
1322 &rxfh.rss_context, sizeof(rxfh.rss_context)))
1323 ret = -EFAULT;
1324
1325 if (!rxfh.rss_context) {
1326 /* indicate whether rxfh was set to default */
1327 if (rxfh.indir_size == 0)
1328 dev->priv_flags &= ~IFF_RXFH_CONFIGURED;
1329 else if (rxfh.indir_size != ETH_RXFH_INDIR_NO_CHANGE)
1330 dev->priv_flags |= IFF_RXFH_CONFIGURED;
1331 }
1332
1333 out:
1334 kfree(rss_config);
1335 return ret;
1336 }
1337
1338 static int ethtool_get_regs(struct net_device *dev, char __user *useraddr)
1339 {
1340 struct ethtool_regs regs;
1341 const struct ethtool_ops *ops = dev->ethtool_ops;
1342 void *regbuf;
1343 int reglen, ret;
1344
1345 if (!ops->get_regs || !ops->get_regs_len)
1346 return -EOPNOTSUPP;
1347
1348 if (copy_from_user(&regs, useraddr, sizeof(regs)))
1349 return -EFAULT;
1350
1351 reglen = ops->get_regs_len(dev);
1352 if (reglen <= 0)
1353 return reglen;
1354
1355 if (regs.len > reglen)
1356 regs.len = reglen;
1357
1358 regbuf = vzalloc(reglen);
1359 if (!regbuf)
1360 return -ENOMEM;
1361
1362 ops->get_regs(dev, &regs, regbuf);
1363
1364 ret = -EFAULT;
1365 if (copy_to_user(useraddr, &regs, sizeof(regs)))
1366 goto out;
1367 useraddr += offsetof(struct ethtool_regs, data);
1368 if (regbuf && copy_to_user(useraddr, regbuf, regs.len))
1369 goto out;
1370 ret = 0;
1371
1372 out:
1373 vfree(regbuf);
1374 return ret;
1375 }
1376
1377 static int ethtool_reset(struct net_device *dev, char __user *useraddr)
1378 {
1379 struct ethtool_value reset;
1380 int ret;
1381
1382 if (!dev->ethtool_ops->reset)
1383 return -EOPNOTSUPP;
1384
1385 if (copy_from_user(&reset, useraddr, sizeof(reset)))
1386 return -EFAULT;
1387
1388 ret = dev->ethtool_ops->reset(dev, &reset.data);
1389 if (ret)
1390 return ret;
1391
1392 if (copy_to_user(useraddr, &reset, sizeof(reset)))
1393 return -EFAULT;
1394 return 0;
1395 }
1396
1397 static int ethtool_get_wol(struct net_device *dev, char __user *useraddr)
1398 {
1399 struct ethtool_wolinfo wol = { .cmd = ETHTOOL_GWOL };
1400
1401 if (!dev->ethtool_ops->get_wol)
1402 return -EOPNOTSUPP;
1403
1404 dev->ethtool_ops->get_wol(dev, &wol);
1405
1406 if (copy_to_user(useraddr, &wol, sizeof(wol)))
1407 return -EFAULT;
1408 return 0;
1409 }
1410
1411 static int ethtool_set_wol(struct net_device *dev, char __user *useraddr)
1412 {
1413 struct ethtool_wolinfo wol;
1414 int ret;
1415
1416 if (!dev->ethtool_ops->set_wol)
1417 return -EOPNOTSUPP;
1418
1419 if (copy_from_user(&wol, useraddr, sizeof(wol)))
1420 return -EFAULT;
1421
1422 ret = dev->ethtool_ops->set_wol(dev, &wol);
1423 if (ret)
1424 return ret;
1425
1426 dev->wol_enabled = !!wol.wolopts;
1427
1428 return 0;
1429 }
1430
1431 static int ethtool_get_eee(struct net_device *dev, char __user *useraddr)
1432 {
1433 struct ethtool_eee edata;
1434 int rc;
1435
1436 if (!dev->ethtool_ops->get_eee)
1437 return -EOPNOTSUPP;
1438
1439 memset(&edata, 0, sizeof(struct ethtool_eee));
1440 edata.cmd = ETHTOOL_GEEE;
1441 rc = dev->ethtool_ops->get_eee(dev, &edata);
1442
1443 if (rc)
1444 return rc;
1445
1446 if (copy_to_user(useraddr, &edata, sizeof(edata)))
1447 return -EFAULT;
1448
1449 return 0;
1450 }
1451
1452 static int ethtool_set_eee(struct net_device *dev, char __user *useraddr)
1453 {
1454 struct ethtool_eee edata;
1455
1456 if (!dev->ethtool_ops->set_eee)
1457 return -EOPNOTSUPP;
1458
1459 if (copy_from_user(&edata, useraddr, sizeof(edata)))
1460 return -EFAULT;
1461
1462 return dev->ethtool_ops->set_eee(dev, &edata);
1463 }
1464
1465 static int ethtool_nway_reset(struct net_device *dev)
1466 {
1467 if (!dev->ethtool_ops->nway_reset)
1468 return -EOPNOTSUPP;
1469
1470 return dev->ethtool_ops->nway_reset(dev);
1471 }
1472
1473 static int ethtool_get_link(struct net_device *dev, char __user *useraddr)
1474 {
1475 struct ethtool_value edata = { .cmd = ETHTOOL_GLINK };
1476
1477 if (!dev->ethtool_ops->get_link)
1478 return -EOPNOTSUPP;
1479
1480 edata.data = netif_running(dev) && dev->ethtool_ops->get_link(dev);
1481
1482 if (copy_to_user(useraddr, &edata, sizeof(edata)))
1483 return -EFAULT;
1484 return 0;
1485 }
1486
1487 static int ethtool_get_any_eeprom(struct net_device *dev, void __user *useraddr,
1488 int (*getter)(struct net_device *,
1489 struct ethtool_eeprom *, u8 *),
1490 u32 total_len)
1491 {
1492 struct ethtool_eeprom eeprom;
1493 void __user *userbuf = useraddr + sizeof(eeprom);
1494 u32 bytes_remaining;
1495 u8 *data;
1496 int ret = 0;
1497
1498 if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
1499 return -EFAULT;
1500
1501 /* Check for wrap and zero */
1502 if (eeprom.offset + eeprom.len <= eeprom.offset)
1503 return -EINVAL;
1504
1505 /* Check for exceeding total eeprom len */
1506 if (eeprom.offset + eeprom.len > total_len)
1507 return -EINVAL;
1508
1509 data = kmalloc(PAGE_SIZE, GFP_USER);
1510 if (!data)
1511 return -ENOMEM;
1512
1513 bytes_remaining = eeprom.len;
1514 while (bytes_remaining > 0) {
1515 eeprom.len = min(bytes_remaining, (u32)PAGE_SIZE);
1516
1517 ret = getter(dev, &eeprom, data);
1518 if (ret)
1519 break;
1520 if (copy_to_user(userbuf, data, eeprom.len)) {
1521 ret = -EFAULT;
1522 break;
1523 }
1524 userbuf += eeprom.len;
1525 eeprom.offset += eeprom.len;
1526 bytes_remaining -= eeprom.len;
1527 }
1528
1529 eeprom.len = userbuf - (useraddr + sizeof(eeprom));
1530 eeprom.offset -= eeprom.len;
1531 if (copy_to_user(useraddr, &eeprom, sizeof(eeprom)))
1532 ret = -EFAULT;
1533
1534 kfree(data);
1535 return ret;
1536 }
1537
1538 static int ethtool_get_eeprom(struct net_device *dev, void __user *useraddr)
1539 {
1540 const struct ethtool_ops *ops = dev->ethtool_ops;
1541
1542 if (!ops->get_eeprom || !ops->get_eeprom_len ||
1543 !ops->get_eeprom_len(dev))
1544 return -EOPNOTSUPP;
1545
1546 return ethtool_get_any_eeprom(dev, useraddr, ops->get_eeprom,
1547 ops->get_eeprom_len(dev));
1548 }
1549
1550 static int ethtool_set_eeprom(struct net_device *dev, void __user *useraddr)
1551 {
1552 struct ethtool_eeprom eeprom;
1553 const struct ethtool_ops *ops = dev->ethtool_ops;
1554 void __user *userbuf = useraddr + sizeof(eeprom);
1555 u32 bytes_remaining;
1556 u8 *data;
1557 int ret = 0;
1558
1559 if (!ops->set_eeprom || !ops->get_eeprom_len ||
1560 !ops->get_eeprom_len(dev))
1561 return -EOPNOTSUPP;
1562
1563 if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
1564 return -EFAULT;
1565
1566 /* Check for wrap and zero */
1567 if (eeprom.offset + eeprom.len <= eeprom.offset)
1568 return -EINVAL;
1569
1570 /* Check for exceeding total eeprom len */
1571 if (eeprom.offset + eeprom.len > ops->get_eeprom_len(dev))
1572 return -EINVAL;
1573
1574 data = kmalloc(PAGE_SIZE, GFP_USER);
1575 if (!data)
1576 return -ENOMEM;
1577
1578 bytes_remaining = eeprom.len;
1579 while (bytes_remaining > 0) {
1580 eeprom.len = min(bytes_remaining, (u32)PAGE_SIZE);
1581
1582 if (copy_from_user(data, userbuf, eeprom.len)) {
1583 ret = -EFAULT;
1584 break;
1585 }
1586 ret = ops->set_eeprom(dev, &eeprom, data);
1587 if (ret)
1588 break;
1589 userbuf += eeprom.len;
1590 eeprom.offset += eeprom.len;
1591 bytes_remaining -= eeprom.len;
1592 }
1593
1594 kfree(data);
1595 return ret;
1596 }
1597
1598 static noinline_for_stack int ethtool_get_coalesce(struct net_device *dev,
1599 void __user *useraddr)
1600 {
1601 struct ethtool_coalesce coalesce = { .cmd = ETHTOOL_GCOALESCE };
1602
1603 if (!dev->ethtool_ops->get_coalesce)
1604 return -EOPNOTSUPP;
1605
1606 dev->ethtool_ops->get_coalesce(dev, &coalesce);
1607
1608 if (copy_to_user(useraddr, &coalesce, sizeof(coalesce)))
1609 return -EFAULT;
1610 return 0;
1611 }
1612
1613 static noinline_for_stack int ethtool_set_coalesce(struct net_device *dev,
1614 void __user *useraddr)
1615 {
1616 struct ethtool_coalesce coalesce;
1617
1618 if (!dev->ethtool_ops->set_coalesce)
1619 return -EOPNOTSUPP;
1620
1621 if (copy_from_user(&coalesce, useraddr, sizeof(coalesce)))
1622 return -EFAULT;
1623
1624 return dev->ethtool_ops->set_coalesce(dev, &coalesce);
1625 }
1626
1627 static int ethtool_get_ringparam(struct net_device *dev, void __user *useraddr)
1628 {
1629 struct ethtool_ringparam ringparam = { .cmd = ETHTOOL_GRINGPARAM };
1630
1631 if (!dev->ethtool_ops->get_ringparam)
1632 return -EOPNOTSUPP;
1633
1634 dev->ethtool_ops->get_ringparam(dev, &ringparam);
1635
1636 if (copy_to_user(useraddr, &ringparam, sizeof(ringparam)))
1637 return -EFAULT;
1638 return 0;
1639 }
1640
1641 static int ethtool_set_ringparam(struct net_device *dev, void __user *useraddr)
1642 {
1643 struct ethtool_ringparam ringparam, max = { .cmd = ETHTOOL_GRINGPARAM };
1644
1645 if (!dev->ethtool_ops->set_ringparam || !dev->ethtool_ops->get_ringparam)
1646 return -EOPNOTSUPP;
1647
1648 if (copy_from_user(&ringparam, useraddr, sizeof(ringparam)))
1649 return -EFAULT;
1650
1651 dev->ethtool_ops->get_ringparam(dev, &max);
1652
1653 /* ensure new ring parameters are within the maximums */
1654 if (ringparam.rx_pending > max.rx_max_pending ||
1655 ringparam.rx_mini_pending > max.rx_mini_max_pending ||
1656 ringparam.rx_jumbo_pending > max.rx_jumbo_max_pending ||
1657 ringparam.tx_pending > max.tx_max_pending)
1658 return -EINVAL;
1659
1660 return dev->ethtool_ops->set_ringparam(dev, &ringparam);
1661 }
1662
1663 static noinline_for_stack int ethtool_get_channels(struct net_device *dev,
1664 void __user *useraddr)
1665 {
1666 struct ethtool_channels channels = { .cmd = ETHTOOL_GCHANNELS };
1667
1668 if (!dev->ethtool_ops->get_channels)
1669 return -EOPNOTSUPP;
1670
1671 dev->ethtool_ops->get_channels(dev, &channels);
1672
1673 if (copy_to_user(useraddr, &channels, sizeof(channels)))
1674 return -EFAULT;
1675 return 0;
1676 }
1677
1678 static noinline_for_stack int ethtool_set_channels(struct net_device *dev,
1679 void __user *useraddr)
1680 {
1681 struct ethtool_channels channels, curr = { .cmd = ETHTOOL_GCHANNELS };
1682 u16 from_channel, to_channel;
1683 u32 max_rx_in_use = 0;
1684 unsigned int i;
1685
1686 if (!dev->ethtool_ops->set_channels || !dev->ethtool_ops->get_channels)
1687 return -EOPNOTSUPP;
1688
1689 if (copy_from_user(&channels, useraddr, sizeof(channels)))
1690 return -EFAULT;
1691
1692 dev->ethtool_ops->get_channels(dev, &curr);
1693
1694 /* ensure new counts are within the maximums */
1695 if (channels.rx_count > curr.max_rx ||
1696 channels.tx_count > curr.max_tx ||
1697 channels.combined_count > curr.max_combined ||
1698 channels.other_count > curr.max_other)
1699 return -EINVAL;
1700
1701 /* ensure the new Rx count fits within the configured Rx flow
1702 * indirection table settings */
1703 if (netif_is_rxfh_configured(dev) &&
1704 !ethtool_get_max_rxfh_channel(dev, &max_rx_in_use) &&
1705 (channels.combined_count + channels.rx_count) <= max_rx_in_use)
1706 return -EINVAL;
1707
1708 /* Disabling channels, query zero-copy AF_XDP sockets */
1709 from_channel = channels.combined_count +
1710 min(channels.rx_count, channels.tx_count);
1711 to_channel = curr.combined_count + max(curr.rx_count, curr.tx_count);
1712 for (i = from_channel; i < to_channel; i++)
1713 if (xdp_get_umem_from_qid(dev, i))
1714 return -EINVAL;
1715
1716 return dev->ethtool_ops->set_channels(dev, &channels);
1717 }
1718
1719 static int ethtool_get_pauseparam(struct net_device *dev, void __user *useraddr)
1720 {
1721 struct ethtool_pauseparam pauseparam = { .cmd = ETHTOOL_GPAUSEPARAM };
1722
1723 if (!dev->ethtool_ops->get_pauseparam)
1724 return -EOPNOTSUPP;
1725
1726 dev->ethtool_ops->get_pauseparam(dev, &pauseparam);
1727
1728 if (copy_to_user(useraddr, &pauseparam, sizeof(pauseparam)))
1729 return -EFAULT;
1730 return 0;
1731 }
1732
1733 static int ethtool_set_pauseparam(struct net_device *dev, void __user *useraddr)
1734 {
1735 struct ethtool_pauseparam pauseparam;
1736
1737 if (!dev->ethtool_ops->set_pauseparam)
1738 return -EOPNOTSUPP;
1739
1740 if (copy_from_user(&pauseparam, useraddr, sizeof(pauseparam)))
1741 return -EFAULT;
1742
1743 return dev->ethtool_ops->set_pauseparam(dev, &pauseparam);
1744 }
1745
1746 static int ethtool_self_test(struct net_device *dev, char __user *useraddr)
1747 {
1748 struct ethtool_test test;
1749 const struct ethtool_ops *ops = dev->ethtool_ops;
1750 u64 *data;
1751 int ret, test_len;
1752
1753 if (!ops->self_test || !ops->get_sset_count)
1754 return -EOPNOTSUPP;
1755
1756 test_len = ops->get_sset_count(dev, ETH_SS_TEST);
1757 if (test_len < 0)
1758 return test_len;
1759 WARN_ON(test_len == 0);
1760
1761 if (copy_from_user(&test, useraddr, sizeof(test)))
1762 return -EFAULT;
1763
1764 test.len = test_len;
1765 data = kmalloc_array(test_len, sizeof(u64), GFP_USER);
1766 if (!data)
1767 return -ENOMEM;
1768
1769 ops->self_test(dev, &test, data);
1770
1771 ret = -EFAULT;
1772 if (copy_to_user(useraddr, &test, sizeof(test)))
1773 goto out;
1774 useraddr += sizeof(test);
1775 if (copy_to_user(useraddr, data, test.len * sizeof(u64)))
1776 goto out;
1777 ret = 0;
1778
1779 out:
1780 kfree(data);
1781 return ret;
1782 }
1783
1784 static int ethtool_get_strings(struct net_device *dev, void __user *useraddr)
1785 {
1786 struct ethtool_gstrings gstrings;
1787 u8 *data;
1788 int ret;
1789
1790 if (copy_from_user(&gstrings, useraddr, sizeof(gstrings)))
1791 return -EFAULT;
1792
1793 ret = __ethtool_get_sset_count(dev, gstrings.string_set);
1794 if (ret < 0)
1795 return ret;
1796 if (ret > S32_MAX / ETH_GSTRING_LEN)
1797 return -ENOMEM;
1798 WARN_ON_ONCE(!ret);
1799
1800 gstrings.len = ret;
1801
1802 if (gstrings.len) {
1803 data = vzalloc(array_size(gstrings.len, ETH_GSTRING_LEN));
1804 if (!data)
1805 return -ENOMEM;
1806
1807 __ethtool_get_strings(dev, gstrings.string_set, data);
1808 } else {
1809 data = NULL;
1810 }
1811
1812 ret = -EFAULT;
1813 if (copy_to_user(useraddr, &gstrings, sizeof(gstrings)))
1814 goto out;
1815 useraddr += sizeof(gstrings);
1816 if (gstrings.len &&
1817 copy_to_user(useraddr, data, gstrings.len * ETH_GSTRING_LEN))
1818 goto out;
1819 ret = 0;
1820
1821 out:
1822 vfree(data);
1823 return ret;
1824 }
1825
1826 static int ethtool_phys_id(struct net_device *dev, void __user *useraddr)
1827 {
1828 struct ethtool_value id;
1829 static bool busy;
1830 const struct ethtool_ops *ops = dev->ethtool_ops;
1831 int rc;
1832
1833 if (!ops->set_phys_id)
1834 return -EOPNOTSUPP;
1835
1836 if (busy)
1837 return -EBUSY;
1838
1839 if (copy_from_user(&id, useraddr, sizeof(id)))
1840 return -EFAULT;
1841
1842 rc = ops->set_phys_id(dev, ETHTOOL_ID_ACTIVE);
1843 if (rc < 0)
1844 return rc;
1845
1846 /* Drop the RTNL lock while waiting, but prevent reentry or
1847 * removal of the device.
1848 */
1849 busy = true;
1850 dev_hold(dev);
1851 rtnl_unlock();
1852
1853 if (rc == 0) {
1854 /* Driver will handle this itself */
1855 schedule_timeout_interruptible(
1856 id.data ? (id.data * HZ) : MAX_SCHEDULE_TIMEOUT);
1857 } else {
1858 /* Driver expects to be called at twice the frequency in rc */
1859 int n = rc * 2, i, interval = HZ / n;
1860
1861 /* Count down seconds */
1862 do {
1863 /* Count down iterations per second */
1864 i = n;
1865 do {
1866 rtnl_lock();
1867 rc = ops->set_phys_id(dev,
1868 (i & 1) ? ETHTOOL_ID_OFF : ETHTOOL_ID_ON);
1869 rtnl_unlock();
1870 if (rc)
1871 break;
1872 schedule_timeout_interruptible(interval);
1873 } while (!signal_pending(current) && --i != 0);
1874 } while (!signal_pending(current) &&
1875 (id.data == 0 || --id.data != 0));
1876 }
1877
1878 rtnl_lock();
1879 dev_put(dev);
1880 busy = false;
1881
1882 (void) ops->set_phys_id(dev, ETHTOOL_ID_INACTIVE);
1883 return rc;
1884 }
1885
1886 static int ethtool_get_stats(struct net_device *dev, void __user *useraddr)
1887 {
1888 struct ethtool_stats stats;
1889 const struct ethtool_ops *ops = dev->ethtool_ops;
1890 u64 *data;
1891 int ret, n_stats;
1892
1893 if (!ops->get_ethtool_stats || !ops->get_sset_count)
1894 return -EOPNOTSUPP;
1895
1896 n_stats = ops->get_sset_count(dev, ETH_SS_STATS);
1897 if (n_stats < 0)
1898 return n_stats;
1899 if (n_stats > S32_MAX / sizeof(u64))
1900 return -ENOMEM;
1901 WARN_ON_ONCE(!n_stats);
1902 if (copy_from_user(&stats, useraddr, sizeof(stats)))
1903 return -EFAULT;
1904
1905 stats.n_stats = n_stats;
1906
1907 if (n_stats) {
1908 data = vzalloc(array_size(n_stats, sizeof(u64)));
1909 if (!data)
1910 return -ENOMEM;
1911 ops->get_ethtool_stats(dev, &stats, data);
1912 } else {
1913 data = NULL;
1914 }
1915
1916 ret = -EFAULT;
1917 if (copy_to_user(useraddr, &stats, sizeof(stats)))
1918 goto out;
1919 useraddr += sizeof(stats);
1920 if (n_stats && copy_to_user(useraddr, data, n_stats * sizeof(u64)))
1921 goto out;
1922 ret = 0;
1923
1924 out:
1925 vfree(data);
1926 return ret;
1927 }
1928
1929 static int ethtool_get_phy_stats(struct net_device *dev, void __user *useraddr)
1930 {
1931 const struct ethtool_ops *ops = dev->ethtool_ops;
1932 struct phy_device *phydev = dev->phydev;
1933 struct ethtool_stats stats;
1934 u64 *data;
1935 int ret, n_stats;
1936
1937 if (!phydev && (!ops->get_ethtool_phy_stats || !ops->get_sset_count))
1938 return -EOPNOTSUPP;
1939
1940 if (dev->phydev && !ops->get_ethtool_phy_stats)
1941 n_stats = phy_ethtool_get_sset_count(dev->phydev);
1942 else
1943 n_stats = ops->get_sset_count(dev, ETH_SS_PHY_STATS);
1944 if (n_stats < 0)
1945 return n_stats;
1946 if (n_stats > S32_MAX / sizeof(u64))
1947 return -ENOMEM;
1948 WARN_ON_ONCE(!n_stats);
1949
1950 if (copy_from_user(&stats, useraddr, sizeof(stats)))
1951 return -EFAULT;
1952
1953 stats.n_stats = n_stats;
1954
1955 if (n_stats) {
1956 data = vzalloc(array_size(n_stats, sizeof(u64)));
1957 if (!data)
1958 return -ENOMEM;
1959
1960 if (dev->phydev && !ops->get_ethtool_phy_stats) {
1961 ret = phy_ethtool_get_stats(dev->phydev, &stats, data);
1962 if (ret < 0)
1963 goto out;
1964 } else {
1965 ops->get_ethtool_phy_stats(dev, &stats, data);
1966 }
1967 } else {
1968 data = NULL;
1969 }
1970
1971 ret = -EFAULT;
1972 if (copy_to_user(useraddr, &stats, sizeof(stats)))
1973 goto out;
1974 useraddr += sizeof(stats);
1975 if (n_stats && copy_to_user(useraddr, data, n_stats * sizeof(u64)))
1976 goto out;
1977 ret = 0;
1978
1979 out:
1980 vfree(data);
1981 return ret;
1982 }
1983
1984 static int ethtool_get_perm_addr(struct net_device *dev, void __user *useraddr)
1985 {
1986 struct ethtool_perm_addr epaddr;
1987
1988 if (copy_from_user(&epaddr, useraddr, sizeof(epaddr)))
1989 return -EFAULT;
1990
1991 if (epaddr.size < dev->addr_len)
1992 return -ETOOSMALL;
1993 epaddr.size = dev->addr_len;
1994
1995 if (copy_to_user(useraddr, &epaddr, sizeof(epaddr)))
1996 return -EFAULT;
1997 useraddr += sizeof(epaddr);
1998 if (copy_to_user(useraddr, dev->perm_addr, epaddr.size))
1999 return -EFAULT;
2000 return 0;
2001 }
2002
2003 static int ethtool_get_value(struct net_device *dev, char __user *useraddr,
2004 u32 cmd, u32 (*actor)(struct net_device *))
2005 {
2006 struct ethtool_value edata = { .cmd = cmd };
2007
2008 if (!actor)
2009 return -EOPNOTSUPP;
2010
2011 edata.data = actor(dev);
2012
2013 if (copy_to_user(useraddr, &edata, sizeof(edata)))
2014 return -EFAULT;
2015 return 0;
2016 }
2017
2018 static int ethtool_set_value_void(struct net_device *dev, char __user *useraddr,
2019 void (*actor)(struct net_device *, u32))
2020 {
2021 struct ethtool_value edata;
2022
2023 if (!actor)
2024 return -EOPNOTSUPP;
2025
2026 if (copy_from_user(&edata, useraddr, sizeof(edata)))
2027 return -EFAULT;
2028
2029 actor(dev, edata.data);
2030 return 0;
2031 }
2032
2033 static int ethtool_set_value(struct net_device *dev, char __user *useraddr,
2034 int (*actor)(struct net_device *, u32))
2035 {
2036 struct ethtool_value edata;
2037
2038 if (!actor)
2039 return -EOPNOTSUPP;
2040
2041 if (copy_from_user(&edata, useraddr, sizeof(edata)))
2042 return -EFAULT;
2043
2044 return actor(dev, edata.data);
2045 }
2046
2047 static noinline_for_stack int ethtool_flash_device(struct net_device *dev,
2048 char __user *useraddr)
2049 {
2050 struct ethtool_flash efl;
2051
2052 if (copy_from_user(&efl, useraddr, sizeof(efl)))
2053 return -EFAULT;
2054 efl.data[ETHTOOL_FLASH_MAX_FILENAME - 1] = 0;
2055
2056 if (!dev->ethtool_ops->flash_device)
2057 return devlink_compat_flash_update(dev, efl.data);
2058
2059 return dev->ethtool_ops->flash_device(dev, &efl);
2060 }
2061
2062 static int ethtool_set_dump(struct net_device *dev,
2063 void __user *useraddr)
2064 {
2065 struct ethtool_dump dump;
2066
2067 if (!dev->ethtool_ops->set_dump)
2068 return -EOPNOTSUPP;
2069
2070 if (copy_from_user(&dump, useraddr, sizeof(dump)))
2071 return -EFAULT;
2072
2073 return dev->ethtool_ops->set_dump(dev, &dump);
2074 }
2075
2076 static int ethtool_get_dump_flag(struct net_device *dev,
2077 void __user *useraddr)
2078 {
2079 int ret;
2080 struct ethtool_dump dump;
2081 const struct ethtool_ops *ops = dev->ethtool_ops;
2082
2083 if (!ops->get_dump_flag)
2084 return -EOPNOTSUPP;
2085
2086 if (copy_from_user(&dump, useraddr, sizeof(dump)))
2087 return -EFAULT;
2088
2089 ret = ops->get_dump_flag(dev, &dump);
2090 if (ret)
2091 return ret;
2092
2093 if (copy_to_user(useraddr, &dump, sizeof(dump)))
2094 return -EFAULT;
2095 return 0;
2096 }
2097
2098 static int ethtool_get_dump_data(struct net_device *dev,
2099 void __user *useraddr)
2100 {
2101 int ret;
2102 __u32 len;
2103 struct ethtool_dump dump, tmp;
2104 const struct ethtool_ops *ops = dev->ethtool_ops;
2105 void *data = NULL;
2106
2107 if (!ops->get_dump_data || !ops->get_dump_flag)
2108 return -EOPNOTSUPP;
2109
2110 if (copy_from_user(&dump, useraddr, sizeof(dump)))
2111 return -EFAULT;
2112
2113 memset(&tmp, 0, sizeof(tmp));
2114 tmp.cmd = ETHTOOL_GET_DUMP_FLAG;
2115 ret = ops->get_dump_flag(dev, &tmp);
2116 if (ret)
2117 return ret;
2118
2119 len = min(tmp.len, dump.len);
2120 if (!len)
2121 return -EFAULT;
2122
2123 /* Don't ever let the driver think there's more space available
2124 * than it requested with .get_dump_flag().
2125 */
2126 dump.len = len;
2127
2128 /* Always allocate enough space to hold the whole thing so that the
2129 * driver does not need to check the length and bother with partial
2130 * dumping.
2131 */
2132 data = vzalloc(tmp.len);
2133 if (!data)
2134 return -ENOMEM;
2135 ret = ops->get_dump_data(dev, &dump, data);
2136 if (ret)
2137 goto out;
2138
2139 /* There are two sane possibilities:
2140 * 1. The driver's .get_dump_data() does not touch dump.len.
2141 * 2. Or it may set dump.len to how much it really writes, which
2142 * should be tmp.len (or len if it can do a partial dump).
2143 * In any case respond to userspace with the actual length of data
2144 * it's receiving.
2145 */
2146 WARN_ON(dump.len != len && dump.len != tmp.len);
2147 dump.len = len;
2148
2149 if (copy_to_user(useraddr, &dump, sizeof(dump))) {
2150 ret = -EFAULT;
2151 goto out;
2152 }
2153 useraddr += offsetof(struct ethtool_dump, data);
2154 if (copy_to_user(useraddr, data, len))
2155 ret = -EFAULT;
2156 out:
2157 vfree(data);
2158 return ret;
2159 }
2160
2161 static int ethtool_get_ts_info(struct net_device *dev, void __user *useraddr)
2162 {
2163 int err = 0;
2164 struct ethtool_ts_info info;
2165 const struct ethtool_ops *ops = dev->ethtool_ops;
2166 struct phy_device *phydev = dev->phydev;
2167
2168 memset(&info, 0, sizeof(info));
2169 info.cmd = ETHTOOL_GET_TS_INFO;
2170
2171 if (phydev && phydev->drv && phydev->drv->ts_info) {
2172 err = phydev->drv->ts_info(phydev, &info);
2173 } else if (ops->get_ts_info) {
2174 err = ops->get_ts_info(dev, &info);
2175 } else {
2176 info.so_timestamping =
2177 SOF_TIMESTAMPING_RX_SOFTWARE |
2178 SOF_TIMESTAMPING_SOFTWARE;
2179 info.phc_index = -1;
2180 }
2181
2182 if (err)
2183 return err;
2184
2185 if (copy_to_user(useraddr, &info, sizeof(info)))
2186 err = -EFAULT;
2187
2188 return err;
2189 }
2190
2191 static int __ethtool_get_module_info(struct net_device *dev,
2192 struct ethtool_modinfo *modinfo)
2193 {
2194 const struct ethtool_ops *ops = dev->ethtool_ops;
2195 struct phy_device *phydev = dev->phydev;
2196
2197 if (dev->sfp_bus)
2198 return sfp_get_module_info(dev->sfp_bus, modinfo);
2199
2200 if (phydev && phydev->drv && phydev->drv->module_info)
2201 return phydev->drv->module_info(phydev, modinfo);
2202
2203 if (ops->get_module_info)
2204 return ops->get_module_info(dev, modinfo);
2205
2206 return -EOPNOTSUPP;
2207 }
2208
2209 static int ethtool_get_module_info(struct net_device *dev,
2210 void __user *useraddr)
2211 {
2212 int ret;
2213 struct ethtool_modinfo modinfo;
2214
2215 if (copy_from_user(&modinfo, useraddr, sizeof(modinfo)))
2216 return -EFAULT;
2217
2218 ret = __ethtool_get_module_info(dev, &modinfo);
2219 if (ret)
2220 return ret;
2221
2222 if (copy_to_user(useraddr, &modinfo, sizeof(modinfo)))
2223 return -EFAULT;
2224
2225 return 0;
2226 }
2227
2228 static int __ethtool_get_module_eeprom(struct net_device *dev,
2229 struct ethtool_eeprom *ee, u8 *data)
2230 {
2231 const struct ethtool_ops *ops = dev->ethtool_ops;
2232 struct phy_device *phydev = dev->phydev;
2233
2234 if (dev->sfp_bus)
2235 return sfp_get_module_eeprom(dev->sfp_bus, ee, data);
2236
2237 if (phydev && phydev->drv && phydev->drv->module_eeprom)
2238 return phydev->drv->module_eeprom(phydev, ee, data);
2239
2240 if (ops->get_module_eeprom)
2241 return ops->get_module_eeprom(dev, ee, data);
2242
2243 return -EOPNOTSUPP;
2244 }
2245
2246 static int ethtool_get_module_eeprom(struct net_device *dev,
2247 void __user *useraddr)
2248 {
2249 int ret;
2250 struct ethtool_modinfo modinfo;
2251
2252 ret = __ethtool_get_module_info(dev, &modinfo);
2253 if (ret)
2254 return ret;
2255
2256 return ethtool_get_any_eeprom(dev, useraddr,
2257 __ethtool_get_module_eeprom,
2258 modinfo.eeprom_len);
2259 }
2260
2261 static int ethtool_tunable_valid(const struct ethtool_tunable *tuna)
2262 {
2263 switch (tuna->id) {
2264 case ETHTOOL_RX_COPYBREAK:
2265 case ETHTOOL_TX_COPYBREAK:
2266 if (tuna->len != sizeof(u32) ||
2267 tuna->type_id != ETHTOOL_TUNABLE_U32)
2268 return -EINVAL;
2269 break;
2270 case ETHTOOL_PFC_PREVENTION_TOUT:
2271 if (tuna->len != sizeof(u16) ||
2272 tuna->type_id != ETHTOOL_TUNABLE_U16)
2273 return -EINVAL;
2274 break;
2275 default:
2276 return -EINVAL;
2277 }
2278
2279 return 0;
2280 }
2281
2282 static int ethtool_get_tunable(struct net_device *dev, void __user *useraddr)
2283 {
2284 int ret;
2285 struct ethtool_tunable tuna;
2286 const struct ethtool_ops *ops = dev->ethtool_ops;
2287 void *data;
2288
2289 if (!ops->get_tunable)
2290 return -EOPNOTSUPP;
2291 if (copy_from_user(&tuna, useraddr, sizeof(tuna)))
2292 return -EFAULT;
2293 ret = ethtool_tunable_valid(&tuna);
2294 if (ret)
2295 return ret;
2296 data = kmalloc(tuna.len, GFP_USER);
2297 if (!data)
2298 return -ENOMEM;
2299 ret = ops->get_tunable(dev, &tuna, data);
2300 if (ret)
2301 goto out;
2302 useraddr += sizeof(tuna);
2303 ret = -EFAULT;
2304 if (copy_to_user(useraddr, data, tuna.len))
2305 goto out;
2306 ret = 0;
2307
2308 out:
2309 kfree(data);
2310 return ret;
2311 }
2312
2313 static int ethtool_set_tunable(struct net_device *dev, void __user *useraddr)
2314 {
2315 int ret;
2316 struct ethtool_tunable tuna;
2317 const struct ethtool_ops *ops = dev->ethtool_ops;
2318 void *data;
2319
2320 if (!ops->set_tunable)
2321 return -EOPNOTSUPP;
2322 if (copy_from_user(&tuna, useraddr, sizeof(tuna)))
2323 return -EFAULT;
2324 ret = ethtool_tunable_valid(&tuna);
2325 if (ret)
2326 return ret;
2327 useraddr += sizeof(tuna);
2328 data = memdup_user(useraddr, tuna.len);
2329 if (IS_ERR(data))
2330 return PTR_ERR(data);
2331 ret = ops->set_tunable(dev, &tuna, data);
2332
2333 kfree(data);
2334 return ret;
2335 }
2336
2337 static noinline_for_stack int
2338 ethtool_get_per_queue_coalesce(struct net_device *dev,
2339 void __user *useraddr,
2340 struct ethtool_per_queue_op *per_queue_opt)
2341 {
2342 u32 bit;
2343 int ret;
2344 DECLARE_BITMAP(queue_mask, MAX_NUM_QUEUE);
2345
2346 if (!dev->ethtool_ops->get_per_queue_coalesce)
2347 return -EOPNOTSUPP;
2348
2349 useraddr += sizeof(*per_queue_opt);
2350
2351 bitmap_from_arr32(queue_mask, per_queue_opt->queue_mask,
2352 MAX_NUM_QUEUE);
2353
2354 for_each_set_bit(bit, queue_mask, MAX_NUM_QUEUE) {
2355 struct ethtool_coalesce coalesce = { .cmd = ETHTOOL_GCOALESCE };
2356
2357 ret = dev->ethtool_ops->get_per_queue_coalesce(dev, bit, &coalesce);
2358 if (ret != 0)
2359 return ret;
2360 if (copy_to_user(useraddr, &coalesce, sizeof(coalesce)))
2361 return -EFAULT;
2362 useraddr += sizeof(coalesce);
2363 }
2364
2365 return 0;
2366 }
2367
2368 static noinline_for_stack int
2369 ethtool_set_per_queue_coalesce(struct net_device *dev,
2370 void __user *useraddr,
2371 struct ethtool_per_queue_op *per_queue_opt)
2372 {
2373 u32 bit;
2374 int i, ret = 0;
2375 int n_queue;
2376 struct ethtool_coalesce *backup = NULL, *tmp = NULL;
2377 DECLARE_BITMAP(queue_mask, MAX_NUM_QUEUE);
2378
2379 if ((!dev->ethtool_ops->set_per_queue_coalesce) ||
2380 (!dev->ethtool_ops->get_per_queue_coalesce))
2381 return -EOPNOTSUPP;
2382
2383 useraddr += sizeof(*per_queue_opt);
2384
2385 bitmap_from_arr32(queue_mask, per_queue_opt->queue_mask, MAX_NUM_QUEUE);
2386 n_queue = bitmap_weight(queue_mask, MAX_NUM_QUEUE);
2387 tmp = backup = kmalloc_array(n_queue, sizeof(*backup), GFP_KERNEL);
2388 if (!backup)
2389 return -ENOMEM;
2390
2391 for_each_set_bit(bit, queue_mask, MAX_NUM_QUEUE) {
2392 struct ethtool_coalesce coalesce;
2393
2394 ret = dev->ethtool_ops->get_per_queue_coalesce(dev, bit, tmp);
2395 if (ret != 0)
2396 goto roll_back;
2397
2398 tmp++;
2399
2400 if (copy_from_user(&coalesce, useraddr, sizeof(coalesce))) {
2401 ret = -EFAULT;
2402 goto roll_back;
2403 }
2404
2405 ret = dev->ethtool_ops->set_per_queue_coalesce(dev, bit, &coalesce);
2406 if (ret != 0)
2407 goto roll_back;
2408
2409 useraddr += sizeof(coalesce);
2410 }
2411
2412 roll_back:
2413 if (ret != 0) {
2414 tmp = backup;
2415 for_each_set_bit(i, queue_mask, bit) {
2416 dev->ethtool_ops->set_per_queue_coalesce(dev, i, tmp);
2417 tmp++;
2418 }
2419 }
2420 kfree(backup);
2421
2422 return ret;
2423 }
2424
2425 static int noinline_for_stack ethtool_set_per_queue(struct net_device *dev,
2426 void __user *useraddr, u32 sub_cmd)
2427 {
2428 struct ethtool_per_queue_op per_queue_opt;
2429
2430 if (copy_from_user(&per_queue_opt, useraddr, sizeof(per_queue_opt)))
2431 return -EFAULT;
2432
2433 if (per_queue_opt.sub_command != sub_cmd)
2434 return -EINVAL;
2435
2436 switch (per_queue_opt.sub_command) {
2437 case ETHTOOL_GCOALESCE:
2438 return ethtool_get_per_queue_coalesce(dev, useraddr, &per_queue_opt);
2439 case ETHTOOL_SCOALESCE:
2440 return ethtool_set_per_queue_coalesce(dev, useraddr, &per_queue_opt);
2441 default:
2442 return -EOPNOTSUPP;
2443 };
2444 }
2445
2446 static int ethtool_phy_tunable_valid(const struct ethtool_tunable *tuna)
2447 {
2448 switch (tuna->id) {
2449 case ETHTOOL_PHY_DOWNSHIFT:
2450 case ETHTOOL_PHY_FAST_LINK_DOWN:
2451 if (tuna->len != sizeof(u8) ||
2452 tuna->type_id != ETHTOOL_TUNABLE_U8)
2453 return -EINVAL;
2454 break;
2455 default:
2456 return -EINVAL;
2457 }
2458
2459 return 0;
2460 }
2461
2462 static int get_phy_tunable(struct net_device *dev, void __user *useraddr)
2463 {
2464 int ret;
2465 struct ethtool_tunable tuna;
2466 struct phy_device *phydev = dev->phydev;
2467 void *data;
2468
2469 if (!(phydev && phydev->drv && phydev->drv->get_tunable))
2470 return -EOPNOTSUPP;
2471
2472 if (copy_from_user(&tuna, useraddr, sizeof(tuna)))
2473 return -EFAULT;
2474 ret = ethtool_phy_tunable_valid(&tuna);
2475 if (ret)
2476 return ret;
2477 data = kmalloc(tuna.len, GFP_USER);
2478 if (!data)
2479 return -ENOMEM;
2480 mutex_lock(&phydev->lock);
2481 ret = phydev->drv->get_tunable(phydev, &tuna, data);
2482 mutex_unlock(&phydev->lock);
2483 if (ret)
2484 goto out;
2485 useraddr += sizeof(tuna);
2486 ret = -EFAULT;
2487 if (copy_to_user(useraddr, data, tuna.len))
2488 goto out;
2489 ret = 0;
2490
2491 out:
2492 kfree(data);
2493 return ret;
2494 }
2495
2496 static int set_phy_tunable(struct net_device *dev, void __user *useraddr)
2497 {
2498 int ret;
2499 struct ethtool_tunable tuna;
2500 struct phy_device *phydev = dev->phydev;
2501 void *data;
2502
2503 if (!(phydev && phydev->drv && phydev->drv->set_tunable))
2504 return -EOPNOTSUPP;
2505 if (copy_from_user(&tuna, useraddr, sizeof(tuna)))
2506 return -EFAULT;
2507 ret = ethtool_phy_tunable_valid(&tuna);
2508 if (ret)
2509 return ret;
2510 useraddr += sizeof(tuna);
2511 data = memdup_user(useraddr, tuna.len);
2512 if (IS_ERR(data))
2513 return PTR_ERR(data);
2514 mutex_lock(&phydev->lock);
2515 ret = phydev->drv->set_tunable(phydev, &tuna, data);
2516 mutex_unlock(&phydev->lock);
2517
2518 kfree(data);
2519 return ret;
2520 }
2521
2522 static int ethtool_get_fecparam(struct net_device *dev, void __user *useraddr)
2523 {
2524 struct ethtool_fecparam fecparam = { .cmd = ETHTOOL_GFECPARAM };
2525 int rc;
2526
2527 if (!dev->ethtool_ops->get_fecparam)
2528 return -EOPNOTSUPP;
2529
2530 rc = dev->ethtool_ops->get_fecparam(dev, &fecparam);
2531 if (rc)
2532 return rc;
2533
2534 if (copy_to_user(useraddr, &fecparam, sizeof(fecparam)))
2535 return -EFAULT;
2536 return 0;
2537 }
2538
2539 static int ethtool_set_fecparam(struct net_device *dev, void __user *useraddr)
2540 {
2541 struct ethtool_fecparam fecparam;
2542
2543 if (!dev->ethtool_ops->set_fecparam)
2544 return -EOPNOTSUPP;
2545
2546 if (copy_from_user(&fecparam, useraddr, sizeof(fecparam)))
2547 return -EFAULT;
2548
2549 return dev->ethtool_ops->set_fecparam(dev, &fecparam);
2550 }
2551
2552 /* The main entry point in this file. Called from net/core/dev_ioctl.c */
2553
2554 int dev_ethtool(struct net *net, struct ifreq *ifr)
2555 {
2556 struct net_device *dev = __dev_get_by_name(net, ifr->ifr_name);
2557 void __user *useraddr = ifr->ifr_data;
2558 u32 ethcmd, sub_cmd;
2559 int rc;
2560 netdev_features_t old_features;
2561
2562 if (!dev || !netif_device_present(dev))
2563 return -ENODEV;
2564
2565 if (copy_from_user(&ethcmd, useraddr, sizeof(ethcmd)))
2566 return -EFAULT;
2567
2568 if (ethcmd == ETHTOOL_PERQUEUE) {
2569 if (copy_from_user(&sub_cmd, useraddr + sizeof(ethcmd), sizeof(sub_cmd)))
2570 return -EFAULT;
2571 } else {
2572 sub_cmd = ethcmd;
2573 }
2574 /* Allow some commands to be done by anyone */
2575 switch (sub_cmd) {
2576 case ETHTOOL_GSET:
2577 case ETHTOOL_GDRVINFO:
2578 case ETHTOOL_GMSGLVL:
2579 case ETHTOOL_GLINK:
2580 case ETHTOOL_GCOALESCE:
2581 case ETHTOOL_GRINGPARAM:
2582 case ETHTOOL_GPAUSEPARAM:
2583 case ETHTOOL_GRXCSUM:
2584 case ETHTOOL_GTXCSUM:
2585 case ETHTOOL_GSG:
2586 case ETHTOOL_GSSET_INFO:
2587 case ETHTOOL_GSTRINGS:
2588 case ETHTOOL_GSTATS:
2589 case ETHTOOL_GPHYSTATS:
2590 case ETHTOOL_GTSO:
2591 case ETHTOOL_GPERMADDR:
2592 case ETHTOOL_GUFO:
2593 case ETHTOOL_GGSO:
2594 case ETHTOOL_GGRO:
2595 case ETHTOOL_GFLAGS:
2596 case ETHTOOL_GPFLAGS:
2597 case ETHTOOL_GRXFH:
2598 case ETHTOOL_GRXRINGS:
2599 case ETHTOOL_GRXCLSRLCNT:
2600 case ETHTOOL_GRXCLSRULE:
2601 case ETHTOOL_GRXCLSRLALL:
2602 case ETHTOOL_GRXFHINDIR:
2603 case ETHTOOL_GRSSH:
2604 case ETHTOOL_GFEATURES:
2605 case ETHTOOL_GCHANNELS:
2606 case ETHTOOL_GET_TS_INFO:
2607 case ETHTOOL_GEEE:
2608 case ETHTOOL_GTUNABLE:
2609 case ETHTOOL_PHY_GTUNABLE:
2610 case ETHTOOL_GLINKSETTINGS:
2611 case ETHTOOL_GFECPARAM:
2612 break;
2613 default:
2614 if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
2615 return -EPERM;
2616 }
2617
2618 if (dev->ethtool_ops->begin) {
2619 rc = dev->ethtool_ops->begin(dev);
2620 if (rc < 0)
2621 return rc;
2622 }
2623 old_features = dev->features;
2624
2625 switch (ethcmd) {
2626 case ETHTOOL_GSET:
2627 rc = ethtool_get_settings(dev, useraddr);
2628 break;
2629 case ETHTOOL_SSET:
2630 rc = ethtool_set_settings(dev, useraddr);
2631 break;
2632 case ETHTOOL_GDRVINFO:
2633 rc = ethtool_get_drvinfo(dev, useraddr);
2634 break;
2635 case ETHTOOL_GREGS:
2636 rc = ethtool_get_regs(dev, useraddr);
2637 break;
2638 case ETHTOOL_GWOL:
2639 rc = ethtool_get_wol(dev, useraddr);
2640 break;
2641 case ETHTOOL_SWOL:
2642 rc = ethtool_set_wol(dev, useraddr);
2643 break;
2644 case ETHTOOL_GMSGLVL:
2645 rc = ethtool_get_value(dev, useraddr, ethcmd,
2646 dev->ethtool_ops->get_msglevel);
2647 break;
2648 case ETHTOOL_SMSGLVL:
2649 rc = ethtool_set_value_void(dev, useraddr,
2650 dev->ethtool_ops->set_msglevel);
2651 break;
2652 case ETHTOOL_GEEE:
2653 rc = ethtool_get_eee(dev, useraddr);
2654 break;
2655 case ETHTOOL_SEEE:
2656 rc = ethtool_set_eee(dev, useraddr);
2657 break;
2658 case ETHTOOL_NWAY_RST:
2659 rc = ethtool_nway_reset(dev);
2660 break;
2661 case ETHTOOL_GLINK:
2662 rc = ethtool_get_link(dev, useraddr);
2663 break;
2664 case ETHTOOL_GEEPROM:
2665 rc = ethtool_get_eeprom(dev, useraddr);
2666 break;
2667 case ETHTOOL_SEEPROM:
2668 rc = ethtool_set_eeprom(dev, useraddr);
2669 break;
2670 case ETHTOOL_GCOALESCE:
2671 rc = ethtool_get_coalesce(dev, useraddr);
2672 break;
2673 case ETHTOOL_SCOALESCE:
2674 rc = ethtool_set_coalesce(dev, useraddr);
2675 break;
2676 case ETHTOOL_GRINGPARAM:
2677 rc = ethtool_get_ringparam(dev, useraddr);
2678 break;
2679 case ETHTOOL_SRINGPARAM:
2680 rc = ethtool_set_ringparam(dev, useraddr);
2681 break;
2682 case ETHTOOL_GPAUSEPARAM:
2683 rc = ethtool_get_pauseparam(dev, useraddr);
2684 break;
2685 case ETHTOOL_SPAUSEPARAM:
2686 rc = ethtool_set_pauseparam(dev, useraddr);
2687 break;
2688 case ETHTOOL_TEST:
2689 rc = ethtool_self_test(dev, useraddr);
2690 break;
2691 case ETHTOOL_GSTRINGS:
2692 rc = ethtool_get_strings(dev, useraddr);
2693 break;
2694 case ETHTOOL_PHYS_ID:
2695 rc = ethtool_phys_id(dev, useraddr);
2696 break;
2697 case ETHTOOL_GSTATS:
2698 rc = ethtool_get_stats(dev, useraddr);
2699 break;
2700 case ETHTOOL_GPERMADDR:
2701 rc = ethtool_get_perm_addr(dev, useraddr);
2702 break;
2703 case ETHTOOL_GFLAGS:
2704 rc = ethtool_get_value(dev, useraddr, ethcmd,
2705 __ethtool_get_flags);
2706 break;
2707 case ETHTOOL_SFLAGS:
2708 rc = ethtool_set_value(dev, useraddr, __ethtool_set_flags);
2709 break;
2710 case ETHTOOL_GPFLAGS:
2711 rc = ethtool_get_value(dev, useraddr, ethcmd,
2712 dev->ethtool_ops->get_priv_flags);
2713 break;
2714 case ETHTOOL_SPFLAGS:
2715 rc = ethtool_set_value(dev, useraddr,
2716 dev->ethtool_ops->set_priv_flags);
2717 break;
2718 case ETHTOOL_GRXFH:
2719 case ETHTOOL_GRXRINGS:
2720 case ETHTOOL_GRXCLSRLCNT:
2721 case ETHTOOL_GRXCLSRULE:
2722 case ETHTOOL_GRXCLSRLALL:
2723 rc = ethtool_get_rxnfc(dev, ethcmd, useraddr);
2724 break;
2725 case ETHTOOL_SRXFH:
2726 case ETHTOOL_SRXCLSRLDEL:
2727 case ETHTOOL_SRXCLSRLINS:
2728 rc = ethtool_set_rxnfc(dev, ethcmd, useraddr);
2729 break;
2730 case ETHTOOL_FLASHDEV:
2731 rc = ethtool_flash_device(dev, useraddr);
2732 break;
2733 case ETHTOOL_RESET:
2734 rc = ethtool_reset(dev, useraddr);
2735 break;
2736 case ETHTOOL_GSSET_INFO:
2737 rc = ethtool_get_sset_info(dev, useraddr);
2738 break;
2739 case ETHTOOL_GRXFHINDIR:
2740 rc = ethtool_get_rxfh_indir(dev, useraddr);
2741 break;
2742 case ETHTOOL_SRXFHINDIR:
2743 rc = ethtool_set_rxfh_indir(dev, useraddr);
2744 break;
2745 case ETHTOOL_GRSSH:
2746 rc = ethtool_get_rxfh(dev, useraddr);
2747 break;
2748 case ETHTOOL_SRSSH:
2749 rc = ethtool_set_rxfh(dev, useraddr);
2750 break;
2751 case ETHTOOL_GFEATURES:
2752 rc = ethtool_get_features(dev, useraddr);
2753 break;
2754 case ETHTOOL_SFEATURES:
2755 rc = ethtool_set_features(dev, useraddr);
2756 break;
2757 case ETHTOOL_GTXCSUM:
2758 case ETHTOOL_GRXCSUM:
2759 case ETHTOOL_GSG:
2760 case ETHTOOL_GTSO:
2761 case ETHTOOL_GGSO:
2762 case ETHTOOL_GGRO:
2763 rc = ethtool_get_one_feature(dev, useraddr, ethcmd);
2764 break;
2765 case ETHTOOL_STXCSUM:
2766 case ETHTOOL_SRXCSUM:
2767 case ETHTOOL_SSG:
2768 case ETHTOOL_STSO:
2769 case ETHTOOL_SGSO:
2770 case ETHTOOL_SGRO:
2771 rc = ethtool_set_one_feature(dev, useraddr, ethcmd);
2772 break;
2773 case ETHTOOL_GCHANNELS:
2774 rc = ethtool_get_channels(dev, useraddr);
2775 break;
2776 case ETHTOOL_SCHANNELS:
2777 rc = ethtool_set_channels(dev, useraddr);
2778 break;
2779 case ETHTOOL_SET_DUMP:
2780 rc = ethtool_set_dump(dev, useraddr);
2781 break;
2782 case ETHTOOL_GET_DUMP_FLAG:
2783 rc = ethtool_get_dump_flag(dev, useraddr);
2784 break;
2785 case ETHTOOL_GET_DUMP_DATA:
2786 rc = ethtool_get_dump_data(dev, useraddr);
2787 break;
2788 case ETHTOOL_GET_TS_INFO:
2789 rc = ethtool_get_ts_info(dev, useraddr);
2790 break;
2791 case ETHTOOL_GMODULEINFO:
2792 rc = ethtool_get_module_info(dev, useraddr);
2793 break;
2794 case ETHTOOL_GMODULEEEPROM:
2795 rc = ethtool_get_module_eeprom(dev, useraddr);
2796 break;
2797 case ETHTOOL_GTUNABLE:
2798 rc = ethtool_get_tunable(dev, useraddr);
2799 break;
2800 case ETHTOOL_STUNABLE:
2801 rc = ethtool_set_tunable(dev, useraddr);
2802 break;
2803 case ETHTOOL_GPHYSTATS:
2804 rc = ethtool_get_phy_stats(dev, useraddr);
2805 break;
2806 case ETHTOOL_PERQUEUE:
2807 rc = ethtool_set_per_queue(dev, useraddr, sub_cmd);
2808 break;
2809 case ETHTOOL_GLINKSETTINGS:
2810 rc = ethtool_get_link_ksettings(dev, useraddr);
2811 break;
2812 case ETHTOOL_SLINKSETTINGS:
2813 rc = ethtool_set_link_ksettings(dev, useraddr);
2814 break;
2815 case ETHTOOL_PHY_GTUNABLE:
2816 rc = get_phy_tunable(dev, useraddr);
2817 break;
2818 case ETHTOOL_PHY_STUNABLE:
2819 rc = set_phy_tunable(dev, useraddr);
2820 break;
2821 case ETHTOOL_GFECPARAM:
2822 rc = ethtool_get_fecparam(dev, useraddr);
2823 break;
2824 case ETHTOOL_SFECPARAM:
2825 rc = ethtool_set_fecparam(dev, useraddr);
2826 break;
2827 default:
2828 rc = -EOPNOTSUPP;
2829 }
2830
2831 if (dev->ethtool_ops->complete)
2832 dev->ethtool_ops->complete(dev);
2833
2834 if (old_features != dev->features)
2835 netdev_features_change(dev);
2836
2837 return rc;
2838 }
2839
2840 struct ethtool_rx_flow_key {
2841 struct flow_dissector_key_basic basic;
2842 union {
2843 struct flow_dissector_key_ipv4_addrs ipv4;
2844 struct flow_dissector_key_ipv6_addrs ipv6;
2845 };
2846 struct flow_dissector_key_ports tp;
2847 struct flow_dissector_key_ip ip;
2848 struct flow_dissector_key_vlan vlan;
2849 struct flow_dissector_key_eth_addrs eth_addrs;
2850 } __aligned(BITS_PER_LONG / 8); /* Ensure that we can do comparisons as longs. */
2851
2852 struct ethtool_rx_flow_match {
2853 struct flow_dissector dissector;
2854 struct ethtool_rx_flow_key key;
2855 struct ethtool_rx_flow_key mask;
2856 };
2857
2858 struct ethtool_rx_flow_rule *
2859 ethtool_rx_flow_rule_create(const struct ethtool_rx_flow_spec_input *input)
2860 {
2861 const struct ethtool_rx_flow_spec *fs = input->fs;
2862 static struct in6_addr zero_addr = {};
2863 struct ethtool_rx_flow_match *match;
2864 struct ethtool_rx_flow_rule *flow;
2865 struct flow_action_entry *act;
2866
2867 flow = kzalloc(sizeof(struct ethtool_rx_flow_rule) +
2868 sizeof(struct ethtool_rx_flow_match), GFP_KERNEL);
2869 if (!flow)
2870 return ERR_PTR(-ENOMEM);
2871
2872 /* ethtool_rx supports only one single action per rule. */
2873 flow->rule = flow_rule_alloc(1);
2874 if (!flow->rule) {
2875 kfree(flow);
2876 return ERR_PTR(-ENOMEM);
2877 }
2878
2879 match = (struct ethtool_rx_flow_match *)flow->priv;
2880 flow->rule->match.dissector = &match->dissector;
2881 flow->rule->match.mask = &match->mask;
2882 flow->rule->match.key = &match->key;
2883
2884 match->mask.basic.n_proto = htons(0xffff);
2885
2886 switch (fs->flow_type & ~(FLOW_EXT | FLOW_MAC_EXT | FLOW_RSS)) {
2887 case TCP_V4_FLOW:
2888 case UDP_V4_FLOW: {
2889 const struct ethtool_tcpip4_spec *v4_spec, *v4_m_spec;
2890
2891 match->key.basic.n_proto = htons(ETH_P_IP);
2892
2893 v4_spec = &fs->h_u.tcp_ip4_spec;
2894 v4_m_spec = &fs->m_u.tcp_ip4_spec;
2895
2896 if (v4_m_spec->ip4src) {
2897 match->key.ipv4.src = v4_spec->ip4src;
2898 match->mask.ipv4.src = v4_m_spec->ip4src;
2899 }
2900 if (v4_m_spec->ip4dst) {
2901 match->key.ipv4.dst = v4_spec->ip4dst;
2902 match->mask.ipv4.dst = v4_m_spec->ip4dst;
2903 }
2904 if (v4_m_spec->ip4src ||
2905 v4_m_spec->ip4dst) {
2906 match->dissector.used_keys |=
2907 BIT(FLOW_DISSECTOR_KEY_IPV4_ADDRS);
2908 match->dissector.offset[FLOW_DISSECTOR_KEY_IPV4_ADDRS] =
2909 offsetof(struct ethtool_rx_flow_key, ipv4);
2910 }
2911 if (v4_m_spec->psrc) {
2912 match->key.tp.src = v4_spec->psrc;
2913 match->mask.tp.src = v4_m_spec->psrc;
2914 }
2915 if (v4_m_spec->pdst) {
2916 match->key.tp.dst = v4_spec->pdst;
2917 match->mask.tp.dst = v4_m_spec->pdst;
2918 }
2919 if (v4_m_spec->psrc ||
2920 v4_m_spec->pdst) {
2921 match->dissector.used_keys |=
2922 BIT(FLOW_DISSECTOR_KEY_PORTS);
2923 match->dissector.offset[FLOW_DISSECTOR_KEY_PORTS] =
2924 offsetof(struct ethtool_rx_flow_key, tp);
2925 }
2926 if (v4_m_spec->tos) {
2927 match->key.ip.tos = v4_spec->tos;
2928 match->mask.ip.tos = v4_m_spec->tos;
2929 match->dissector.used_keys |=
2930 BIT(FLOW_DISSECTOR_KEY_IP);
2931 match->dissector.offset[FLOW_DISSECTOR_KEY_IP] =
2932 offsetof(struct ethtool_rx_flow_key, ip);
2933 }
2934 }
2935 break;
2936 case TCP_V6_FLOW:
2937 case UDP_V6_FLOW: {
2938 const struct ethtool_tcpip6_spec *v6_spec, *v6_m_spec;
2939
2940 match->key.basic.n_proto = htons(ETH_P_IPV6);
2941
2942 v6_spec = &fs->h_u.tcp_ip6_spec;
2943 v6_m_spec = &fs->m_u.tcp_ip6_spec;
2944 if (memcmp(v6_m_spec->ip6src, &zero_addr, sizeof(zero_addr))) {
2945 memcpy(&match->key.ipv6.src, v6_spec->ip6src,
2946 sizeof(match->key.ipv6.src));
2947 memcpy(&match->mask.ipv6.src, v6_m_spec->ip6src,
2948 sizeof(match->mask.ipv6.src));
2949 }
2950 if (memcmp(v6_m_spec->ip6dst, &zero_addr, sizeof(zero_addr))) {
2951 memcpy(&match->key.ipv6.dst, v6_spec->ip6dst,
2952 sizeof(match->key.ipv6.dst));
2953 memcpy(&match->mask.ipv6.dst, v6_m_spec->ip6dst,
2954 sizeof(match->mask.ipv6.dst));
2955 }
2956 if (memcmp(v6_m_spec->ip6src, &zero_addr, sizeof(zero_addr)) ||
2957 memcmp(v6_m_spec->ip6src, &zero_addr, sizeof(zero_addr))) {
2958 match->dissector.used_keys |=
2959 BIT(FLOW_DISSECTOR_KEY_IPV6_ADDRS);
2960 match->dissector.offset[FLOW_DISSECTOR_KEY_IPV6_ADDRS] =
2961 offsetof(struct ethtool_rx_flow_key, ipv6);
2962 }
2963 if (v6_m_spec->psrc) {
2964 match->key.tp.src = v6_spec->psrc;
2965 match->mask.tp.src = v6_m_spec->psrc;
2966 }
2967 if (v6_m_spec->pdst) {
2968 match->key.tp.dst = v6_spec->pdst;
2969 match->mask.tp.dst = v6_m_spec->pdst;
2970 }
2971 if (v6_m_spec->psrc ||
2972 v6_m_spec->pdst) {
2973 match->dissector.used_keys |=
2974 BIT(FLOW_DISSECTOR_KEY_PORTS);
2975 match->dissector.offset[FLOW_DISSECTOR_KEY_PORTS] =
2976 offsetof(struct ethtool_rx_flow_key, tp);
2977 }
2978 if (v6_m_spec->tclass) {
2979 match->key.ip.tos = v6_spec->tclass;
2980 match->mask.ip.tos = v6_m_spec->tclass;
2981 match->dissector.used_keys |=
2982 BIT(FLOW_DISSECTOR_KEY_IP);
2983 match->dissector.offset[FLOW_DISSECTOR_KEY_IP] =
2984 offsetof(struct ethtool_rx_flow_key, ip);
2985 }
2986 }
2987 break;
2988 default:
2989 ethtool_rx_flow_rule_destroy(flow);
2990 return ERR_PTR(-EINVAL);
2991 }
2992
2993 switch (fs->flow_type & ~(FLOW_EXT | FLOW_MAC_EXT | FLOW_RSS)) {
2994 case TCP_V4_FLOW:
2995 case TCP_V6_FLOW:
2996 match->key.basic.ip_proto = IPPROTO_TCP;
2997 break;
2998 case UDP_V4_FLOW:
2999 case UDP_V6_FLOW:
3000 match->key.basic.ip_proto = IPPROTO_UDP;
3001 break;
3002 }
3003 match->mask.basic.ip_proto = 0xff;
3004
3005 match->dissector.used_keys |= BIT(FLOW_DISSECTOR_KEY_BASIC);
3006 match->dissector.offset[FLOW_DISSECTOR_KEY_BASIC] =
3007 offsetof(struct ethtool_rx_flow_key, basic);
3008
3009 if (fs->flow_type & FLOW_EXT) {
3010 const struct ethtool_flow_ext *ext_h_spec = &fs->h_ext;
3011 const struct ethtool_flow_ext *ext_m_spec = &fs->m_ext;
3012
3013 if (ext_m_spec->vlan_etype) {
3014 match->key.vlan.vlan_tpid = ext_h_spec->vlan_etype;
3015 match->mask.vlan.vlan_tpid = ext_m_spec->vlan_etype;
3016 }
3017
3018 if (ext_m_spec->vlan_tci) {
3019 match->key.vlan.vlan_id =
3020 ntohs(ext_h_spec->vlan_tci) & 0x0fff;
3021 match->mask.vlan.vlan_id =
3022 ntohs(ext_m_spec->vlan_tci) & 0x0fff;
3023
3024 match->key.vlan.vlan_priority =
3025 (ntohs(ext_h_spec->vlan_tci) & 0xe000) >> 13;
3026 match->mask.vlan.vlan_priority =
3027 (ntohs(ext_m_spec->vlan_tci) & 0xe000) >> 13;
3028 }
3029
3030 if (ext_m_spec->vlan_etype ||
3031 ext_m_spec->vlan_tci) {
3032 match->dissector.used_keys |=
3033 BIT(FLOW_DISSECTOR_KEY_VLAN);
3034 match->dissector.offset[FLOW_DISSECTOR_KEY_VLAN] =
3035 offsetof(struct ethtool_rx_flow_key, vlan);
3036 }
3037 }
3038 if (fs->flow_type & FLOW_MAC_EXT) {
3039 const struct ethtool_flow_ext *ext_h_spec = &fs->h_ext;
3040 const struct ethtool_flow_ext *ext_m_spec = &fs->m_ext;
3041
3042 memcpy(match->key.eth_addrs.dst, ext_h_spec->h_dest,
3043 ETH_ALEN);
3044 memcpy(match->mask.eth_addrs.dst, ext_m_spec->h_dest,
3045 ETH_ALEN);
3046
3047 match->dissector.used_keys |=
3048 BIT(FLOW_DISSECTOR_KEY_ETH_ADDRS);
3049 match->dissector.offset[FLOW_DISSECTOR_KEY_ETH_ADDRS] =
3050 offsetof(struct ethtool_rx_flow_key, eth_addrs);
3051 }
3052
3053 act = &flow->rule->action.entries[0];
3054 switch (fs->ring_cookie) {
3055 case RX_CLS_FLOW_DISC:
3056 act->id = FLOW_ACTION_DROP;
3057 break;
3058 case RX_CLS_FLOW_WAKE:
3059 act->id = FLOW_ACTION_WAKE;
3060 break;
3061 default:
3062 act->id = FLOW_ACTION_QUEUE;
3063 if (fs->flow_type & FLOW_RSS)
3064 act->queue.ctx = input->rss_ctx;
3065
3066 act->queue.vf = ethtool_get_flow_spec_ring_vf(fs->ring_cookie);
3067 act->queue.index = ethtool_get_flow_spec_ring(fs->ring_cookie);
3068 break;
3069 }
3070
3071 return flow;
3072 }
3073 EXPORT_SYMBOL(ethtool_rx_flow_rule_create);
3074
3075 void ethtool_rx_flow_rule_destroy(struct ethtool_rx_flow_rule *flow)
3076 {
3077 kfree(flow->rule);
3078 kfree(flow);
3079 }
3080 EXPORT_SYMBOL(ethtool_rx_flow_rule_destroy);
Ubuntu Jammy Linux kernel mirror