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