ethtool.c 54.3 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 * net/core/ethtool.c - Ethtool ioctl handler
 * Copyright (c) 2003 Matthew Wilcox <matthew@wil.cx>
 *
 * This file is where we call all the ethtool_ops commands to get
6
 * the information ethtool needs.
L
Linus Torvalds 已提交
7
 *
8 9 10 11
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
L
Linus Torvalds 已提交
12 13 14 15
 */

#include <linux/module.h>
#include <linux/types.h>
16
#include <linux/capability.h>
L
Linus Torvalds 已提交
17 18 19
#include <linux/errno.h>
#include <linux/ethtool.h>
#include <linux/netdevice.h>
20 21
#include <linux/net_tstamp.h>
#include <linux/phy.h>
22
#include <linux/bitops.h>
23
#include <linux/uaccess.h>
24
#include <linux/vmalloc.h>
25
#include <linux/slab.h>
26 27
#include <linux/rtnetlink.h>
#include <linux/sched.h>
28
#include <linux/net.h>
L
Linus Torvalds 已提交
29

30
/*
L
Linus Torvalds 已提交
31 32 33 34 35 36 37 38 39
 * Some useful ethtool_ops methods that're device independent.
 * If we find that all drivers want to do the same thing here,
 * we can turn these into dev_() function calls.
 */

u32 ethtool_op_get_link(struct net_device *dev)
{
	return netif_carrier_ok(dev) ? 1 : 0;
}
40
EXPORT_SYMBOL(ethtool_op_get_link);
L
Linus Torvalds 已提交
41

42 43 44 45 46 47 48 49 50 51 52
int ethtool_op_get_ts_info(struct net_device *dev, struct ethtool_ts_info *info)
{
	info->so_timestamping =
		SOF_TIMESTAMPING_TX_SOFTWARE |
		SOF_TIMESTAMPING_RX_SOFTWARE |
		SOF_TIMESTAMPING_SOFTWARE;
	info->phc_index = -1;
	return 0;
}
EXPORT_SYMBOL(ethtool_op_get_ts_info);

L
Linus Torvalds 已提交
53 54
/* Handlers for each ethtool command */

55
#define ETHTOOL_DEV_FEATURE_WORDS	((NETDEV_FEATURE_COUNT + 31) / 32)
56

57 58 59 60 61 62 63
static const char netdev_features_strings[NETDEV_FEATURE_COUNT][ETH_GSTRING_LEN] = {
	[NETIF_F_SG_BIT] =               "tx-scatter-gather",
	[NETIF_F_IP_CSUM_BIT] =          "tx-checksum-ipv4",
	[NETIF_F_HW_CSUM_BIT] =          "tx-checksum-ip-generic",
	[NETIF_F_IPV6_CSUM_BIT] =        "tx-checksum-ipv6",
	[NETIF_F_HIGHDMA_BIT] =          "highdma",
	[NETIF_F_FRAGLIST_BIT] =         "tx-scatter-gather-fraglist",
64
	[NETIF_F_HW_VLAN_CTAG_TX_BIT] =  "tx-vlan-hw-insert",
65

66 67
	[NETIF_F_HW_VLAN_CTAG_RX_BIT] =  "rx-vlan-hw-parse",
	[NETIF_F_HW_VLAN_CTAG_FILTER_BIT] = "rx-vlan-filter",
68 69 70
	[NETIF_F_HW_VLAN_STAG_TX_BIT] =  "tx-vlan-stag-hw-insert",
	[NETIF_F_HW_VLAN_STAG_RX_BIT] =  "rx-vlan-stag-hw-parse",
	[NETIF_F_HW_VLAN_STAG_FILTER_BIT] = "rx-vlan-stag-filter",
71 72 73 74 75 76 77 78 79 80 81 82 83
	[NETIF_F_VLAN_CHALLENGED_BIT] =  "vlan-challenged",
	[NETIF_F_GSO_BIT] =              "tx-generic-segmentation",
	[NETIF_F_LLTX_BIT] =             "tx-lockless",
	[NETIF_F_NETNS_LOCAL_BIT] =      "netns-local",
	[NETIF_F_GRO_BIT] =              "rx-gro",
	[NETIF_F_LRO_BIT] =              "rx-lro",

	[NETIF_F_TSO_BIT] =              "tx-tcp-segmentation",
	[NETIF_F_UFO_BIT] =              "tx-udp-fragmentation",
	[NETIF_F_GSO_ROBUST_BIT] =       "tx-gso-robust",
	[NETIF_F_TSO_ECN_BIT] =          "tx-tcp-ecn-segmentation",
	[NETIF_F_TSO6_BIT] =             "tx-tcp6-segmentation",
	[NETIF_F_FSO_BIT] =              "tx-fcoe-segmentation",
84
	[NETIF_F_GSO_GRE_BIT] =		 "tx-gre-segmentation",
E
Eric Dumazet 已提交
85
	[NETIF_F_GSO_IPIP_BIT] =	 "tx-ipip-segmentation",
E
Eric Dumazet 已提交
86
	[NETIF_F_GSO_SIT_BIT] =		 "tx-sit-segmentation",
87
	[NETIF_F_GSO_UDP_TUNNEL_BIT] =	 "tx-udp_tnl-segmentation",
88 89

	[NETIF_F_FCOE_CRC_BIT] =         "tx-checksum-fcoe-crc",
90
	[NETIF_F_SCTP_CRC_BIT] =        "tx-checksum-sctp",
91 92 93 94 95 96
	[NETIF_F_FCOE_MTU_BIT] =         "fcoe-mtu",
	[NETIF_F_NTUPLE_BIT] =           "rx-ntuple-filter",
	[NETIF_F_RXHASH_BIT] =           "rx-hashing",
	[NETIF_F_RXCSUM_BIT] =           "rx-checksum",
	[NETIF_F_NOCACHE_COPY_BIT] =     "tx-nocache-copy",
	[NETIF_F_LOOPBACK_BIT] =         "loopback",
B
Ben Greear 已提交
97
	[NETIF_F_RXFCS_BIT] =            "rx-fcs",
B
Ben Greear 已提交
98
	[NETIF_F_RXALL_BIT] =            "rx-all",
99
	[NETIF_F_HW_L2FW_DOFFLOAD_BIT] = "l2-fwd-offload",
J
Jiri Pirko 已提交
100
	[NETIF_F_BUSY_POLL_BIT] =        "busy-poll",
101
	[NETIF_F_HW_TC_BIT] =		 "hw-tc-offload",
102 103
};

104 105 106 107 108 109
static const char
rss_hash_func_strings[ETH_RSS_HASH_FUNCS_COUNT][ETH_GSTRING_LEN] = {
	[ETH_RSS_HASH_TOP_BIT] =	"toeplitz",
	[ETH_RSS_HASH_XOR_BIT] =	"xor",
};

110 111 112 113 114 115 116
static const char
tunable_strings[__ETHTOOL_TUNABLE_COUNT][ETH_GSTRING_LEN] = {
	[ETHTOOL_ID_UNSPEC]     = "Unspec",
	[ETHTOOL_RX_COPYBREAK]	= "rx-copybreak",
	[ETHTOOL_TX_COPYBREAK]	= "tx-copybreak",
};

117 118 119 120 121 122
static int ethtool_get_features(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_gfeatures cmd = {
		.cmd = ETHTOOL_GFEATURES,
		.size = ETHTOOL_DEV_FEATURE_WORDS,
	};
123
	struct ethtool_get_features_block features[ETHTOOL_DEV_FEATURE_WORDS];
124 125
	u32 __user *sizeaddr;
	u32 copy_size;
126 127 128
	int i;

	/* in case feature bits run out again */
M
Michał Mirosław 已提交
129
	BUILD_BUG_ON(ETHTOOL_DEV_FEATURE_WORDS * sizeof(u32) > sizeof(netdev_features_t));
130 131

	for (i = 0; i < ETHTOOL_DEV_FEATURE_WORDS; ++i) {
M
Michał Mirosław 已提交
132 133 134 135 136
		features[i].available = (u32)(dev->hw_features >> (32 * i));
		features[i].requested = (u32)(dev->wanted_features >> (32 * i));
		features[i].active = (u32)(dev->features >> (32 * i));
		features[i].never_changed =
			(u32)(NETIF_F_NEVER_CHANGE >> (32 * i));
137
	}
138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158

	sizeaddr = useraddr + offsetof(struct ethtool_gfeatures, size);
	if (get_user(copy_size, sizeaddr))
		return -EFAULT;

	if (copy_size > ETHTOOL_DEV_FEATURE_WORDS)
		copy_size = ETHTOOL_DEV_FEATURE_WORDS;

	if (copy_to_user(useraddr, &cmd, sizeof(cmd)))
		return -EFAULT;
	useraddr += sizeof(cmd);
	if (copy_to_user(useraddr, features, copy_size * sizeof(*features)))
		return -EFAULT;

	return 0;
}

static int ethtool_set_features(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_sfeatures cmd;
	struct ethtool_set_features_block features[ETHTOOL_DEV_FEATURE_WORDS];
159 160
	netdev_features_t wanted = 0, valid = 0;
	int i, ret = 0;
161 162 163 164 165 166 167 168 169 170 171

	if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
		return -EFAULT;
	useraddr += sizeof(cmd);

	if (cmd.size != ETHTOOL_DEV_FEATURE_WORDS)
		return -EINVAL;

	if (copy_from_user(features, useraddr, sizeof(features)))
		return -EFAULT;

172
	for (i = 0; i < ETHTOOL_DEV_FEATURE_WORDS; ++i) {
M
Michał Mirosław 已提交
173 174
		valid |= (netdev_features_t)features[i].valid << (32 * i);
		wanted |= (netdev_features_t)features[i].requested << (32 * i);
175 176 177
	}

	if (valid & ~NETIF_F_ETHTOOL_BITS)
178 179
		return -EINVAL;

180 181
	if (valid & ~dev->hw_features) {
		valid &= dev->hw_features;
182 183 184
		ret |= ETHTOOL_F_UNSUPPORTED;
	}

185 186
	dev->wanted_features &= ~valid;
	dev->wanted_features |= wanted & valid;
187
	__netdev_update_features(dev);
188

189
	if ((dev->wanted_features ^ dev->features) & valid)
190 191 192 193 194
		ret |= ETHTOOL_F_WISH;

	return ret;
}

A
Andrew Lunn 已提交
195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211
static int phy_get_sset_count(struct phy_device *phydev)
{
	int ret;

	if (phydev->drv->get_sset_count &&
	    phydev->drv->get_strings &&
	    phydev->drv->get_stats) {
		mutex_lock(&phydev->lock);
		ret = phydev->drv->get_sset_count(phydev);
		mutex_unlock(&phydev->lock);

		return ret;
	}

	return -EOPNOTSUPP;
}

