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