Merge branch 'docs-next' of git://git.lwn.net/linux-2.6
[linux-2.6] / 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 <asm/uaccess.h>
21
22 /*
23  * Some useful ethtool_ops methods that're device independent.
24  * If we find that all drivers want to do the same thing here,
25  * we can turn these into dev_() function calls.
26  */
27
28 u32 ethtool_op_get_link(struct net_device *dev)
29 {
30         return netif_carrier_ok(dev) ? 1 : 0;
31 }
32
33 u32 ethtool_op_get_tx_csum(struct net_device *dev)
34 {
35         return (dev->features & NETIF_F_ALL_CSUM) != 0;
36 }
37
38 int ethtool_op_set_tx_csum(struct net_device *dev, u32 data)
39 {
40         if (data)
41                 dev->features |= NETIF_F_IP_CSUM;
42         else
43                 dev->features &= ~NETIF_F_IP_CSUM;
44
45         return 0;
46 }
47
48 int ethtool_op_set_tx_hw_csum(struct net_device *dev, u32 data)
49 {
50         if (data)
51                 dev->features |= NETIF_F_HW_CSUM;
52         else
53                 dev->features &= ~NETIF_F_HW_CSUM;
54
55         return 0;
56 }
57
58 int ethtool_op_set_tx_ipv6_csum(struct net_device *dev, u32 data)
59 {
60         if (data)
61                 dev->features |= NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM;
62         else
63                 dev->features &= ~(NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM);
64
65         return 0;
66 }
67
68 u32 ethtool_op_get_sg(struct net_device *dev)
69 {
70         return (dev->features & NETIF_F_SG) != 0;
71 }
72
73 int ethtool_op_set_sg(struct net_device *dev, u32 data)
74 {
75         if (data)
76                 dev->features |= NETIF_F_SG;
77         else
78                 dev->features &= ~NETIF_F_SG;
79
80         return 0;
81 }
82
83 u32 ethtool_op_get_tso(struct net_device *dev)
84 {
85         return (dev->features & NETIF_F_TSO) != 0;
86 }
87
88 int ethtool_op_set_tso(struct net_device *dev, u32 data)
89 {
90         if (data)
91                 dev->features |= NETIF_F_TSO;
92         else
93                 dev->features &= ~NETIF_F_TSO;
94
95         return 0;
96 }
97
98 u32 ethtool_op_get_ufo(struct net_device *dev)
99 {
100         return (dev->features & NETIF_F_UFO) != 0;
101 }
102
103 int ethtool_op_set_ufo(struct net_device *dev, u32 data)
104 {
105         if (data)
106                 dev->features |= NETIF_F_UFO;
107         else
108                 dev->features &= ~NETIF_F_UFO;
109         return 0;
110 }
111
112 /* the following list of flags are the same as their associated
113  * NETIF_F_xxx values in include/linux/netdevice.h
114  */
115 static const u32 flags_dup_features =
116         ETH_FLAG_LRO;
117
118 u32 ethtool_op_get_flags(struct net_device *dev)
119 {
120         /* in the future, this function will probably contain additional
121          * handling for flags which are not so easily handled
122          * by a simple masking operation
123          */
124
125         return dev->features & flags_dup_features;
126 }
127
128 int ethtool_op_set_flags(struct net_device *dev, u32 data)
129 {
130         if (data & ETH_FLAG_LRO)
131                 dev->features |= NETIF_F_LRO;
132         else
133                 dev->features &= ~NETIF_F_LRO;
134
135         return 0;
136 }
137
138 /* Handlers for each ethtool command */
139
140 static int ethtool_get_settings(struct net_device *dev, void __user *useraddr)
141 {
142         struct ethtool_cmd cmd = { ETHTOOL_GSET };
143         int err;
144
145         if (!dev->ethtool_ops->get_settings)
146                 return -EOPNOTSUPP;
147
148         err = dev->ethtool_ops->get_settings(dev, &cmd);
149         if (err < 0)
150                 return err;
151
152         if (copy_to_user(useraddr, &cmd, sizeof(cmd)))
153                 return -EFAULT;
154         return 0;
155 }
156
157 static int ethtool_set_settings(struct net_device *dev, void __user *useraddr)
158 {
159         struct ethtool_cmd cmd;
160
161         if (!dev->ethtool_ops->set_settings)
162                 return -EOPNOTSUPP;
163
164         if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
165                 return -EFAULT;
166
167         return dev->ethtool_ops->set_settings(dev, &cmd);
168 }
169
170 static int ethtool_get_drvinfo(struct net_device *dev, void __user *useraddr)
171 {
172         struct ethtool_drvinfo info;
173         const struct ethtool_ops *ops = dev->ethtool_ops;
174
175         if (!ops->get_drvinfo)
176                 return -EOPNOTSUPP;
177
178         memset(&info, 0, sizeof(info));
179         info.cmd = ETHTOOL_GDRVINFO;
180         ops->get_drvinfo(dev, &info);
181
182         if (ops->get_sset_count) {
183                 int rc;
184
185                 rc = ops->get_sset_count(dev, ETH_SS_TEST);
186                 if (rc >= 0)
187                         info.testinfo_len = rc;
188                 rc = ops->get_sset_count(dev, ETH_SS_STATS);
189                 if (rc >= 0)
190                         info.n_stats = rc;
191                 rc = ops->get_sset_count(dev, ETH_SS_PRIV_FLAGS);
192                 if (rc >= 0)
193                         info.n_priv_flags = rc;
194         } else {
195                 /* code path for obsolete hooks */
196
197                 if (ops->self_test_count)
198                         info.testinfo_len = ops->self_test_count(dev);
199                 if (ops->get_stats_count)
200                         info.n_stats = ops->get_stats_count(dev);
201         }
202         if (ops->get_regs_len)
203                 info.regdump_len = ops->get_regs_len(dev);
204         if (ops->get_eeprom_len)
205                 info.eedump_len = ops->get_eeprom_len(dev);
206
207         if (copy_to_user(useraddr, &info, sizeof(info)))
208                 return -EFAULT;
209         return 0;
210 }
211
212 static int ethtool_set_rxhash(struct net_device *dev, void __user *useraddr)
213 {
214         struct ethtool_rxnfc cmd;
215
216         if (!dev->ethtool_ops->set_rxhash)
217                 return -EOPNOTSUPP;
218
219         if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
220                 return -EFAULT;
221
222         return dev->ethtool_ops->set_rxhash(dev, &cmd);
223 }
224
225 static int ethtool_get_rxhash(struct net_device *dev, void __user *useraddr)
226 {
227         struct ethtool_rxnfc info;
228
229         if (!dev->ethtool_ops->get_rxhash)
230                 return -EOPNOTSUPP;
231
232         if (copy_from_user(&info, useraddr, sizeof(info)))
233                 return -EFAULT;
234
235         dev->ethtool_ops->get_rxhash(dev, &info);
236
237         if (copy_to_user(useraddr, &info, sizeof(info)))
238                 return -EFAULT;
239         return 0;
240 }
241
242 static int ethtool_get_regs(struct net_device *dev, char __user *useraddr)
243 {
244         struct ethtool_regs regs;
245         const struct ethtool_ops *ops = dev->ethtool_ops;
246         void *regbuf;
247         int reglen, ret;
248
249         if (!ops->get_regs || !ops->get_regs_len)
250                 return -EOPNOTSUPP;
251
252         if (copy_from_user(&regs, useraddr, sizeof(regs)))
253                 return -EFAULT;
254
255         reglen = ops->get_regs_len(dev);
256         if (regs.len > reglen)
257                 regs.len = reglen;
258
259         regbuf = kmalloc(reglen, GFP_USER);
260         if (!regbuf)
261                 return -ENOMEM;
262
263         ops->get_regs(dev, &regs, regbuf);
264
265         ret = -EFAULT;
266         if (copy_to_user(useraddr, &regs, sizeof(regs)))
267                 goto out;
268         useraddr += offsetof(struct ethtool_regs, data);
269         if (copy_to_user(useraddr, regbuf, regs.len))
270                 goto out;
271         ret = 0;
272
273  out:
274         kfree(regbuf);
275         return ret;
276 }
277
278 static int ethtool_get_wol(struct net_device *dev, char __user *useraddr)
279 {
280         struct ethtool_wolinfo wol = { ETHTOOL_GWOL };
281
282         if (!dev->ethtool_ops->get_wol)
283                 return -EOPNOTSUPP;
284
285         dev->ethtool_ops->get_wol(dev, &wol);
286
287         if (copy_to_user(useraddr, &wol, sizeof(wol)))
288                 return -EFAULT;
289         return 0;
290 }
291
292 static int ethtool_set_wol(struct net_device *dev, char __user *useraddr)
293 {
294         struct ethtool_wolinfo wol;
295
296         if (!dev->ethtool_ops->set_wol)
297                 return -EOPNOTSUPP;
298
299         if (copy_from_user(&wol, useraddr, sizeof(wol)))
300                 return -EFAULT;
301
302         return dev->ethtool_ops->set_wol(dev, &wol);
303 }
304
305 static int ethtool_nway_reset(struct net_device *dev)
306 {
307         if (!dev->ethtool_ops->nway_reset)
308                 return -EOPNOTSUPP;
309
310         return dev->ethtool_ops->nway_reset(dev);
311 }
312
313 static int ethtool_get_eeprom(struct net_device *dev, void __user *useraddr)
314 {
315         struct ethtool_eeprom eeprom;
316         const struct ethtool_ops *ops = dev->ethtool_ops;
317         void __user *userbuf = useraddr + sizeof(eeprom);
318         u32 bytes_remaining;
319         u8 *data;
320         int ret = 0;
321
322         if (!ops->get_eeprom || !ops->get_eeprom_len)
323                 return -EOPNOTSUPP;
324
325         if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
326                 return -EFAULT;
327
328         /* Check for wrap and zero */
329         if (eeprom.offset + eeprom.len <= eeprom.offset)
330                 return -EINVAL;
331
332         /* Check for exceeding total eeprom len */
333         if (eeprom.offset + eeprom.len > ops->get_eeprom_len(dev))
334                 return -EINVAL;
335
336         data = kmalloc(PAGE_SIZE, GFP_USER);
337         if (!data)
338                 return -ENOMEM;
339
340         bytes_remaining = eeprom.len;
341         while (bytes_remaining > 0) {
342                 eeprom.len = min(bytes_remaining, (u32)PAGE_SIZE);
343
344                 ret = ops->get_eeprom(dev, &eeprom, data);
345                 if (ret)
346                         break;
347                 if (copy_to_user(userbuf, data, eeprom.len)) {
348                         ret = -EFAULT;
349                         break;
350                 }
351                 userbuf += eeprom.len;
352                 eeprom.offset += eeprom.len;
353                 bytes_remaining -= eeprom.len;
354         }
355
356         eeprom.len = userbuf - (useraddr + sizeof(eeprom));
357         eeprom.offset -= eeprom.len;
358         if (copy_to_user(useraddr, &eeprom, sizeof(eeprom)))
359                 ret = -EFAULT;
360
361         kfree(data);
362         return ret;
363 }
364
365 static int ethtool_set_eeprom(struct net_device *dev, void __user *useraddr)
366 {
367         struct ethtool_eeprom eeprom;
368         const struct ethtool_ops *ops = dev->ethtool_ops;
369         void __user *userbuf = useraddr + sizeof(eeprom);
370         u32 bytes_remaining;
371         u8 *data;
372         int ret = 0;
373
374         if (!ops->set_eeprom || !ops->get_eeprom_len)
375                 return -EOPNOTSUPP;
376
377         if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
378                 return -EFAULT;
379
380         /* Check for wrap and zero */
381         if (eeprom.offset + eeprom.len <= eeprom.offset)
382                 return -EINVAL;
383
384         /* Check for exceeding total eeprom len */
385         if (eeprom.offset + eeprom.len > ops->get_eeprom_len(dev))
386                 return -EINVAL;
387
388         data = kmalloc(PAGE_SIZE, GFP_USER);
389         if (!data)
390                 return -ENOMEM;
391
392         bytes_remaining = eeprom.len;
393         while (bytes_remaining > 0) {
394                 eeprom.len = min(bytes_remaining, (u32)PAGE_SIZE);
395
396                 if (copy_from_user(data, userbuf, eeprom.len)) {
397                         ret = -EFAULT;
398                         break;
399                 }
400                 ret = ops->set_eeprom(dev, &eeprom, data);
401                 if (ret)
402                         break;
403                 userbuf += eeprom.len;
404                 eeprom.offset += eeprom.len;
405                 bytes_remaining -= eeprom.len;
406         }
407
408         kfree(data);
409         return ret;
410 }
411
412 static int ethtool_get_coalesce(struct net_device *dev, void __user *useraddr)
413 {
414         struct ethtool_coalesce coalesce = { ETHTOOL_GCOALESCE };
415
416         if (!dev->ethtool_ops->get_coalesce)
417                 return -EOPNOTSUPP;
418
419         dev->ethtool_ops->get_coalesce(dev, &coalesce);
420
421         if (copy_to_user(useraddr, &coalesce, sizeof(coalesce)))
422                 return -EFAULT;
423         return 0;
424 }
425
426 static int ethtool_set_coalesce(struct net_device *dev, void __user *useraddr)
427 {
428         struct ethtool_coalesce coalesce;
429
430         if (!dev->ethtool_ops->set_coalesce)
431                 return -EOPNOTSUPP;
432
433         if (copy_from_user(&coalesce, useraddr, sizeof(coalesce)))
434                 return -EFAULT;
435
436         return dev->ethtool_ops->set_coalesce(dev, &coalesce);
437 }
438
439 static int ethtool_get_ringparam(struct net_device *dev, void __user *useraddr)
440 {
441         struct ethtool_ringparam ringparam = { ETHTOOL_GRINGPARAM };
442
443         if (!dev->ethtool_ops->get_ringparam)
444                 return -EOPNOTSUPP;
445
446         dev->ethtool_ops->get_ringparam(dev, &ringparam);
447
448         if (copy_to_user(useraddr, &ringparam, sizeof(ringparam)))
449                 return -EFAULT;
450         return 0;
451 }
452
453 static int ethtool_set_ringparam(struct net_device *dev, void __user *useraddr)
454 {
455         struct ethtool_ringparam ringparam;
456
457         if (!dev->ethtool_ops->set_ringparam)
458                 return -EOPNOTSUPP;
459
460         if (copy_from_user(&ringparam, useraddr, sizeof(ringparam)))
461                 return -EFAULT;
462
463         return dev->ethtool_ops->set_ringparam(dev, &ringparam);
464 }
465
466 static int ethtool_get_pauseparam(struct net_device *dev, void __user *useraddr)
467 {
468         struct ethtool_pauseparam pauseparam = { ETHTOOL_GPAUSEPARAM };
469
470         if (!dev->ethtool_ops->get_pauseparam)
471                 return -EOPNOTSUPP;
472
473         dev->ethtool_ops->get_pauseparam(dev, &pauseparam);
474
475         if (copy_to_user(useraddr, &pauseparam, sizeof(pauseparam)))
476                 return -EFAULT;
477         return 0;
478 }
479
480 static int ethtool_set_pauseparam(struct net_device *dev, void __user *useraddr)
481 {
482         struct ethtool_pauseparam pauseparam;
483
484         if (!dev->ethtool_ops->set_pauseparam)
485                 return -EOPNOTSUPP;
486
487         if (copy_from_user(&pauseparam, useraddr, sizeof(pauseparam)))
488                 return -EFAULT;
489
490         return dev->ethtool_ops->set_pauseparam(dev, &pauseparam);
491 }
492
493 static int __ethtool_set_sg(struct net_device *dev, u32 data)
494 {
495         int err;
496
497         if (!data && dev->ethtool_ops->set_tso) {
498                 err = dev->ethtool_ops->set_tso(dev, 0);
499                 if (err)
500                         return err;
501         }
502
503         if (!data && dev->ethtool_ops->set_ufo) {
504                 err = dev->ethtool_ops->set_ufo(dev, 0);
505                 if (err)
506                         return err;
507         }
508         return dev->ethtool_ops->set_sg(dev, data);
509 }
510
511 static int ethtool_set_tx_csum(struct net_device *dev, char __user *useraddr)
512 {
513         struct ethtool_value edata;
514         int err;
515
516         if (!dev->ethtool_ops->set_tx_csum)
517                 return -EOPNOTSUPP;
518
519         if (copy_from_user(&edata, useraddr, sizeof(edata)))
520                 return -EFAULT;
521
522         if (!edata.data && dev->ethtool_ops->set_sg) {
523                 err = __ethtool_set_sg(dev, 0);
524                 if (err)
525                         return err;
526         }
527
528         return dev->ethtool_ops->set_tx_csum(dev, edata.data);
529 }
530
531 static int ethtool_set_rx_csum(struct net_device *dev, char __user *useraddr)
532 {
533         struct ethtool_value edata;
534
535         if (!dev->ethtool_ops->set_rx_csum)
536                 return -EOPNOTSUPP;
537
538         if (copy_from_user(&edata, useraddr, sizeof(edata)))
539                 return -EFAULT;
540
541         if (!edata.data && dev->ethtool_ops->set_sg)
542                 dev->features &= ~NETIF_F_GRO;
543
544         return dev->ethtool_ops->set_rx_csum(dev, edata.data);
545 }
546
547 static int ethtool_set_sg(struct net_device *dev, char __user *useraddr)
548 {
549         struct ethtool_value edata;
550
551         if (!dev->ethtool_ops->set_sg)
552                 return -EOPNOTSUPP;
553
554         if (copy_from_user(&edata, useraddr, sizeof(edata)))
555                 return -EFAULT;
556
557         if (edata.data &&
558             !(dev->features & NETIF_F_ALL_CSUM))
559                 return -EINVAL;
560
561         return __ethtool_set_sg(dev, edata.data);
562 }
563
564 static int ethtool_set_tso(struct net_device *dev, char __user *useraddr)
565 {
566         struct ethtool_value edata;
567
568         if (!dev->ethtool_ops->set_tso)
569                 return -EOPNOTSUPP;
570
571         if (copy_from_user(&edata, useraddr, sizeof(edata)))
572                 return -EFAULT;
573
574         if (edata.data && !(dev->features & NETIF_F_SG))
575                 return -EINVAL;
576
577         return dev->ethtool_ops->set_tso(dev, edata.data);
578 }
579
580 static int ethtool_set_ufo(struct net_device *dev, char __user *useraddr)
581 {
582         struct ethtool_value edata;
583
584         if (!dev->ethtool_ops->set_ufo)
585                 return -EOPNOTSUPP;
586         if (copy_from_user(&edata, useraddr, sizeof(edata)))
587                 return -EFAULT;
588         if (edata.data && !(dev->features & NETIF_F_SG))
589                 return -EINVAL;
590         if (edata.data && !(dev->features & NETIF_F_HW_CSUM))
591                 return -EINVAL;
592         return dev->ethtool_ops->set_ufo(dev, edata.data);
593 }
594
595 static int ethtool_get_gso(struct net_device *dev, char __user *useraddr)
596 {
597         struct ethtool_value edata = { ETHTOOL_GGSO };
598
599         edata.data = dev->features & NETIF_F_GSO;
600         if (copy_to_user(useraddr, &edata, sizeof(edata)))
601                  return -EFAULT;
602         return 0;
603 }
604
605 static int ethtool_set_gso(struct net_device *dev, char __user *useraddr)
606 {
607         struct ethtool_value edata;
608
609         if (copy_from_user(&edata, useraddr, sizeof(edata)))
610                 return -EFAULT;
611         if (edata.data)
612                 dev->features |= NETIF_F_GSO;
613         else
614                 dev->features &= ~NETIF_F_GSO;
615         return 0;
616 }
617
618 static int ethtool_get_gro(struct net_device *dev, char __user *useraddr)
619 {
620         struct ethtool_value edata = { ETHTOOL_GGRO };
621
622         edata.data = dev->features & NETIF_F_GRO;
623         if (copy_to_user(useraddr, &edata, sizeof(edata)))
624                  return -EFAULT;
625         return 0;
626 }
627
628 static int ethtool_set_gro(struct net_device *dev, char __user *useraddr)
629 {
630         struct ethtool_value edata;
631
632         if (copy_from_user(&edata, useraddr, sizeof(edata)))
633                 return -EFAULT;
634
635         if (edata.data) {
636                 if (!dev->ethtool_ops->get_rx_csum ||
637                     !dev->ethtool_ops->get_rx_csum(dev))
638                         return -EINVAL;
639                 dev->features |= NETIF_F_GRO;
640         } else
641                 dev->features &= ~NETIF_F_GRO;
642
643         return 0;
644 }
645
646 static int ethtool_self_test(struct net_device *dev, char __user *useraddr)
647 {
648         struct ethtool_test test;
649         const struct ethtool_ops *ops = dev->ethtool_ops;
650         u64 *data;
651         int ret, test_len;
652
653         if (!ops->self_test)
654                 return -EOPNOTSUPP;
655         if (!ops->get_sset_count && !ops->self_test_count)
656                 return -EOPNOTSUPP;
657
658         if (ops->get_sset_count)
659                 test_len = ops->get_sset_count(dev, ETH_SS_TEST);
660         else
661                 /* code path for obsolete hook */
662                 test_len = ops->self_test_count(dev);
663         if (test_len < 0)
664                 return test_len;
665         WARN_ON(test_len == 0);
666
667         if (copy_from_user(&test, useraddr, sizeof(test)))
668                 return -EFAULT;
669
670         test.len = test_len;
671         data = kmalloc(test_len * sizeof(u64), GFP_USER);
672         if (!data)
673                 return -ENOMEM;
674
675         ops->self_test(dev, &test, data);
676
677         ret = -EFAULT;
678         if (copy_to_user(useraddr, &test, sizeof(test)))
679                 goto out;
680         useraddr += sizeof(test);
681         if (copy_to_user(useraddr, data, test.len * sizeof(u64)))
682                 goto out;
683         ret = 0;
684
685  out:
686         kfree(data);
687         return ret;
688 }
689
690 static int ethtool_get_strings(struct net_device *dev, void __user *useraddr)
691 {
692         struct ethtool_gstrings gstrings;
693         const struct ethtool_ops *ops = dev->ethtool_ops;
694         u8 *data;
695         int ret;
696
697         if (!ops->get_strings)
698                 return -EOPNOTSUPP;
699
700         if (copy_from_user(&gstrings, useraddr, sizeof(gstrings)))
701                 return -EFAULT;
702
703         if (ops->get_sset_count) {
704                 ret = ops->get_sset_count(dev, gstrings.string_set);
705                 if (ret < 0)
706                         return ret;
707
708                 gstrings.len = ret;
709         } else {
710                 /* code path for obsolete hooks */
711
712                 switch (gstrings.string_set) {
713                 case ETH_SS_TEST:
714                         if (!ops->self_test_count)
715                                 return -EOPNOTSUPP;
716                         gstrings.len = ops->self_test_count(dev);
717                         break;
718                 case ETH_SS_STATS:
719                         if (!ops->get_stats_count)
720                                 return -EOPNOTSUPP;
721                         gstrings.len = ops->get_stats_count(dev);
722                         break;
723                 default:
724                         return -EINVAL;
725                 }
726         }
727
728         data = kmalloc(gstrings.len * ETH_GSTRING_LEN, GFP_USER);
729         if (!data)
730                 return -ENOMEM;
731
732         ops->get_strings(dev, gstrings.string_set, data);
733
734         ret = -EFAULT;
735         if (copy_to_user(useraddr, &gstrings, sizeof(gstrings)))
736                 goto out;
737         useraddr += sizeof(gstrings);
738         if (copy_to_user(useraddr, data, gstrings.len * ETH_GSTRING_LEN))
739                 goto out;
740         ret = 0;
741
742  out:
743         kfree(data);
744         return ret;
745 }
746
747 static int ethtool_phys_id(struct net_device *dev, void __user *useraddr)
748 {
749         struct ethtool_value id;
750
751         if (!dev->ethtool_ops->phys_id)
752                 return -EOPNOTSUPP;
753
754         if (copy_from_user(&id, useraddr, sizeof(id)))
755                 return -EFAULT;
756
757         return dev->ethtool_ops->phys_id(dev, id.data);
758 }
759
760 static int ethtool_get_stats(struct net_device *dev, void __user *useraddr)
761 {
762         struct ethtool_stats stats;
763         const struct ethtool_ops *ops = dev->ethtool_ops;
764         u64 *data;
765         int ret, n_stats;
766
767         if (!ops->get_ethtool_stats)
768                 return -EOPNOTSUPP;
769         if (!ops->get_sset_count && !ops->get_stats_count)
770                 return -EOPNOTSUPP;
771
772         if (ops->get_sset_count)
773                 n_stats = ops->get_sset_count(dev, ETH_SS_STATS);
774         else
775                 /* code path for obsolete hook */
776                 n_stats = ops->get_stats_count(dev);
777         if (n_stats < 0)
778                 return n_stats;
779         WARN_ON(n_stats == 0);
780
781         if (copy_from_user(&stats, useraddr, sizeof(stats)))
782                 return -EFAULT;
783
784         stats.n_stats = n_stats;
785         data = kmalloc(n_stats * sizeof(u64), GFP_USER);
786         if (!data)
787                 return -ENOMEM;
788
789         ops->get_ethtool_stats(dev, &stats, data);
790
791         ret = -EFAULT;
792         if (copy_to_user(useraddr, &stats, sizeof(stats)))
793                 goto out;
794         useraddr += sizeof(stats);
795         if (copy_to_user(useraddr, data, stats.n_stats * sizeof(u64)))
796                 goto out;
797         ret = 0;
798
799  out:
800         kfree(data);
801         return ret;
802 }
803
804 static int ethtool_get_perm_addr(struct net_device *dev, void __user *useraddr)
805 {
806         struct ethtool_perm_addr epaddr;
807
808         if (copy_from_user(&epaddr, useraddr, sizeof(epaddr)))
809                 return -EFAULT;
810
811         if (epaddr.size < dev->addr_len)
812                 return -ETOOSMALL;
813         epaddr.size = dev->addr_len;
814
815         if (copy_to_user(useraddr, &epaddr, sizeof(epaddr)))
816                 return -EFAULT;
817         useraddr += sizeof(epaddr);
818         if (copy_to_user(useraddr, dev->perm_addr, epaddr.size))
819                 return -EFAULT;
820         return 0;
821 }
822
823 static int ethtool_get_value(struct net_device *dev, char __user *useraddr,
824                              u32 cmd, u32 (*actor)(struct net_device *))
825 {
826         struct ethtool_value edata = { cmd };
827
828         if (!actor)
829                 return -EOPNOTSUPP;
830
831         edata.data = actor(dev);
832
833         if (copy_to_user(useraddr, &edata, sizeof(edata)))
834                 return -EFAULT;
835         return 0;
836 }
837
838 static int ethtool_set_value_void(struct net_device *dev, char __user *useraddr,
839                              void (*actor)(struct net_device *, u32))
840 {
841         struct ethtool_value edata;
842
843         if (!actor)
844                 return -EOPNOTSUPP;
845
846         if (copy_from_user(&edata, useraddr, sizeof(edata)))
847                 return -EFAULT;
848
849         actor(dev, edata.data);
850         return 0;
851 }
852
853 static int ethtool_set_value(struct net_device *dev, char __user *useraddr,
854                              int (*actor)(struct net_device *, u32))
855 {
856         struct ethtool_value edata;
857
858         if (!actor)
859                 return -EOPNOTSUPP;
860
861         if (copy_from_user(&edata, useraddr, sizeof(edata)))
862                 return -EFAULT;
863
864         return actor(dev, edata.data);
865 }
866
867 /* The main entry point in this file.  Called from net/core/dev.c */
868
869 int dev_ethtool(struct net *net, struct ifreq *ifr)
870 {
871         struct net_device *dev = __dev_get_by_name(net, ifr->ifr_name);
872         void __user *useraddr = ifr->ifr_data;
873         u32 ethcmd;
874         int rc;
875         unsigned long old_features;
876
877         if (!dev || !netif_device_present(dev))
878                 return -ENODEV;
879
880         if (!dev->ethtool_ops)
881                 return -EOPNOTSUPP;
882
883         if (copy_from_user(&ethcmd, useraddr, sizeof (ethcmd)))
884                 return -EFAULT;
885
886         /* Allow some commands to be done by anyone */
887         switch(ethcmd) {
888         case ETHTOOL_GDRVINFO:
889         case ETHTOOL_GMSGLVL:
890         case ETHTOOL_GCOALESCE:
891         case ETHTOOL_GRINGPARAM:
892         case ETHTOOL_GPAUSEPARAM:
893         case ETHTOOL_GRXCSUM:
894         case ETHTOOL_GTXCSUM:
895         case ETHTOOL_GSG:
896         case ETHTOOL_GSTRINGS:
897         case ETHTOOL_GTSO:
898         case ETHTOOL_GPERMADDR:
899         case ETHTOOL_GUFO:
900         case ETHTOOL_GGSO:
901         case ETHTOOL_GFLAGS:
902         case ETHTOOL_GPFLAGS:
903         case ETHTOOL_GRXFH:
904                 break;
905         default:
906                 if (!capable(CAP_NET_ADMIN))
907                         return -EPERM;
908         }
909
910         if (dev->ethtool_ops->begin)
911                 if ((rc = dev->ethtool_ops->begin(dev)) < 0)
912                         return rc;
913
914         old_features = dev->features;
915
916         switch (ethcmd) {
917         case ETHTOOL_GSET:
918                 rc = ethtool_get_settings(dev, useraddr);
919                 break;
920         case ETHTOOL_SSET:
921                 rc = ethtool_set_settings(dev, useraddr);
922                 break;
923         case ETHTOOL_GDRVINFO:
924                 rc = ethtool_get_drvinfo(dev, useraddr);
925                 break;
926         case ETHTOOL_GREGS:
927                 rc = ethtool_get_regs(dev, useraddr);
928                 break;
929         case ETHTOOL_GWOL:
930                 rc = ethtool_get_wol(dev, useraddr);
931                 break;
932         case ETHTOOL_SWOL:
933                 rc = ethtool_set_wol(dev, useraddr);
934                 break;
935         case ETHTOOL_GMSGLVL:
936                 rc = ethtool_get_value(dev, useraddr, ethcmd,
937                                        dev->ethtool_ops->get_msglevel);
938                 break;
939         case ETHTOOL_SMSGLVL:
940                 rc = ethtool_set_value_void(dev, useraddr,
941                                        dev->ethtool_ops->set_msglevel);
942                 break;
943         case ETHTOOL_NWAY_RST:
944                 rc = ethtool_nway_reset(dev);
945                 break;
946         case ETHTOOL_GLINK:
947                 rc = ethtool_get_value(dev, useraddr, ethcmd,
948                                        dev->ethtool_ops->get_link);
949                 break;
950         case ETHTOOL_GEEPROM:
951                 rc = ethtool_get_eeprom(dev, useraddr);
952                 break;
953         case ETHTOOL_SEEPROM:
954                 rc = ethtool_set_eeprom(dev, useraddr);
955                 break;
956         case ETHTOOL_GCOALESCE:
957                 rc = ethtool_get_coalesce(dev, useraddr);
958                 break;
959         case ETHTOOL_SCOALESCE:
960                 rc = ethtool_set_coalesce(dev, useraddr);
961                 break;
962         case ETHTOOL_GRINGPARAM:
963                 rc = ethtool_get_ringparam(dev, useraddr);
964                 break;
965         case ETHTOOL_SRINGPARAM:
966                 rc = ethtool_set_ringparam(dev, useraddr);
967                 break;
968         case ETHTOOL_GPAUSEPARAM:
969                 rc = ethtool_get_pauseparam(dev, useraddr);
970                 break;
971         case ETHTOOL_SPAUSEPARAM:
972                 rc = ethtool_set_pauseparam(dev, useraddr);
973                 break;
974         case ETHTOOL_GRXCSUM:
975                 rc = ethtool_get_value(dev, useraddr, ethcmd,
976                                        dev->ethtool_ops->get_rx_csum);
977                 break;
978         case ETHTOOL_SRXCSUM:
979                 rc = ethtool_set_rx_csum(dev, useraddr);
980                 break;
981         case ETHTOOL_GTXCSUM:
982                 rc = ethtool_get_value(dev, useraddr, ethcmd,
983                                        (dev->ethtool_ops->get_tx_csum ?
984                                         dev->ethtool_ops->get_tx_csum :
985                                         ethtool_op_get_tx_csum));
986                 break;
987         case ETHTOOL_STXCSUM:
988                 rc = ethtool_set_tx_csum(dev, useraddr);
989                 break;
990         case ETHTOOL_GSG:
991                 rc = ethtool_get_value(dev, useraddr, ethcmd,
992                                        (dev->ethtool_ops->get_sg ?
993                                         dev->ethtool_ops->get_sg :
994                                         ethtool_op_get_sg));
995                 break;
996         case ETHTOOL_SSG:
997                 rc = ethtool_set_sg(dev, useraddr);
998                 break;
999         case ETHTOOL_GTSO:
1000                 rc = ethtool_get_value(dev, useraddr, ethcmd,
1001                                        (dev->ethtool_ops->get_tso ?
1002                                         dev->ethtool_ops->get_tso :
1003                                         ethtool_op_get_tso));
1004                 break;
1005         case ETHTOOL_STSO:
1006                 rc = ethtool_set_tso(dev, useraddr);
1007                 break;
1008         case ETHTOOL_TEST:
1009                 rc = ethtool_self_test(dev, useraddr);
1010                 break;
1011         case ETHTOOL_GSTRINGS:
1012                 rc = ethtool_get_strings(dev, useraddr);
1013                 break;
1014         case ETHTOOL_PHYS_ID:
1015                 rc = ethtool_phys_id(dev, useraddr);
1016                 break;
1017         case ETHTOOL_GSTATS:
1018                 rc = ethtool_get_stats(dev, useraddr);
1019                 break;
1020         case ETHTOOL_GPERMADDR:
1021                 rc = ethtool_get_perm_addr(dev, useraddr);
1022                 break;
1023         case ETHTOOL_GUFO:
1024                 rc = ethtool_get_value(dev, useraddr, ethcmd,
1025                                        (dev->ethtool_ops->get_ufo ?
1026                                         dev->ethtool_ops->get_ufo :
1027                                         ethtool_op_get_ufo));
1028                 break;
1029         case ETHTOOL_SUFO:
1030                 rc = ethtool_set_ufo(dev, useraddr);
1031                 break;
1032         case ETHTOOL_GGSO:
1033                 rc = ethtool_get_gso(dev, useraddr);
1034                 break;
1035         case ETHTOOL_SGSO:
1036                 rc = ethtool_set_gso(dev, useraddr);
1037                 break;
1038         case ETHTOOL_GFLAGS:
1039                 rc = ethtool_get_value(dev, useraddr, ethcmd,
1040                                        dev->ethtool_ops->get_flags);
1041                 break;
1042         case ETHTOOL_SFLAGS:
1043                 rc = ethtool_set_value(dev, useraddr,
1044                                        dev->ethtool_ops->set_flags);
1045                 break;
1046         case ETHTOOL_GPFLAGS:
1047                 rc = ethtool_get_value(dev, useraddr, ethcmd,
1048                                        dev->ethtool_ops->get_priv_flags);
1049                 break;
1050         case ETHTOOL_SPFLAGS:
1051                 rc = ethtool_set_value(dev, useraddr,
1052                                        dev->ethtool_ops->set_priv_flags);
1053                 break;
1054         case ETHTOOL_GRXFH:
1055                 rc = ethtool_get_rxhash(dev, useraddr);
1056                 break;
1057         case ETHTOOL_SRXFH:
1058                 rc = ethtool_set_rxhash(dev, useraddr);
1059                 break;
1060         case ETHTOOL_GGRO:
1061                 rc = ethtool_get_gro(dev, useraddr);
1062                 break;
1063         case ETHTOOL_SGRO:
1064                 rc = ethtool_set_gro(dev, useraddr);
1065                 break;
1066         default:
1067                 rc = -EOPNOTSUPP;
1068         }
1069
1070         if (dev->ethtool_ops->complete)
1071                 dev->ethtool_ops->complete(dev);
1072
1073         if (old_features != dev->features)
1074                 netdev_features_change(dev);
1075
1076         return rc;
1077 }
1078
1079 EXPORT_SYMBOL(ethtool_op_get_link);
1080 EXPORT_SYMBOL(ethtool_op_get_sg);
1081 EXPORT_SYMBOL(ethtool_op_get_tso);
1082 EXPORT_SYMBOL(ethtool_op_get_tx_csum);
1083 EXPORT_SYMBOL(ethtool_op_set_sg);
1084 EXPORT_SYMBOL(ethtool_op_set_tso);
1085 EXPORT_SYMBOL(ethtool_op_set_tx_csum);
1086 EXPORT_SYMBOL(ethtool_op_set_tx_hw_csum);
1087 EXPORT_SYMBOL(ethtool_op_set_tx_ipv6_csum);
1088 EXPORT_SYMBOL(ethtool_op_set_ufo);
1089 EXPORT_SYMBOL(ethtool_op_get_ufo);
1090 EXPORT_SYMBOL(ethtool_op_set_flags);
1091 EXPORT_SYMBOL(ethtool_op_get_flags);