212 213 214 215
static int __ethtool_get_sset_count(struct net_device *dev, int sset)
{
	const struct ethtool_ops *ops = dev->ethtool_ops;

216 217 218
	if (sset == ETH_SS_FEATURES)
		return ARRAY_SIZE(netdev_features_strings);

219 220 221
	if (sset == ETH_SS_RSS_HASH_FUNCS)
		return ARRAY_SIZE(rss_hash_func_strings);

222 223 224
	if (sset == ETH_SS_TUNABLES)
		return ARRAY_SIZE(tunable_strings);

A
Andrew Lunn 已提交
225 226 227 228 229 230 231
	if (sset == ETH_SS_PHY_STATS) {
		if (dev->phydev)
			return phy_get_sset_count(dev->phydev);
		else
			return -EOPNOTSUPP;
	}

232
	if (ops->get_sset_count && ops->get_strings)
233 234 235 236 237 238 239 240 241 242
		return ops->get_sset_count(dev, sset);
	else
		return -EOPNOTSUPP;
}

static void __ethtool_get_strings(struct net_device *dev,
	u32 stringset, u8 *data)
{
	const struct ethtool_ops *ops = dev->ethtool_ops;

243 244 245
	if (stringset == ETH_SS_FEATURES)
		memcpy(data, netdev_features_strings,
			sizeof(netdev_features_strings));
246 247 248
	else if (stringset == ETH_SS_RSS_HASH_FUNCS)
		memcpy(data, rss_hash_func_strings,
		       sizeof(rss_hash_func_strings));
249 250
	else if (stringset == ETH_SS_TUNABLES)
		memcpy(data, tunable_strings, sizeof(tunable_strings));
A
Andrew Lunn 已提交
251 252 253 254 255 256 257 258 259 260 261
	else if (stringset == ETH_SS_PHY_STATS) {
		struct phy_device *phydev = dev->phydev;

		if (phydev) {
			mutex_lock(&phydev->lock);
			phydev->drv->get_strings(phydev, data);
			mutex_unlock(&phydev->lock);
		} else {
			return;
		}
	} else
262 263
		/* ops->get_strings is valid because checked earlier */
		ops->get_strings(dev, stringset, data);
264 265
}

266
static netdev_features_t ethtool_get_feature_mask(u32 eth_cmd)
267 268 269 270 271 272
{
	/* feature masks of legacy discrete ethtool ops */

	switch (eth_cmd) {
	case ETHTOOL_GTXCSUM:
	case ETHTOOL_STXCSUM:
273
		return NETIF_F_CSUM_MASK | NETIF_F_SCTP_CRC;
274 275 276
	case ETHTOOL_GRXCSUM:
	case ETHTOOL_SRXCSUM:
		return NETIF_F_RXCSUM;
277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299
	case ETHTOOL_GSG:
	case ETHTOOL_SSG:
		return NETIF_F_SG;
	case ETHTOOL_GTSO:
	case ETHTOOL_STSO:
		return NETIF_F_ALL_TSO;
	case ETHTOOL_GUFO:
	case ETHTOOL_SUFO:
		return NETIF_F_UFO;
	case ETHTOOL_GGSO:
	case ETHTOOL_SGSO:
		return NETIF_F_GSO;
	case ETHTOOL_GGRO:
	case ETHTOOL_SGRO:
		return NETIF_F_GRO;
	default:
		BUG();
	}
}

static int ethtool_get_one_feature(struct net_device *dev,
	char __user *useraddr, u32 ethcmd)
{
300
	netdev_features_t mask = ethtool_get_feature_mask(ethcmd);
301 302
	struct ethtool_value edata = {
		.cmd = ethcmd,
303
		.data = !!(dev->features & mask),
304 305 306 307 308 309 310 311 312 313 314
	};

	if (copy_to_user(useraddr, &edata, sizeof(edata)))
		return -EFAULT;
	return 0;
}

static int ethtool_set_one_feature(struct net_device *dev,
	void __user *useraddr, u32 ethcmd)
{
	struct ethtool_value edata;
315
	netdev_features_t mask;
316 317 318 319

	if (copy_from_user(&edata, useraddr, sizeof(edata)))
		return -EFAULT;

320 321
	mask = ethtool_get_feature_mask(ethcmd);
	mask &= dev->hw_features;
M
Michał Mirosław 已提交
322 323
	if (!mask)
		return -EOPNOTSUPP;
324

M
Michał Mirosław 已提交
325 326 327 328
	if (edata.data)
		dev->wanted_features |= mask;
	else
		dev->wanted_features &= ~mask;
329

M
Michał Mirosław 已提交
330
	__netdev_update_features(dev);
331

M
Michał Mirosław 已提交
332 333 334
	return 0;
}

335 336
#define ETH_ALL_FLAGS    (ETH_FLAG_LRO | ETH_FLAG_RXVLAN | ETH_FLAG_TXVLAN | \
			  ETH_FLAG_NTUPLE | ETH_FLAG_RXHASH)
337 338 339
#define ETH_ALL_FEATURES (NETIF_F_LRO | NETIF_F_HW_VLAN_CTAG_RX | \
			  NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_NTUPLE | \
			  NETIF_F_RXHASH)
M
Michał Mirosław 已提交
340 341 342

static u32 __ethtool_get_flags(struct net_device *dev)
{
343 344
	u32 flags = 0;

345 346 347 348 349 350 351 352 353 354
	if (dev->features & NETIF_F_LRO)
		flags |= ETH_FLAG_LRO;
	if (dev->features & NETIF_F_HW_VLAN_CTAG_RX)
		flags |= ETH_FLAG_RXVLAN;
	if (dev->features & NETIF_F_HW_VLAN_CTAG_TX)
		flags |= ETH_FLAG_TXVLAN;
	if (dev->features & NETIF_F_NTUPLE)
		flags |= ETH_FLAG_NTUPLE;
	if (dev->features & NETIF_F_RXHASH)
		flags |= ETH_FLAG_RXHASH;
355 356

	return flags;
357 358
}

M
Michał Mirosław 已提交
359
static int __ethtool_set_flags(struct net_device *dev, u32 data)
360
{
361
	netdev_features_t features = 0, changed;
362

363
	if (data & ~ETH_ALL_FLAGS)
364 365
		return -EINVAL;

366 367 368 369 370 371 372 373 374 375
	if (data & ETH_FLAG_LRO)
		features |= NETIF_F_LRO;
	if (data & ETH_FLAG_RXVLAN)
		features |= NETIF_F_HW_VLAN_CTAG_RX;
	if (data & ETH_FLAG_TXVLAN)
		features |= NETIF_F_HW_VLAN_CTAG_TX;
	if (data & ETH_FLAG_NTUPLE)
		features |= NETIF_F_NTUPLE;
	if (data & ETH_FLAG_RXHASH)
		features |= NETIF_F_RXHASH;
376

377
	/* allow changing only bits set in hw_features */
378
	changed = (features ^ dev->features) & ETH_ALL_FEATURES;
379 380 381 382
	if (changed & ~dev->hw_features)
		return (changed & dev->hw_features) ? -EINVAL : -EOPNOTSUPP;

	dev->wanted_features =
383
		(dev->wanted_features & ~changed) | (features & changed);
384

385
	__netdev_update_features(dev);
386 387 388 389

	return 0;
}

390
int __ethtool_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
L
Linus Torvalds 已提交
391
{
392
	ASSERT_RTNL();
L
Linus Torvalds 已提交
393

394
	if (!dev->ethtool_ops->get_settings)
L
Linus Torvalds 已提交
395 396
		return -EOPNOTSUPP;

397 398 399 400 401 402 403 404 405 406 407
	memset(cmd, 0, sizeof(struct ethtool_cmd));
	cmd->cmd = ETHTOOL_GSET;
	return dev->ethtool_ops->get_settings(dev, cmd);
}
EXPORT_SYMBOL(__ethtool_get_settings);

static int ethtool_get_settings(struct net_device *dev, void __user *useraddr)
{
	int err;
	struct ethtool_cmd cmd;

408
	err = __ethtool_get_settings(dev, &cmd);
L
Linus Torvalds 已提交
409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429
	if (err < 0)
		return err;

	if (copy_to_user(useraddr, &cmd, sizeof(cmd)))
		return -EFAULT;
	return 0;
}

static int ethtool_set_settings(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_cmd cmd;

	if (!dev->ethtool_ops->set_settings)
		return -EOPNOTSUPP;

	if (copy_from_user(&cmd, useraddr, sizeof(cmd)))
		return -EFAULT;

	return dev->ethtool_ops->set_settings(dev, &cmd);
}

430 431
static noinline_for_stack int ethtool_get_drvinfo(struct net_device *dev,
						  void __user *useraddr)
L
Linus Torvalds 已提交
432 433
{
	struct ethtool_drvinfo info;
434
	const struct ethtool_ops *ops = dev->ethtool_ops;
L
Linus Torvalds 已提交
435 436 437

	memset(&info, 0, sizeof(info));
	info.cmd = ETHTOOL_GDRVINFO;
438
	if (ops->get_drvinfo) {
439 440 441 442 443 444 445 446 447
		ops->get_drvinfo(dev, &info);
	} else if (dev->dev.parent && dev->dev.parent->driver) {
		strlcpy(info.bus_info, dev_name(dev->dev.parent),
			sizeof(info.bus_info));
		strlcpy(info.driver, dev->dev.parent->driver->name,
			sizeof(info.driver));
	} else {
		return -EOPNOTSUPP;
	}
L
Linus Torvalds 已提交
448

449 450
	/*
	 * this method of obtaining string set info is deprecated;
451
	 * Use ETHTOOL_GSSET_INFO instead.
452
	 */
453
	if (ops->get_sset_count) {
454 455 456 457 458 459 460 461
		int rc;

		rc = ops->get_sset_count(dev, ETH_SS_TEST);
		if (rc >= 0)
			info.testinfo_len = rc;
		rc = ops->get_sset_count(dev, ETH_SS_STATS);
		if (rc >= 0)
			info.n_stats = rc;
462 463 464
		rc = ops->get_sset_count(dev, ETH_SS_PRIV_FLAGS);
		if (rc >= 0)
			info.n_priv_flags = rc;
465
	}
466
	if (ops->get_regs_len)
L
Linus Torvalds 已提交
467
		info.regdump_len = ops->get_regs_len(dev);
468
	if (ops->get_eeprom_len)
L
Linus Torvalds 已提交
469 470 471 472 473 474 475
		info.eedump_len = ops->get_eeprom_len(dev);

	if (copy_to_user(useraddr, &info, sizeof(info)))
		return -EFAULT;
	return 0;
}

E
Eric Dumazet 已提交
476
static noinline_for_stack int ethtool_get_sset_info(struct net_device *dev,
477
						    void __user *useraddr)
