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_GGRO:
 931         case ETHTOOL_GFLAGS:
 932         case ETHTOOL_GPFLAGS:
 933         case ETHTOOL_GRXFH:
 934         case ETHTOOL_GRXRINGS:
 935         case ETHTOOL_GRXCLSRLCNT:
 936         case ETHTOOL_GRXCLSRULE:
 937         case ETHTOOL_GRXCLSRLALL:
 938                 break;
 939         default:
 940                 if (!capable(CAP_NET_ADMIN))
 941                         return -EPERM;
 942         }
 943
 944         if (dev->ethtool_ops->begin)
 945                 if ((rc = dev->ethtool_ops->begin(dev)) < 0)
 946                         return rc;
 947
 948         old_features = dev->features;
 949
 950         switch (ethcmd) {
 951         case ETHTOOL_GSET:
 952                 rc = ethtool_get_settings(dev, useraddr);
 953                 break;
 954         case ETHTOOL_SSET:
 955                 rc = ethtool_set_settings(dev, useraddr);
 956                 break;
 957         case ETHTOOL_GDRVINFO:
 958                 rc = ethtool_get_drvinfo(dev, useraddr);
 959                 break;
 960         case ETHTOOL_GREGS:
 961                 rc = ethtool_get_regs(dev, useraddr);
 962                 break;
 963         case ETHTOOL_GWOL:
 964                 rc = ethtool_get_wol(dev, useraddr);
 965                 break;
 966         case ETHTOOL_SWOL:
 967                 rc = ethtool_set_wol(dev, useraddr);
 968                 break;
 969         case ETHTOOL_GMSGLVL:
 970                 rc = ethtool_get_value(dev, useraddr, ethcmd,
 971                                        dev->ethtool_ops->get_msglevel);
 972                 break;
 973         case ETHTOOL_SMSGLVL:
 974                 rc = ethtool_set_value_void(dev, useraddr,
 975                                        dev->ethtool_ops->set_msglevel);
 976                 break;
 977         case ETHTOOL_NWAY_RST:
 978                 rc = ethtool_nway_reset(dev);
 979                 break;
 980         case ETHTOOL_GLINK:
 981                 rc = ethtool_get_value(dev, useraddr, ethcmd,
 982                                        dev->ethtool_ops->get_link);
 983                 break;
 984         case ETHTOOL_GEEPROM:
 985                 rc = ethtool_get_eeprom(dev, useraddr);
 986                 break;
 987         case ETHTOOL_SEEPROM:
 988                 rc = ethtool_set_eeprom(dev, useraddr);
 989                 break;
 990         case ETHTOOL_GCOALESCE:
 991                 rc = ethtool_get_coalesce(dev, useraddr);
 992                 break;
 993         case ETHTOOL_SCOALESCE:
 994                 rc = ethtool_set_coalesce(dev, useraddr);
 995                 break;
 996         case ETHTOOL_GRINGPARAM:
 997                 rc = ethtool_get_ringparam(dev, useraddr);
 998                 break;
 999         case ETHTOOL_SRINGPARAM:
1000                 rc = ethtool_set_ringparam(dev, useraddr);
1001                 break;
1002         case ETHTOOL_GPAUSEPARAM:
1003                 rc = ethtool_get_pauseparam(dev, useraddr);
1004                 break;
1005         case ETHTOOL_SPAUSEPARAM:
1006                 rc = ethtool_set_pauseparam(dev, useraddr);
1007                 break;
1008         case ETHTOOL_GRXCSUM:
1009                 rc = ethtool_get_value(dev, useraddr, ethcmd,
1010                                        (dev->ethtool_ops->get_rx_csum ?
1011                                         dev->ethtool_ops->get_rx_csum :
1012                                         ethtool_op_get_rx_csum));
1013                 break;
1014         case ETHTOOL_SRXCSUM:
1015                 rc = ethtool_set_rx_csum(dev, useraddr);
1016                 break;
1017         case ETHTOOL_GTXCSUM:
1018                 rc = ethtool_get_value(dev, useraddr, ethcmd,
1019                                        (dev->ethtool_ops->get_tx_csum ?
1020                                         dev->ethtool_ops->get_tx_csum :
1021                                         ethtool_op_get_tx_csum));
1022                 break;
1023         case ETHTOOL_STXCSUM:
1024                 rc = ethtool_set_tx_csum(dev, useraddr);
1025                 break;
1026         case ETHTOOL_GSG:
1027                 rc = ethtool_get_value(dev, useraddr, ethcmd,
1028                                        (dev->ethtool_ops->get_sg ?
1029                                         dev->ethtool_ops->get_sg :
1030                                         ethtool_op_get_sg));
1031                 break;
1032         case ETHTOOL_SSG:
1033                 rc = ethtool_set_sg(dev, useraddr);
1034                 break;
1035         case ETHTOOL_GTSO:
1036                 rc = ethtool_get_value(dev, useraddr, ethcmd,
1037                                        (dev->ethtool_ops->get_tso ?
1038                                         dev->ethtool_ops->get_tso :
1039                                         ethtool_op_get_tso));
1040                 break;
1041         case ETHTOOL_STSO:
1042                 rc = ethtool_set_tso(dev, useraddr);
1043                 break;
1044         case ETHTOOL_TEST:
1045                 rc = ethtool_self_test(dev, useraddr);
1046                 break;
1047         case ETHTOOL_GSTRINGS:
1048                 rc = ethtool_get_strings(dev, useraddr);
1049                 break;
1050         case ETHTOOL_PHYS_ID:
1051                 rc = ethtool_phys_id(dev, useraddr);
1052                 break;
1053         case ETHTOOL_GSTATS:
1054                 rc = ethtool_get_stats(dev, useraddr);
1055                 break;
1056         case ETHTOOL_GPERMADDR:
1057                 rc = ethtool_get_perm_addr(dev, useraddr);
1058                 break;
1059         case ETHTOOL_GUFO:
1060                 rc = ethtool_get_value(dev, useraddr, ethcmd,
1061                                        (dev->ethtool_ops->get_ufo ?
1062                                         dev->ethtool_ops->get_ufo :
1063                                         ethtool_op_get_ufo));
1064                 break;
1065         case ETHTOOL_SUFO:
1066                 rc = ethtool_set_ufo(dev, useraddr);
1067                 break;
1068         case ETHTOOL_GGSO:
1069                 rc = ethtool_get_gso(dev, useraddr);
1070                 break;
1071         case ETHTOOL_SGSO:
1072                 rc = ethtool_set_gso(dev, useraddr);
1073                 break;
1074         case ETHTOOL_GFLAGS:
1075                 rc = ethtool_get_value(dev, useraddr, ethcmd,
1076                                        (dev->ethtool_ops->get_flags ?
1077                                         dev->ethtool_ops->get_flags :
1078                                         ethtool_op_get_flags));
1079                 break;
1080         case ETHTOOL_SFLAGS:
1081                 rc = ethtool_set_value(dev, useraddr,
1082                                        dev->ethtool_ops->set_flags);
1083                 break;
1084         case ETHTOOL_GPFLAGS:
1085                 rc = ethtool_get_value(dev, useraddr, ethcmd,
1086                                        dev->ethtool_ops->get_priv_flags);
1087                 break;
1088         case ETHTOOL_SPFLAGS:
1089                 rc = ethtool_set_value(dev, useraddr,
1090                                        dev->ethtool_ops->set_priv_flags);
1091                 break;
1092         case ETHTOOL_GRXFH:
1093         case ETHTOOL_GRXRINGS:
1094         case ETHTOOL_GRXCLSRLCNT:
1095         case ETHTOOL_GRXCLSRULE:
1096         case ETHTOOL_GRXCLSRLALL:
1097                 rc = ethtool_get_rxnfc(dev, useraddr);
1098                 break;
1099         case ETHTOOL_SRXFH:
1100         case ETHTOOL_SRXCLSRLDEL:
1101         case ETHTOOL_SRXCLSRLINS:
1102                 rc = ethtool_set_rxnfc(dev, useraddr);
1103                 break;
1104         case ETHTOOL_GGRO:
1105                 rc = ethtool_get_gro(dev, useraddr);
1106                 break;
1107         case ETHTOOL_SGRO:
1108                 rc = ethtool_set_gro(dev, useraddr);
1109                 break;
1110         case ETHTOOL_FLASHDEV:
1111                 rc = ethtool_flash_device(dev, useraddr);
1112                 break;
1113         case ETHTOOL_RESET:
1114                 rc = ethtool_reset(dev, useraddr);
1115                 break;
1116         default:
1117                 rc = -EOPNOTSUPP;
1118         }
1119
1120         if (dev->ethtool_ops->complete)
1121                 dev->ethtool_ops->complete(dev);
1122
1123         if (old_features != dev->features)
1124                 netdev_features_change(dev);
1125
1126         return rc;
1127 }
1128
1129 EXPORT_SYMBOL(ethtool_op_get_link);
1130 EXPORT_SYMBOL(ethtool_op_get_sg);
1131 EXPORT_SYMBOL(ethtool_op_get_tso);
1132 EXPORT_SYMBOL(ethtool_op_set_sg);
1133 EXPORT_SYMBOL(ethtool_op_set_tso);
1134 EXPORT_SYMBOL(ethtool_op_set_tx_csum);
1135 EXPORT_SYMBOL(ethtool_op_set_tx_hw_csum);
1136 EXPORT_SYMBOL(ethtool_op_set_tx_ipv6_csum);
1137 EXPORT_SYMBOL(ethtool_op_set_ufo);
1138 EXPORT_SYMBOL(ethtool_op_get_ufo);
1139 EXPORT_SYMBOL(ethtool_op_set_flags);
1140 EXPORT_SYMBOL(ethtool_op_get_flags);