1
2
3
4
5
6
7
8
9
10
11
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/slab.h>
26#include <linux/rtnetlink.h>
27#include <linux/sched.h>
28#include <linux/net.h>
29
30
31
32
33
34
35
36u32 ethtool_op_get_link(struct net_device *dev)
37{
38 return netif_carrier_ok(dev) ? 1 : 0;
39}
40EXPORT_SYMBOL(ethtool_op_get_link);
41
42int ethtool_op_get_ts_info(struct net_device *dev, struct ethtool_ts_info *info)
43{
44 info->so_timestamping =
45 SOF_TIMESTAMPING_TX_SOFTWARE |
46 SOF_TIMESTAMPING_RX_SOFTWARE |
47 SOF_TIMESTAMPING_SOFTWARE;
48 info->phc_index = -1;
49 return 0;
50}
51EXPORT_SYMBOL(ethtool_op_get_ts_info);
52
53
54
55#define ETHTOOL_DEV_FEATURE_WORDS ((NETDEV_FEATURE_COUNT + 31) / 32)
56
57static const char netdev_features_strings[NETDEV_FEATURE_COUNT][ETH_GSTRING_LEN] = {
58 [NETIF_F_SG_BIT] = "tx-scatter-gather",
59 [NETIF_F_IP_CSUM_BIT] = "tx-checksum-ipv4",
60 [NETIF_F_HW_CSUM_BIT] = "tx-checksum-ip-generic",
61 [NETIF_F_IPV6_CSUM_BIT] = "tx-checksum-ipv6",
62 [NETIF_F_HIGHDMA_BIT] = "highdma",
63 [NETIF_F_FRAGLIST_BIT] = "tx-scatter-gather-fraglist",
64 [NETIF_F_HW_VLAN_CTAG_TX_BIT] = "tx-vlan-hw-insert",
65
66 [NETIF_F_HW_VLAN_CTAG_RX_BIT] = "rx-vlan-hw-parse",
67 [NETIF_F_HW_VLAN_CTAG_FILTER_BIT] = "rx-vlan-filter",
68 [NETIF_F_HW_VLAN_STAG_TX_BIT] = "tx-vlan-stag-hw-insert",
69 [NETIF_F_HW_VLAN_STAG_RX_BIT] = "rx-vlan-stag-hw-parse",
70 [NETIF_F_HW_VLAN_STAG_FILTER_BIT] = "rx-vlan-stag-filter",
71 [NETIF_F_VLAN_CHALLENGED_BIT] = "vlan-challenged",
72 [NETIF_F_GSO_BIT] = "tx-generic-segmentation",
73 [NETIF_F_LLTX_BIT] = "tx-lockless",
74 [NETIF_F_NETNS_LOCAL_BIT] = "netns-local",
75 [NETIF_F_GRO_BIT] = "rx-gro",
76 [NETIF_F_LRO_BIT] = "rx-lro",
77
78 [NETIF_F_TSO_BIT] = "tx-tcp-segmentation",
79 [NETIF_F_UFO_BIT] = "tx-udp-fragmentation",
80 [NETIF_F_GSO_ROBUST_BIT] = "tx-gso-robust",
81 [NETIF_F_TSO_ECN_BIT] = "tx-tcp-ecn-segmentation",
82 [NETIF_F_TSO6_BIT] = "tx-tcp6-segmentation",
83 [NETIF_F_FSO_BIT] = "tx-fcoe-segmentation",
84 [NETIF_F_GSO_GRE_BIT] = "tx-gre-segmentation",
85 [NETIF_F_GSO_IPIP_BIT] = "tx-ipip-segmentation",
86 [NETIF_F_GSO_SIT_BIT] = "tx-sit-segmentation",
87 [NETIF_F_GSO_UDP_TUNNEL_BIT] = "tx-udp_tnl-segmentation",
88
89 [NETIF_F_FCOE_CRC_BIT] = "tx-checksum-fcoe-crc",
90 [NETIF_F_SCTP_CSUM_BIT] = "tx-checksum-sctp",
91 [NETIF_F_FCOE_MTU_BIT] = "fcoe-mtu",
92 [NETIF_F_NTUPLE_BIT] = "rx-ntuple-filter",
93 [NETIF_F_RXHASH_BIT] = "rx-hashing",
94 [NETIF_F_RXCSUM_BIT] = "rx-checksum",
95 [NETIF_F_NOCACHE_COPY_BIT] = "tx-nocache-copy",
96 [NETIF_F_LOOPBACK_BIT] = "loopback",
97 [NETIF_F_RXFCS_BIT] = "rx-fcs",
98 [NETIF_F_RXALL_BIT] = "rx-all",
99 [NETIF_F_HW_L2FW_DOFFLOAD_BIT] = "l2-fwd-offload",
100 [NETIF_F_BUSY_POLL_BIT] = "busy-poll",
101};
102
103static const char
104rss_hash_func_strings[ETH_RSS_HASH_FUNCS_COUNT][ETH_GSTRING_LEN] = {
105 [ETH_RSS_HASH_TOP_BIT] = "toeplitz",
106 [ETH_RSS_HASH_XOR_BIT] = "xor",
107};
108
109static const char
110tunable_strings[__ETHTOOL_TUNABLE_COUNT][ETH_GSTRING_LEN] = {
111 [ETHTOOL_ID_UNSPEC] = "Unspec",
112 [ETHTOOL_RX_COPYBREAK] = "rx-copybreak",
113 [ETHTOOL_TX_COPYBREAK] = "tx-copybreak",
114};
115
116static int ethtool_get_features(struct net_device *dev, void __user *useraddr)
117{
118 struct ethtool_gfeatures cmd = {
119 .cmd = ETHTOOL_GFEATURES,
120 .size = ETHTOOL_DEV_FEATURE_WORDS,
121 };
122 struct ethtool_get_features_block features[ETHTOOL_DEV_FEATURE_WORDS];
123 u32 __user *sizeaddr;
124 u32 copy_size;
125 int i;
126
127
128 BUILD_BUG_ON(ETHTOOL_DEV_FEATURE_WORDS * sizeof(u32) > sizeof(netdev_features_t));
129
130 for (i = 0; i < ETHTOOL_DEV_FEATURE_WORDS; ++i) {
131 features[i].available = (u32)(dev->hw_features >> (32 * i));
132 features[i].requested = (u32)(dev->wanted_features >> (32 * i));
133 features[i].active = (u32)(dev->features >> (32 * i));
134 features[i].never_changed =
135 (u32)(NETIF_F_NEVER_CHANGE >> (32 * i));
136 }
137
138 sizeaddr = useraddr + offsetof(struct ethtool_gfeatures, size);
139 if (get_user(copy_size, sizeaddr))
140 return -EFAULT;
141
142 if (copy_size > ETHTOOL_DEV_FEATURE_WORDS)
143 copy_size = ETHTOOL_DEV_FEATURE_WORDS;
144
145 if (copy_to_user(useraddr, &cmd, sizeof(cmd)))
146 return -EFAULT;
147 useraddr += sizeof(cmd);
148 if (copy_to_user(useraddr, features, copy_size * sizeof(*features)))
149 return -EFAULT;
150
151 return 0;
152}
153
154static int ethtool_set_features(struct net_device *dev, void __user *useraddr)
155{
156 struct ethtool_sfeatures cmd;
157 struct ethtool_set_features_block features[ETHTOOL_DEV_FEATURE_WORDS];
158 netdev_features_t wanted = 0, valid = 0;
159 int i, ret = 0;
160
161 if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
162 return -EFAULT;
163 useraddr += sizeof(cmd);
164
165 if (cmd.size != ETHTOOL_DEV_FEATURE_WORDS)
166 return -EINVAL;
167
168 if (copy_from_user(features, useraddr, sizeof(features)))
169 return -EFAULT;
170
171 for (i = 0; i < ETHTOOL_DEV_FEATURE_WORDS; ++i) {
172 valid |= (netdev_features_t)features[i].valid << (32 * i);
173 wanted |= (netdev_features_t)features[i].requested << (32 * i);
174 }
175
176 if (valid & ~NETIF_F_ETHTOOL_BITS)
177 return -EINVAL;
178
179 if (valid & ~dev->hw_features) {
180 valid &= dev->hw_features;
181 ret |= ETHTOOL_F_UNSUPPORTED;
182 }
183
184 dev->wanted_features &= ~valid;
185 dev->wanted_features |= wanted & valid;
186 __netdev_update_features(dev);
187
188 if ((dev->wanted_features ^ dev->features) & valid)
189 ret |= ETHTOOL_F_WISH;
190
191 return ret;
192}
193
194static int __ethtool_get_sset_count(struct net_device *dev, int sset)
195{
196 const struct ethtool_ops *ops = dev->ethtool_ops;
197
198 if (sset == ETH_SS_FEATURES)
199 return ARRAY_SIZE(netdev_features_strings);
200
201 if (sset == ETH_SS_RSS_HASH_FUNCS)
202 return ARRAY_SIZE(rss_hash_func_strings);
203
204 if (sset == ETH_SS_TUNABLES)
205 return ARRAY_SIZE(tunable_strings);
206
207 if (ops->get_sset_count && ops->get_strings)
208 return ops->get_sset_count(dev, sset);
209 else
210 return -EOPNOTSUPP;
211}
212
213static void __ethtool_get_strings(struct net_device *dev,
214 u32 stringset, u8 *data)
215{
216 const struct ethtool_ops *ops = dev->ethtool_ops;
217
218 if (stringset == ETH_SS_FEATURES)
219 memcpy(data, netdev_features_strings,
220 sizeof(netdev_features_strings));
221 else if (stringset == ETH_SS_RSS_HASH_FUNCS)
222 memcpy(data, rss_hash_func_strings,
223 sizeof(rss_hash_func_strings));
224 else if (stringset == ETH_SS_TUNABLES)
225 memcpy(data, tunable_strings, sizeof(tunable_strings));
226 else
227
228 ops->get_strings(dev, stringset, data);
229}
230
231static netdev_features_t ethtool_get_feature_mask(u32 eth_cmd)
232{
233
234
235 switch (eth_cmd) {
236 case ETHTOOL_GTXCSUM:
237 case ETHTOOL_STXCSUM:
238 return NETIF_F_ALL_CSUM | NETIF_F_SCTP_CSUM;
239 case ETHTOOL_GRXCSUM:
240 case ETHTOOL_SRXCSUM:
241 return NETIF_F_RXCSUM;
242 case ETHTOOL_GSG:
243 case ETHTOOL_SSG:
244 return NETIF_F_SG;
245 case ETHTOOL_GTSO:
246 case ETHTOOL_STSO:
247 return NETIF_F_ALL_TSO;
248 case ETHTOOL_GUFO:
249 case ETHTOOL_SUFO:
250 return NETIF_F_UFO;
251 case ETHTOOL_GGSO:
252 case ETHTOOL_SGSO:
253 return NETIF_F_GSO;
254 case ETHTOOL_GGRO:
255 case ETHTOOL_SGRO:
256 return NETIF_F_GRO;
257 default:
258 BUG();
259 }
260}
261
262static int ethtool_get_one_feature(struct net_device *dev,
263 char __user *useraddr, u32 ethcmd)
264{
265 netdev_features_t mask = ethtool_get_feature_mask(ethcmd);
266 struct ethtool_value edata = {
267 .cmd = ethcmd,
268 .data = !!(dev->features & mask),
269 };
270
271 if (copy_to_user(useraddr, &edata, sizeof(edata)))
272 return -EFAULT;
273 return 0;
274}
275
276static int ethtool_set_one_feature(struct net_device *dev,
277 void __user *useraddr, u32 ethcmd)
278{
279 struct ethtool_value edata;
280 netdev_features_t mask;
281
282 if (copy_from_user(&edata, useraddr, sizeof(edata)))
283 return -EFAULT;
284
285 mask = ethtool_get_feature_mask(ethcmd);
286 mask &= dev->hw_features;
287 if (!mask)
288 return -EOPNOTSUPP;
289
290 if (edata.data)
291 dev->wanted_features |= mask;
292 else
293 dev->wanted_features &= ~mask;
294
295 __netdev_update_features(dev);
296
297 return 0;
298}
299
300#define ETH_ALL_FLAGS (ETH_FLAG_LRO | ETH_FLAG_RXVLAN | ETH_FLAG_TXVLAN | \
301 ETH_FLAG_NTUPLE | ETH_FLAG_RXHASH)
302#define ETH_ALL_FEATURES (NETIF_F_LRO | NETIF_F_HW_VLAN_CTAG_RX | \
303 NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_NTUPLE | \
304 NETIF_F_RXHASH)
305
306static u32 __ethtool_get_flags(struct net_device *dev)
307{
308 u32 flags = 0;
309
310 if (dev->features & NETIF_F_LRO)
311 flags |= ETH_FLAG_LRO;
312 if (dev->features & NETIF_F_HW_VLAN_CTAG_RX)
313 flags |= ETH_FLAG_RXVLAN;
314 if (dev->features & NETIF_F_HW_VLAN_CTAG_TX)
315 flags |= ETH_FLAG_TXVLAN;
316 if (dev->features & NETIF_F_NTUPLE)
317 flags |= ETH_FLAG_NTUPLE;
318 if (dev->features & NETIF_F_RXHASH)
319 flags |= ETH_FLAG_RXHASH;
320
321 return flags;
322}
323
324static int __ethtool_set_flags(struct net_device *dev, u32 data)
325{
326 netdev_features_t features = 0, changed;
327
328 if (data & ~ETH_ALL_FLAGS)
329 return -EINVAL;
330
331 if (data & ETH_FLAG_LRO)
332 features |= NETIF_F_LRO;
333 if (data & ETH_FLAG_RXVLAN)
334 features |= NETIF_F_HW_VLAN_CTAG_RX;
335 if (data & ETH_FLAG_TXVLAN)
336 features |= NETIF_F_HW_VLAN_CTAG_TX;
337 if (data & ETH_FLAG_NTUPLE)
338 features |= NETIF_F_NTUPLE;
339 if (data & ETH_FLAG_RXHASH)
340 features |= NETIF_F_RXHASH;
341
342
343 changed = (features ^ dev->features) & ETH_ALL_FEATURES;
344 if (changed & ~dev->hw_features)
345 return (changed & dev->hw_features) ? -EINVAL : -EOPNOTSUPP;
346
347 dev->wanted_features =
348 (dev->wanted_features & ~changed) | (features & changed);
349
350 __netdev_update_features(dev);
351
352 return 0;
353}
354
355int __ethtool_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
356{
357 ASSERT_RTNL();
358
359 if (!dev->ethtool_ops->get_settings)
360 return -EOPNOTSUPP;
361
362 memset(cmd, 0, sizeof(struct ethtool_cmd));
363 cmd->cmd = ETHTOOL_GSET;
364 return dev->ethtool_ops->get_settings(dev, cmd);
365}
366EXPORT_SYMBOL(__ethtool_get_settings);
367
368static int ethtool_get_settings(struct net_device *dev, void __user *useraddr)
369{
370 int err;
371 struct ethtool_cmd cmd;
372
373 err = __ethtool_get_settings(dev, &cmd);
374 if (err < 0)
375 return err;
376
377 if (copy_to_user(useraddr, &cmd, sizeof(cmd)))
378 return -EFAULT;
379 return 0;
380}
381
382static int ethtool_set_settings(struct net_device *dev, void __user *useraddr)
383{
384 struct ethtool_cmd cmd;
385
386 if (!dev->ethtool_ops->set_settings)
387 return -EOPNOTSUPP;
388
389 if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
390 return -EFAULT;
391
392 return dev->ethtool_ops->set_settings(dev, &cmd);
393}
394
395static noinline_for_stack int ethtool_get_drvinfo(struct net_device *dev,
396 void __user *useraddr)
397{
398 struct ethtool_drvinfo info;
399 const struct ethtool_ops *ops = dev->ethtool_ops;
400
401 memset(&info, 0, sizeof(info));
402 info.cmd = ETHTOOL_GDRVINFO;
403 if (ops->get_drvinfo) {
404 ops->get_drvinfo(dev, &info);
405 } else if (dev->dev.parent && dev->dev.parent->driver) {
406 strlcpy(info.bus_info, dev_name(dev->dev.parent),
407 sizeof(info.bus_info));
408 strlcpy(info.driver, dev->dev.parent->driver->name,
409 sizeof(info.driver));
410 } else {
411 return -EOPNOTSUPP;
412 }
413
414
415
416
417
418 if (ops->get_sset_count) {
419 int rc;
420
421 rc = ops->get_sset_count(dev, ETH_SS_TEST);
422 if (rc >= 0)
423 info.testinfo_len = rc;
424 rc = ops->get_sset_count(dev, ETH_SS_STATS);
425 if (rc >= 0)
426 info.n_stats = rc;
427 rc = ops->get_sset_count(dev, ETH_SS_PRIV_FLAGS);
428 if (rc >= 0)
429 info.n_priv_flags = rc;
430 }
431 if (ops->get_regs_len)
432 info.regdump_len = ops->get_regs_len(dev);
433 if (ops->get_eeprom_len)
434 info.eedump_len = ops->get_eeprom_len(dev);
435
436 if (copy_to_user(useraddr, &info, sizeof(info)))
437 return -EFAULT;
438 return 0;
439}
440
441static noinline_for_stack int ethtool_get_sset_info(struct net_device *dev,
442 void __user *useraddr)
443{
444 struct ethtool_sset_info info;
445 u64 sset_mask;
446 int i, idx = 0, n_bits = 0, ret, rc;
447 u32 *info_buf = NULL;
448
449 if (copy_from_user(&info, useraddr, sizeof(info)))
450 return -EFAULT;
451
452
453 sset_mask = info.sset_mask;
454 if (!sset_mask)
455 return 0;
456
457
458 n_bits = hweight64(sset_mask);
459
460 memset(&info, 0, sizeof(info));
461 info.cmd = ETHTOOL_GSSET_INFO;
462
463 info_buf = kzalloc(n_bits * sizeof(u32), GFP_USER);
464 if (!info_buf)
465 return -ENOMEM;
466
467
468
469
470
471 for (i = 0; i < 64; i++) {
472 if (!(sset_mask & (1ULL << i)))
473 continue;
474
475 rc = __ethtool_get_sset_count(dev, i);
476 if (rc >= 0) {
477 info.sset_mask |= (1ULL << i);
478 info_buf[idx++] = rc;
479 }
480 }
481
482 ret = -EFAULT;
483 if (copy_to_user(useraddr, &info, sizeof(info)))
484 goto out;
485
486 useraddr += offsetof(struct ethtool_sset_info, data);
487 if (copy_to_user(useraddr, info_buf, idx * sizeof(u32)))
488 goto out;
489
490 ret = 0;
491
492out:
493 kfree(info_buf);
494 return ret;
495}
496
497static noinline_for_stack int ethtool_set_rxnfc(struct net_device *dev,
498 u32 cmd, void __user *useraddr)
499{
500 struct ethtool_rxnfc info;
501 size_t info_size = sizeof(info);
502 int rc;
503
504 if (!dev->ethtool_ops->set_rxnfc)
505 return -EOPNOTSUPP;
506
507
508
509
510
511 if (cmd == ETHTOOL_SRXFH)
512 info_size = (offsetof(struct ethtool_rxnfc, data) +
513 sizeof(info.data));
514
515 if (copy_from_user(&info, useraddr, info_size))
516 return -EFAULT;
517
518 rc = dev->ethtool_ops->set_rxnfc(dev, &info);
519 if (rc)
520 return rc;
521
522 if (cmd == ETHTOOL_SRXCLSRLINS &&
523 copy_to_user(useraddr, &info, info_size))
524 return -EFAULT;
525
526 return 0;
527}
528
529static noinline_for_stack int ethtool_get_rxnfc(struct net_device *dev,
530 u32 cmd, void __user *useraddr)
531{
532 struct ethtool_rxnfc info;
533 size_t info_size = sizeof(info);
534 const struct ethtool_ops *ops = dev->ethtool_ops;
535 int ret;
536 void *rule_buf = NULL;
537
538 if (!ops->get_rxnfc)
539 return -EOPNOTSUPP;
540
541
542
543
544
545 if (cmd == ETHTOOL_GRXFH)
546 info_size = (offsetof(struct ethtool_rxnfc, data) +
547 sizeof(info.data));
548
549 if (copy_from_user(&info, useraddr, info_size))
550 return -EFAULT;
551
552 if (info.cmd == ETHTOOL_GRXCLSRLALL) {
553 if (info.rule_cnt > 0) {
554 if (info.rule_cnt <= KMALLOC_MAX_SIZE / sizeof(u32))
555 rule_buf = kzalloc(info.rule_cnt * sizeof(u32),
556 GFP_USER);
557 if (!rule_buf)
558 return -ENOMEM;
559 }
560 }
561
562 ret = ops->get_rxnfc(dev, &info, rule_buf);
563 if (ret < 0)
564 goto err_out;
565
566 ret = -EFAULT;
567 if (copy_to_user(useraddr, &info, info_size))
568 goto err_out;
569
570 if (rule_buf) {
571 useraddr += offsetof(struct ethtool_rxnfc, rule_locs);
572 if (copy_to_user(useraddr, rule_buf,
573 info.rule_cnt * sizeof(u32)))
574 goto err_out;
575 }
576 ret = 0;
577
578err_out:
579 kfree(rule_buf);
580
581 return ret;
582}
583
584static int ethtool_copy_validate_indir(u32 *indir, void __user *useraddr,
585 struct ethtool_rxnfc *rx_rings,
586 u32 size)
587{
588 int i;
589
590 if (copy_from_user(indir, useraddr, size * sizeof(indir[0])))
591 return -EFAULT;
592
593
594 for (i = 0; i < size; i++)
595 if (indir[i] >= rx_rings->data)
596 return -EINVAL;
597
598 return 0;
599}
600
601u8 netdev_rss_key[NETDEV_RSS_KEY_LEN];
602
603void netdev_rss_key_fill(void *buffer, size_t len)
604{
605 BUG_ON(len > sizeof(netdev_rss_key));
606 net_get_random_once(netdev_rss_key, sizeof(netdev_rss_key));
607 memcpy(buffer, netdev_rss_key, len);
608}
609EXPORT_SYMBOL(netdev_rss_key_fill);
610
611static noinline_for_stack int ethtool_get_rxfh_indir(struct net_device *dev,
612 void __user *useraddr)
613{
614 u32 user_size, dev_size;
615 u32 *indir;
616 int ret;
617
618 if (!dev->ethtool_ops->get_rxfh_indir_size ||
619 !dev->ethtool_ops->get_rxfh)
620 return -EOPNOTSUPP;
621 dev_size = dev->ethtool_ops->get_rxfh_indir_size(dev);
622 if (dev_size == 0)
623 return -EOPNOTSUPP;
624
625 if (copy_from_user(&user_size,
626 useraddr + offsetof(struct ethtool_rxfh_indir, size),
627 sizeof(user_size)))
628 return -EFAULT;
629
630 if (copy_to_user(useraddr + offsetof(struct ethtool_rxfh_indir, size),
631 &dev_size, sizeof(dev_size)))
632 return -EFAULT;
633
634
635
636
637
638 if (user_size < dev_size)
639 return user_size == 0 ? 0 : -EINVAL;
640
641 indir = kcalloc(dev_size, sizeof(indir[0]), GFP_USER);
642 if (!indir)
643 return -ENOMEM;
644
645 ret = dev->ethtool_ops->get_rxfh(dev, indir, NULL, NULL);
646 if (ret)
647 goto out;
648
649 if (copy_to_user(useraddr +
650 offsetof(struct ethtool_rxfh_indir, ring_index[0]),
651 indir, dev_size * sizeof(indir[0])))
652 ret = -EFAULT;
653
654out:
655 kfree(indir);
656 return ret;
657}
658
659static noinline_for_stack int ethtool_set_rxfh_indir(struct net_device *dev,
660 void __user *useraddr)
661{
662 struct ethtool_rxnfc rx_rings;
663 u32 user_size, dev_size, i;
664 u32 *indir;
665 const struct ethtool_ops *ops = dev->ethtool_ops;
666 int ret;
667 u32 ringidx_offset = offsetof(struct ethtool_rxfh_indir, ring_index[0]);
668
669 if (!ops->get_rxfh_indir_size || !ops->set_rxfh ||
670 !ops->get_rxnfc)
671 return -EOPNOTSUPP;
672
673 dev_size = ops->get_rxfh_indir_size(dev);
674 if (dev_size == 0)
675 return -EOPNOTSUPP;
676
677 if (copy_from_user(&user_size,
678 useraddr + offsetof(struct ethtool_rxfh_indir, size),
679 sizeof(user_size)))
680 return -EFAULT;
681
682 if (user_size != 0 && user_size != dev_size)
683 return -EINVAL;
684
685 indir = kcalloc(dev_size, sizeof(indir[0]), GFP_USER);
686 if (!indir)
687 return -ENOMEM;
688
689 rx_rings.cmd = ETHTOOL_GRXRINGS;
690 ret = ops->get_rxnfc(dev, &rx_rings, NULL);
691 if (ret)
692 goto out;
693
694 if (user_size == 0) {
695 for (i = 0; i < dev_size; i++)
696 indir[i] = ethtool_rxfh_indir_default(i, rx_rings.data);
697 } else {
698 ret = ethtool_copy_validate_indir(indir,
699 useraddr + ringidx_offset,
700 &rx_rings,
701 dev_size);
702 if (ret)
703 goto out;
704 }
705
706 ret = ops->set_rxfh(dev, indir, NULL, ETH_RSS_HASH_NO_CHANGE);
707
708out:
709 kfree(indir);
710 return ret;
711}
712
713static noinline_for_stack int ethtool_get_rxfh(struct net_device *dev,
714 void __user *useraddr)
715{
716 int ret;
717 const struct ethtool_ops *ops = dev->ethtool_ops;
718 u32 user_indir_size, user_key_size;
719 u32 dev_indir_size = 0, dev_key_size = 0;
720 struct ethtool_rxfh rxfh;
721 u32 total_size;
722 u32 indir_bytes;
723 u32 *indir = NULL;
724 u8 dev_hfunc = 0;
725 u8 *hkey = NULL;
726 u8 *rss_config;
727
728 if (!ops->get_rxfh)
729 return -EOPNOTSUPP;
730
731 if (ops->get_rxfh_indir_size)
732 dev_indir_size = ops->get_rxfh_indir_size(dev);
733 if (ops->get_rxfh_key_size)
734 dev_key_size = ops->get_rxfh_key_size(dev);
735
736 if (copy_from_user(&rxfh, useraddr, sizeof(rxfh)))
737 return -EFAULT;
738 user_indir_size = rxfh.indir_size;
739 user_key_size = rxfh.key_size;
740
741
742 if (rxfh.rss_context || rxfh.rsvd8[0] || rxfh.rsvd8[1] ||
743 rxfh.rsvd8[2] || rxfh.rsvd32)
744 return -EINVAL;
745
746 rxfh.indir_size = dev_indir_size;
747 rxfh.key_size = dev_key_size;
748 if (copy_to_user(useraddr, &rxfh, sizeof(rxfh)))
749 return -EFAULT;
750
751 if ((user_indir_size && (user_indir_size != dev_indir_size)) ||
752 (user_key_size && (user_key_size != dev_key_size)))
753 return -EINVAL;
754
755 indir_bytes = user_indir_size * sizeof(indir[0]);
756 total_size = indir_bytes + user_key_size;
757 rss_config = kzalloc(total_size, GFP_USER);
758 if (!rss_config)
759 return -ENOMEM;
760
761 if (user_indir_size)
762 indir = (u32 *)rss_config;
763
764 if (user_key_size)
765 hkey = rss_config + indir_bytes;
766
767 ret = dev->ethtool_ops->get_rxfh(dev, indir, hkey, &dev_hfunc);
768 if (ret)
769 goto out;
770
771 if (copy_to_user(useraddr + offsetof(struct ethtool_rxfh, hfunc),
772 &dev_hfunc, sizeof(rxfh.hfunc))) {
773 ret = -EFAULT;
774 } else if (copy_to_user(useraddr +
775 offsetof(struct ethtool_rxfh, rss_config[0]),
776 rss_config, total_size)) {
777 ret = -EFAULT;
778 }
779out:
780 kfree(rss_config);
781
782 return ret;
783}
784
785static noinline_for_stack int ethtool_set_rxfh(struct net_device *dev,
786 void __user *useraddr)
787{
788 int ret;
789 const struct ethtool_ops *ops = dev->ethtool_ops;
790 struct ethtool_rxnfc rx_rings;
791 struct ethtool_rxfh rxfh;
792 u32 dev_indir_size = 0, dev_key_size = 0, i;
793 u32 *indir = NULL, indir_bytes = 0;
794 u8 *hkey = NULL;
795 u8 *rss_config;
796 u32 rss_cfg_offset = offsetof(struct ethtool_rxfh, rss_config[0]);
797
798 if (!ops->get_rxnfc || !ops->set_rxfh)
799 return -EOPNOTSUPP;
800
801 if (ops->get_rxfh_indir_size)
802 dev_indir_size = ops->get_rxfh_indir_size(dev);
803 if (ops->get_rxfh_key_size)
804 dev_key_size = ops->get_rxfh_key_size(dev);
805
806 if (copy_from_user(&rxfh, useraddr, sizeof(rxfh)))
807 return -EFAULT;
808
809
810 if (rxfh.rss_context || rxfh.rsvd8[0] || rxfh.rsvd8[1] ||
811 rxfh.rsvd8[2] || rxfh.rsvd32)
812 return -EINVAL;
813
814
815
816
817 if ((rxfh.indir_size &&
818 rxfh.indir_size != ETH_RXFH_INDIR_NO_CHANGE &&
819 rxfh.indir_size != dev_indir_size) ||
820 (rxfh.key_size && (rxfh.key_size != dev_key_size)) ||
821 (rxfh.indir_size == ETH_RXFH_INDIR_NO_CHANGE &&
822 rxfh.key_size == 0 && rxfh.hfunc == ETH_RSS_HASH_NO_CHANGE))
823 return -EINVAL;
824
825 if (rxfh.indir_size != ETH_RXFH_INDIR_NO_CHANGE)
826 indir_bytes = dev_indir_size * sizeof(indir[0]);
827
828 rss_config = kzalloc(indir_bytes + rxfh.key_size, GFP_USER);
829 if (!rss_config)
830 return -ENOMEM;
831
832 rx_rings.cmd = ETHTOOL_GRXRINGS;
833 ret = ops->get_rxnfc(dev, &rx_rings, NULL);
834 if (ret)
835 goto out;
836
837
838
839
840 if (rxfh.indir_size &&
841 rxfh.indir_size != ETH_RXFH_INDIR_NO_CHANGE) {
842 indir = (u32 *)rss_config;
843 ret = ethtool_copy_validate_indir(indir,
844 useraddr + rss_cfg_offset,
845 &rx_rings,
846 rxfh.indir_size);
847 if (ret)
848 goto out;
849 } else if (rxfh.indir_size == 0) {
850 indir = (u32 *)rss_config;
851 for (i = 0; i < dev_indir_size; i++)
852 indir[i] = ethtool_rxfh_indir_default(i, rx_rings.data);
853 }
854
855 if (rxfh.key_size) {
856 hkey = rss_config + indir_bytes;
857 if (copy_from_user(hkey,
858 useraddr + rss_cfg_offset + indir_bytes,
859 rxfh.key_size)) {
860 ret = -EFAULT;
861 goto out;
862 }
863 }
864
865 ret = ops->set_rxfh(dev, indir, hkey, rxfh.hfunc);
866
867out:
868 kfree(rss_config);
869 return ret;
870}
871
872static int ethtool_get_regs(struct net_device *dev, char __user *useraddr)
873{
874 struct ethtool_regs regs;
875 const struct ethtool_ops *ops = dev->ethtool_ops;
876 void *regbuf;
877 int reglen, ret;
878
879 if (!ops->get_regs || !ops->get_regs_len)
880 return -EOPNOTSUPP;
881
882 if (copy_from_user(®s, useraddr, sizeof(regs)))
883 return -EFAULT;
884
885 reglen = ops->get_regs_len(dev);
886 if (regs.len > reglen)
887 regs.len = reglen;
888
889 regbuf = vzalloc(reglen);
890 if (reglen && !regbuf)
891 return -ENOMEM;
892
893 ops->get_regs(dev, ®s, regbuf);
894
895 ret = -EFAULT;
896 if (copy_to_user(useraddr, ®s, sizeof(regs)))
897 goto out;
898 useraddr += offsetof(struct ethtool_regs, data);
899 if (regbuf && copy_to_user(useraddr, regbuf, regs.len))
900 goto out;
901 ret = 0;
902
903 out:
904 vfree(regbuf);
905 return ret;
906}
907
908static int ethtool_reset(struct net_device *dev, char __user *useraddr)
909{
910 struct ethtool_value reset;
911 int ret;
912
913 if (!dev->ethtool_ops->reset)
914 return -EOPNOTSUPP;
915
916 if (copy_from_user(&reset, useraddr, sizeof(reset)))
917 return -EFAULT;
918
919 ret = dev->ethtool_ops->reset(dev, &reset.data);
920 if (ret)
921 return ret;
922
923 if (copy_to_user(useraddr, &reset, sizeof(reset)))
924 return -EFAULT;
925 return 0;
926}
927
928static int ethtool_get_wol(struct net_device *dev, char __user *useraddr)
929{
930 struct ethtool_wolinfo wol = { .cmd = ETHTOOL_GWOL };
931
932 if (!dev->ethtool_ops->get_wol)
933 return -EOPNOTSUPP;
934
935 dev->ethtool_ops->get_wol(dev, &wol);
936
937 if (copy_to_user(useraddr, &wol, sizeof(wol)))
938 return -EFAULT;
939 return 0;
940}
941
942static int ethtool_set_wol(struct net_device *dev, char __user *useraddr)
943{
944 struct ethtool_wolinfo wol;
945
946 if (!dev->ethtool_ops->set_wol)
947 return -EOPNOTSUPP;
948
949 if (copy_from_user(&wol, useraddr, sizeof(wol)))
950 return -EFAULT;
951
952 return dev->ethtool_ops->set_wol(dev, &wol);
953}
954
955static int ethtool_get_eee(struct net_device *dev, char __user *useraddr)
956{
957 struct ethtool_eee edata;
958 int rc;
959
960 if (!dev->ethtool_ops->get_eee)
961 return -EOPNOTSUPP;
962
963 memset(&edata, 0, sizeof(struct ethtool_eee));
964 edata.cmd = ETHTOOL_GEEE;
965 rc = dev->ethtool_ops->get_eee(dev, &edata);
966
967 if (rc)
968 return rc;
969
970 if (copy_to_user(useraddr, &edata, sizeof(edata)))
971 return -EFAULT;
972
973 return 0;
974}
975
976static int ethtool_set_eee(struct net_device *dev, char __user *useraddr)
977{
978 struct ethtool_eee edata;
979
980 if (!dev->ethtool_ops->set_eee)
981 return -EOPNOTSUPP;
982
983 if (copy_from_user(&edata, useraddr, sizeof(edata)))
984 return -EFAULT;
985
986 return dev->ethtool_ops->set_eee(dev, &edata);
987}
988
989static int ethtool_nway_reset(struct net_device *dev)
990{
991 if (!dev->ethtool_ops->nway_reset)
992 return -EOPNOTSUPP;
993
994 return dev->ethtool_ops->nway_reset(dev);
995}
996
997static int ethtool_get_link(struct net_device *dev, char __user *useraddr)
998{
999 struct ethtool_value edata = { .cmd = ETHTOOL_GLINK };
1000
1001 if (!dev->ethtool_ops->get_link)
1002 return -EOPNOTSUPP;
1003
1004 edata.data = netif_running(dev) && dev->ethtool_ops->get_link(dev);
1005
1006 if (copy_to_user(useraddr, &edata, sizeof(edata)))
1007 return -EFAULT;
1008 return 0;
1009}
1010
1011static int ethtool_get_any_eeprom(struct net_device *dev, void __user *useraddr,
1012 int (*getter)(struct net_device *,
1013 struct ethtool_eeprom *, u8 *),
1014 u32 total_len)
1015{
1016 struct ethtool_eeprom eeprom;
1017 void __user *userbuf = useraddr + sizeof(eeprom);
1018 u32 bytes_remaining;
1019 u8 *data;
1020 int ret = 0;
1021
1022 if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
1023 return -EFAULT;
1024
1025
1026 if (eeprom.offset + eeprom.len <= eeprom.offset)
1027 return -EINVAL;
1028
1029
1030 if (eeprom.offset + eeprom.len > total_len)
1031 return -EINVAL;
1032
1033 data = kmalloc(PAGE_SIZE, GFP_USER);
1034 if (!data)
1035 return -ENOMEM;
1036
1037 bytes_remaining = eeprom.len;
1038 while (bytes_remaining > 0) {
1039 eeprom.len = min(bytes_remaining, (u32)PAGE_SIZE);
1040
1041 ret = getter(dev, &eeprom, data);
1042 if (ret)
1043 break;
1044 if (copy_to_user(userbuf, data, eeprom.len)) {
1045 ret = -EFAULT;
1046 break;
1047 }
1048 userbuf += eeprom.len;
1049 eeprom.offset += eeprom.len;
1050 bytes_remaining -= eeprom.len;
1051 }
1052
1053 eeprom.len = userbuf - (useraddr + sizeof(eeprom));
1054 eeprom.offset -= eeprom.len;
1055 if (copy_to_user(useraddr, &eeprom, sizeof(eeprom)))
1056 ret = -EFAULT;
1057
1058 kfree(data);
1059 return ret;
1060}
1061
1062static int ethtool_get_eeprom(struct net_device *dev, void __user *useraddr)
1063{
1064 const struct ethtool_ops *ops = dev->ethtool_ops;
1065
1066 if (!ops->get_eeprom || !ops->get_eeprom_len ||
1067 !ops->get_eeprom_len(dev))
1068 return -EOPNOTSUPP;
1069
1070 return ethtool_get_any_eeprom(dev, useraddr, ops->get_eeprom,
1071 ops->get_eeprom_len(dev));
1072}
1073
1074static int ethtool_set_eeprom(struct net_device *dev, void __user *useraddr)
1075{
1076 struct ethtool_eeprom eeprom;
1077 const struct ethtool_ops *ops = dev->ethtool_ops;
1078 void __user *userbuf = useraddr + sizeof(eeprom);
1079 u32 bytes_remaining;
1080 u8 *data;
1081 int ret = 0;
1082
1083 if (!ops->set_eeprom || !ops->get_eeprom_len ||
1084 !ops->get_eeprom_len(dev))
1085 return -EOPNOTSUPP;
1086
1087 if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
1088 return -EFAULT;
1089
1090
1091 if (eeprom.offset + eeprom.len <= eeprom.offset)
1092 return -EINVAL;
1093
1094
1095 if (eeprom.offset + eeprom.len > ops->get_eeprom_len(dev))
1096 return -EINVAL;
1097
1098 data = kmalloc(PAGE_SIZE, GFP_USER);
1099 if (!data)
1100 return -ENOMEM;
1101
1102 bytes_remaining = eeprom.len;
1103 while (bytes_remaining > 0) {
1104 eeprom.len = min(bytes_remaining, (u32)PAGE_SIZE);
1105
1106 if (copy_from_user(data, userbuf, eeprom.len)) {
1107 ret = -EFAULT;
1108 break;
1109 }
1110 ret = ops->set_eeprom(dev, &eeprom, data);
1111 if (ret)
1112 break;
1113 userbuf += eeprom.len;
1114 eeprom.offset += eeprom.len;
1115 bytes_remaining -= eeprom.len;
1116 }
1117
1118 kfree(data);
1119 return ret;
1120}
1121
1122static noinline_for_stack int ethtool_get_coalesce(struct net_device *dev,
1123 void __user *useraddr)
1124{
1125 struct ethtool_coalesce coalesce = { .cmd = ETHTOOL_GCOALESCE };
1126
1127 if (!dev->ethtool_ops->get_coalesce)
1128 return -EOPNOTSUPP;
1129
1130 dev->ethtool_ops->get_coalesce(dev, &coalesce);
1131
1132 if (copy_to_user(useraddr, &coalesce, sizeof(coalesce)))
1133 return -EFAULT;
1134 return 0;
1135}
1136
1137static noinline_for_stack int ethtool_set_coalesce(struct net_device *dev,
1138 void __user *useraddr)
1139{
1140 struct ethtool_coalesce coalesce;
1141
1142 if (!dev->ethtool_ops->set_coalesce)
1143 return -EOPNOTSUPP;
1144
1145 if (copy_from_user(&coalesce, useraddr, sizeof(coalesce)))
1146 return -EFAULT;
1147
1148 return dev->ethtool_ops->set_coalesce(dev, &coalesce);
1149}
1150
1151static int ethtool_get_ringparam(struct net_device *dev, void __user *useraddr)
1152{
1153 struct ethtool_ringparam ringparam = { .cmd = ETHTOOL_GRINGPARAM };
1154
1155 if (!dev->ethtool_ops->get_ringparam)
1156 return -EOPNOTSUPP;
1157
1158 dev->ethtool_ops->get_ringparam(dev, &ringparam);
1159
1160 if (copy_to_user(useraddr, &ringparam, sizeof(ringparam)))
1161 return -EFAULT;
1162 return 0;
1163}
1164
1165static int ethtool_set_ringparam(struct net_device *dev, void __user *useraddr)
1166{
1167 struct ethtool_ringparam ringparam;
1168
1169 if (!dev->ethtool_ops->set_ringparam)
1170 return -EOPNOTSUPP;
1171
1172 if (copy_from_user(&ringparam, useraddr, sizeof(ringparam)))
1173 return -EFAULT;
1174
1175 return dev->ethtool_ops->set_ringparam(dev, &ringparam);
1176}
1177
1178static noinline_for_stack int ethtool_get_channels(struct net_device *dev,
1179 void __user *useraddr)
1180{
1181 struct ethtool_channels channels = { .cmd = ETHTOOL_GCHANNELS };
1182
1183 if (!dev->ethtool_ops->get_channels)
1184 return -EOPNOTSUPP;
1185
1186 dev->ethtool_ops->get_channels(dev, &channels);
1187
1188 if (copy_to_user(useraddr, &channels, sizeof(channels)))
1189 return -EFAULT;
1190 return 0;
1191}
1192
1193static noinline_for_stack int ethtool_set_channels(struct net_device *dev,
1194 void __user *useraddr)
1195{
1196 struct ethtool_channels channels;
1197
1198 if (!dev->ethtool_ops->set_channels)
1199 return -EOPNOTSUPP;
1200
1201 if (copy_from_user(&channels, useraddr, sizeof(channels)))
1202 return -EFAULT;
1203
1204 return dev->ethtool_ops->set_channels(dev, &channels);
1205}
1206
1207static int ethtool_get_pauseparam(struct net_device *dev, void __user *useraddr)
1208{
1209 struct ethtool_pauseparam pauseparam = { ETHTOOL_GPAUSEPARAM };
1210
1211 if (!dev->ethtool_ops->get_pauseparam)
1212 return -EOPNOTSUPP;
1213
1214 dev->ethtool_ops->get_pauseparam(dev, &pauseparam);
1215
1216 if (copy_to_user(useraddr, &pauseparam, sizeof(pauseparam)))
1217 return -EFAULT;
1218 return 0;
1219}
1220
1221static int ethtool_set_pauseparam(struct net_device *dev, void __user *useraddr)
1222{
1223 struct ethtool_pauseparam pauseparam;
1224
1225 if (!dev->ethtool_ops->set_pauseparam)
1226 return -EOPNOTSUPP;
1227
1228 if (copy_from_user(&pauseparam, useraddr, sizeof(pauseparam)))
1229 return -EFAULT;
1230
1231 return dev->ethtool_ops->set_pauseparam(dev, &pauseparam);
1232}
1233
1234static int ethtool_self_test(struct net_device *dev, char __user *useraddr)
1235{
1236 struct ethtool_test test;
1237 const struct ethtool_ops *ops = dev->ethtool_ops;
1238 u64 *data;
1239 int ret, test_len;
1240
1241 if (!ops->self_test || !ops->get_sset_count)
1242 return -EOPNOTSUPP;
1243
1244 test_len = ops->get_sset_count(dev, ETH_SS_TEST);
1245 if (test_len < 0)
1246 return test_len;
1247 WARN_ON(test_len == 0);
1248
1249 if (copy_from_user(&test, useraddr, sizeof(test)))
1250 return -EFAULT;
1251
1252 test.len = test_len;
1253 data = kmalloc(test_len * sizeof(u64), GFP_USER);
1254 if (!data)
1255 return -ENOMEM;
1256
1257 ops->self_test(dev, &test, data);
1258
1259 ret = -EFAULT;
1260 if (copy_to_user(useraddr, &test, sizeof(test)))
1261 goto out;
1262 useraddr += sizeof(test);
1263 if (copy_to_user(useraddr, data, test.len * sizeof(u64)))
1264 goto out;
1265 ret = 0;
1266
1267 out:
1268 kfree(data);
1269 return ret;
1270}
1271
1272static int ethtool_get_strings(struct net_device *dev, void __user *useraddr)
1273{
1274 struct ethtool_gstrings gstrings;
1275 u8 *data;
1276 int ret;
1277
1278 if (copy_from_user(&gstrings, useraddr, sizeof(gstrings)))
1279 return -EFAULT;
1280
1281 ret = __ethtool_get_sset_count(dev, gstrings.string_set);
1282 if (ret < 0)
1283 return ret;
1284
1285 gstrings.len = ret;
1286
1287 data = kcalloc(gstrings.len, ETH_GSTRING_LEN, GFP_USER);
1288 if (!data)
1289 return -ENOMEM;
1290
1291 __ethtool_get_strings(dev, gstrings.string_set, data);
1292
1293 ret = -EFAULT;
1294 if (copy_to_user(useraddr, &gstrings, sizeof(gstrings)))
1295 goto out;
1296 useraddr += sizeof(gstrings);
1297 if (copy_to_user(useraddr, data, gstrings.len * ETH_GSTRING_LEN))
1298 goto out;
1299 ret = 0;
1300
1301out:
1302 kfree(data);
1303 return ret;
1304}
1305
1306static int ethtool_phys_id(struct net_device *dev, void __user *useraddr)
1307{
1308 struct ethtool_value id;
1309 static bool busy;
1310 const struct ethtool_ops *ops = dev->ethtool_ops;
1311 int rc;
1312
1313 if (!ops->set_phys_id)
1314 return -EOPNOTSUPP;
1315
1316 if (busy)
1317 return -EBUSY;
1318
1319 if (copy_from_user(&id, useraddr, sizeof(id)))
1320 return -EFAULT;
1321
1322 rc = ops->set_phys_id(dev, ETHTOOL_ID_ACTIVE);
1323 if (rc < 0)
1324 return rc;
1325
1326
1327
1328
1329 busy = true;
1330 dev_hold(dev);
1331 rtnl_unlock();
1332
1333 if (rc == 0) {
1334
1335 schedule_timeout_interruptible(
1336 id.data ? (id.data * HZ) : MAX_SCHEDULE_TIMEOUT);
1337 } else {
1338
1339 int n = rc * 2, i, interval = HZ / n;
1340
1341
1342 do {
1343
1344 i = n;
1345 do {
1346 rtnl_lock();
1347 rc = ops->set_phys_id(dev,
1348 (i & 1) ? ETHTOOL_ID_OFF : ETHTOOL_ID_ON);
1349 rtnl_unlock();
1350 if (rc)
1351 break;
1352 schedule_timeout_interruptible(interval);
1353 } while (!signal_pending(current) && --i != 0);
1354 } while (!signal_pending(current) &&
1355 (id.data == 0 || --id.data != 0));
1356 }
1357
1358 rtnl_lock();
1359 dev_put(dev);
1360 busy = false;
1361
1362 (void) ops->set_phys_id(dev, ETHTOOL_ID_INACTIVE);
1363 return rc;
1364}
1365
1366static int ethtool_get_stats(struct net_device *dev, void __user *useraddr)
1367{
1368 struct ethtool_stats stats;
1369 const struct ethtool_ops *ops = dev->ethtool_ops;
1370 u64 *data;
1371 int ret, n_stats;
1372
1373 if (!ops->get_ethtool_stats || !ops->get_sset_count)
1374 return -EOPNOTSUPP;
1375
1376 n_stats = ops->get_sset_count(dev, ETH_SS_STATS);
1377 if (n_stats < 0)
1378 return n_stats;
1379 WARN_ON(n_stats == 0);
1380
1381 if (copy_from_user(&stats, useraddr, sizeof(stats)))
1382 return -EFAULT;
1383
1384 stats.n_stats = n_stats;
1385 data = kmalloc(n_stats * sizeof(u64), GFP_USER);
1386 if (!data)
1387 return -ENOMEM;
1388
1389 ops->get_ethtool_stats(dev, &stats, data);
1390
1391 ret = -EFAULT;
1392 if (copy_to_user(useraddr, &stats, sizeof(stats)))
1393 goto out;
1394 useraddr += sizeof(stats);
1395 if (copy_to_user(useraddr, data, stats.n_stats * sizeof(u64)))
1396 goto out;
1397 ret = 0;
1398
1399 out:
1400 kfree(data);
1401 return ret;
1402}
1403
1404static int ethtool_get_perm_addr(struct net_device *dev, void __user *useraddr)
1405{
1406 struct ethtool_perm_addr epaddr;
1407
1408 if (copy_from_user(&epaddr, useraddr, sizeof(epaddr)))
1409 return -EFAULT;
1410
1411 if (epaddr.size < dev->addr_len)
1412 return -ETOOSMALL;
1413 epaddr.size = dev->addr_len;
1414
1415 if (copy_to_user(useraddr, &epaddr, sizeof(epaddr)))
1416 return -EFAULT;
1417 useraddr += sizeof(epaddr);
1418 if (copy_to_user(useraddr, dev->perm_addr, epaddr.size))
1419 return -EFAULT;
1420 return 0;
1421}
1422
1423static int ethtool_get_value(struct net_device *dev, char __user *useraddr,
1424 u32 cmd, u32 (*actor)(struct net_device *))
1425{
1426 struct ethtool_value edata = { .cmd = cmd };
1427
1428 if (!actor)
1429 return -EOPNOTSUPP;
1430
1431 edata.data = actor(dev);
1432
1433 if (copy_to_user(useraddr, &edata, sizeof(edata)))
1434 return -EFAULT;
1435 return 0;
1436}
1437
1438static int ethtool_set_value_void(struct net_device *dev, char __user *useraddr,
1439 void (*actor)(struct net_device *, u32))
1440{
1441 struct ethtool_value edata;
1442
1443 if (!actor)
1444 return -EOPNOTSUPP;
1445
1446 if (copy_from_user(&edata, useraddr, sizeof(edata)))
1447 return -EFAULT;
1448
1449 actor(dev, edata.data);
1450 return 0;
1451}
1452
1453static int ethtool_set_value(struct net_device *dev, char __user *useraddr,
1454 int (*actor)(struct net_device *, u32))
1455{
1456 struct ethtool_value edata;
1457
1458 if (!actor)
1459 return -EOPNOTSUPP;
1460
1461 if (copy_from_user(&edata, useraddr, sizeof(edata)))
1462 return -EFAULT;
1463
1464 return actor(dev, edata.data);
1465}
1466
1467static noinline_for_stack int ethtool_flash_device(struct net_device *dev,
1468 char __user *useraddr)
1469{
1470 struct ethtool_flash efl;
1471
1472 if (copy_from_user(&efl, useraddr, sizeof(efl)))
1473 return -EFAULT;
1474
1475 if (!dev->ethtool_ops->flash_device)
1476 return -EOPNOTSUPP;
1477
1478 efl.data[ETHTOOL_FLASH_MAX_FILENAME - 1] = 0;
1479
1480 return dev->ethtool_ops->flash_device(dev, &efl);
1481}
1482
1483static int ethtool_set_dump(struct net_device *dev,
1484 void __user *useraddr)
1485{
1486 struct ethtool_dump dump;
1487
1488 if (!dev->ethtool_ops->set_dump)
1489 return -EOPNOTSUPP;
1490
1491 if (copy_from_user(&dump, useraddr, sizeof(dump)))
1492 return -EFAULT;
1493
1494 return dev->ethtool_ops->set_dump(dev, &dump);
1495}
1496
1497static int ethtool_get_dump_flag(struct net_device *dev,
1498 void __user *useraddr)
1499{
1500 int ret;
1501 struct ethtool_dump dump;
1502 const struct ethtool_ops *ops = dev->ethtool_ops;
1503
1504 if (!ops->get_dump_flag)
1505 return -EOPNOTSUPP;
1506
1507 if (copy_from_user(&dump, useraddr, sizeof(dump)))
1508 return -EFAULT;
1509
1510 ret = ops->get_dump_flag(dev, &dump);
1511 if (ret)
1512 return ret;
1513
1514 if (copy_to_user(useraddr, &dump, sizeof(dump)))
1515 return -EFAULT;
1516 return 0;
1517}
1518
1519static int ethtool_get_dump_data(struct net_device *dev,
1520 void __user *useraddr)
1521{
1522 int ret;
1523 __u32 len;
1524 struct ethtool_dump dump, tmp;
1525 const struct ethtool_ops *ops = dev->ethtool_ops;
1526 void *data = NULL;
1527
1528 if (!ops->get_dump_data || !ops->get_dump_flag)
1529 return -EOPNOTSUPP;
1530
1531 if (copy_from_user(&dump, useraddr, sizeof(dump)))
1532 return -EFAULT;
1533
1534 memset(&tmp, 0, sizeof(tmp));
1535 tmp.cmd = ETHTOOL_GET_DUMP_FLAG;
1536 ret = ops->get_dump_flag(dev, &tmp);
1537 if (ret)
1538 return ret;
1539
1540 len = min(tmp.len, dump.len);
1541 if (!len)
1542 return -EFAULT;
1543
1544
1545
1546
1547 dump.len = len;
1548
1549
1550
1551
1552
1553 data = vzalloc(tmp.len);
1554 if (!data)
1555 return -ENOMEM;
1556 ret = ops->get_dump_data(dev, &dump, data);
1557 if (ret)
1558 goto out;
1559
1560
1561
1562
1563
1564
1565
1566
1567 WARN_ON(dump.len != len && dump.len != tmp.len);
1568 dump.len = len;
1569
1570 if (copy_to_user(useraddr, &dump, sizeof(dump))) {
1571 ret = -EFAULT;
1572 goto out;
1573 }
1574 useraddr += offsetof(struct ethtool_dump, data);
1575 if (copy_to_user(useraddr, data, len))
1576 ret = -EFAULT;
1577out:
1578 vfree(data);
1579 return ret;
1580}
1581
1582static int ethtool_get_ts_info(struct net_device *dev, void __user *useraddr)
1583{
1584 int err = 0;
1585 struct ethtool_ts_info info;
1586 const struct ethtool_ops *ops = dev->ethtool_ops;
1587 struct phy_device *phydev = dev->phydev;
1588
1589 memset(&info, 0, sizeof(info));
1590 info.cmd = ETHTOOL_GET_TS_INFO;
1591
1592 if (phydev && phydev->drv && phydev->drv->ts_info) {
1593 err = phydev->drv->ts_info(phydev, &info);
1594 } else if (ops->get_ts_info) {
1595 err = ops->get_ts_info(dev, &info);
1596 } else {
1597 info.so_timestamping =
1598 SOF_TIMESTAMPING_RX_SOFTWARE |
1599 SOF_TIMESTAMPING_SOFTWARE;
1600 info.phc_index = -1;
1601 }
1602
1603 if (err)
1604 return err;
1605
1606 if (copy_to_user(useraddr, &info, sizeof(info)))
1607 err = -EFAULT;
1608
1609 return err;
1610}
1611
1612static int __ethtool_get_module_info(struct net_device *dev,
1613 struct ethtool_modinfo *modinfo)
1614{
1615 const struct ethtool_ops *ops = dev->ethtool_ops;
1616 struct phy_device *phydev = dev->phydev;
1617
1618 if (phydev && phydev->drv && phydev->drv->module_info)
1619 return phydev->drv->module_info(phydev, modinfo);
1620
1621 if (ops->get_module_info)
1622 return ops->get_module_info(dev, modinfo);
1623
1624 return -EOPNOTSUPP;
1625}
1626
1627static int ethtool_get_module_info(struct net_device *dev,
1628 void __user *useraddr)
1629{
1630 int ret;
1631 struct ethtool_modinfo modinfo;
1632
1633 if (copy_from_user(&modinfo, useraddr, sizeof(modinfo)))
1634 return -EFAULT;
1635
1636 ret = __ethtool_get_module_info(dev, &modinfo);
1637 if (ret)
1638 return ret;
1639
1640 if (copy_to_user(useraddr, &modinfo, sizeof(modinfo)))
1641 return -EFAULT;
1642
1643 return 0;
1644}
1645
1646static int __ethtool_get_module_eeprom(struct net_device *dev,
1647 struct ethtool_eeprom *ee, u8 *data)
1648{
1649 const struct ethtool_ops *ops = dev->ethtool_ops;
1650 struct phy_device *phydev = dev->phydev;
1651
1652 if (phydev && phydev->drv && phydev->drv->module_eeprom)
1653 return phydev->drv->module_eeprom(phydev, ee, data);
1654
1655 if (ops->get_module_eeprom)
1656 return ops->get_module_eeprom(dev, ee, data);
1657
1658 return -EOPNOTSUPP;
1659}
1660
1661static int ethtool_get_module_eeprom(struct net_device *dev,
1662 void __user *useraddr)
1663{
1664 int ret;
1665 struct ethtool_modinfo modinfo;
1666
1667 ret = __ethtool_get_module_info(dev, &modinfo);
1668 if (ret)
1669 return ret;
1670
1671 return ethtool_get_any_eeprom(dev, useraddr,
1672 __ethtool_get_module_eeprom,
1673 modinfo.eeprom_len);
1674}
1675
1676static int ethtool_tunable_valid(const struct ethtool_tunable *tuna)
1677{
1678 switch (tuna->id) {
1679 case ETHTOOL_RX_COPYBREAK:
1680 case ETHTOOL_TX_COPYBREAK:
1681 if (tuna->len != sizeof(u32) ||
1682 tuna->type_id != ETHTOOL_TUNABLE_U32)
1683 return -EINVAL;
1684 break;
1685 default:
1686 return -EINVAL;
1687 }
1688
1689 return 0;
1690}
1691
1692static int ethtool_get_tunable(struct net_device *dev, void __user *useraddr)
1693{
1694 int ret;
1695 struct ethtool_tunable tuna;
1696 const struct ethtool_ops *ops = dev->ethtool_ops;
1697 void *data;
1698
1699 if (!ops->get_tunable)
1700 return -EOPNOTSUPP;
1701 if (copy_from_user(&tuna, useraddr, sizeof(tuna)))
1702 return -EFAULT;
1703 ret = ethtool_tunable_valid(&tuna);
1704 if (ret)
1705 return ret;
1706 data = kmalloc(tuna.len, GFP_USER);
1707 if (!data)
1708 return -ENOMEM;
1709 ret = ops->get_tunable(dev, &tuna, data);
1710 if (ret)
1711 goto out;
1712 useraddr += sizeof(tuna);
1713 ret = -EFAULT;
1714 if (copy_to_user(useraddr, data, tuna.len))
1715 goto out;
1716 ret = 0;
1717
1718out:
1719 kfree(data);
1720 return ret;
1721}
1722
1723static int ethtool_set_tunable(struct net_device *dev, void __user *useraddr)
1724{
1725 int ret;
1726 struct ethtool_tunable tuna;
1727 const struct ethtool_ops *ops = dev->ethtool_ops;
1728 void *data;
1729
1730 if (!ops->set_tunable)
1731 return -EOPNOTSUPP;
1732 if (copy_from_user(&tuna, useraddr, sizeof(tuna)))
1733 return -EFAULT;
1734 ret = ethtool_tunable_valid(&tuna);
1735 if (ret)
1736 return ret;
1737 data = kmalloc(tuna.len, GFP_USER);
1738 if (!data)
1739 return -ENOMEM;
1740 useraddr += sizeof(tuna);
1741 ret = -EFAULT;
1742 if (copy_from_user(data, useraddr, tuna.len))
1743 goto out;
1744 ret = ops->set_tunable(dev, &tuna, data);
1745
1746out:
1747 kfree(data);
1748 return ret;
1749}
1750
1751
1752
1753int dev_ethtool(struct net *net, struct ifreq *ifr)
1754{
1755 struct net_device *dev = __dev_get_by_name(net, ifr->ifr_name);
1756 void __user *useraddr = ifr->ifr_data;
1757 u32 ethcmd;
1758 int rc;
1759 netdev_features_t old_features;
1760
1761 if (!dev || !netif_device_present(dev))
1762 return -ENODEV;
1763
1764 if (copy_from_user(ðcmd, useraddr, sizeof(ethcmd)))
1765 return -EFAULT;
1766
1767
1768 switch (ethcmd) {
1769 case ETHTOOL_GSET:
1770 case ETHTOOL_GDRVINFO:
1771 case ETHTOOL_GMSGLVL:
1772 case ETHTOOL_GLINK:
1773 case ETHTOOL_GCOALESCE:
1774 case ETHTOOL_GRINGPARAM:
1775 case ETHTOOL_GPAUSEPARAM:
1776 case ETHTOOL_GRXCSUM:
1777 case ETHTOOL_GTXCSUM:
1778 case ETHTOOL_GSG:
1779 case ETHTOOL_GSSET_INFO:
1780 case ETHTOOL_GSTRINGS:
1781 case ETHTOOL_GSTATS:
1782 case ETHTOOL_GTSO:
1783 case ETHTOOL_GPERMADDR:
1784 case ETHTOOL_GUFO:
1785 case ETHTOOL_GGSO:
1786 case ETHTOOL_GGRO:
1787 case ETHTOOL_GFLAGS:
1788 case ETHTOOL_GPFLAGS:
1789 case ETHTOOL_GRXFH:
1790 case ETHTOOL_GRXRINGS:
1791 case ETHTOOL_GRXCLSRLCNT:
1792 case ETHTOOL_GRXCLSRULE:
1793 case ETHTOOL_GRXCLSRLALL:
1794 case ETHTOOL_GRXFHINDIR:
1795 case ETHTOOL_GRSSH:
1796 case ETHTOOL_GFEATURES:
1797 case ETHTOOL_GCHANNELS:
1798 case ETHTOOL_GET_TS_INFO:
1799 case ETHTOOL_GEEE:
1800 case ETHTOOL_GTUNABLE:
1801 break;
1802 default:
1803 if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
1804 return -EPERM;
1805 }
1806
1807 if (dev->ethtool_ops->begin) {
1808 rc = dev->ethtool_ops->begin(dev);
1809 if (rc < 0)
1810 return rc;
1811 }
1812 old_features = dev->features;
1813
1814 switch (ethcmd) {
1815 case ETHTOOL_GSET:
1816 rc = ethtool_get_settings(dev, useraddr);
1817 break;
1818 case ETHTOOL_SSET:
1819 rc = ethtool_set_settings(dev, useraddr);
1820 break;
1821 case ETHTOOL_GDRVINFO:
1822 rc = ethtool_get_drvinfo(dev, useraddr);
1823 break;
1824 case ETHTOOL_GREGS:
1825 rc = ethtool_get_regs(dev, useraddr);
1826 break;
1827 case ETHTOOL_GWOL:
1828 rc = ethtool_get_wol(dev, useraddr);
1829 break;
1830 case ETHTOOL_SWOL:
1831 rc = ethtool_set_wol(dev, useraddr);
1832 break;
1833 case ETHTOOL_GMSGLVL:
1834 rc = ethtool_get_value(dev, useraddr, ethcmd,
1835 dev->ethtool_ops->get_msglevel);
1836 break;
1837 case ETHTOOL_SMSGLVL:
1838 rc = ethtool_set_value_void(dev, useraddr,
1839 dev->ethtool_ops->set_msglevel);
1840 break;
1841 case ETHTOOL_GEEE:
1842 rc = ethtool_get_eee(dev, useraddr);
1843 break;
1844 case ETHTOOL_SEEE:
1845 rc = ethtool_set_eee(dev, useraddr);
1846 break;
1847 case ETHTOOL_NWAY_RST:
1848 rc = ethtool_nway_reset(dev);
1849 break;
1850 case ETHTOOL_GLINK:
1851 rc = ethtool_get_link(dev, useraddr);
1852 break;
1853 case ETHTOOL_GEEPROM:
1854 rc = ethtool_get_eeprom(dev, useraddr);
1855 break;
1856 case ETHTOOL_SEEPROM:
1857 rc = ethtool_set_eeprom(dev, useraddr);
1858 break;
1859 case ETHTOOL_GCOALESCE:
1860 rc = ethtool_get_coalesce(dev, useraddr);
1861 break;
1862 case ETHTOOL_SCOALESCE:
1863 rc = ethtool_set_coalesce(dev, useraddr);
1864 break;
1865 case ETHTOOL_GRINGPARAM:
1866 rc = ethtool_get_ringparam(dev, useraddr);
1867 break;
1868 case ETHTOOL_SRINGPARAM:
1869 rc = ethtool_set_ringparam(dev, useraddr);
1870 break;
1871 case ETHTOOL_GPAUSEPARAM:
1872 rc = ethtool_get_pauseparam(dev, useraddr);
1873 break;
1874 case ETHTOOL_SPAUSEPARAM:
1875 rc = ethtool_set_pauseparam(dev, useraddr);
1876 break;
1877 case ETHTOOL_TEST:
1878 rc = ethtool_self_test(dev, useraddr);
1879 break;
1880 case ETHTOOL_GSTRINGS:
1881 rc = ethtool_get_strings(dev, useraddr);
1882 break;
1883 case ETHTOOL_PHYS_ID:
1884 rc = ethtool_phys_id(dev, useraddr);
1885 break;
1886 case ETHTOOL_GSTATS:
1887 rc = ethtool_get_stats(dev, useraddr);
1888 break;
1889 case ETHTOOL_GPERMADDR:
1890 rc = ethtool_get_perm_addr(dev, useraddr);
1891 break;
1892 case ETHTOOL_GFLAGS:
1893 rc = ethtool_get_value(dev, useraddr, ethcmd,
1894 __ethtool_get_flags);
1895 break;
1896 case ETHTOOL_SFLAGS:
1897 rc = ethtool_set_value(dev, useraddr, __ethtool_set_flags);
1898 break;
1899 case ETHTOOL_GPFLAGS:
1900 rc = ethtool_get_value(dev, useraddr, ethcmd,
1901 dev->ethtool_ops->get_priv_flags);
1902 break;
1903 case ETHTOOL_SPFLAGS:
1904 rc = ethtool_set_value(dev, useraddr,
1905 dev->ethtool_ops->set_priv_flags);
1906 break;
1907 case ETHTOOL_GRXFH:
1908 case ETHTOOL_GRXRINGS:
1909 case ETHTOOL_GRXCLSRLCNT:
1910 case ETHTOOL_GRXCLSRULE:
1911 case ETHTOOL_GRXCLSRLALL:
1912 rc = ethtool_get_rxnfc(dev, ethcmd, useraddr);
1913 break;
1914 case ETHTOOL_SRXFH:
1915 case ETHTOOL_SRXCLSRLDEL:
1916 case ETHTOOL_SRXCLSRLINS:
1917 rc = ethtool_set_rxnfc(dev, ethcmd, useraddr);
1918 break;
1919 case ETHTOOL_FLASHDEV:
1920 rc = ethtool_flash_device(dev, useraddr);
1921 break;
1922 case ETHTOOL_RESET:
1923 rc = ethtool_reset(dev, useraddr);
1924 break;
1925 case ETHTOOL_GSSET_INFO:
1926 rc = ethtool_get_sset_info(dev, useraddr);
1927 break;
1928 case ETHTOOL_GRXFHINDIR:
1929 rc = ethtool_get_rxfh_indir(dev, useraddr);
1930 break;
1931 case ETHTOOL_SRXFHINDIR:
1932 rc = ethtool_set_rxfh_indir(dev, useraddr);
1933 break;
1934 case ETHTOOL_GRSSH:
1935 rc = ethtool_get_rxfh(dev, useraddr);
1936 break;
1937 case ETHTOOL_SRSSH:
1938 rc = ethtool_set_rxfh(dev, useraddr);
1939 break;
1940 case ETHTOOL_GFEATURES:
1941 rc = ethtool_get_features(dev, useraddr);
1942 break;
1943 case ETHTOOL_SFEATURES:
1944 rc = ethtool_set_features(dev, useraddr);
1945 break;
1946 case ETHTOOL_GTXCSUM:
1947 case ETHTOOL_GRXCSUM:
1948 case ETHTOOL_GSG:
1949 case ETHTOOL_GTSO:
1950 case ETHTOOL_GUFO:
1951 case ETHTOOL_GGSO:
1952 case ETHTOOL_GGRO:
1953 rc = ethtool_get_one_feature(dev, useraddr, ethcmd);
1954 break;
1955 case ETHTOOL_STXCSUM:
1956 case ETHTOOL_SRXCSUM:
1957 case ETHTOOL_SSG:
1958 case ETHTOOL_STSO:
1959 case ETHTOOL_SUFO:
1960 case ETHTOOL_SGSO:
1961 case ETHTOOL_SGRO:
1962 rc = ethtool_set_one_feature(dev, useraddr, ethcmd);
1963 break;
1964 case ETHTOOL_GCHANNELS:
1965 rc = ethtool_get_channels(dev, useraddr);
1966 break;
1967 case ETHTOOL_SCHANNELS:
1968 rc = ethtool_set_channels(dev, useraddr);
1969 break;
1970 case ETHTOOL_SET_DUMP:
1971 rc = ethtool_set_dump(dev, useraddr);
1972 break;
1973 case ETHTOOL_GET_DUMP_FLAG:
1974 rc = ethtool_get_dump_flag(dev, useraddr);
1975 break;
1976 case ETHTOOL_GET_DUMP_DATA:
1977 rc = ethtool_get_dump_data(dev, useraddr);
1978 break;
1979 case ETHTOOL_GET_TS_INFO:
1980 rc = ethtool_get_ts_info(dev, useraddr);
1981 break;
1982 case ETHTOOL_GMODULEINFO:
1983 rc = ethtool_get_module_info(dev, useraddr);
1984 break;
1985 case ETHTOOL_GMODULEEEPROM:
1986 rc = ethtool_get_module_eeprom(dev, useraddr);
1987 break;
1988 case ETHTOOL_GTUNABLE:
1989 rc = ethtool_get_tunable(dev, useraddr);
1990 break;
1991 case ETHTOOL_STUNABLE:
1992 rc = ethtool_set_tunable(dev, useraddr);
1993 break;
1994 default:
1995 rc = -EOPNOTSUPP;
1996 }
1997
1998 if (dev->ethtool_ops->complete)
1999 dev->ethtool_ops->complete(dev);
2000
2001 if (old_features != dev->features)
2002 netdev_features_change(dev);
2003
2004 return rc;
2005}
2006