478 479 480 481 482 483 484 485 486 487 488 489 490 491 492
{
	struct ethtool_sset_info info;
	u64 sset_mask;
	int i, idx = 0, n_bits = 0, ret, rc;
	u32 *info_buf = NULL;

	if (copy_from_user(&info, useraddr, sizeof(info)))
		return -EFAULT;

	/* store copy of mask, because we zero struct later on */
	sset_mask = info.sset_mask;
	if (!sset_mask)
		return 0;

	/* calculate size of return buffer */
493
	n_bits = hweight64(sset_mask);
494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509

	memset(&info, 0, sizeof(info));
	info.cmd = ETHTOOL_GSSET_INFO;

	info_buf = kzalloc(n_bits * sizeof(u32), GFP_USER);
	if (!info_buf)
		return -ENOMEM;

	/*
	 * fill return buffer based on input bitmask and successful
	 * get_sset_count return
	 */
	for (i = 0; i < 64; i++) {
		if (!(sset_mask & (1ULL << i)))
			continue;

510
		rc = __ethtool_get_sset_count(dev, i);
511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531
		if (rc >= 0) {
			info.sset_mask |= (1ULL << i);
			info_buf[idx++] = rc;
		}
	}

	ret = -EFAULT;
	if (copy_to_user(useraddr, &info, sizeof(info)))
		goto out;

	useraddr += offsetof(struct ethtool_sset_info, data);
	if (copy_to_user(useraddr, info_buf, idx * sizeof(u32)))
		goto out;

	ret = 0;

out:
	kfree(info_buf);
	return ret;
}

532
static noinline_for_stack int ethtool_set_rxnfc(struct net_device *dev,
533
						u32 cmd, void __user *useraddr)
534
{
535 536
	struct ethtool_rxnfc info;
	size_t info_size = sizeof(info);
537
	int rc;
538

539
	if (!dev->ethtool_ops->set_rxnfc)
540 541
		return -EOPNOTSUPP;

542 543 544 545 546 547 548 549 550
	/* struct ethtool_rxnfc was originally defined for
	 * ETHTOOL_{G,S}RXFH with only the cmd, flow_type and data
	 * members.  User-space might still be using that
	 * definition. */
	if (cmd == ETHTOOL_SRXFH)
		info_size = (offsetof(struct ethtool_rxnfc, data) +
			     sizeof(info.data));

	if (copy_from_user(&info, useraddr, info_size))
551 552
		return -EFAULT;

553 554 555 556 557 558 559 560 561
	rc = dev->ethtool_ops->set_rxnfc(dev, &info);
	if (rc)
		return rc;

	if (cmd == ETHTOOL_SRXCLSRLINS &&
	    copy_to_user(useraddr, &info, info_size))
		return -EFAULT;

	return 0;
562 563
}

564
static noinline_for_stack int ethtool_get_rxnfc(struct net_device *dev,
565
						u32 cmd, void __user *useraddr)
566 567
{
	struct ethtool_rxnfc info;
568
	size_t info_size = sizeof(info);
569 570 571
	const struct ethtool_ops *ops = dev->ethtool_ops;
	int ret;
	void *rule_buf = NULL;
572

573
	if (!ops->get_rxnfc)
574 575
		return -EOPNOTSUPP;

576 577 578 579 580 581 582 583 584
	/* struct ethtool_rxnfc was originally defined for
	 * ETHTOOL_{G,S}RXFH with only the cmd, flow_type and data
	 * members.  User-space might still be using that
	 * definition. */
	if (cmd == ETHTOOL_GRXFH)
		info_size = (offsetof(struct ethtool_rxnfc, data) +
			     sizeof(info.data));

	if (copy_from_user(&info, useraddr, info_size))
585 586
		return -EFAULT;

587 588
	if (info.cmd == ETHTOOL_GRXCLSRLALL) {
		if (info.rule_cnt > 0) {
589
			if (info.rule_cnt <= KMALLOC_MAX_SIZE / sizeof(u32))
590
				rule_buf = kzalloc(info.rule_cnt * sizeof(u32),
591
						   GFP_USER);
592 593 594 595
			if (!rule_buf)
				return -ENOMEM;
		}
	}
596

597 598 599 600 601
	ret = ops->get_rxnfc(dev, &info, rule_buf);
	if (ret < 0)
		goto err_out;

	ret = -EFAULT;
602
	if (copy_to_user(useraddr, &info, info_size))
603 604 605 606 607 608 609 610 611 612 613
		goto err_out;

	if (rule_buf) {
		useraddr += offsetof(struct ethtool_rxnfc, rule_locs);
		if (copy_to_user(useraddr, rule_buf,
				 info.rule_cnt * sizeof(u32)))
			goto err_out;
	}
	ret = 0;

err_out:
614
	kfree(rule_buf);
615 616

	return ret;
617 618
}

619 620 621 622
static int ethtool_copy_validate_indir(u32 *indir, void __user *useraddr,
					struct ethtool_rxnfc *rx_rings,
					u32 size)
{
623
	int i;
624 625

	if (copy_from_user(indir, useraddr, size * sizeof(indir[0])))
626
		return -EFAULT;
627 628

	/* Validate ring indices */
629 630 631 632 633
	for (i = 0; i < size; i++)
		if (indir[i] >= rx_rings->data)
			return -EINVAL;

	return 0;
634 635
}

636
u8 netdev_rss_key[NETDEV_RSS_KEY_LEN] __read_mostly;
637 638 639 640 641 642 643 644 645

void netdev_rss_key_fill(void *buffer, size_t len)
{
	BUG_ON(len > sizeof(netdev_rss_key));
	net_get_random_once(netdev_rss_key, sizeof(netdev_rss_key));
	memcpy(buffer, netdev_rss_key, len);
}
EXPORT_SYMBOL(netdev_rss_key_fill);

646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676
static int ethtool_get_max_rxfh_channel(struct net_device *dev, u32 *max)
{
	u32 dev_size, current_max = 0;
	u32 *indir;
	int ret;

	if (!dev->ethtool_ops->get_rxfh_indir_size ||
	    !dev->ethtool_ops->get_rxfh)
		return -EOPNOTSUPP;
	dev_size = dev->ethtool_ops->get_rxfh_indir_size(dev);
	if (dev_size == 0)
		return -EOPNOTSUPP;

	indir = kcalloc(dev_size, sizeof(indir[0]), GFP_USER);
	if (!indir)
		return -ENOMEM;

	ret = dev->ethtool_ops->get_rxfh(dev, indir, NULL, NULL);
	if (ret)
		goto out;

	while (dev_size--)
		current_max = max(current_max, indir[dev_size]);

	*max = current_max;

out:
	kfree(indir);
	return ret;
}

677 678 679
static noinline_for_stack int ethtool_get_rxfh_indir(struct net_device *dev,
						     void __user *useraddr)
{
680 681
	u32 user_size, dev_size;
	u32 *indir;
682 683
	int ret;

684
	if (!dev->ethtool_ops->get_rxfh_indir_size ||
685
	    !dev->ethtool_ops->get_rxfh)
686 687 688
		return -EOPNOTSUPP;
	dev_size = dev->ethtool_ops->get_rxfh_indir_size(dev);
	if (dev_size == 0)
689 690
		return -EOPNOTSUPP;

691
	if (copy_from_user(&user_size,
692
			   useraddr + offsetof(struct ethtool_rxfh_indir, size),
693
			   sizeof(user_size)))
694 695
		return -EFAULT;

696 697 698 699 700 701 702 703 704 705 706 707
	if (copy_to_user(useraddr + offsetof(struct ethtool_rxfh_indir, size),
			 &dev_size, sizeof(dev_size)))
		return -EFAULT;

	/* If the user buffer size is 0, this is just a query for the
	 * device table size.  Otherwise, if it's smaller than the
	 * device table size it's an error.
	 */
	if (user_size < dev_size)
		return user_size == 0 ? 0 : -EINVAL;

	indir = kcalloc(dev_size, sizeof(indir[0]), GFP_USER);
708 709 710
	if (!indir)
		return -ENOMEM;

711
	ret = dev->ethtool_ops->get_rxfh(dev, indir, NULL, NULL);
712 713 714
	if (ret)
		goto out;

715 716 717
	if (copy_to_user(useraddr +
			 offsetof(struct ethtool_rxfh_indir, ring_index[0]),
			 indir, dev_size * sizeof(indir[0])))
718 719 720 721 722 723 724 725 726 727
		ret = -EFAULT;

out:
	kfree(indir);
	return ret;
}

static noinline_for_stack int ethtool_set_rxfh_indir(struct net_device *dev,
						     void __user *useraddr)
{
728 729 730
	struct ethtool_rxnfc rx_rings;
	u32 user_size, dev_size, i;
	u32 *indir;
731
	const struct ethtool_ops *ops = dev->ethtool_ops;
732
	int ret;
733
	u32 ringidx_offset = offsetof(struct ethtool_rxfh_indir, ring_index[0]);
734

735
	if (!ops->get_rxfh_indir_size || !ops->set_rxfh ||
736
	    !ops->get_rxnfc)
737
		return -EOPNOTSUPP;
738 739

	dev_size = ops->get_rxfh_indir_size(dev);
740
	if (dev_size == 0)
741 742
		return -EOPNOTSUPP;

743
	if (copy_from_user(&user_size,
744
			   useraddr + offsetof(struct ethtool_rxfh_indir, size),
745
			   sizeof(user_size)))
746 747
		return -EFAULT;

748
	if (user_size != 0 && user_size != dev_size)
749 750 751
		return -EINVAL;

	indir = kcalloc(dev_size, sizeof(indir[0]), GFP_USER);
752 753 754
	if (!indir)
		return -ENOMEM;

755
	rx_rings.cmd = ETHTOOL_GRXRINGS;
756
	ret = ops->get_rxnfc(dev, &rx_rings, NULL);
757 758
	if (ret)
		goto out;
759 760 761 762 763

	if (user_size == 0) {
		for (i = 0; i < dev_size; i++)
			indir[i] = ethtool_rxfh_indir_default(i, rx_rings.data);
	} else {
764 765 766 767 768 769 770 771
		ret = ethtool_copy_validate_indir(indir,
						  useraddr + ringidx_offset,
						  &rx_rings,
						  dev_size);
		if (ret)
			goto out;
	}

772
	ret = ops->set_rxfh(dev, indir, NULL, ETH_RSS_HASH_NO_CHANGE);
773 774 775 776 777 778 779 780
	if (ret)
		goto out;

	/* indicate whether rxfh was set to default */
	if (user_size == 0)
		dev->priv_flags &= ~IFF_RXFH_CONFIGURED;
	else
		dev->priv_flags |= IFF_RXFH_CONFIGURED;
781 782 783 784 785 786 787 788 789 790 791

out:
	kfree(indir);
	return ret;
}

static noinline_for_stack int ethtool_get_rxfh(struct net_device *dev,
					       void __user *useraddr)
{
	int ret;
	const struct ethtool_ops *ops = dev->ethtool_ops;
792
	u32 user_indir_size, user_key_size;
793
	u32 dev_indir_size = 0, dev_key_size = 0;
794
	struct ethtool_rxfh rxfh;
795
	u32 total_size;
796
	u32 indir_bytes;
797
	u32 *indir = NULL;
798
	u8 dev_hfunc = 0;
799 800 801
	u8 *hkey = NULL;
	u8 *rss_config;

802
	if (!ops->get_rxfh)
803 804 805 806 807 808 809
		return -EOPNOTSUPP;

	if (ops->get_rxfh_indir_size)
		dev_indir_size = ops->get_rxfh_indir_size(dev);
	if (ops->get_rxfh_key_size)
		dev_key_size = ops->get_rxfh_key_size(dev);

810
	if (copy_from_user(&rxfh, useraddr, sizeof(rxfh)))
811
		return -EFAULT;
812 813
	user_indir_size = rxfh.indir_size;
	user_key_size = rxfh.key_size;
814

815
	/* Check that reserved fields are 0 for now */
816 817
	if (rxfh.rss_context || rxfh.rsvd8[0] || rxfh.rsvd8[1] ||
	    rxfh.rsvd8[2] || rxfh.rsvd32)
818 819 820 821 822
		return -EINVAL;

	rxfh.indir_size = dev_indir_size;
	rxfh.key_size = dev_key_size;
	if (copy_to_user(useraddr, &rxfh, sizeof(rxfh)))
823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840
		return -EFAULT;

	if ((user_indir_size && (user_indir_size != dev_indir_size)) ||
	    (user_key_size && (user_key_size != dev_key_size)))
		return -EINVAL;

	indir_bytes = user_indir_size * sizeof(indir[0]);
	total_size = indir_bytes + user_key_size;
	rss_config = kzalloc(total_size, GFP_USER);
	if (!rss_config)
		return -ENOMEM;

	if (user_indir_size)
		indir = (u32 *)rss_config;

	if (user_key_size)
		hkey = rss_config + indir_bytes;

841 842 843
	ret = dev->ethtool_ops->get_rxfh(dev, indir, hkey, &dev_hfunc);
	if (ret)
		goto out;
844

845 846 847 848 849 850 851 852 853
	if (copy_to_user(useraddr + offsetof(struct ethtool_rxfh, hfunc),
			 &dev_hfunc, sizeof(rxfh.hfunc))) {
		ret = -EFAULT;
	} else if (copy_to_user(useraddr +
			      offsetof(struct ethtool_rxfh, rss_config[0]),
			      rss_config, total_size)) {
		ret = -EFAULT;
	}
out:
854 855 856 857 858 859 860 861 862 863 864
	kfree(rss_config);

	return ret;
}

static noinline_for_stack int ethtool_set_rxfh(struct net_device *dev,
					       void __user *useraddr)
{
	int ret;
	const struct ethtool_ops *ops = dev->ethtool_ops;
	struct ethtool_rxnfc rx_rings;
865 866
	struct ethtool_rxfh rxfh;
	u32 dev_indir_size = 0, dev_key_size = 0, i;
867 868 869 870 871
	u32 *indir = NULL, indir_bytes = 0;
	u8 *hkey = NULL;
	u8 *rss_config;
	u32 rss_cfg_offset = offsetof(struct ethtool_rxfh, rss_config[0]);

872
	if (!ops->get_rxnfc || !ops->set_rxfh)
873 874 875 876 877
		return -EOPNOTSUPP;

	if (ops->get_rxfh_indir_size)
		dev_indir_size = ops->get_rxfh_indir_size(dev);
	if (ops->get_rxfh_key_size)
878
		dev_key_size = ops->get_rxfh_key_size(dev);
879

880
	if (copy_from_user(&rxfh, useraddr, sizeof(rxfh)))
881 882
		return -EFAULT;

883
	/* Check that reserved fields are 0 for now */
884 885
	if (rxfh.rss_context || rxfh.rsvd8[0] || rxfh.rsvd8[1] ||
	    rxfh.rsvd8[2] || rxfh.rsvd32)
886 887
		return -EINVAL;

888 889
	/* If either indir, hash key or function is valid, proceed further.
	 * Must request at least one change: indir size, hash key or function.
890
	 */
891 892 893 894 895
	if ((rxfh.indir_size &&
	     rxfh.indir_size != ETH_RXFH_INDIR_NO_CHANGE &&
	     rxfh.indir_size != dev_indir_size) ||
	    (rxfh.key_size && (rxfh.key_size != dev_key_size)) ||
	    (rxfh.indir_size == ETH_RXFH_INDIR_NO_CHANGE &&
896
	     rxfh.key_size == 0 && rxfh.hfunc == ETH_RSS_HASH_NO_CHANGE))
897 898
		return -EINVAL;

899
	if (rxfh.indir_size != ETH_RXFH_INDIR_NO_CHANGE)
900 901
		indir_bytes = dev_indir_size * sizeof(indir[0]);

902
	rss_config = kzalloc(indir_bytes + rxfh.key_size, GFP_USER);
903 904 905 906 907 908 909 910
	if (!rss_config)
		return -ENOMEM;

	rx_rings.cmd = ETHTOOL_GRXRINGS;
	ret = ops->get_rxnfc(dev, &rx_rings, NULL);
	if (ret)
		goto out;

911 912
	/* rxfh.indir_size == 0 means reset the indir table to default.
	 * rxfh.indir_size == ETH_RXFH_INDIR_NO_CHANGE means leave it unchanged.
913
	 */
914 915
	if (rxfh.indir_size &&
	    rxfh.indir_size != ETH_RXFH_INDIR_NO_CHANGE) {
916 917 918 919
		indir = (u32 *)rss_config;
		ret = ethtool_copy_validate_indir(indir,
						  useraddr + rss_cfg_offset,
						  &rx_rings,
920
						  rxfh.indir_size);
921
		if (ret)
922
			goto out;
923
	} else if (rxfh.indir_size == 0) {
924 925 926 927
		indir = (u32 *)rss_config;
		for (i = 0; i < dev_indir_size; i++)
			indir[i] = ethtool_rxfh_indir_default(i, rx_rings.data);
	}
928

929
	if (rxfh.key_size) {
930 931 932
		hkey = rss_config + indir_bytes;
		if (copy_from_user(hkey,
				   useraddr + rss_cfg_offset + indir_bytes,
933
				   rxfh.key_size)) {
934 935
			ret = -EFAULT;
			goto out;
936
		}
937 938
	}

939
	ret = ops->set_rxfh(dev, indir, hkey, rxfh.hfunc);
940 941 942 943 944 945 946 947
	if (ret)
		goto out;

	/* indicate whether rxfh was set to default */
	if (rxfh.indir_size == 0)
		dev->priv_flags &= ~IFF_RXFH_CONFIGURED;
	else if (rxfh.indir_size != ETH_RXFH_INDIR_NO_CHANGE)
		dev->priv_flags |= IFF_RXFH_CONFIGURED;
948 949

out:
950
	kfree(rss_config);
951 952 953
	return ret;
}

L
Linus Torvalds 已提交
954 955 956
static int ethtool_get_regs(struct net_device *dev, char __user *useraddr)
{
	struct ethtool_regs regs;
957
	const struct ethtool_ops *ops = dev->ethtool_ops;
L
Linus Torvalds 已提交
958 959 960 961 962 963 964 965 966 967 968 969 970
	void *regbuf;
	int reglen, ret;

	if (!ops->get_regs || !ops->get_regs_len)
		return -EOPNOTSUPP;

	if (copy_from_user(&regs, useraddr, sizeof(regs)))
		return -EFAULT;

	reglen = ops->get_regs_len(dev);
	if (regs.len > reglen)
		regs.len = reglen;

971
	regbuf = vzalloc(reglen);
972
	if (reglen && !regbuf)
L
Linus Torvalds 已提交
973 974 975 976 977 978 979 980
		return -ENOMEM;

	ops->get_regs(dev, &regs, regbuf);

	ret = -EFAULT;
	if (copy_to_user(useraddr, &regs, sizeof(regs)))
		goto out;
	useraddr += offsetof(struct ethtool_regs, data);
981
	if (regbuf && copy_to_user(useraddr, regbuf, regs.len))
L
Linus Torvalds 已提交
982 983 984 985
		goto out;
	ret = 0;

 out:
986
	vfree(regbuf);
L
Linus Torvalds 已提交
987 988 989
	return ret;
}

B
Ben Hutchings 已提交
990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009
static int ethtool_reset(struct net_device *dev, char __user *useraddr)
{
	struct ethtool_value reset;
	int ret;

	if (!dev->ethtool_ops->reset)
		return -EOPNOTSUPP;

	if (copy_from_user(&reset, useraddr, sizeof(reset)))
		return -EFAULT;

	ret = dev->ethtool_ops->reset(dev, &reset.data);
	if (ret)
		return ret;

	if (copy_to_user(useraddr, &reset, sizeof(reset)))
		return -EFAULT;
	return 0;
}

L
Linus Torvalds 已提交
1010 1011
static int ethtool_get_wol(struct net_device *dev, char __user *useraddr)
{
1012
	struct ethtool_wolinfo wol = { .cmd = ETHTOOL_GWOL };
L
Linus Torvalds 已提交
1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036

	if (!dev->ethtool_ops->get_wol)
		return -EOPNOTSUPP;

	dev->ethtool_ops->get_wol(dev, &wol);

	if (copy_to_user(useraddr, &wol, sizeof(wol)))
		return -EFAULT;
	return 0;
}

static int ethtool_set_wol(struct net_device *dev, char __user *useraddr)
{
	struct ethtool_wolinfo wol;

	if (!dev->ethtool_ops->set_wol)
		return -EOPNOTSUPP;

	if (copy_from_user(&wol, useraddr, sizeof(wol)))
		return -EFAULT;

	return dev->ethtool_ops->set_wol(dev, &wol);
}

1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070
static int ethtool_get_eee(struct net_device *dev, char __user *useraddr)
{
	struct ethtool_eee edata;
	int rc;

	if (!dev->ethtool_ops->get_eee)
		return -EOPNOTSUPP;

	memset(&edata, 0, sizeof(struct ethtool_eee));
	edata.cmd = ETHTOOL_GEEE;
	rc = dev->ethtool_ops->get_eee(dev, &edata);

	if (rc)
		return rc;

	if (copy_to_user(useraddr, &edata, sizeof(edata)))
		return -EFAULT;

	return 0;
}

static int ethtool_set_eee(struct net_device *dev, char __user *useraddr)
{
	struct ethtool_eee edata;

	if (!dev->ethtool_ops->set_eee)
		return -EOPNOTSUPP;

	if (copy_from_user(&edata, useraddr, sizeof(edata)))
		return -EFAULT;

	return dev->ethtool_ops->set_eee(dev, &edata);
}

L
Linus Torvalds 已提交
1071 1072 1073 1074 1075 1076 1077 1078
static int ethtool_nway_reset(struct net_device *dev)
{
	if (!dev->ethtool_ops->nway_reset)
		return -EOPNOTSUPP;

	return dev->ethtool_ops->nway_reset(dev);
}

1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092
static int ethtool_get_link(struct net_device *dev, char __user *useraddr)
{
	struct ethtool_value edata = { .cmd = ETHTOOL_GLINK };

	if (!dev->ethtool_ops->get_link)
		return -EOPNOTSUPP;

	edata.data = netif_running(dev) && dev->ethtool_ops->get_link(dev);

	if (copy_to_user(useraddr, &edata, sizeof(edata)))
		return -EFAULT;
	return 0;
}

1093 1094 1095 1096
static int ethtool_get_any_eeprom(struct net_device *dev, void __user *useraddr,
				  int (*getter)(struct net_device *,
						struct ethtool_eeprom *, u8 *),
				  u32 total_len)
L
Linus Torvalds 已提交
1097 1098
{
	struct ethtool_eeprom eeprom;
1099 1100
	void __user *userbuf = useraddr + sizeof(eeprom);
	u32 bytes_remaining;
L
Linus Torvalds 已提交
1101
	u8 *data;
1102
	int ret = 0;
L
Linus Torvalds 已提交
1103 1104 1105 1106 1107 1108 1109 1110 1111

	if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
		return -EFAULT;

	/* Check for wrap and zero */
	if (eeprom.offset + eeprom.len <= eeprom.offset)
		return -EINVAL;

	/* Check for exceeding total eeprom len */
1112
	if (eeprom.offset + eeprom.len > total_len)
L
Linus Torvalds 已提交
1113 1114
		return -EINVAL;

1115
	data = kmalloc(PAGE_SIZE, GFP_USER);
L
Linus Torvalds 已提交
1116 1117 1118
	if (!data)
		return -ENOMEM;

1119 1120 1121 1122
	bytes_remaining = eeprom.len;
	while (bytes_remaining > 0) {
		eeprom.len = min(bytes_remaining, (u32)PAGE_SIZE);

1123
		ret = getter(dev, &eeprom, data);
1124 1125 1126 1127 1128 1129 1130 1131 1132 1133
		if (ret)
			break;
		if (copy_to_user(userbuf, data, eeprom.len)) {
			ret = -EFAULT;
			break;
		}
		userbuf += eeprom.len;
		eeprom.offset += eeprom.len;
		bytes_remaining -= eeprom.len;
	}
L
Linus Torvalds 已提交
1134

1135 1136 1137 1138 1139
	eeprom.len = userbuf - (useraddr + sizeof(eeprom));
	eeprom.offset -= eeprom.len;
	if (copy_to_user(useraddr, &eeprom, sizeof(eeprom)))
		ret = -EFAULT;

L
Linus Torvalds 已提交
1140 1141 1142 1143
	kfree(data);
	return ret;
}

1144 1145 1146 1147
static int ethtool_get_eeprom(struct net_device *dev, void __user *useraddr)
{
	const struct ethtool_ops *ops = dev->ethtool_ops;

1148 1149
	if (!ops->get_eeprom || !ops->get_eeprom_len ||
	    !ops->get_eeprom_len(dev))
1150 1151 1152 1153 1154 1155
		return -EOPNOTSUPP;

	return ethtool_get_any_eeprom(dev, useraddr, ops->get_eeprom,
				      ops->get_eeprom_len(dev));
}

L
Linus Torvalds 已提交
1156 1157 1158
static int ethtool_set_eeprom(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_eeprom eeprom;
1159
	const struct ethtool_ops *ops = dev->ethtool_ops;
1160 1161
	void __user *userbuf = useraddr + sizeof(eeprom);
	u32 bytes_remaining;
L
Linus Torvalds 已提交
1162
	u8 *data;
1163
	int ret = 0;
L
Linus Torvalds 已提交
1164

1165 1166
	if (!ops->set_eeprom || !ops->get_eeprom_len ||
	    !ops->get_eeprom_len(dev))
L
Linus Torvalds 已提交
1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179
		return -EOPNOTSUPP;

	if (copy_from_user(&eeprom, useraddr, sizeof(eeprom)))
		return -EFAULT;

	/* Check for wrap and zero */
	if (eeprom.offset + eeprom.len <= eeprom.offset)
		return -EINVAL;

	/* Check for exceeding total eeprom len */
	if (eeprom.offset + eeprom.len > ops->get_eeprom_len(dev))
		return -EINVAL;

1180
	data = kmalloc(PAGE_SIZE, GFP_USER);
L
Linus Torvalds 已提交
1181 1182 1183
	if (!data)
		return -ENOMEM;

1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198
	bytes_remaining = eeprom.len;
	while (bytes_remaining > 0) {
		eeprom.len = min(bytes_remaining, (u32)PAGE_SIZE);

		if (copy_from_user(data, userbuf, eeprom.len)) {
			ret = -EFAULT;
			break;
		}
		ret = ops->set_eeprom(dev, &eeprom, data);
		if (ret)
			break;
		userbuf += eeprom.len;
		eeprom.offset += eeprom.len;
		bytes_remaining -= eeprom.len;
	}
L
Linus Torvalds 已提交
1199 1200 1201 1202 1203

	kfree(data);
	return ret;
}

1204 1205
static noinline_for_stack int ethtool_get_coalesce(struct net_device *dev,
						   void __user *useraddr)
L
Linus Torvalds 已提交
1206
{
1207
	struct ethtool_coalesce coalesce = { .cmd = ETHTOOL_GCOALESCE };
L
Linus Torvalds 已提交
1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218

	if (!dev->ethtool_ops->get_coalesce)
		return -EOPNOTSUPP;

	dev->ethtool_ops->get_coalesce(dev, &coalesce);

	if (copy_to_user(useraddr, &coalesce, sizeof(coalesce)))
		return -EFAULT;
	return 0;
}

1219 1220
static noinline_for_stack int ethtool_set_coalesce(struct net_device *dev,
						   void __user *useraddr)
L
Linus Torvalds 已提交
1221 1222 1223
{
	struct ethtool_coalesce coalesce;

1224
	if (!dev->ethtool_ops->set_coalesce)
L
Linus Torvalds 已提交
1225 1226 1227 1228 1229 1230 1231 1232 1233 1234
		return -EOPNOTSUPP;

	if (copy_from_user(&coalesce, useraddr, sizeof(coalesce)))
		return -EFAULT;

	return dev->ethtool_ops->set_coalesce(dev, &coalesce);
}

static int ethtool_get_ringparam(struct net_device *dev, void __user *useraddr)
{
1235
	struct ethtool_ringparam ringparam = { .cmd = ETHTOOL_GRINGPARAM };
L
Linus Torvalds 已提交
1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259

	if (!dev->ethtool_ops->get_ringparam)
		return -EOPNOTSUPP;

	dev->ethtool_ops->get_ringparam(dev, &ringparam);

	if (copy_to_user(useraddr, &ringparam, sizeof(ringparam)))
		return -EFAULT;
	return 0;
}

static int ethtool_set_ringparam(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_ringparam ringparam;

	if (!dev->ethtool_ops->set_ringparam)
		return -EOPNOTSUPP;

	if (copy_from_user(&ringparam, useraddr, sizeof(ringparam)))
		return -EFAULT;

	return dev->ethtool_ops->set_ringparam(dev, &ringparam);
}

1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277
static noinline_for_stack int ethtool_get_channels(struct net_device *dev,
						   void __user *useraddr)
{
	struct ethtool_channels channels = { .cmd = ETHTOOL_GCHANNELS };

	if (!dev->ethtool_ops->get_channels)
		return -EOPNOTSUPP;

	dev->ethtool_ops->get_channels(dev, &channels);

	if (copy_to_user(useraddr, &channels, sizeof(channels)))
		return -EFAULT;
	return 0;
}

static noinline_for_stack int ethtool_set_channels(struct net_device *dev,
						   void __user *useraddr)
{
1278
	struct ethtool_channels channels, max;
1279
	u32 max_rx_in_use = 0;
1280

1281
	if (!dev->ethtool_ops->set_channels || !dev->ethtool_ops->get_channels)
1282 1283 1284 1285 1286
		return -EOPNOTSUPP;

	if (copy_from_user(&channels, useraddr, sizeof(channels)))
		return -EFAULT;

1287 1288 1289 1290 1291 1292 1293 1294 1295
	dev->ethtool_ops->get_channels(dev, &max);

	/* ensure new counts are within the maximums */
	if ((channels.rx_count > max.max_rx) ||
	    (channels.tx_count > max.max_tx) ||
	    (channels.combined_count > max.max_combined) ||
	    (channels.other_count > max.max_other))
		return -EINVAL;

1296 1297 1298 1299 1300 1301 1302
	/* ensure the new Rx count fits within the configured Rx flow
	 * indirection table settings */
	if (netif_is_rxfh_configured(dev) &&
	    !ethtool_get_max_rxfh_channel(dev, &max_rx_in_use) &&
	    (channels.combined_count + channels.rx_count) <= max_rx_in_use)
	    return -EINVAL;

1303 1304 1305
	return dev->ethtool_ops->set_channels(dev, &channels);
}

L
Linus Torvalds 已提交
1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323
static int ethtool_get_pauseparam(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_pauseparam pauseparam = { ETHTOOL_GPAUSEPARAM };

	if (!dev->ethtool_ops->get_pauseparam)
		return -EOPNOTSUPP;

	dev->ethtool_ops->get_pauseparam(dev, &pauseparam);

	if (copy_to_user(useraddr, &pauseparam, sizeof(pauseparam)))
		return -EFAULT;
	return 0;
}

static int ethtool_set_pauseparam(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_pauseparam pauseparam;

1324
	if (!dev->ethtool_ops->set_pauseparam)
L
Linus Torvalds 已提交
1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335
		return -EOPNOTSUPP;

	if (copy_from_user(&pauseparam, useraddr, sizeof(pauseparam)))
		return -EFAULT;

	return dev->ethtool_ops->set_pauseparam(dev, &pauseparam);
}

static int ethtool_self_test(struct net_device *dev, char __user *useraddr)
{
	struct ethtool_test test;
1336
	const struct ethtool_ops *ops = dev->ethtool_ops;
L
Linus Torvalds 已提交
1337
	u64 *data;
1338
	int ret, test_len;
L
Linus Torvalds 已提交
1339

1340
	if (!ops->self_test || !ops->get_sset_count)
L
Linus Torvalds 已提交
1341 1342
		return -EOPNOTSUPP;

1343
	test_len = ops->get_sset_count(dev, ETH_SS_TEST);
1344 1345 1346 1347
	if (test_len < 0)
		return test_len;
	WARN_ON(test_len == 0);

L
Linus Torvalds 已提交
1348 1349 1350
	if (copy_from_user(&test, useraddr, sizeof(test)))
		return -EFAULT;

1351 1352
	test.len = test_len;
	data = kmalloc(test_len * sizeof(u64), GFP_USER);
L
Linus Torvalds 已提交
1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379
	if (!data)
		return -ENOMEM;

	ops->self_test(dev, &test, data);

	ret = -EFAULT;
	if (copy_to_user(useraddr, &test, sizeof(test)))
		goto out;
	useraddr += sizeof(test);
	if (copy_to_user(useraddr, data, test.len * sizeof(u64)))
		goto out;
	ret = 0;

 out:
	kfree(data);
	return ret;
}

static int ethtool_get_strings(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_gstrings gstrings;
	u8 *data;
	int ret;

	if (copy_from_user(&gstrings, useraddr, sizeof(gstrings)))
		return -EFAULT;

1380
	ret = __ethtool_get_sset_count(dev, gstrings.string_set);
1381 1382 1383 1384
	if (ret < 0)
		return ret;

	gstrings.len = ret;
L
Linus Torvalds 已提交
1385

1386
	data = kcalloc(gstrings.len, ETH_GSTRING_LEN, GFP_USER);
L
Linus Torvalds 已提交
1387 1388 1389
	if (!data)
		return -ENOMEM;

1390
	__ethtool_get_strings(dev, gstrings.string_set, data);
L
Linus Torvalds 已提交
1391 1392 1393 1394 1395 1396 1397 1398 1399

	ret = -EFAULT;
	if (copy_to_user(useraddr, &gstrings, sizeof(gstrings)))
		goto out;
	useraddr += sizeof(gstrings);
	if (copy_to_user(useraddr, data, gstrings.len * ETH_GSTRING_LEN))
		goto out;
	ret = 0;

1400
out:
L
Linus Torvalds 已提交
1401 1402 1403 1404 1405 1406 1407
	kfree(data);
	return ret;
}

static int ethtool_phys_id(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_value id;
1408
	static bool busy;
1409
	const struct ethtool_ops *ops = dev->ethtool_ops;
1410
	int rc;
L
Linus Torvalds 已提交
1411

1412
	if (!ops->set_phys_id)
L
Linus Torvalds 已提交
1413 1414
		return -EOPNOTSUPP;

1415 1416 1417
	if (busy)
		return -EBUSY;

L
Linus Torvalds 已提交
1418 1419 1420
	if (copy_from_user(&id, useraddr, sizeof(id)))
		return -EFAULT;

1421
	rc = ops->set_phys_id(dev, ETHTOOL_ID_ACTIVE);
1422
	if (rc < 0)
1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434
		return rc;

	/* Drop the RTNL lock while waiting, but prevent reentry or
	 * removal of the device.
	 */
	busy = true;
	dev_hold(dev);
	rtnl_unlock();

	if (rc == 0) {
		/* Driver will handle this itself */
		schedule_timeout_interruptible(
1435
			id.data ? (id.data * HZ) : MAX_SCHEDULE_TIMEOUT);
1436
	} else {
1437 1438 1439 1440
		/* Driver expects to be called at twice the frequency in rc */
		int n = rc * 2, i, interval = HZ / n;

		/* Count down seconds */
1441
		do {
1442 1443 1444 1445
			/* Count down iterations per second */
			i = n;
			do {
				rtnl_lock();
1446
				rc = ops->set_phys_id(dev,
1447 1448 1449 1450 1451 1452
				    (i & 1) ? ETHTOOL_ID_OFF : ETHTOOL_ID_ON);
				rtnl_unlock();
				if (rc)
					break;
				schedule_timeout_interruptible(interval);
			} while (!signal_pending(current) && --i != 0);
1453 1454 1455 1456 1457 1458 1459 1460
		} while (!signal_pending(current) &&
			 (id.data == 0 || --id.data != 0));
	}

	rtnl_lock();
	dev_put(dev);
	busy = false;

1461
	(void) ops->set_phys_id(dev, ETHTOOL_ID_INACTIVE);
1462
	return rc;
L
Linus Torvalds 已提交
1463 1464 1465 1466 1467
}

static int ethtool_get_stats(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_stats stats;
1468
	const struct ethtool_ops *ops = dev->ethtool_ops;
L
Linus Torvalds 已提交
1469
	u64 *data;
1470
	int ret, n_stats;
L
Linus Torvalds 已提交
1471

1472
	if (!ops->get_ethtool_stats || !ops->get_sset_count)
L
Linus Torvalds 已提交
1473 1474
		return -EOPNOTSUPP;

1475
	n_stats = ops->get_sset_count(dev, ETH_SS_STATS);
1476 1477 1478 1479
	if (n_stats < 0)
		return n_stats;
	WARN_ON(n_stats == 0);

L
Linus Torvalds 已提交
1480 1481 1482
	if (copy_from_user(&stats, useraddr, sizeof(stats)))
		return -EFAULT;

1483 1484
	stats.n_stats = n_stats;
	data = kmalloc(n_stats * sizeof(u64), GFP_USER);
L
Linus Torvalds 已提交
1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502
	if (!data)
		return -ENOMEM;

	ops->get_ethtool_stats(dev, &stats, data);

	ret = -EFAULT;
	if (copy_to_user(useraddr, &stats, sizeof(stats)))
		goto out;
	useraddr += sizeof(stats);
	if (copy_to_user(useraddr, data, stats.n_stats * sizeof(u64)))
		goto out;
	ret = 0;

 out:
	kfree(data);
	return ret;
}

A
Andrew Lunn 已提交
1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543
static int ethtool_get_phy_stats(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_stats stats;
	struct phy_device *phydev = dev->phydev;
	u64 *data;
	int ret, n_stats;

	if (!phydev)
		return -EOPNOTSUPP;

	n_stats = phy_get_sset_count(phydev);

	if (n_stats < 0)
		return n_stats;
	WARN_ON(n_stats == 0);

	if (copy_from_user(&stats, useraddr, sizeof(stats)))
		return -EFAULT;

	stats.n_stats = n_stats;
	data = kmalloc_array(n_stats, sizeof(u64), GFP_USER);
	if (!data)
		return -ENOMEM;

	mutex_lock(&phydev->lock);
	phydev->drv->get_stats(phydev, &stats, data);
	mutex_unlock(&phydev->lock);

	ret = -EFAULT;
	if (copy_to_user(useraddr, &stats, sizeof(stats)))
		goto out;
	useraddr += sizeof(stats);
	if (copy_to_user(useraddr, data, stats.n_stats * sizeof(u64)))
		goto out;
	ret = 0;

 out:
	kfree(data);
	return ret;
}

1544
static int ethtool_get_perm_addr(struct net_device *dev, void __user *useraddr)
1545 1546 1547
{
	struct ethtool_perm_addr epaddr;

1548
	if (copy_from_user(&epaddr, useraddr, sizeof(epaddr)))
1549 1550
		return -EFAULT;

1551 1552 1553
	if (epaddr.size < dev->addr_len)
		return -ETOOSMALL;
	epaddr.size = dev->addr_len;
1554 1555

	if (copy_to_user(useraddr, &epaddr, sizeof(epaddr)))
1556
		return -EFAULT;
1557
	useraddr += sizeof(epaddr);
1558 1559 1560
	if (copy_to_user(useraddr, dev->perm_addr, epaddr.size))
		return -EFAULT;
	return 0;
1561 1562
}

1563 1564
static int ethtool_get_value(struct net_device *dev, char __user *useraddr,
			     u32 cmd, u32 (*actor)(struct net_device *))
1565
{
1566
	struct ethtool_value edata = { .cmd = cmd };
1567

1568
	if (!actor)
1569 1570
		return -EOPNOTSUPP;

1571
	edata.data = actor(dev);
1572 1573 1574 1575 1576 1577

	if (copy_to_user(useraddr, &edata, sizeof(edata)))
		return -EFAULT;
	return 0;
}

1578 1579
static int ethtool_set_value_void(struct net_device *dev, char __user *useraddr,
			     void (*actor)(struct net_device *, u32))
1580 1581 1582
{
	struct ethtool_value edata;

1583
	if (!actor)
1584 1585 1586 1587 1588
		return -EOPNOTSUPP;

	if (copy_from_user(&edata, useraddr, sizeof(edata)))
		return -EFAULT;

1589
	actor(dev, edata.data);
1590 1591 1592
	return 0;
}

1593 1594
static int ethtool_set_value(struct net_device *dev, char __user *useraddr,
			     int (*actor)(struct net_device *, u32))
1595 1596 1597
{
	struct ethtool_value edata;

1598
	if (!actor)
1599 1600 1601 1602 1603
		return -EOPNOTSUPP;

	if (copy_from_user(&edata, useraddr, sizeof(edata)))
		return -EFAULT;

1604
	return actor(dev, edata.data);
1605 1606
}

1607 1608
static noinline_for_stack int ethtool_flash_device(struct net_device *dev,
						   char __user *useraddr)
1609 1610 1611 1612 1613 1614 1615 1616 1617
{
	struct ethtool_flash efl;

	if (copy_from_user(&efl, useraddr, sizeof(efl)))
		return -EFAULT;

	if (!dev->ethtool_ops->flash_device)
		return -EOPNOTSUPP;

1618 1619
	efl.data[ETHTOOL_FLASH_MAX_FILENAME - 1] = 0;

1620 1621 1622
	return dev->ethtool_ops->flash_device(dev, &efl);
}

1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643
static int ethtool_set_dump(struct net_device *dev,
			void __user *useraddr)
{
	struct ethtool_dump dump;

	if (!dev->ethtool_ops->set_dump)
		return -EOPNOTSUPP;

	if (copy_from_user(&dump, useraddr, sizeof(dump)))
		return -EFAULT;

	return dev->ethtool_ops->set_dump(dev, &dump);
}

static int ethtool_get_dump_flag(struct net_device *dev,
				void __user *useraddr)
{
	int ret;
	struct ethtool_dump dump;
	const struct ethtool_ops *ops = dev->ethtool_ops;

1644
	if (!ops->get_dump_flag)
1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667
		return -EOPNOTSUPP;

	if (copy_from_user(&dump, useraddr, sizeof(dump)))
		return -EFAULT;

	ret = ops->get_dump_flag(dev, &dump);
	if (ret)
		return ret;

	if (copy_to_user(useraddr, &dump, sizeof(dump)))
		return -EFAULT;
	return 0;
}

static int ethtool_get_dump_data(struct net_device *dev,
				void __user *useraddr)
{
	int ret;
	__u32 len;
	struct ethtool_dump dump, tmp;
	const struct ethtool_ops *ops = dev->ethtool_ops;
	void *data = NULL;

1668
	if (!ops->get_dump_data || !ops->get_dump_flag)
1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679
		return -EOPNOTSUPP;

	if (copy_from_user(&dump, useraddr, sizeof(dump)))
		return -EFAULT;

	memset(&tmp, 0, sizeof(tmp));
	tmp.cmd = ETHTOOL_GET_DUMP_FLAG;
	ret = ops->get_dump_flag(dev, &tmp);
	if (ret)
		return ret;

1680
	len = min(tmp.len, dump.len);
1681 1682 1683
	if (!len)
		return -EFAULT;

1684 1685 1686 1687 1688 1689 1690 1691 1692
	/* Don't ever let the driver think there's more space available
	 * than it requested with .get_dump_flag().
	 */
	dump.len = len;

	/* Always allocate enough space to hold the whole thing so that the
	 * driver does not need to check the length and bother with partial
	 * dumping.
	 */
1693 1694 1695 1696 1697 1698 1699
	data = vzalloc(tmp.len);
	if (!data)
		return -ENOMEM;
	ret = ops->get_dump_data(dev, &dump, data);
	if (ret)
		goto out;

1700 1701 1702 1703 1704 1705 1706 1707 1708 1709
	/* There are two sane possibilities:
	 * 1. The driver's .get_dump_data() does not touch dump.len.
	 * 2. Or it may set dump.len to how much it really writes, which
	 *    should be tmp.len (or len if it can do a partial dump).
	 * In any case respond to userspace with the actual length of data
	 * it's receiving.
	 */
	WARN_ON(dump.len != len && dump.len != tmp.len);
	dump.len = len;

1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721
	if (copy_to_user(useraddr, &dump, sizeof(dump))) {
		ret = -EFAULT;
		goto out;
	}
	useraddr += offsetof(struct ethtool_dump, data);
	if (copy_to_user(useraddr, data, len))
		ret = -EFAULT;
out:
	vfree(data);
	return ret;
}

1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733
static int ethtool_get_ts_info(struct net_device *dev, void __user *useraddr)
{
	int err = 0;
	struct ethtool_ts_info info;
	const struct ethtool_ops *ops = dev->ethtool_ops;
	struct phy_device *phydev = dev->phydev;

	memset(&info, 0, sizeof(info));
	info.cmd = ETHTOOL_GET_TS_INFO;

	if (phydev && phydev->drv && phydev->drv->ts_info) {
		err = phydev->drv->ts_info(phydev, &info);
1734
	} else if (ops->get_ts_info) {
1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751
		err = ops->get_ts_info(dev, &info);
	} else {
		info.so_timestamping =
			SOF_TIMESTAMPING_RX_SOFTWARE |
			SOF_TIMESTAMPING_SOFTWARE;
		info.phc_index = -1;
	}

	if (err)
		return err;

	if (copy_to_user(useraddr, &info, sizeof(info)))
		err = -EFAULT;

	return err;
}

1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766
static int __ethtool_get_module_info(struct net_device *dev,
				     struct ethtool_modinfo *modinfo)
{
	const struct ethtool_ops *ops = dev->ethtool_ops;
	struct phy_device *phydev = dev->phydev;

	if (phydev && phydev->drv && phydev->drv->module_info)
		return phydev->drv->module_info(phydev, modinfo);

	if (ops->get_module_info)
		return ops->get_module_info(dev, modinfo);

	return -EOPNOTSUPP;
}

1767 1768 1769 1770 1771 1772 1773 1774 1775
static int ethtool_get_module_info(struct net_device *dev,
				   void __user *useraddr)
{
	int ret;
	struct ethtool_modinfo modinfo;

	if (copy_from_user(&modinfo, useraddr, sizeof(modinfo)))
		return -EFAULT;

1776
	ret = __ethtool_get_module_info(dev, &modinfo);
1777 1778 1779 1780 1781 1782 1783 1784 1785
	if (ret)
		return ret;

	if (copy_to_user(useraddr, &modinfo, sizeof(modinfo)))
		return -EFAULT;

	return 0;
}

1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800
static int __ethtool_get_module_eeprom(struct net_device *dev,
				       struct ethtool_eeprom *ee, u8 *data)
{
	const struct ethtool_ops *ops = dev->ethtool_ops;
	struct phy_device *phydev = dev->phydev;

	if (phydev && phydev->drv && phydev->drv->module_eeprom)
		return phydev->drv->module_eeprom(phydev, ee, data);

	if (ops->get_module_eeprom)
		return ops->get_module_eeprom(dev, ee, data);

	return -EOPNOTSUPP;
}

1801 1802 1803 1804 1805 1806
static int ethtool_get_module_eeprom(struct net_device *dev,
				     void __user *useraddr)
{
	int ret;
	struct ethtool_modinfo modinfo;

1807
	ret = __ethtool_get_module_info(dev, &modinfo);
1808 1809 1810
	if (ret)
		return ret;

1811 1812
	return ethtool_get_any_eeprom(dev, useraddr,
				      __ethtool_get_module_eeprom,
1813 1814 1815
				      modinfo.eeprom_len);
}

1816 1817 1818 1819
static int ethtool_tunable_valid(const struct ethtool_tunable *tuna)
{
	switch (tuna->id) {
	case ETHTOOL_RX_COPYBREAK:
1820
	case ETHTOOL_TX_COPYBREAK:
1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890
		if (tuna->len != sizeof(u32) ||
		    tuna->type_id != ETHTOOL_TUNABLE_U32)
			return -EINVAL;
		break;
	default:
		return -EINVAL;
	}

	return 0;
}

static int ethtool_get_tunable(struct net_device *dev, void __user *useraddr)
{
	int ret;
	struct ethtool_tunable tuna;
	const struct ethtool_ops *ops = dev->ethtool_ops;
	void *data;

	if (!ops->get_tunable)
		return -EOPNOTSUPP;
	if (copy_from_user(&tuna, useraddr, sizeof(tuna)))
		return -EFAULT;
	ret = ethtool_tunable_valid(&tuna);
	if (ret)
		return ret;
	data = kmalloc(tuna.len, GFP_USER);
	if (!data)
		return -ENOMEM;
	ret = ops->get_tunable(dev, &tuna, data);
	if (ret)
		goto out;
	useraddr += sizeof(tuna);
	ret = -EFAULT;
	if (copy_to_user(useraddr, data, tuna.len))
		goto out;
	ret = 0;

out:
	kfree(data);
	return ret;
}

static int ethtool_set_tunable(struct net_device *dev, void __user *useraddr)
{
	int ret;
	struct ethtool_tunable tuna;
	const struct ethtool_ops *ops = dev->ethtool_ops;
	void *data;

	if (!ops->set_tunable)
		return -EOPNOTSUPP;
	if (copy_from_user(&tuna, useraddr, sizeof(tuna)))
		return -EFAULT;
	ret = ethtool_tunable_valid(&tuna);
	if (ret)
		return ret;
	data = kmalloc(tuna.len, GFP_USER);
	if (!data)
		return -ENOMEM;
	useraddr += sizeof(tuna);
	ret = -EFAULT;
	if (copy_from_user(data, useraddr, tuna.len))
		goto out;
	ret = ops->set_tunable(dev, &tuna, data);

out:
	kfree(data);
	return ret;
}

1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922
static int ethtool_get_per_queue_coalesce(struct net_device *dev,
					  void __user *useraddr,
					  struct ethtool_per_queue_op *per_queue_opt)
{
	u32 bit;
	int ret;
	DECLARE_BITMAP(queue_mask, MAX_NUM_QUEUE);

	if (!dev->ethtool_ops->get_per_queue_coalesce)
		return -EOPNOTSUPP;

	useraddr += sizeof(*per_queue_opt);

	bitmap_from_u32array(queue_mask,
			     MAX_NUM_QUEUE,
			     per_queue_opt->queue_mask,
			     DIV_ROUND_UP(MAX_NUM_QUEUE, 32));

	for_each_set_bit(bit, queue_mask, MAX_NUM_QUEUE) {
		struct ethtool_coalesce coalesce = { .cmd = ETHTOOL_GCOALESCE };

		ret = dev->ethtool_ops->get_per_queue_coalesce(dev, bit, &coalesce);
		if (ret != 0)
			return ret;
		if (copy_to_user(useraddr, &coalesce, sizeof(coalesce)))
			return -EFAULT;
		useraddr += sizeof(coalesce);
	}

	return 0;
}

1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981
static int ethtool_set_per_queue_coalesce(struct net_device *dev,
					  void __user *useraddr,
					  struct ethtool_per_queue_op *per_queue_opt)
{
	u32 bit;
	int i, ret = 0;
	int n_queue;
	struct ethtool_coalesce *backup = NULL, *tmp = NULL;
	DECLARE_BITMAP(queue_mask, MAX_NUM_QUEUE);

	if ((!dev->ethtool_ops->set_per_queue_coalesce) ||
	    (!dev->ethtool_ops->get_per_queue_coalesce))
		return -EOPNOTSUPP;

	useraddr += sizeof(*per_queue_opt);

	bitmap_from_u32array(queue_mask,
			     MAX_NUM_QUEUE,
			     per_queue_opt->queue_mask,
			     DIV_ROUND_UP(MAX_NUM_QUEUE, 32));
	n_queue = bitmap_weight(queue_mask, MAX_NUM_QUEUE);
	tmp = backup = kmalloc_array(n_queue, sizeof(*backup), GFP_KERNEL);
	if (!backup)
		return -ENOMEM;

	for_each_set_bit(bit, queue_mask, MAX_NUM_QUEUE) {
		struct ethtool_coalesce coalesce;

		ret = dev->ethtool_ops->get_per_queue_coalesce(dev, bit, tmp);
		if (ret != 0)
			goto roll_back;

		tmp++;

		if (copy_from_user(&coalesce, useraddr, sizeof(coalesce))) {
			ret = -EFAULT;
			goto roll_back;
		}

		ret = dev->ethtool_ops->set_per_queue_coalesce(dev, bit, &coalesce);
		if (ret != 0)
			goto roll_back;

		useraddr += sizeof(coalesce);
	}

roll_back:
	if (ret != 0) {
		tmp = backup;
		for_each_set_bit(i, queue_mask, bit) {
			dev->ethtool_ops->set_per_queue_coalesce(dev, i, tmp);
			tmp++;
		}
	}
	kfree(backup);

	return ret;
}

1982 1983 1984 1985 1986 1987 1988 1989
static int ethtool_set_per_queue(struct net_device *dev, void __user *useraddr)
{
	struct ethtool_per_queue_op per_queue_opt;

	if (copy_from_user(&per_queue_opt, useraddr, sizeof(per_queue_opt)))
		return -EFAULT;

	switch (per_queue_opt.sub_command) {
1990 1991
	case ETHTOOL_GCOALESCE:
		return ethtool_get_per_queue_coalesce(dev, useraddr, &per_queue_opt);
1992 1993
	case ETHTOOL_SCOALESCE:
		return ethtool_set_per_queue_coalesce(dev, useraddr, &per_queue_opt);
1994 1995 1996 1997 1998
	default:
		return -EOPNOTSUPP;
	};
}

1999
/* The main entry point in this file.  Called from net/core/dev_ioctl.c */
L
Linus Torvalds 已提交
2000

2001
int dev_ethtool(struct net *net, struct ifreq *ifr)
L
Linus Torvalds 已提交
2002
{
2003
	struct net_device *dev = __dev_get_by_name(net, ifr->ifr_name);
L
Linus Torvalds 已提交
2004
	void __user *useraddr = ifr->ifr_data;
2005
	u32 ethcmd, sub_cmd;
L
Linus Torvalds 已提交
2006
	int rc;
2007
	netdev_features_t old_features;
L
Linus Torvalds 已提交
2008 2009 2010 2011

	if (!dev || !netif_device_present(dev))
		return -ENODEV;

2012
	if (copy_from_user(&ethcmd, useraddr, sizeof(ethcmd)))
L
Linus Torvalds 已提交
2013 2014
		return -EFAULT;

2015 2016 2017 2018 2019 2020
	if (ethcmd == ETHTOOL_PERQUEUE) {
		if (copy_from_user(&sub_cmd, useraddr + sizeof(ethcmd), sizeof(sub_cmd)))
			return -EFAULT;
	} else {
		sub_cmd = ethcmd;
	}
2021
	/* Allow some commands to be done by anyone */
2022
	switch (sub_cmd) {
2023
	case ETHTOOL_GSET:
2024 2025
	case ETHTOOL_GDRVINFO:
	case ETHTOOL_GMSGLVL:
2026
	case ETHTOOL_GLINK:
2027 2028 2029 2030 2031 2032
	case ETHTOOL_GCOALESCE:
	case ETHTOOL_GRINGPARAM:
	case ETHTOOL_GPAUSEPARAM:
	case ETHTOOL_GRXCSUM:
	case ETHTOOL_GTXCSUM:
	case ETHTOOL_GSG:
2033
	case ETHTOOL_GSSET_INFO:
2034
	case ETHTOOL_GSTRINGS:
2035
	case ETHTOOL_GSTATS:
A
Andrew Lunn 已提交
2036
	case ETHTOOL_GPHYSTATS:
2037 2038 2039 2040
	case ETHTOOL_GTSO:
	case ETHTOOL_GPERMADDR:
	case ETHTOOL_GUFO:
	case ETHTOOL_GGSO:
2041
	case ETHTOOL_GGRO:
2042 2043
	case ETHTOOL_GFLAGS:
	case ETHTOOL_GPFLAGS:
2044
	case ETHTOOL_GRXFH:
2045 2046 2047 2048
	case ETHTOOL_GRXRINGS:
	case ETHTOOL_GRXCLSRLCNT:
	case ETHTOOL_GRXCLSRULE:
	case ETHTOOL_GRXCLSRLALL:
2049
	case ETHTOOL_GRXFHINDIR:
2050
	case ETHTOOL_GRSSH:
2051
	case ETHTOOL_GFEATURES:
2052
	case ETHTOOL_GCHANNELS:
2053
	case ETHTOOL_GET_TS_INFO:
2054
	case ETHTOOL_GEEE:
2055
	case ETHTOOL_GTUNABLE:
2056 2057
		break;
	default:
2058
		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
2059 2060 2061
			return -EPERM;
	}

2062 2063 2064
	if (dev->ethtool_ops->begin) {
		rc = dev->ethtool_ops->begin(dev);
		if (rc  < 0)
L
Linus Torvalds 已提交
2065
			return rc;
2066
	}
2067 2068
	old_features = dev->features;

L
Linus Torvalds 已提交
2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088
	switch (ethcmd) {
	case ETHTOOL_GSET:
		rc = ethtool_get_settings(dev, useraddr);
		break;
	case ETHTOOL_SSET:
		rc = ethtool_set_settings(dev, useraddr);
		break;
	case ETHTOOL_GDRVINFO:
		rc = ethtool_get_drvinfo(dev, useraddr);
		break;
	case ETHTOOL_GREGS:
		rc = ethtool_get_regs(dev, useraddr);
		break;
	case ETHTOOL_GWOL:
		rc = ethtool_get_wol(dev, useraddr);
		break;
	case ETHTOOL_SWOL:
		rc = ethtool_set_wol(dev, useraddr);
		break;
	case ETHTOOL_GMSGLVL:
2089 2090
		rc = ethtool_get_value(dev, useraddr, ethcmd,
				       dev->ethtool_ops->get_msglevel);
L
Linus Torvalds 已提交
2091 2092
		break;
	case ETHTOOL_SMSGLVL:
2093 2094
		rc = ethtool_set_value_void(dev, useraddr,
				       dev->ethtool_ops->set_msglevel);
L
Linus Torvalds 已提交
2095
		break;
2096 2097 2098 2099 2100 2101
	case ETHTOOL_GEEE:
		rc = ethtool_get_eee(dev, useraddr);
		break;
	case ETHTOOL_SEEE:
		rc = ethtool_set_eee(dev, useraddr);
		break;
L
Linus Torvalds 已提交
2102 2103 2104 2105
	case ETHTOOL_NWAY_RST:
		rc = ethtool_nway_reset(dev);
		break;
	case ETHTOOL_GLINK:
2106
		rc = ethtool_get_link(dev, useraddr);
L
Linus Torvalds 已提交
2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143
		break;
	case ETHTOOL_GEEPROM:
		rc = ethtool_get_eeprom(dev, useraddr);
		break;
	case ETHTOOL_SEEPROM:
		rc = ethtool_set_eeprom(dev, useraddr);
		break;
	case ETHTOOL_GCOALESCE:
		rc = ethtool_get_coalesce(dev, useraddr);
		break;
	case ETHTOOL_SCOALESCE:
		rc = ethtool_set_coalesce(dev, useraddr);
		break;
	case ETHTOOL_GRINGPARAM:
		rc = ethtool_get_ringparam(dev, useraddr);
		break;
	case ETHTOOL_SRINGPARAM:
		rc = ethtool_set_ringparam(dev, useraddr);
		break;
	case ETHTOOL_GPAUSEPARAM:
		rc = ethtool_get_pauseparam(dev, useraddr);
		break;
	case ETHTOOL_SPAUSEPARAM:
		rc = ethtool_set_pauseparam(dev, useraddr);
		break;
	case ETHTOOL_TEST:
		rc = ethtool_self_test(dev, useraddr);
		break;
	case ETHTOOL_GSTRINGS:
		rc = ethtool_get_strings(dev, useraddr);
		break;
	case ETHTOOL_PHYS_ID:
		rc = ethtool_phys_id(dev, useraddr);
		break;
	case ETHTOOL_GSTATS:
		rc = ethtool_get_stats(dev, useraddr);
		break;
2144 2145 2146
	case ETHTOOL_GPERMADDR:
		rc = ethtool_get_perm_addr(dev, useraddr);
		break;
2147
	case ETHTOOL_GFLAGS:
2148
		rc = ethtool_get_value(dev, useraddr, ethcmd,
M
Michał Mirosław 已提交
2149
					__ethtool_get_flags);
2150 2151
		break;
	case ETHTOOL_SFLAGS:
2152
		rc = ethtool_set_value(dev, useraddr, __ethtool_set_flags);
2153
		break;
2154
	case ETHTOOL_GPFLAGS:
2155 2156
		rc = ethtool_get_value(dev, useraddr, ethcmd,
				       dev->ethtool_ops->get_priv_flags);
2157 2158
		break;
	case ETHTOOL_SPFLAGS:
2159 2160
		rc = ethtool_set_value(dev, useraddr,
				       dev->ethtool_ops->set_priv_flags);
2161
		break;
2162
	case ETHTOOL_GRXFH:
2163 2164 2165 2166
	case ETHTOOL_GRXRINGS:
	case ETHTOOL_GRXCLSRLCNT:
	case ETHTOOL_GRXCLSRULE:
	case ETHTOOL_GRXCLSRLALL:
2167
		rc = ethtool_get_rxnfc(dev, ethcmd, useraddr);
2168 2169
		break;
	case ETHTOOL_SRXFH:
2170 2171
	case ETHTOOL_SRXCLSRLDEL:
	case ETHTOOL_SRXCLSRLINS:
2172
		rc = ethtool_set_rxnfc(dev, ethcmd, useraddr);
2173
		break;
2174 2175 2176
	case ETHTOOL_FLASHDEV:
		rc = ethtool_flash_device(dev, useraddr);
		break;
B
Ben Hutchings 已提交
2177 2178 2179
	case ETHTOOL_RESET:
		rc = ethtool_reset(dev, useraddr);
		break;
2180 2181 2182
	case ETHTOOL_GSSET_INFO:
		rc = ethtool_get_sset_info(dev, useraddr);
		break;
2183 2184 2185 2186 2187 2188
	case ETHTOOL_GRXFHINDIR:
		rc = ethtool_get_rxfh_indir(dev, useraddr);
		break;
	case ETHTOOL_SRXFHINDIR:
		rc = ethtool_set_rxfh_indir(dev, useraddr);
		break;
2189 2190 2191 2192 2193 2194
	case ETHTOOL_GRSSH:
		rc = ethtool_get_rxfh(dev, useraddr);
		break;
	case ETHTOOL_SRSSH:
		rc = ethtool_set_rxfh(dev, useraddr);
		break;
2195 2196 2197 2198 2199 2200
	case ETHTOOL_GFEATURES:
		rc = ethtool_get_features(dev, useraddr);
		break;
	case ETHTOOL_SFEATURES:
		rc = ethtool_set_features(dev, useraddr);
		break;
2201
	case ETHTOOL_GTXCSUM:
2202
	case ETHTOOL_GRXCSUM:
2203 2204 2205 2206 2207 2208 2209 2210
	case ETHTOOL_GSG:
	case ETHTOOL_GTSO:
	case ETHTOOL_GUFO:
	case ETHTOOL_GGSO:
	case ETHTOOL_GGRO:
		rc = ethtool_get_one_feature(dev, useraddr, ethcmd);
		break;
	case ETHTOOL_STXCSUM:
2211
	case ETHTOOL_SRXCSUM:
2212 2213 2214 2215 2216 2217 2218
	case ETHTOOL_SSG:
	case ETHTOOL_STSO:
	case ETHTOOL_SUFO:
	case ETHTOOL_SGSO:
	case ETHTOOL_SGRO:
		rc = ethtool_set_one_feature(dev, useraddr, ethcmd);
		break;
2219 2220 2221 2222 2223 2224
	case ETHTOOL_GCHANNELS:
		rc = ethtool_get_channels(dev, useraddr);
		break;
	case ETHTOOL_SCHANNELS:
		rc = ethtool_set_channels(dev, useraddr);
		break;
2225 2226 2227 2228 2229 2230 2231 2232 2233
	case ETHTOOL_SET_DUMP:
		rc = ethtool_set_dump(dev, useraddr);
		break;
	case ETHTOOL_GET_DUMP_FLAG:
		rc = ethtool_get_dump_flag(dev, useraddr);
		break;
	case ETHTOOL_GET_DUMP_DATA:
		rc = ethtool_get_dump_data(dev, useraddr);
		break;
2234 2235 2236
	case ETHTOOL_GET_TS_INFO:
		rc = ethtool_get_ts_info(dev, useraddr);
		break;
2237 2238 2239 2240 2241 2242
	case ETHTOOL_GMODULEINFO:
		rc = ethtool_get_module_info(dev, useraddr);
		break;
	case ETHTOOL_GMODULEEEPROM:
		rc = ethtool_get_module_eeprom(dev, useraddr);
		break;
2243 2244 2245 2246 2247 2248
	case ETHTOOL_GTUNABLE:
		rc = ethtool_get_tunable(dev, useraddr);
		break;
	case ETHTOOL_STUNABLE:
		rc = ethtool_set_tunable(dev, useraddr);
		break;
A
Andrew Lunn 已提交
2249 2250 2251
	case ETHTOOL_GPHYSTATS:
		rc = ethtool_get_phy_stats(dev, useraddr);
		break;
2252 2253 2254
	case ETHTOOL_PERQUEUE:
		rc = ethtool_set_per_queue(dev, useraddr);
		break;
L
Linus Torvalds 已提交
2255
	default:
2256
		rc = -EOPNOTSUPP;
L
Linus Torvalds 已提交
2257
	}
2258

2259
	if (dev->ethtool_ops->complete)
L
Linus Torvalds 已提交
2260
		dev->ethtool_ops->complete(dev);
2261 2262 2263 2264

	if (old_features != dev->features)
		netdev_features_change(dev);

L
Linus Torvalds 已提交
2265 2266
	return rc;
}