rtnetlink.c 112.6 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18
/*
 * INET		An implementation of the TCP/IP protocol suite for the LINUX
 *		operating system.  INET is implemented using the  BSD Socket
 *		interface as the means of communication with the user level.
 *
 *		Routing netlink socket interface: protocol independent part.
 *
 * Authors:	Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
 *
 *		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.
 *
 *	Fixes:
 *	Vitaly E. Lavrov		RTA_OK arithmetics was wrong.
 */

19
#include <linux/bitops.h>
L
Linus Torvalds 已提交
20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36
#include <linux/errno.h>
#include <linux/module.h>
#include <linux/types.h>
#include <linux/socket.h>
#include <linux/kernel.h>
#include <linux/timer.h>
#include <linux/string.h>
#include <linux/sockios.h>
#include <linux/net.h>
#include <linux/fcntl.h>
#include <linux/mm.h>
#include <linux/slab.h>
#include <linux/interrupt.h>
#include <linux/capability.h>
#include <linux/skbuff.h>
#include <linux/init.h>
#include <linux/security.h>
37
#include <linux/mutex.h>
38
#include <linux/if_addr.h>
39
#include <linux/if_bridge.h>
40
#include <linux/if_vlan.h>
41
#include <linux/pci.h>
42
#include <linux/etherdevice.h>
M
Martin KaFai Lau 已提交
43
#include <linux/bpf.h>
L
Linus Torvalds 已提交
44

45
#include <linux/uaccess.h>
L
Linus Torvalds 已提交
46 47 48

#include <linux/inet.h>
#include <linux/netdevice.h>
49
#include <net/switchdev.h>
L
Linus Torvalds 已提交
50 51 52 53 54
#include <net/ip.h>
#include <net/protocol.h>
#include <net/arp.h>
#include <net/route.h>
#include <net/udp.h>
55
#include <net/tcp.h>
L
Linus Torvalds 已提交
56 57
#include <net/sock.h>
#include <net/pkt_sched.h>
58
#include <net/fib_rules.h>
59
#include <net/rtnetlink.h>
60
#include <net/net_namespace.h>
L
Linus Torvalds 已提交
61

E
Eric Dumazet 已提交
62
struct rtnl_link {
63 64
	rtnl_doit_func		doit;
	rtnl_dumpit_func	dumpit;
65
	struct module		*owner;
66
	unsigned int		flags;
67
	struct rcu_head		rcu;
68 69
};

70
static DEFINE_MUTEX(rtnl_mutex);
L
Linus Torvalds 已提交
71 72 73

void rtnl_lock(void)
{
74
	mutex_lock(&rtnl_mutex);
L
Linus Torvalds 已提交
75
}
E
Eric Dumazet 已提交
76
EXPORT_SYMBOL(rtnl_lock);
L
Linus Torvalds 已提交
77

78 79 80 81 82 83 84 85 86 87
static struct sk_buff *defer_kfree_skb_list;
void rtnl_kfree_skbs(struct sk_buff *head, struct sk_buff *tail)
{
	if (head && tail) {
		tail->next = defer_kfree_skb_list;
		defer_kfree_skb_list = head;
	}
}
EXPORT_SYMBOL(rtnl_kfree_skbs);

88
void __rtnl_unlock(void)
L
Linus Torvalds 已提交
89
{
90 91 92 93
	struct sk_buff *head = defer_kfree_skb_list;

	defer_kfree_skb_list = NULL;

94
	mutex_unlock(&rtnl_mutex);
95 96 97 98 99 100 101 102

	while (head) {
		struct sk_buff *next = head->next;

		kfree_skb(head);
		cond_resched();
		head = next;
	}
L
Linus Torvalds 已提交
103
}
104

L
Linus Torvalds 已提交
105 106
void rtnl_unlock(void)
{
H
Herbert Xu 已提交
107
	/* This fellow will unlock it for us. */
L
Linus Torvalds 已提交
108 109
	netdev_run_todo();
}
E
Eric Dumazet 已提交
110
EXPORT_SYMBOL(rtnl_unlock);
L
Linus Torvalds 已提交
111

112 113 114 115
int rtnl_trylock(void)
{
	return mutex_trylock(&rtnl_mutex);
}
E
Eric Dumazet 已提交
116
EXPORT_SYMBOL(rtnl_trylock);
117

118 119 120 121
int rtnl_is_locked(void)
{
	return mutex_is_locked(&rtnl_mutex);
}
E
Eric Dumazet 已提交
122
EXPORT_SYMBOL(rtnl_is_locked);
123

124
#ifdef CONFIG_PROVE_LOCKING
125
bool lockdep_rtnl_is_held(void)
126 127 128 129 130 131
{
	return lockdep_is_held(&rtnl_mutex);
}
EXPORT_SYMBOL(lockdep_rtnl_is_held);
#endif /* #ifdef CONFIG_PROVE_LOCKING */

132
static struct rtnl_link *__rcu *rtnl_msg_handlers[RTNL_FAMILY_MAX + 1];
133 134 135 136 137 138 139 140 141 142 143 144 145 146 147

static inline int rtm_msgindex(int msgtype)
{
	int msgindex = msgtype - RTM_BASE;

	/*
	 * msgindex < 0 implies someone tried to register a netlink
	 * control code. msgindex >= RTM_NR_MSGTYPES may indicate that
	 * the message type has not been added to linux/rtnetlink.h
	 */
	BUG_ON(msgindex < 0 || msgindex >= RTM_NR_MSGTYPES);

	return msgindex;
}

148 149 150 151 152 153 154 155 156 157 158 159 160 161
static struct rtnl_link *rtnl_get_link(int protocol, int msgtype)
{
	struct rtnl_link **tab;

	if (protocol >= ARRAY_SIZE(rtnl_msg_handlers))
		protocol = PF_UNSPEC;

	tab = rcu_dereference_rtnl(rtnl_msg_handlers[protocol]);
	if (!tab)
		tab = rcu_dereference_rtnl(rtnl_msg_handlers[PF_UNSPEC]);

	return tab[msgtype];
}

162 163 164 165
static int rtnl_register_internal(struct module *owner,
				  int protocol, int msgtype,
				  rtnl_doit_func doit, rtnl_dumpit_func dumpit,
				  unsigned int flags)
166
{
167 168
	struct rtnl_link *link, *old;
	struct rtnl_link __rcu **tab;
169
	int msgindex;
170
	int ret = -ENOBUFS;
171

172
	BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
173 174
	msgindex = rtm_msgindex(msgtype);

175 176
	rtnl_lock();
	tab = rtnl_msg_handlers[protocol];
177
	if (tab == NULL) {
178 179 180
		tab = kcalloc(RTM_NR_MSGTYPES, sizeof(void *), GFP_KERNEL);
		if (!tab)
			goto unlock;
181

182
		/* ensures we see the 0 stores */
183
		rcu_assign_pointer(rtnl_msg_handlers[protocol], tab);
184 185
	}

186 187 188 189 190 191 192 193 194 195 196
	old = rtnl_dereference(tab[msgindex]);
	if (old) {
		link = kmemdup(old, sizeof(*old), GFP_KERNEL);
		if (!link)
			goto unlock;
	} else {
		link = kzalloc(sizeof(*link), GFP_KERNEL);
		if (!link)
			goto unlock;
	}

197 198 199
	WARN_ON(link->owner && link->owner != owner);
	link->owner = owner;

200
	WARN_ON(doit && link->doit && link->doit != doit);
201
	if (doit)
202 203
		link->doit = doit;
	WARN_ON(dumpit && link->dumpit && link->dumpit != dumpit);
204
	if (dumpit)
205
		link->dumpit = dumpit;
206

207 208 209 210 211 212 213 214 215 216
	link->flags |= flags;

	/* publish protocol:msgtype */
	rcu_assign_pointer(tab[msgindex], link);
	ret = 0;
	if (old)
		kfree_rcu(old, rcu);
unlock:
	rtnl_unlock();
	return ret;
217
}
218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241

/**
 * rtnl_register_module - Register a rtnetlink message type
 *
 * @owner: module registering the hook (THIS_MODULE)
 * @protocol: Protocol family or PF_UNSPEC
 * @msgtype: rtnetlink message type
 * @doit: Function pointer called for each request message
 * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message
 * @flags: rtnl_link_flags to modifiy behaviour of doit/dumpit functions
 *
 * Like rtnl_register, but for use by removable modules.
 */
int rtnl_register_module(struct module *owner,
			 int protocol, int msgtype,
			 rtnl_doit_func doit, rtnl_dumpit_func dumpit,
			 unsigned int flags)
{
	return rtnl_register_internal(owner, protocol, msgtype,
				      doit, dumpit, flags);
}
EXPORT_SYMBOL_GPL(rtnl_register_module);

/**
242
 * rtnl_register - Register a rtnetlink message type
243 244 245 246 247 248 249 250 251 252 253 254 255
 * @protocol: Protocol family or PF_UNSPEC
 * @msgtype: rtnetlink message type
 * @doit: Function pointer called for each request message
 * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message
 * @flags: rtnl_link_flags to modifiy behaviour of doit/dumpit functions
 *
 * Registers the specified function pointers (at least one of them has
 * to be non-NULL) to be called whenever a request message for the
 * specified protocol family and message type is received.
 *
 * The special protocol family PF_UNSPEC may be used to define fallback
 * function pointers for the case when no entry for the specific protocol
 * family exists.
256 257
 */
void rtnl_register(int protocol, int msgtype,
258
		   rtnl_doit_func doit, rtnl_dumpit_func dumpit,
259
		   unsigned int flags)
260
{
261 262 263 264 265 266 267
	int err;

	err = rtnl_register_internal(NULL, protocol, msgtype, doit, dumpit,
				     flags);
	if (err)
		pr_err("Unable to register rtnetlink message handler, "
		       "protocol = %d, message type = %d\n", protocol, msgtype);
268 269 270 271 272 273 274 275 276 277 278
}

/**
 * rtnl_unregister - Unregister a rtnetlink message type
 * @protocol: Protocol family or PF_UNSPEC
 * @msgtype: rtnetlink message type
 *
 * Returns 0 on success or a negative error code.
 */
int rtnl_unregister(int protocol, int msgtype)
{
279
	struct rtnl_link **tab, *link;
280 281
	int msgindex;

282
	BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
283 284
	msgindex = rtm_msgindex(msgtype);

285
	rtnl_lock();
286 287
	tab = rtnl_dereference(rtnl_msg_handlers[protocol]);
	if (!tab) {
288
		rtnl_unlock();
289
		return -ENOENT;
290
	}
291

292 293
	link = tab[msgindex];
	rcu_assign_pointer(tab[msgindex], NULL);
294
	rtnl_unlock();
295

296 297
	kfree_rcu(link, rcu);

298 299 300 301 302 303 304 305 306 307 308 309 310
	return 0;
}
EXPORT_SYMBOL_GPL(rtnl_unregister);

/**
 * rtnl_unregister_all - Unregister all rtnetlink message type of a protocol
 * @protocol : Protocol family or PF_UNSPEC
 *
 * Identical to calling rtnl_unregster() for all registered message types
 * of a certain protocol family.
 */
void rtnl_unregister_all(int protocol)
{
311 312
	struct rtnl_link **tab, *link;
	int msgindex;
313

314
	BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
315

316
	rtnl_lock();
317
	tab = rtnl_msg_handlers[protocol];
318
	RCU_INIT_POINTER(rtnl_msg_handlers[protocol], NULL);
319 320 321 322 323 324 325 326
	for (msgindex = 0; msgindex < RTM_NR_MSGTYPES; msgindex++) {
		link = tab[msgindex];
		if (!link)
			continue;

		rcu_assign_pointer(tab[msgindex], NULL);
		kfree_rcu(link, rcu);
	}
327 328
	rtnl_unlock();

329 330
	synchronize_net();

331
	kfree(tab);
332 333
}
EXPORT_SYMBOL_GPL(rtnl_unregister_all);
L
Linus Torvalds 已提交
334

P
Patrick McHardy 已提交
335 336
static LIST_HEAD(link_ops);

337 338 339 340 341 342 343 344 345 346 347
static const struct rtnl_link_ops *rtnl_link_ops_get(const char *kind)
{
	const struct rtnl_link_ops *ops;

	list_for_each_entry(ops, &link_ops, list) {
		if (!strcmp(ops->kind, kind))
			return ops;
	}
	return NULL;
}

P
Patrick McHardy 已提交
348 349 350 351 352 353 354 355 356 357 358 359
/**
 * __rtnl_link_register - Register rtnl_link_ops with rtnetlink.
 * @ops: struct rtnl_link_ops * to register
 *
 * The caller must hold the rtnl_mutex. This function should be used
 * by drivers that create devices during module initialization. It
 * must be called before registering the devices.
 *
 * Returns 0 on success or a negative error code.
 */
int __rtnl_link_register(struct rtnl_link_ops *ops)
{
360 361 362
	if (rtnl_link_ops_get(ops->kind))
		return -EEXIST;

363 364 365 366 367 368
	/* The check for setup is here because if ops
	 * does not have that filled up, it is not possible
	 * to use the ops for creating device. So do not
	 * fill up dellink as well. That disables rtnl_dellink.
	 */
	if (ops->setup && !ops->dellink)
369
		ops->dellink = unregister_netdevice_queue;
370

P
Patrick McHardy 已提交
371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392
	list_add_tail(&ops->list, &link_ops);
	return 0;
}
EXPORT_SYMBOL_GPL(__rtnl_link_register);

/**
 * rtnl_link_register - Register rtnl_link_ops with rtnetlink.
 * @ops: struct rtnl_link_ops * to register
 *
 * Returns 0 on success or a negative error code.
 */
int rtnl_link_register(struct rtnl_link_ops *ops)
{
	int err;

	rtnl_lock();
	err = __rtnl_link_register(ops);
	rtnl_unlock();
	return err;
}
EXPORT_SYMBOL_GPL(rtnl_link_register);

393 394 395
static void __rtnl_kill_links(struct net *net, struct rtnl_link_ops *ops)
{
	struct net_device *dev;
396 397
	LIST_HEAD(list_kill);

398
	for_each_netdev(net, dev) {
399 400
		if (dev->rtnl_link_ops == ops)
			ops->dellink(dev, &list_kill);
401
	}
402
	unregister_netdevice_many(&list_kill);
403 404
}

P
Patrick McHardy 已提交
405 406 407 408
/**
 * __rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink.
 * @ops: struct rtnl_link_ops * to unregister
 *
409
 * The caller must hold the rtnl_mutex.
P
Patrick McHardy 已提交
410 411 412
 */
void __rtnl_link_unregister(struct rtnl_link_ops *ops)
{
413
	struct net *net;
414

415
	for_each_net(net) {
416
		__rtnl_kill_links(net, ops);
417
	}
P
Patrick McHardy 已提交
418 419 420 421
	list_del(&ops->list);
}
EXPORT_SYMBOL_GPL(__rtnl_link_unregister);

422 423 424 425 426 427 428
/* Return with the rtnl_lock held when there are no network
 * devices unregistering in any network namespace.
 */
static void rtnl_lock_unregistering_all(void)
{
	struct net *net;
	bool unregistering;
429
	DEFINE_WAIT_FUNC(wait, woken_wake_function);
430

431
	add_wait_queue(&netdev_unregistering_wq, &wait);
432 433 434 435 436 437 438 439 440 441 442 443
	for (;;) {
		unregistering = false;
		rtnl_lock();
		for_each_net(net) {
			if (net->dev_unreg_count > 0) {
				unregistering = true;
				break;
			}
		}
		if (!unregistering)
			break;
		__rtnl_unlock();
444 445

		wait_woken(&wait, TASK_UNINTERRUPTIBLE, MAX_SCHEDULE_TIMEOUT);
446
	}
447
	remove_wait_queue(&netdev_unregistering_wq, &wait);
448 449
}

P
Patrick McHardy 已提交
450 451 452 453 454 455
/**
 * rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink.
 * @ops: struct rtnl_link_ops * to unregister
 */
void rtnl_link_unregister(struct rtnl_link_ops *ops)
{
456 457 458
	/* Close the race with cleanup_net() */
	mutex_lock(&net_mutex);
	rtnl_lock_unregistering_all();
P
Patrick McHardy 已提交
459 460
	__rtnl_link_unregister(ops);
	rtnl_unlock();
461
	mutex_unlock(&net_mutex);
P
Patrick McHardy 已提交
462 463 464
}
EXPORT_SYMBOL_GPL(rtnl_link_unregister);

465 466 467 468
static size_t rtnl_link_get_slave_info_data_size(const struct net_device *dev)
{
	struct net_device *master_dev;
	const struct rtnl_link_ops *ops;
469
	size_t size = 0;
470

471 472 473
	rcu_read_lock();

	master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev);
474
	if (!master_dev)
475 476
		goto out;

477
	ops = master_dev->rtnl_link_ops;
478
	if (!ops || !ops->get_slave_size)
479
		goto out;
480
	/* IFLA_INFO_SLAVE_DATA + nested data */
481
	size = nla_total_size(sizeof(struct nlattr)) +
482
	       ops->get_slave_size(master_dev, dev);
483 484 485 486

out:
	rcu_read_unlock();
	return size;
487 488
}

P
Patrick McHardy 已提交
489 490 491 492 493 494 495 496
static size_t rtnl_link_get_size(const struct net_device *dev)
{
	const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
	size_t size;

	if (!ops)
		return 0;

497 498
	size = nla_total_size(sizeof(struct nlattr)) + /* IFLA_LINKINFO */
	       nla_total_size(strlen(ops->kind) + 1);  /* IFLA_INFO_KIND */
P
Patrick McHardy 已提交
499 500 501

	if (ops->get_size)
		/* IFLA_INFO_DATA + nested data */
502
		size += nla_total_size(sizeof(struct nlattr)) +
P
Patrick McHardy 已提交
503 504 505
			ops->get_size(dev);

	if (ops->get_xstats_size)
506 507
		/* IFLA_INFO_XSTATS */
		size += nla_total_size(ops->get_xstats_size(dev));
P
Patrick McHardy 已提交
508

509 510
	size += rtnl_link_get_slave_info_data_size(dev);

P
Patrick McHardy 已提交
511 512 513
	return size;
}

T
Thomas Graf 已提交
514 515 516 517 518 519
static LIST_HEAD(rtnl_af_ops);

static const struct rtnl_af_ops *rtnl_af_lookup(const int family)
{
	const struct rtnl_af_ops *ops;

F
Florian Westphal 已提交
520
	list_for_each_entry_rcu(ops, &rtnl_af_ops, list) {
T
Thomas Graf 已提交
521 522 523 524 525 526 527 528 529 530 531 532 533
		if (ops->family == family)
			return ops;
	}

	return NULL;
}

/**
 * rtnl_af_register - Register rtnl_af_ops with rtnetlink.
 * @ops: struct rtnl_af_ops * to register
 *
 * Returns 0 on success or a negative error code.
 */
534
void rtnl_af_register(struct rtnl_af_ops *ops)
T
Thomas Graf 已提交
535 536
{
	rtnl_lock();
F
Florian Westphal 已提交
537
	list_add_tail_rcu(&ops->list, &rtnl_af_ops);
T
Thomas Graf 已提交
538 539 540 541 542 543 544 545 546 547 548
	rtnl_unlock();
}
EXPORT_SYMBOL_GPL(rtnl_af_register);

/**
 * rtnl_af_unregister - Unregister rtnl_af_ops from rtnetlink.
 * @ops: struct rtnl_af_ops * to unregister
 */
void rtnl_af_unregister(struct rtnl_af_ops *ops)
{
	rtnl_lock();
F
Florian Westphal 已提交
549
	list_del_rcu(&ops->list);
T
Thomas Graf 已提交
550
	rtnl_unlock();
F
Florian Westphal 已提交
551 552

	synchronize_rcu();
T
Thomas Graf 已提交
553 554 555
}
EXPORT_SYMBOL_GPL(rtnl_af_unregister);

556 557
static size_t rtnl_link_get_af_size(const struct net_device *dev,
				    u32 ext_filter_mask)
T
Thomas Graf 已提交
558 559 560 561 562 563 564
{
	struct rtnl_af_ops *af_ops;
	size_t size;

	/* IFLA_AF_SPEC */
	size = nla_total_size(sizeof(struct nlattr));

F
Florian Westphal 已提交
565 566
	rcu_read_lock();
	list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
T
Thomas Graf 已提交
567 568 569
		if (af_ops->get_link_af_size) {
			/* AF_* + nested data */
			size += nla_total_size(sizeof(struct nlattr)) +
570
				af_ops->get_link_af_size(dev, ext_filter_mask);
T
Thomas Graf 已提交
571 572
		}
	}
F
Florian Westphal 已提交
573
	rcu_read_unlock();
T
Thomas Graf 已提交
574 575 576 577

	return size;
}

578
static bool rtnl_have_link_slave_info(const struct net_device *dev)
P
Patrick McHardy 已提交
579
{
580
	struct net_device *master_dev;
581
	bool ret = false;
P
Patrick McHardy 已提交
582

583 584 585
	rcu_read_lock();

	master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev);
586
	if (master_dev && master_dev->rtnl_link_ops)
587 588 589
		ret = true;
	rcu_read_unlock();
	return ret;
590 591 592 593 594 595 596 597 598
}

static int rtnl_link_slave_info_fill(struct sk_buff *skb,
				     const struct net_device *dev)
{
	struct net_device *master_dev;
	const struct rtnl_link_ops *ops;
	struct nlattr *slave_data;
	int err;
P
Patrick McHardy 已提交
599

600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632
	master_dev = netdev_master_upper_dev_get((struct net_device *) dev);
	if (!master_dev)
		return 0;
	ops = master_dev->rtnl_link_ops;
	if (!ops)
		return 0;
	if (nla_put_string(skb, IFLA_INFO_SLAVE_KIND, ops->kind) < 0)
		return -EMSGSIZE;
	if (ops->fill_slave_info) {
		slave_data = nla_nest_start(skb, IFLA_INFO_SLAVE_DATA);
		if (!slave_data)
			return -EMSGSIZE;
		err = ops->fill_slave_info(skb, master_dev, dev);
		if (err < 0)
			goto err_cancel_slave_data;
		nla_nest_end(skb, slave_data);
	}
	return 0;

err_cancel_slave_data:
	nla_nest_cancel(skb, slave_data);
	return err;
}

static int rtnl_link_info_fill(struct sk_buff *skb,
			       const struct net_device *dev)
{
	const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
	struct nlattr *data;
	int err;

	if (!ops)
		return 0;
P
Patrick McHardy 已提交
633
	if (nla_put_string(skb, IFLA_INFO_KIND, ops->kind) < 0)
634
		return -EMSGSIZE;
P
Patrick McHardy 已提交
635 636 637
	if (ops->fill_xstats) {
		err = ops->fill_xstats(skb, dev);
		if (err < 0)
638
			return err;
P
Patrick McHardy 已提交
639 640 641
	}
	if (ops->fill_info) {
		data = nla_nest_start(skb, IFLA_INFO_DATA);
642 643
		if (data == NULL)
			return -EMSGSIZE;
P
Patrick McHardy 已提交
644 645 646 647 648 649 650 651 652
		err = ops->fill_info(skb, dev);
		if (err < 0)
			goto err_cancel_data;
		nla_nest_end(skb, data);
	}
	return 0;

err_cancel_data:
	nla_nest_cancel(skb, data);
653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675
	return err;
}

static int rtnl_link_fill(struct sk_buff *skb, const struct net_device *dev)
{
	struct nlattr *linkinfo;
	int err = -EMSGSIZE;

	linkinfo = nla_nest_start(skb, IFLA_LINKINFO);
	if (linkinfo == NULL)
		goto out;

	err = rtnl_link_info_fill(skb, dev);
	if (err < 0)
		goto err_cancel_link;

	err = rtnl_link_slave_info_fill(skb, dev);
	if (err < 0)
		goto err_cancel_link;

	nla_nest_end(skb, linkinfo);
	return 0;

P
Patrick McHardy 已提交
676 677 678 679 680 681
err_cancel_link:
	nla_nest_cancel(skb, linkinfo);
out:
	return err;
}

682
int rtnetlink_send(struct sk_buff *skb, struct net *net, u32 pid, unsigned int group, int echo)
L
Linus Torvalds 已提交
683
{
684
	struct sock *rtnl = net->rtnl;
L
Linus Torvalds 已提交
685 686
	int err = 0;

687
	NETLINK_CB(skb).dst_group = group;
L
Linus Torvalds 已提交
688
	if (echo)
689
		refcount_inc(&skb->users);
L
Linus Torvalds 已提交
690 691 692 693 694 695
	netlink_broadcast(rtnl, skb, pid, group, GFP_KERNEL);
	if (echo)
		err = netlink_unicast(rtnl, skb, pid, MSG_DONTWAIT);
	return err;
}

696
int rtnl_unicast(struct sk_buff *skb, struct net *net, u32 pid)
697
{
698 699
	struct sock *rtnl = net->rtnl;

700 701
	return nlmsg_unicast(rtnl, skb, pid);
}
E
Eric Dumazet 已提交
702
EXPORT_SYMBOL(rtnl_unicast);
703

704 705
void rtnl_notify(struct sk_buff *skb, struct net *net, u32 pid, u32 group,
		 struct nlmsghdr *nlh, gfp_t flags)
706
{
707
	struct sock *rtnl = net->rtnl;
708 709 710 711 712
	int report = 0;

	if (nlh)
		report = nlmsg_report(nlh);

713
	nlmsg_notify(rtnl, skb, pid, group, report, flags);
714
}
E
Eric Dumazet 已提交
715
EXPORT_SYMBOL(rtnl_notify);
716

717
void rtnl_set_sk_err(struct net *net, u32 group, int error)
718
{
719 720
	struct sock *rtnl = net->rtnl;

721 722
	netlink_set_err(rtnl, 0, group, error);
}
E
Eric Dumazet 已提交
723
EXPORT_SYMBOL(rtnl_set_sk_err);
724

L
Linus Torvalds 已提交
725 726
int rtnetlink_put_metrics(struct sk_buff *skb, u32 *metrics)
{
727 728 729 730 731 732 733 734 735
	struct nlattr *mx;
	int i, valid = 0;

	mx = nla_nest_start(skb, RTA_METRICS);
	if (mx == NULL)
		return -ENOBUFS;

	for (i = 0; i < RTAX_MAX; i++) {
		if (metrics[i]) {
736 737 738 739 740 741 742 743
			if (i == RTAX_CC_ALGO - 1) {
				char tmp[TCP_CA_NAME_MAX], *name;

				name = tcp_ca_get_name_by_key(metrics[i], tmp);
				if (!name)
					continue;
				if (nla_put_string(skb, i + 1, name))
					goto nla_put_failure;
744 745 746
			} else if (i == RTAX_FEATURES - 1) {
				u32 user_features = metrics[i] & RTAX_FEATURE_MASK;

747 748
				if (!user_features)
					continue;
749 750 751
				BUILD_BUG_ON(RTAX_FEATURE_MASK & DST_FEATURE_MASK);
				if (nla_put_u32(skb, i + 1, user_features))
					goto nla_put_failure;
752 753 754 755
			} else {
				if (nla_put_u32(skb, i + 1, metrics[i]))
					goto nla_put_failure;
			}
756 757
			valid++;
		}
L
Linus Torvalds 已提交
758 759
	}

760 761 762 763
	if (!valid) {
		nla_nest_cancel(skb, mx);
		return 0;
	}
764 765 766 767

	return nla_nest_end(skb, mx);

nla_put_failure:
768 769
	nla_nest_cancel(skb, mx);
	return -EMSGSIZE;
L
Linus Torvalds 已提交
770
}
E
Eric Dumazet 已提交
771
EXPORT_SYMBOL(rtnetlink_put_metrics);
L
Linus Torvalds 已提交
772

773
int rtnl_put_cacheinfo(struct sk_buff *skb, struct dst_entry *dst, u32 id,
774
		       long expires, u32 error)
775 776
{
	struct rta_cacheinfo ci = {
777
		.rta_lastuse = jiffies_delta_to_clock_t(jiffies - dst->lastuse),
778 779 780 781 782 783
		.rta_used = dst->__use,
		.rta_clntref = atomic_read(&(dst->__refcnt)),
		.rta_error = error,
		.rta_id =  id,
	};

784 785
	if (expires) {
		unsigned long clock;
786

787 788 789 790
		clock = jiffies_to_clock_t(abs(expires));
		clock = min_t(unsigned long, clock, INT_MAX);
		ci.rta_expires = (expires > 0) ? clock : -clock;
	}
791 792 793
	return nla_put(skb, RTA_CACHEINFO, sizeof(ci), &ci);
}
EXPORT_SYMBOL_GPL(rtnl_put_cacheinfo);
L
Linus Torvalds 已提交
794

795
static void set_operstate(struct net_device *dev, unsigned char transition)
S
Stefan Rompf 已提交
796 797 798
{
	unsigned char operstate = dev->operstate;

E
Eric Dumazet 已提交
799
	switch (transition) {
S
Stefan Rompf 已提交
800 801 802 803 804 805 806 807 808 809 810 811
	case IF_OPER_UP:
		if ((operstate == IF_OPER_DORMANT ||
		     operstate == IF_OPER_UNKNOWN) &&
		    !netif_dormant(dev))
			operstate = IF_OPER_UP;
		break;

	case IF_OPER_DORMANT:
		if (operstate == IF_OPER_UP ||
		    operstate == IF_OPER_UNKNOWN)
			operstate = IF_OPER_DORMANT;
		break;
812
	}
S
Stefan Rompf 已提交
813 814 815 816 817

	if (dev->operstate != operstate) {
		write_lock_bh(&dev_base_lock);
		dev->operstate = operstate;
		write_unlock_bh(&dev_base_lock);
818 819
		netdev_state_change(dev);
	}
S
Stefan Rompf 已提交
820 821
}

822 823 824 825 826 827
static unsigned int rtnl_dev_get_flags(const struct net_device *dev)
{
	return (dev->flags & ~(IFF_PROMISC | IFF_ALLMULTI)) |
	       (dev->gflags & (IFF_PROMISC | IFF_ALLMULTI));
}

828 829 830 831 832 833 834 835
static unsigned int rtnl_dev_combine_flags(const struct net_device *dev,
					   const struct ifinfomsg *ifm)
{
	unsigned int flags = ifm->ifi_flags;

	/* bugwards compatibility: ifi_change == 0 is treated as ~0 */
	if (ifm->ifi_change)
		flags = (flags & ifm->ifi_change) |
836
			(rtnl_dev_get_flags(dev) & ~ifm->ifi_change);
837 838 839 840

	return flags;
}

841
static void copy_rtnl_link_stats(struct rtnl_link_stats *a,
842
				 const struct rtnl_link_stats64 *b)
L
Linus Torvalds 已提交
843
{
844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870
	a->rx_packets = b->rx_packets;
	a->tx_packets = b->tx_packets;
	a->rx_bytes = b->rx_bytes;
	a->tx_bytes = b->tx_bytes;
	a->rx_errors = b->rx_errors;
	a->tx_errors = b->tx_errors;
	a->rx_dropped = b->rx_dropped;
	a->tx_dropped = b->tx_dropped;

	a->multicast = b->multicast;
	a->collisions = b->collisions;

	a->rx_length_errors = b->rx_length_errors;
	a->rx_over_errors = b->rx_over_errors;
	a->rx_crc_errors = b->rx_crc_errors;
	a->rx_frame_errors = b->rx_frame_errors;
	a->rx_fifo_errors = b->rx_fifo_errors;
	a->rx_missed_errors = b->rx_missed_errors;

	a->tx_aborted_errors = b->tx_aborted_errors;
	a->tx_carrier_errors = b->tx_carrier_errors;
	a->tx_fifo_errors = b->tx_fifo_errors;
	a->tx_heartbeat_errors = b->tx_heartbeat_errors;
	a->tx_window_errors = b->tx_window_errors;

	a->rx_compressed = b->rx_compressed;
	a->tx_compressed = b->tx_compressed;
871 872

	a->rx_nohandler = b->rx_nohandler;
873 874
}

875
/* All VF info */
876 877
static inline int rtnl_vfinfo_size(const struct net_device *dev,
				   u32 ext_filter_mask)
878
{
879
	if (dev->dev.parent && (ext_filter_mask & RTEXT_FILTER_VF)) {
880
		int num_vfs = dev_num_vf(dev->dev.parent);
S
Sabrina Dubroca 已提交
881
		size_t size = nla_total_size(0);
882
		size += num_vfs *
S
Sabrina Dubroca 已提交
883 884 885 886
			(nla_total_size(0) +
			 nla_total_size(sizeof(struct ifla_vf_mac)) +
			 nla_total_size(sizeof(struct ifla_vf_vlan)) +
			 nla_total_size(0) + /* nest IFLA_VF_VLAN_LIST */
887 888
			 nla_total_size(MAX_VLAN_LIST_LEN *
					sizeof(struct ifla_vf_vlan_info)) +
889
			 nla_total_size(sizeof(struct ifla_vf_spoofchk)) +
S
Sabrina Dubroca 已提交
890
			 nla_total_size(sizeof(struct ifla_vf_tx_rate)) +
J
Jiri Benc 已提交
891
			 nla_total_size(sizeof(struct ifla_vf_rate)) +
892
			 nla_total_size(sizeof(struct ifla_vf_link_state)) +
893
			 nla_total_size(sizeof(struct ifla_vf_rss_query_en)) +
S
Sabrina Dubroca 已提交
894
			 nla_total_size(0) + /* nest IFLA_VF_STATS */
895
			 /* IFLA_VF_STATS_RX_PACKETS */
N
Nicolas Dichtel 已提交
896
			 nla_total_size_64bit(sizeof(__u64)) +
897
			 /* IFLA_VF_STATS_TX_PACKETS */
N
Nicolas Dichtel 已提交
898
			 nla_total_size_64bit(sizeof(__u64)) +
899
			 /* IFLA_VF_STATS_RX_BYTES */
N
Nicolas Dichtel 已提交
900
			 nla_total_size_64bit(sizeof(__u64)) +
901
			 /* IFLA_VF_STATS_TX_BYTES */
N
Nicolas Dichtel 已提交
902
			 nla_total_size_64bit(sizeof(__u64)) +
903
			 /* IFLA_VF_STATS_BROADCAST */
N
Nicolas Dichtel 已提交
904
			 nla_total_size_64bit(sizeof(__u64)) +
905
			 /* IFLA_VF_STATS_MULTICAST */
N
Nicolas Dichtel 已提交
906
			 nla_total_size_64bit(sizeof(__u64)) +
907 908 909 910
			 /* IFLA_VF_STATS_RX_DROPPED */
			 nla_total_size_64bit(sizeof(__u64)) +
			 /* IFLA_VF_STATS_TX_DROPPED */
			 nla_total_size_64bit(sizeof(__u64)) +
H
Hiroshi Shimamoto 已提交
911
			 nla_total_size(sizeof(struct ifla_vf_trust)));
912 913
		return size;
	} else
914 915 916
		return 0;
}

917 918
static size_t rtnl_port_size(const struct net_device *dev,
			     u32 ext_filter_mask)
919 920 921 922 923 924 925 926 927 928 929 930 931
{
	size_t port_size = nla_total_size(4)		/* PORT_VF */
		+ nla_total_size(PORT_PROFILE_MAX)	/* PORT_PROFILE */
		+ nla_total_size(PORT_UUID_MAX)		/* PORT_INSTANCE_UUID */
		+ nla_total_size(PORT_UUID_MAX)		/* PORT_HOST_UUID */
		+ nla_total_size(1)			/* PROT_VDP_REQUEST */
		+ nla_total_size(2);			/* PORT_VDP_RESPONSE */
	size_t vf_ports_size = nla_total_size(sizeof(struct nlattr));
	size_t vf_port_size = nla_total_size(sizeof(struct nlattr))
		+ port_size;
	size_t port_self_size = nla_total_size(sizeof(struct nlattr))
		+ port_size;

932 933
	if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent ||
	    !(ext_filter_mask & RTEXT_FILTER_VF))
934 935 936 937 938 939 940 941
		return 0;
	if (dev_num_vf(dev->dev.parent))
		return port_self_size + vf_ports_size +
			vf_port_size * dev_num_vf(dev->dev.parent);
	else
		return port_self_size;
}

D
David S. Miller 已提交
942
static size_t rtnl_xdp_size(void)
943
{
944
	size_t xdp_size = nla_total_size(0) +	/* nest IFLA_XDP */
M
Martin KaFai Lau 已提交
945 946
			  nla_total_size(1) +	/* XDP_ATTACHED */
			  nla_total_size(4);	/* XDP_PROG_ID */
947

D
David S. Miller 已提交
948
	return xdp_size;
949 950
}

951 952
static noinline size_t if_nlmsg_size(const struct net_device *dev,
				     u32 ext_filter_mask)
953 954 955
{
	return NLMSG_ALIGN(sizeof(struct ifinfomsg))
	       + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
956
	       + nla_total_size(IFALIASZ) /* IFLA_IFALIAS */
957
	       + nla_total_size(IFNAMSIZ) /* IFLA_QDISC */
958
	       + nla_total_size_64bit(sizeof(struct rtnl_link_ifmap))
959
	       + nla_total_size(sizeof(struct rtnl_link_stats))
960
	       + nla_total_size_64bit(sizeof(struct rtnl_link_stats64))
961 962 963 964 965 966 967
	       + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
	       + nla_total_size(MAX_ADDR_LEN) /* IFLA_BROADCAST */
	       + nla_total_size(4) /* IFLA_TXQLEN */
	       + nla_total_size(4) /* IFLA_WEIGHT */
	       + nla_total_size(4) /* IFLA_MTU */
	       + nla_total_size(4) /* IFLA_LINK */
	       + nla_total_size(4) /* IFLA_MASTER */
968
	       + nla_total_size(1) /* IFLA_CARRIER */
969
	       + nla_total_size(4) /* IFLA_PROMISCUITY */
970 971
	       + nla_total_size(4) /* IFLA_NUM_TX_QUEUES */
	       + nla_total_size(4) /* IFLA_NUM_RX_QUEUES */
972 973
	       + nla_total_size(4) /* IFLA_GSO_MAX_SEGS */
	       + nla_total_size(4) /* IFLA_GSO_MAX_SIZE */
974
	       + nla_total_size(1) /* IFLA_OPERSTATE */
P
Patrick McHardy 已提交
975
	       + nla_total_size(1) /* IFLA_LINKMODE */
976
	       + nla_total_size(4) /* IFLA_CARRIER_CHANGES */
977
	       + nla_total_size(4) /* IFLA_LINK_NETNSID */
978
	       + nla_total_size(4) /* IFLA_GROUP */
979 980 981
	       + nla_total_size(ext_filter_mask
			        & RTEXT_FILTER_VF ? 4 : 0) /* IFLA_NUM_VF */
	       + rtnl_vfinfo_size(dev, ext_filter_mask) /* IFLA_VFINFO_LIST */
982
	       + rtnl_port_size(dev, ext_filter_mask) /* IFLA_VF_PORTS + IFLA_PORT_SELF */
T
Thomas Graf 已提交
983
	       + rtnl_link_get_size(dev) /* IFLA_LINKINFO */
984
	       + rtnl_link_get_af_size(dev, ext_filter_mask) /* IFLA_AF_SPEC */
985
	       + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_PORT_ID */
986
	       + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_SWITCH_ID */
987
	       + nla_total_size(IFNAMSIZ) /* IFLA_PHYS_PORT_NAME */
D
David S. Miller 已提交
988
	       + rtnl_xdp_size() /* IFLA_XDP */
989
	       + nla_total_size(4)  /* IFLA_EVENT */
990
	       + nla_total_size(4)  /* IFLA_NEW_NETNSID */
991
	       + nla_total_size(4)  /* IFLA_NEW_IFINDEX */
992
	       + nla_total_size(1)  /* IFLA_PROTO_DOWN */
993
	       + nla_total_size(4)  /* IFLA_IF_NETNSID */
994 995
	       + nla_total_size(4)  /* IFLA_CARRIER_UP_COUNT */
	       + nla_total_size(4)  /* IFLA_CARRIER_DOWN_COUNT */
996
	       + 0;
997 998
}

999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011
static int rtnl_vf_ports_fill(struct sk_buff *skb, struct net_device *dev)
{
	struct nlattr *vf_ports;
	struct nlattr *vf_port;
	int vf;
	int err;

	vf_ports = nla_nest_start(skb, IFLA_VF_PORTS);
	if (!vf_ports)
		return -EMSGSIZE;

	for (vf = 0; vf < dev_num_vf(dev->dev.parent); vf++) {
		vf_port = nla_nest_start(skb, IFLA_VF_PORT);
1012 1013
		if (!vf_port)
			goto nla_put_failure;
1014 1015
		if (nla_put_u32(skb, IFLA_PORT_VF, vf))
			goto nla_put_failure;
1016
		err = dev->netdev_ops->ndo_get_vf_port(dev, vf, skb);
1017 1018
		if (err == -EMSGSIZE)
			goto nla_put_failure;
1019 1020 1021 1022 1023 1024 1025 1026 1027 1028
		if (err) {
			nla_nest_cancel(skb, vf_port);
			continue;
		}
		nla_nest_end(skb, vf_port);
	}

	nla_nest_end(skb, vf_ports);

	return 0;
1029 1030 1031 1032

nla_put_failure:
	nla_nest_cancel(skb, vf_ports);
	return -EMSGSIZE;
1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046
}

static int rtnl_port_self_fill(struct sk_buff *skb, struct net_device *dev)
{
	struct nlattr *port_self;
	int err;

	port_self = nla_nest_start(skb, IFLA_PORT_SELF);
	if (!port_self)
		return -EMSGSIZE;

	err = dev->netdev_ops->ndo_get_vf_port(dev, PORT_SELF_VF, skb);
	if (err) {
		nla_nest_cancel(skb, port_self);
1047
		return (err == -EMSGSIZE) ? err : 0;
1048 1049 1050 1051 1052 1053 1054
	}

	nla_nest_end(skb, port_self);

	return 0;
}

1055 1056
static int rtnl_port_fill(struct sk_buff *skb, struct net_device *dev,
			  u32 ext_filter_mask)
1057 1058 1059
{
	int err;

1060 1061
	if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent ||
	    !(ext_filter_mask & RTEXT_FILTER_VF))
1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076
		return 0;

	err = rtnl_port_self_fill(skb, dev);
	if (err)
		return err;

	if (dev_num_vf(dev->dev.parent)) {
		err = rtnl_vf_ports_fill(skb, dev);
		if (err)
			return err;
	}

	return 0;
}

1077 1078 1079
static int rtnl_phys_port_id_fill(struct sk_buff *skb, struct net_device *dev)
{
	int err;
1080
	struct netdev_phys_item_id ppid;
1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094

	err = dev_get_phys_port_id(dev, &ppid);
	if (err) {
		if (err == -EOPNOTSUPP)
			return 0;
		return err;
	}

	if (nla_put(skb, IFLA_PHYS_PORT_ID, ppid.id_len, ppid.id))
		return -EMSGSIZE;

	return 0;
}

1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106
static int rtnl_phys_port_name_fill(struct sk_buff *skb, struct net_device *dev)
{
	char name[IFNAMSIZ];
	int err;

	err = dev_get_phys_port_name(dev, name, sizeof(name));
	if (err) {
		if (err == -EOPNOTSUPP)
			return 0;
		return err;
	}

1107
	if (nla_put_string(skb, IFLA_PHYS_PORT_NAME, name))
1108 1109 1110 1111 1112
		return -EMSGSIZE;

	return 0;
}

1113 1114 1115
static int rtnl_phys_switch_id_fill(struct sk_buff *skb, struct net_device *dev)
{
	int err;
1116
	struct switchdev_attr attr = {
1117
		.orig_dev = dev,
1118
		.id = SWITCHDEV_ATTR_ID_PORT_PARENT_ID,
1119 1120
		.flags = SWITCHDEV_F_NO_RECURSE,
	};
1121

1122
	err = switchdev_port_attr_get(dev, &attr);
1123 1124 1125 1126 1127 1128
	if (err) {
		if (err == -EOPNOTSUPP)
			return 0;
		return err;
	}

1129 1130
	if (nla_put(skb, IFLA_PHYS_SWITCH_ID, attr.u.ppid.id_len,
		    attr.u.ppid.id))
1131 1132 1133 1134 1135
		return -EMSGSIZE;

	return 0;
}

1136 1137 1138
static noinline_for_stack int rtnl_fill_stats(struct sk_buff *skb,
					      struct net_device *dev)
{
1139
	struct rtnl_link_stats64 *sp;
1140
	struct nlattr *attr;
1141

1142 1143
	attr = nla_reserve_64bit(skb, IFLA_STATS64,
				 sizeof(struct rtnl_link_stats64), IFLA_PAD);
1144 1145 1146
	if (!attr)
		return -EMSGSIZE;

1147 1148
	sp = nla_data(attr);
	dev_get_stats(dev, sp);
1149

1150 1151
	attr = nla_reserve(skb, IFLA_STATS,
			   sizeof(struct rtnl_link_stats));
1152 1153 1154
	if (!attr)
		return -EMSGSIZE;

1155
	copy_rtnl_link_stats(nla_data(attr), sp);
1156 1157 1158 1159 1160 1161 1162 1163 1164 1165

	return 0;
}

static noinline_for_stack int rtnl_fill_vfinfo(struct sk_buff *skb,
					       struct net_device *dev,
					       int vfs_num,
					       struct nlattr *vfinfo)
{
	struct ifla_vf_rss_query_en vf_rss_query_en;
1166
	struct nlattr *vf, *vfstats, *vfvlanlist;
1167
	struct ifla_vf_link_state vf_linkstate;
1168
	struct ifla_vf_vlan_info vf_vlan_info;
1169 1170 1171 1172 1173 1174 1175 1176 1177
	struct ifla_vf_spoofchk vf_spoofchk;
	struct ifla_vf_tx_rate vf_tx_rate;
	struct ifla_vf_stats vf_stats;
	struct ifla_vf_trust vf_trust;
	struct ifla_vf_vlan vf_vlan;
	struct ifla_vf_rate vf_rate;
	struct ifla_vf_mac vf_mac;
	struct ifla_vf_info ivi;

1178 1179
	memset(&ivi, 0, sizeof(ivi));

1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191
	/* Not all SR-IOV capable drivers support the
	 * spoofcheck and "RSS query enable" query.  Preset to
	 * -1 so the user space tool can detect that the driver
	 * didn't report anything.
	 */
	ivi.spoofchk = -1;
	ivi.rss_query_en = -1;
	ivi.trusted = -1;
	/* The default value for VF link state is "auto"
	 * IFLA_VF_LINK_STATE_AUTO which equals zero
	 */
	ivi.linkstate = 0;
1192 1193
	/* VLAN Protocol by default is 802.1Q */
	ivi.vlan_proto = htons(ETH_P_8021Q);
1194 1195 1196
	if (dev->netdev_ops->ndo_get_vf_config(dev, vfs_num, &ivi))
		return 0;

1197 1198
	memset(&vf_vlan_info, 0, sizeof(vf_vlan_info));

1199 1200
	vf_mac.vf =
		vf_vlan.vf =
1201
		vf_vlan_info.vf =
1202 1203 1204 1205 1206 1207 1208 1209 1210 1211
		vf_rate.vf =
		vf_tx_rate.vf =
		vf_spoofchk.vf =
		vf_linkstate.vf =
		vf_rss_query_en.vf =
		vf_trust.vf = ivi.vf;

	memcpy(vf_mac.mac, ivi.mac, sizeof(ivi.mac));
	vf_vlan.vlan = ivi.vlan;
	vf_vlan.qos = ivi.qos;
1212 1213 1214
	vf_vlan_info.vlan = ivi.vlan;
	vf_vlan_info.qos = ivi.qos;
	vf_vlan_info.vlan_proto = ivi.vlan_proto;
1215 1216 1217 1218 1219 1220 1221 1222
	vf_tx_rate.rate = ivi.max_tx_rate;
	vf_rate.min_tx_rate = ivi.min_tx_rate;
	vf_rate.max_tx_rate = ivi.max_tx_rate;
	vf_spoofchk.setting = ivi.spoofchk;
	vf_linkstate.link_state = ivi.linkstate;
	vf_rss_query_en.setting = ivi.rss_query_en;
	vf_trust.setting = ivi.trusted;
	vf = nla_nest_start(skb, IFLA_VF_INFO);
1223 1224
	if (!vf)
		goto nla_put_vfinfo_failure;
1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239
	if (nla_put(skb, IFLA_VF_MAC, sizeof(vf_mac), &vf_mac) ||
	    nla_put(skb, IFLA_VF_VLAN, sizeof(vf_vlan), &vf_vlan) ||
	    nla_put(skb, IFLA_VF_RATE, sizeof(vf_rate),
		    &vf_rate) ||
	    nla_put(skb, IFLA_VF_TX_RATE, sizeof(vf_tx_rate),
		    &vf_tx_rate) ||
	    nla_put(skb, IFLA_VF_SPOOFCHK, sizeof(vf_spoofchk),
		    &vf_spoofchk) ||
	    nla_put(skb, IFLA_VF_LINK_STATE, sizeof(vf_linkstate),
		    &vf_linkstate) ||
	    nla_put(skb, IFLA_VF_RSS_QUERY_EN,
		    sizeof(vf_rss_query_en),
		    &vf_rss_query_en) ||
	    nla_put(skb, IFLA_VF_TRUST,
		    sizeof(vf_trust), &vf_trust))
1240 1241 1242 1243 1244 1245 1246 1247 1248 1249
		goto nla_put_vf_failure;
	vfvlanlist = nla_nest_start(skb, IFLA_VF_VLAN_LIST);
	if (!vfvlanlist)
		goto nla_put_vf_failure;
	if (nla_put(skb, IFLA_VF_VLAN_INFO, sizeof(vf_vlan_info),
		    &vf_vlan_info)) {
		nla_nest_cancel(skb, vfvlanlist);
		goto nla_put_vf_failure;
	}
	nla_nest_end(skb, vfvlanlist);
1250 1251 1252 1253 1254
	memset(&vf_stats, 0, sizeof(vf_stats));
	if (dev->netdev_ops->ndo_get_vf_stats)
		dev->netdev_ops->ndo_get_vf_stats(dev, vfs_num,
						&vf_stats);
	vfstats = nla_nest_start(skb, IFLA_VF_STATS);
1255 1256
	if (!vfstats)
		goto nla_put_vf_failure;
N
Nicolas Dichtel 已提交
1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267
	if (nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_PACKETS,
			      vf_stats.rx_packets, IFLA_VF_STATS_PAD) ||
	    nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_PACKETS,
			      vf_stats.tx_packets, IFLA_VF_STATS_PAD) ||
	    nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_BYTES,
			      vf_stats.rx_bytes, IFLA_VF_STATS_PAD) ||
	    nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_BYTES,
			      vf_stats.tx_bytes, IFLA_VF_STATS_PAD) ||
	    nla_put_u64_64bit(skb, IFLA_VF_STATS_BROADCAST,
			      vf_stats.broadcast, IFLA_VF_STATS_PAD) ||
	    nla_put_u64_64bit(skb, IFLA_VF_STATS_MULTICAST,
1268 1269 1270 1271 1272
			      vf_stats.multicast, IFLA_VF_STATS_PAD) ||
	    nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_DROPPED,
			      vf_stats.rx_dropped, IFLA_VF_STATS_PAD) ||
	    nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_DROPPED,
			      vf_stats.tx_dropped, IFLA_VF_STATS_PAD)) {
1273 1274 1275
		nla_nest_cancel(skb, vfstats);
		goto nla_put_vf_failure;
	}
1276 1277 1278
	nla_nest_end(skb, vfstats);
	nla_nest_end(skb, vf);
	return 0;
1279 1280 1281 1282 1283 1284

nla_put_vf_failure:
	nla_nest_cancel(skb, vf);
nla_put_vfinfo_failure:
	nla_nest_cancel(skb, vfinfo);
	return -EMSGSIZE;
1285 1286
}

1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316
static noinline_for_stack int rtnl_fill_vf(struct sk_buff *skb,
					   struct net_device *dev,
					   u32 ext_filter_mask)
{
	struct nlattr *vfinfo;
	int i, num_vfs;

	if (!dev->dev.parent || ((ext_filter_mask & RTEXT_FILTER_VF) == 0))
		return 0;

	num_vfs = dev_num_vf(dev->dev.parent);
	if (nla_put_u32(skb, IFLA_NUM_VF, num_vfs))
		return -EMSGSIZE;

	if (!dev->netdev_ops->ndo_get_vf_config)
		return 0;

	vfinfo = nla_nest_start(skb, IFLA_VFINFO_LIST);
	if (!vfinfo)
		return -EMSGSIZE;

	for (i = 0; i < num_vfs; i++) {
		if (rtnl_fill_vfinfo(skb, dev, i, vfinfo))
			return -EMSGSIZE;
	}

	nla_nest_end(skb, vfinfo);
	return 0;
}

1317 1318
static int rtnl_fill_link_ifmap(struct sk_buff *skb, struct net_device *dev)
{
K
Kangjie Lu 已提交
1319 1320 1321 1322 1323 1324 1325 1326 1327 1328
	struct rtnl_link_ifmap map;

	memset(&map, 0, sizeof(map));
	map.mem_start   = dev->mem_start;
	map.mem_end     = dev->mem_end;
	map.base_addr   = dev->base_addr;
	map.irq         = dev->irq;
	map.dma         = dev->dma;
	map.port        = dev->if_port;

1329
	if (nla_put_64bit(skb, IFLA_MAP, sizeof(map), &map, IFLA_PAD))
1330 1331 1332 1333 1334
		return -EMSGSIZE;

	return 0;
}

M
Martin KaFai Lau 已提交
1335
static u8 rtnl_xdp_attached_mode(struct net_device *dev, u32 *prog_id)
1336 1337
{
	const struct net_device_ops *ops = dev->netdev_ops;
M
Martin KaFai Lau 已提交
1338
	const struct bpf_prog *generic_xdp_prog;
1339
	struct netdev_bpf xdp;
1340 1341 1342

	ASSERT_RTNL();

M
Martin KaFai Lau 已提交
1343 1344 1345 1346
	*prog_id = 0;
	generic_xdp_prog = rtnl_dereference(dev->xdp_prog);
	if (generic_xdp_prog) {
		*prog_id = generic_xdp_prog->aux->id;
1347
		return XDP_ATTACHED_SKB;
M
Martin KaFai Lau 已提交
1348
	}
1349
	if (!ops->ndo_bpf)
1350
		return XDP_ATTACHED_NONE;
1351

1352 1353 1354 1355
	__dev_xdp_query(dev, ops->ndo_bpf, &xdp);
	*prog_id = xdp.prog_id;

	return xdp.prog_attached;
1356 1357
}

1358 1359 1360
static int rtnl_xdp_fill(struct sk_buff *skb, struct net_device *dev)
{
	struct nlattr *xdp;
M
Martin KaFai Lau 已提交
1361
	u32 prog_id;
1362 1363 1364 1365 1366
	int err;

	xdp = nla_nest_start(skb, IFLA_XDP);
	if (!xdp)
		return -EMSGSIZE;
1367 1368

	err = nla_put_u8(skb, IFLA_XDP_ATTACHED,
M
Martin KaFai Lau 已提交
1369
			 rtnl_xdp_attached_mode(dev, &prog_id));
1370 1371 1372
	if (err)
		goto err_cancel;

M
Martin KaFai Lau 已提交
1373 1374 1375 1376 1377 1378
	if (prog_id) {
		err = nla_put_u32(skb, IFLA_XDP_PROG_ID, prog_id);
		if (err)
			goto err_cancel;
	}

1379 1380 1381 1382 1383 1384 1385 1386
	nla_nest_end(skb, xdp);
	return 0;

err_cancel:
	nla_nest_cancel(skb, xdp);
	return err;
}

1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416
static u32 rtnl_get_event(unsigned long event)
{
	u32 rtnl_event_type = IFLA_EVENT_NONE;

	switch (event) {
	case NETDEV_REBOOT:
		rtnl_event_type = IFLA_EVENT_REBOOT;
		break;
	case NETDEV_FEAT_CHANGE:
		rtnl_event_type = IFLA_EVENT_FEATURES;
		break;
	case NETDEV_BONDING_FAILOVER:
		rtnl_event_type = IFLA_EVENT_BONDING_FAILOVER;
		break;
	case NETDEV_NOTIFY_PEERS:
		rtnl_event_type = IFLA_EVENT_NOTIFY_PEERS;
		break;
	case NETDEV_RESEND_IGMP:
		rtnl_event_type = IFLA_EVENT_IGMP_RESEND;
		break;
	case NETDEV_CHANGEINFODATA:
		rtnl_event_type = IFLA_EVENT_BONDING_OPTIONS;
		break;
	default:
		break;
	}

	return rtnl_event_type;
}

1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441
static int put_master_ifindex(struct sk_buff *skb, struct net_device *dev)
{
	const struct net_device *upper_dev;
	int ret = 0;

	rcu_read_lock();

	upper_dev = netdev_master_upper_dev_get_rcu(dev);
	if (upper_dev)
		ret = nla_put_u32(skb, IFLA_MASTER, upper_dev->ifindex);

	rcu_read_unlock();
	return ret;
}

static int nla_put_iflink(struct sk_buff *skb, const struct net_device *dev)
{
	int ifindex = dev_get_iflink(dev);

	if (dev->ifindex == ifindex)
		return 0;

	return nla_put_u32(skb, IFLA_LINK, ifindex);
}

1442 1443 1444 1445 1446 1447 1448 1449 1450 1451
static noinline_for_stack int nla_put_ifalias(struct sk_buff *skb,
					      struct net_device *dev)
{
	char buf[IFALIASZ];
	int ret;

	ret = dev_get_alias(dev, buf, sizeof(buf));
	return ret > 0 ? nla_put_string(skb, IFLA_IFALIAS, buf) : 0;
}

1452
static int rtnl_fill_link_netnsid(struct sk_buff *skb,
1453 1454
				  const struct net_device *dev,
				  struct net *src_net)
1455 1456 1457 1458 1459
{
	if (dev->rtnl_link_ops && dev->rtnl_link_ops->get_link_net) {
		struct net *link_net = dev->rtnl_link_ops->get_link_net(dev);

		if (!net_eq(dev_net(dev), link_net)) {
1460
			int id = peernet2id_alloc(src_net, link_net);
1461 1462 1463 1464 1465 1466 1467 1468 1469

			if (nla_put_s32(skb, IFLA_LINK_NETNSID, id))
				return -EMSGSIZE;
		}
	}

	return 0;
}

1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480
static int rtnl_fill_link_af(struct sk_buff *skb,
			     const struct net_device *dev,
			     u32 ext_filter_mask)
{
	const struct rtnl_af_ops *af_ops;
	struct nlattr *af_spec;

	af_spec = nla_nest_start(skb, IFLA_AF_SPEC);
	if (!af_spec)
		return -EMSGSIZE;

F
Florian Westphal 已提交
1481
	list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510
		struct nlattr *af;
		int err;

		if (!af_ops->fill_link_af)
			continue;

		af = nla_nest_start(skb, af_ops->family);
		if (!af)
			return -EMSGSIZE;

		err = af_ops->fill_link_af(skb, dev, ext_filter_mask);
		/*
		 * Caller may return ENODATA to indicate that there
		 * was no data to be dumped. This is not an error, it
		 * means we should trim the attribute header and
		 * continue.
		 */
		if (err == -ENODATA)
			nla_nest_cancel(skb, af);
		else if (err < 0)
			return -EMSGSIZE;

		nla_nest_end(skb, af);
	}

	nla_nest_end(skb, af_spec);
	return 0;
}

1511 1512
static int rtnl_fill_ifinfo(struct sk_buff *skb,
			    struct net_device *dev, struct net *src_net,
1513
			    int type, u32 pid, u32 seq, u32 change,
1514
			    unsigned int flags, u32 ext_filter_mask,
1515 1516
			    u32 event, int *new_nsid, int new_ifindex,
			    int tgt_netnsid)
1517 1518 1519
{
	struct ifinfomsg *ifm;
	struct nlmsghdr *nlh;
L
Linus Torvalds 已提交
1520

1521
	ASSERT_RTNL();
1522 1523
	nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifm), flags);
	if (nlh == NULL)
1524
		return -EMSGSIZE;
L
Linus Torvalds 已提交
1525

1526 1527 1528 1529 1530 1531 1532 1533
	ifm = nlmsg_data(nlh);
	ifm->ifi_family = AF_UNSPEC;
	ifm->__ifi_pad = 0;
	ifm->ifi_type = dev->type;
	ifm->ifi_index = dev->ifindex;
	ifm->ifi_flags = dev_get_flags(dev);
	ifm->ifi_change = change;

1534 1535 1536
	if (tgt_netnsid >= 0 && nla_put_s32(skb, IFLA_IF_NETNSID, tgt_netnsid))
		goto nla_put_failure;

1537 1538 1539 1540 1541 1542 1543
	if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
	    nla_put_u32(skb, IFLA_TXQLEN, dev->tx_queue_len) ||
	    nla_put_u8(skb, IFLA_OPERSTATE,
		       netif_running(dev) ? dev->operstate : IF_OPER_DOWN) ||
	    nla_put_u8(skb, IFLA_LINKMODE, dev->link_mode) ||
	    nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
	    nla_put_u32(skb, IFLA_GROUP, dev->group) ||
1544
	    nla_put_u32(skb, IFLA_PROMISCUITY, dev->promiscuity) ||
1545
	    nla_put_u32(skb, IFLA_NUM_TX_QUEUES, dev->num_tx_queues) ||
1546 1547
	    nla_put_u32(skb, IFLA_GSO_MAX_SEGS, dev->gso_max_segs) ||
	    nla_put_u32(skb, IFLA_GSO_MAX_SIZE, dev->gso_max_size) ||
1548
#ifdef CONFIG_RPS
1549
	    nla_put_u32(skb, IFLA_NUM_RX_QUEUES, dev->num_rx_queues) ||
1550
#endif
1551 1552
	    nla_put_iflink(skb, dev) ||
	    put_master_ifindex(skb, dev) ||
1553
	    nla_put_u8(skb, IFLA_CARRIER, netif_carrier_ok(dev)) ||
1554 1555
	    (dev->qdisc &&
	     nla_put_string(skb, IFLA_QDISC, dev->qdisc->ops->id)) ||
1556
	    nla_put_ifalias(skb, dev) ||
1557
	    nla_put_u32(skb, IFLA_CARRIER_CHANGES,
1558 1559 1560 1561 1562 1563 1564
			atomic_read(&dev->carrier_up_count) +
			atomic_read(&dev->carrier_down_count)) ||
	    nla_put_u8(skb, IFLA_PROTO_DOWN, dev->proto_down) ||
	    nla_put_u32(skb, IFLA_CARRIER_UP_COUNT,
			atomic_read(&dev->carrier_up_count)) ||
	    nla_put_u32(skb, IFLA_CARRIER_DOWN_COUNT,
			atomic_read(&dev->carrier_down_count)))
1565
		goto nla_put_failure;
1566

1567 1568 1569 1570 1571
	if (event != IFLA_EVENT_NONE) {
		if (nla_put_u32(skb, IFLA_EVENT, event))
			goto nla_put_failure;
	}

1572 1573
	if (rtnl_fill_link_ifmap(skb, dev))
		goto nla_put_failure;
L
Linus Torvalds 已提交
1574 1575

	if (dev->addr_len) {
1576 1577 1578
		if (nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr) ||
		    nla_put(skb, IFLA_BROADCAST, dev->addr_len, dev->broadcast))
			goto nla_put_failure;
L
Linus Torvalds 已提交
1579 1580
	}

1581 1582 1583
	if (rtnl_phys_port_id_fill(skb, dev))
		goto nla_put_failure;

1584 1585 1586
	if (rtnl_phys_port_name_fill(skb, dev))
		goto nla_put_failure;

1587 1588 1589
	if (rtnl_phys_switch_id_fill(skb, dev))
		goto nla_put_failure;

1590
	if (rtnl_fill_stats(skb, dev))
1591 1592
		goto nla_put_failure;

1593
	if (rtnl_fill_vf(skb, dev, ext_filter_mask))
1594
		goto nla_put_failure;
1595

1596
	if (rtnl_port_fill(skb, dev, ext_filter_mask))
1597 1598
		goto nla_put_failure;

1599 1600 1601
	if (rtnl_xdp_fill(skb, dev))
		goto nla_put_failure;

1602
	if (dev->rtnl_link_ops || rtnl_have_link_slave_info(dev)) {
P
Patrick McHardy 已提交
1603 1604 1605 1606
		if (rtnl_link_fill(skb, dev) < 0)
			goto nla_put_failure;
	}

1607
	if (rtnl_fill_link_netnsid(skb, dev, src_net))
1608
		goto nla_put_failure;
1609

1610 1611 1612
	if (new_nsid &&
	    nla_put_s32(skb, IFLA_NEW_NETNSID, *new_nsid) < 0)
		goto nla_put_failure;
1613 1614 1615 1616
	if (new_ifindex &&
	    nla_put_s32(skb, IFLA_NEW_IFINDEX, new_ifindex) < 0)
		goto nla_put_failure;

1617

F
Florian Westphal 已提交
1618
	rcu_read_lock();
1619
	if (rtnl_fill_link_af(skb, dev, ext_filter_mask))
F
Florian Westphal 已提交
1620 1621
		goto nla_put_failure_rcu;
	rcu_read_unlock();
T
Thomas Graf 已提交
1622

1623 1624
	nlmsg_end(skb, nlh);
	return 0;
1625

F
Florian Westphal 已提交
1626 1627
nla_put_failure_rcu:
	rcu_read_unlock();
1628
nla_put_failure:
1629 1630
	nlmsg_cancel(skb, nlh);
	return -EMSGSIZE;
L
Linus Torvalds 已提交
1631 1632
}

J
Jiri Pirko 已提交
1633
static const struct nla_policy ifla_policy[IFLA_MAX+1] = {
1634
	[IFLA_IFNAME]		= { .type = NLA_STRING, .len = IFNAMSIZ-1 },
P
Patrick McHardy 已提交
1635 1636
	[IFLA_ADDRESS]		= { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
	[IFLA_BROADCAST]	= { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
1637
	[IFLA_MAP]		= { .len = sizeof(struct rtnl_link_ifmap) },
1638
	[IFLA_MTU]		= { .type = NLA_U32 },
1639
	[IFLA_LINK]		= { .type = NLA_U32 },
1640
	[IFLA_MASTER]		= { .type = NLA_U32 },
1641
	[IFLA_CARRIER]		= { .type = NLA_U8 },
1642 1643 1644 1645
	[IFLA_TXQLEN]		= { .type = NLA_U32 },
	[IFLA_WEIGHT]		= { .type = NLA_U32 },
	[IFLA_OPERSTATE]	= { .type = NLA_U8 },
	[IFLA_LINKMODE]		= { .type = NLA_U8 },
1646
	[IFLA_LINKINFO]		= { .type = NLA_NESTED },
1647
	[IFLA_NET_NS_PID]	= { .type = NLA_U32 },
1648
	[IFLA_NET_NS_FD]	= { .type = NLA_U32 },
1649 1650 1651 1652
	/* IFLA_IFALIAS is a string, but policy is set to NLA_BINARY to
	 * allow 0-length string (needed to remove an alias).
	 */
	[IFLA_IFALIAS]	        = { .type = NLA_BINARY, .len = IFALIASZ - 1 },
1653
	[IFLA_VFINFO_LIST]	= {. type = NLA_NESTED },
1654 1655
	[IFLA_VF_PORTS]		= { .type = NLA_NESTED },
	[IFLA_PORT_SELF]	= { .type = NLA_NESTED },
T
Thomas Graf 已提交
1656
	[IFLA_AF_SPEC]		= { .type = NLA_NESTED },
1657
	[IFLA_EXT_MASK]		= { .type = NLA_U32 },
1658
	[IFLA_PROMISCUITY]	= { .type = NLA_U32 },
1659 1660
	[IFLA_NUM_TX_QUEUES]	= { .type = NLA_U32 },
	[IFLA_NUM_RX_QUEUES]	= { .type = NLA_U32 },
1661 1662
	[IFLA_GSO_MAX_SEGS]	= { .type = NLA_U32 },
	[IFLA_GSO_MAX_SIZE]	= { .type = NLA_U32 },
1663
	[IFLA_PHYS_PORT_ID]	= { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN },
1664
	[IFLA_CARRIER_CHANGES]	= { .type = NLA_U32 },  /* ignored */
1665
	[IFLA_PHYS_SWITCH_ID]	= { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN },
1666
	[IFLA_LINK_NETNSID]	= { .type = NLA_S32 },
1667
	[IFLA_PROTO_DOWN]	= { .type = NLA_U8 },
1668
	[IFLA_XDP]		= { .type = NLA_NESTED },
1669
	[IFLA_EVENT]		= { .type = NLA_U32 },
1670
	[IFLA_GROUP]		= { .type = NLA_U32 },
1671
	[IFLA_IF_NETNSID]	= { .type = NLA_S32 },
1672 1673
	[IFLA_CARRIER_UP_COUNT]	= { .type = NLA_U32 },
	[IFLA_CARRIER_DOWN_COUNT] = { .type = NLA_U32 },
1674 1675
};

P
Patrick McHardy 已提交
1676 1677 1678
static const struct nla_policy ifla_info_policy[IFLA_INFO_MAX+1] = {
	[IFLA_INFO_KIND]	= { .type = NLA_STRING },
	[IFLA_INFO_DATA]	= { .type = NLA_NESTED },
1679 1680
	[IFLA_INFO_SLAVE_KIND]	= { .type = NLA_STRING },
	[IFLA_INFO_SLAVE_DATA]	= { .type = NLA_NESTED },
P
Patrick McHardy 已提交
1681 1682
};

1683
static const struct nla_policy ifla_vf_policy[IFLA_VF_MAX+1] = {
1684 1685
	[IFLA_VF_MAC]		= { .len = sizeof(struct ifla_vf_mac) },
	[IFLA_VF_VLAN]		= { .len = sizeof(struct ifla_vf_vlan) },
1686
	[IFLA_VF_VLAN_LIST]     = { .type = NLA_NESTED },
1687 1688 1689 1690
	[IFLA_VF_TX_RATE]	= { .len = sizeof(struct ifla_vf_tx_rate) },
	[IFLA_VF_SPOOFCHK]	= { .len = sizeof(struct ifla_vf_spoofchk) },
	[IFLA_VF_RATE]		= { .len = sizeof(struct ifla_vf_rate) },
	[IFLA_VF_LINK_STATE]	= { .len = sizeof(struct ifla_vf_link_state) },
1691
	[IFLA_VF_RSS_QUERY_EN]	= { .len = sizeof(struct ifla_vf_rss_query_en) },
1692
	[IFLA_VF_STATS]		= { .type = NLA_NESTED },
H
Hiroshi Shimamoto 已提交
1693
	[IFLA_VF_TRUST]		= { .len = sizeof(struct ifla_vf_trust) },
1694 1695
	[IFLA_VF_IB_NODE_GUID]	= { .len = sizeof(struct ifla_vf_guid) },
	[IFLA_VF_IB_PORT_GUID]	= { .len = sizeof(struct ifla_vf_guid) },
1696 1697
};

1698 1699 1700 1701 1702 1703 1704 1705 1706 1707
static const struct nla_policy ifla_port_policy[IFLA_PORT_MAX+1] = {
	[IFLA_PORT_VF]		= { .type = NLA_U32 },
	[IFLA_PORT_PROFILE]	= { .type = NLA_STRING,
				    .len = PORT_PROFILE_MAX },
	[IFLA_PORT_INSTANCE_UUID] = { .type = NLA_BINARY,
				      .len = PORT_UUID_MAX },
	[IFLA_PORT_HOST_UUID]	= { .type = NLA_STRING,
				    .len = PORT_UUID_MAX },
	[IFLA_PORT_REQUEST]	= { .type = NLA_U8, },
	[IFLA_PORT_RESPONSE]	= { .type = NLA_U16, },
1708 1709 1710 1711 1712 1713 1714

	/* Unused, but we need to keep it here since user space could
	 * fill it. It's also broken with regard to NLA_BINARY use in
	 * combination with structs.
	 */
	[IFLA_PORT_VSI_TYPE]	= { .type = NLA_BINARY,
				    .len = sizeof(struct ifla_port_vsi) },
1715 1716
};

1717 1718 1719
static const struct nla_policy ifla_xdp_policy[IFLA_XDP_MAX + 1] = {
	[IFLA_XDP_FD]		= { .type = NLA_S32 },
	[IFLA_XDP_ATTACHED]	= { .type = NLA_U8 },
1720
	[IFLA_XDP_FLAGS]	= { .type = NLA_U32 },
M
Martin KaFai Lau 已提交
1721
	[IFLA_XDP_PROG_ID]	= { .type = NLA_U32 },
1722 1723
};

1724 1725 1726 1727 1728
static const struct rtnl_link_ops *linkinfo_to_kind_ops(const struct nlattr *nla)
{
	const struct rtnl_link_ops *ops = NULL;
	struct nlattr *linfo[IFLA_INFO_MAX + 1];

1729 1730
	if (nla_parse_nested(linfo, IFLA_INFO_MAX, nla,
			     ifla_info_policy, NULL) < 0)
1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776
		return NULL;

	if (linfo[IFLA_INFO_KIND]) {
		char kind[MODULE_NAME_LEN];

		nla_strlcpy(kind, linfo[IFLA_INFO_KIND], sizeof(kind));
		ops = rtnl_link_ops_get(kind);
	}

	return ops;
}

static bool link_master_filtered(struct net_device *dev, int master_idx)
{
	struct net_device *master;

	if (!master_idx)
		return false;

	master = netdev_master_upper_dev_get(dev);
	if (!master || master->ifindex != master_idx)
		return true;

	return false;
}

static bool link_kind_filtered(const struct net_device *dev,
			       const struct rtnl_link_ops *kind_ops)
{
	if (kind_ops && dev->rtnl_link_ops != kind_ops)
		return true;

	return false;
}

static bool link_dump_filtered(struct net_device *dev,
			       int master_idx,
			       const struct rtnl_link_ops *kind_ops)
{
	if (link_master_filtered(dev, master_idx) ||
	    link_kind_filtered(dev, kind_ops))
		return true;

	return false;
}

1777
static struct net *get_target_net(struct sock *sk, int netnsid)
1778 1779 1780
{
	struct net *net;

1781
	net = get_net_ns_by_id(sock_net(sk), netnsid);
1782 1783 1784 1785 1786 1787
	if (!net)
		return ERR_PTR(-EINVAL);

	/* For now, the caller is required to have CAP_NET_ADMIN in
	 * the user namespace owning the target net ns.
	 */
1788
	if (!sk_ns_capable(sk, net->user_ns, CAP_NET_ADMIN)) {
1789 1790 1791 1792 1793 1794
		put_net(net);
		return ERR_PTR(-EACCES);
	}
	return net;
}

J
Jiri Pirko 已提交
1795 1796 1797
static int rtnl_dump_ifinfo(struct sk_buff *skb, struct netlink_callback *cb)
{
	struct net *net = sock_net(skb->sk);
1798
	struct net *tgt_net = net;
J
Jiri Pirko 已提交
1799 1800 1801 1802 1803 1804
	int h, s_h;
	int idx = 0, s_idx;
	struct net_device *dev;
	struct hlist_head *head;
	struct nlattr *tb[IFLA_MAX+1];
	u32 ext_filter_mask = 0;
1805 1806 1807
	const struct rtnl_link_ops *kind_ops = NULL;
	unsigned int flags = NLM_F_MULTI;
	int master_idx = 0;
1808
	int netnsid = -1;
1809
	int err;
1810
	int hdrlen;
J
Jiri Pirko 已提交
1811 1812 1813 1814

	s_h = cb->args[0];
	s_idx = cb->args[1];

1815 1816 1817 1818 1819 1820 1821 1822 1823 1824
	/* A hack to preserve kernel<->userspace interface.
	 * The correct header is ifinfomsg. It is consistent with rtnl_getlink.
	 * However, before Linux v3.9 the code here assumed rtgenmsg and that's
	 * what iproute2 < v3.9.0 used.
	 * We can detect the old iproute2. Even including the IFLA_EXT_MASK
	 * attribute, its netlink message is shorter than struct ifinfomsg.
	 */
	hdrlen = nlmsg_len(cb->nlh) < sizeof(struct ifinfomsg) ?
		 sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg);

1825 1826
	if (nlmsg_parse(cb->nlh, hdrlen, tb, IFLA_MAX,
			ifla_policy, NULL) >= 0) {
1827 1828
		if (tb[IFLA_IF_NETNSID]) {
			netnsid = nla_get_s32(tb[IFLA_IF_NETNSID]);
1829
			tgt_net = get_target_net(skb->sk, netnsid);
1830 1831 1832 1833 1834 1835
			if (IS_ERR(tgt_net)) {
				tgt_net = net;
				netnsid = -1;
			}
		}

J
Jiri Pirko 已提交
1836 1837
		if (tb[IFLA_EXT_MASK])
			ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
1838 1839 1840 1841 1842 1843 1844 1845 1846

		if (tb[IFLA_MASTER])
			master_idx = nla_get_u32(tb[IFLA_MASTER]);

		if (tb[IFLA_LINKINFO])
			kind_ops = linkinfo_to_kind_ops(tb[IFLA_LINKINFO]);

		if (master_idx || kind_ops)
			flags |= NLM_F_DUMP_FILTERED;
J
Jiri Pirko 已提交
1847 1848 1849 1850
	}

	for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
		idx = 0;
1851
		head = &tgt_net->dev_index_head[h];
1852
		hlist_for_each_entry(dev, head, index_hlist) {
1853
			if (link_dump_filtered(dev, master_idx, kind_ops))
1854
				goto cont;
J
Jiri Pirko 已提交
1855 1856
			if (idx < s_idx)
				goto cont;
1857 1858
			err = rtnl_fill_ifinfo(skb, dev, net,
					       RTM_NEWLINK,
1859 1860
					       NETLINK_CB(cb->skb).portid,
					       cb->nlh->nlmsg_seq, 0,
1861
					       flags,
1862
					       ext_filter_mask, 0, NULL, 0,
1863
					       netnsid);
1864

1865 1866 1867 1868 1869 1870
			if (err < 0) {
				if (likely(skb->len))
					goto out;

				goto out_err;
			}
J
Jiri Pirko 已提交
1871 1872 1873 1874 1875
cont:
			idx++;
		}
	}
out:
1876 1877
	err = skb->len;
out_err:
J
Jiri Pirko 已提交
1878 1879
	cb->args[1] = idx;
	cb->args[0] = h;
1880 1881
	cb->seq = net->dev_base_seq;
	nl_dump_check_consistent(cb, nlmsg_hdr(skb));
1882 1883
	if (netnsid >= 0)
		put_net(tgt_net);
J
Jiri Pirko 已提交
1884

1885
	return err;
J
Jiri Pirko 已提交
1886 1887
}

1888 1889
int rtnl_nla_parse_ifla(struct nlattr **tb, const struct nlattr *head, int len,
			struct netlink_ext_ack *exterr)
J
Jiri Pirko 已提交
1890
{
1891
	return nla_parse(tb, IFLA_MAX, head, len, ifla_policy, exterr);
J
Jiri Pirko 已提交
1892 1893 1894
}
EXPORT_SYMBOL(rtnl_nla_parse_ifla);

1895 1896 1897 1898 1899 1900 1901 1902
struct net *rtnl_link_get_net(struct net *src_net, struct nlattr *tb[])
{
	struct net *net;
	/* Examine the link attributes and figure out which
	 * network namespace we are talking about.
	 */
	if (tb[IFLA_NET_NS_PID])
		net = get_net_ns_by_pid(nla_get_u32(tb[IFLA_NET_NS_PID]));
1903 1904
	else if (tb[IFLA_NET_NS_FD])
		net = get_net_ns_by_fd(nla_get_u32(tb[IFLA_NET_NS_FD]));
1905 1906 1907 1908 1909 1910
	else
		net = get_net(src_net);
	return net;
}
EXPORT_SYMBOL(rtnl_link_get_net);

1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 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
/* Figure out which network namespace we are talking about by
 * examining the link attributes in the following order:
 *
 * 1. IFLA_NET_NS_PID
 * 2. IFLA_NET_NS_FD
 * 3. IFLA_IF_NETNSID
 */
static struct net *rtnl_link_get_net_by_nlattr(struct net *src_net,
					       struct nlattr *tb[])
{
	struct net *net;

	if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD])
		return rtnl_link_get_net(src_net, tb);

	if (!tb[IFLA_IF_NETNSID])
		return get_net(src_net);

	net = get_net_ns_by_id(src_net, nla_get_u32(tb[IFLA_IF_NETNSID]));
	if (!net)
		return ERR_PTR(-EINVAL);

	return net;
}

static struct net *rtnl_link_get_net_capable(const struct sk_buff *skb,
					     struct net *src_net,
					     struct nlattr *tb[], int cap)
{
	struct net *net;

	net = rtnl_link_get_net_by_nlattr(src_net, tb);
	if (IS_ERR(net))
		return net;

	if (!netlink_ns_capable(skb, net->user_ns, cap)) {
		put_net(net);
		return ERR_PTR(-EPERM);
	}

	return net;
}

1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965
static int validate_linkmsg(struct net_device *dev, struct nlattr *tb[])
{
	if (dev) {
		if (tb[IFLA_ADDRESS] &&
		    nla_len(tb[IFLA_ADDRESS]) < dev->addr_len)
			return -EINVAL;

		if (tb[IFLA_BROADCAST] &&
		    nla_len(tb[IFLA_BROADCAST]) < dev->addr_len)
			return -EINVAL;
	}

1966 1967 1968 1969 1970 1971 1972
	if (tb[IFLA_AF_SPEC]) {
		struct nlattr *af;
		int rem, err;

		nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) {
			const struct rtnl_af_ops *af_ops;

F
Florian Westphal 已提交
1973 1974 1975 1976
			rcu_read_lock();
			af_ops = rtnl_af_lookup(nla_type(af));
			if (!af_ops) {
				rcu_read_unlock();
1977
				return -EAFNOSUPPORT;
F
Florian Westphal 已提交
1978
			}
1979

F
Florian Westphal 已提交
1980 1981
			if (!af_ops->set_link_af) {
				rcu_read_unlock();
1982
				return -EOPNOTSUPP;
F
Florian Westphal 已提交
1983
			}
1984 1985

			if (af_ops->validate_link_af) {
1986
				err = af_ops->validate_link_af(dev, af);
F
Florian Westphal 已提交
1987 1988
				if (err < 0) {
					rcu_read_unlock();
1989
					return err;
F
Florian Westphal 已提交
1990
				}
1991
			}
F
Florian Westphal 已提交
1992 1993

			rcu_read_unlock();
1994 1995 1996
		}
	}

1997 1998 1999
	return 0;
}

2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015
static int handle_infiniband_guid(struct net_device *dev, struct ifla_vf_guid *ivt,
				  int guid_type)
{
	const struct net_device_ops *ops = dev->netdev_ops;

	return ops->ndo_set_vf_guid(dev, ivt->vf, ivt->guid, guid_type);
}

static int handle_vf_guid(struct net_device *dev, struct ifla_vf_guid *ivt, int guid_type)
{
	if (dev->type != ARPHRD_INFINIBAND)
		return -EOPNOTSUPP;

	return handle_infiniband_guid(dev, ivt, guid_type);
}

2016
static int do_setvfinfo(struct net_device *dev, struct nlattr **tb)
2017 2018
{
	const struct net_device_ops *ops = dev->netdev_ops;
2019
	int err = -EINVAL;
2020

2021 2022
	if (tb[IFLA_VF_MAC]) {
		struct ifla_vf_mac *ivm = nla_data(tb[IFLA_VF_MAC]);
2023

2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037
		err = -EOPNOTSUPP;
		if (ops->ndo_set_vf_mac)
			err = ops->ndo_set_vf_mac(dev, ivm->vf,
						  ivm->mac);
		if (err < 0)
			return err;
	}

	if (tb[IFLA_VF_VLAN]) {
		struct ifla_vf_vlan *ivv = nla_data(tb[IFLA_VF_VLAN]);

		err = -EOPNOTSUPP;
		if (ops->ndo_set_vf_vlan)
			err = ops->ndo_set_vf_vlan(dev, ivv->vf, ivv->vlan,
2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063
						   ivv->qos,
						   htons(ETH_P_8021Q));
		if (err < 0)
			return err;
	}

	if (tb[IFLA_VF_VLAN_LIST]) {
		struct ifla_vf_vlan_info *ivvl[MAX_VLAN_LIST_LEN];
		struct nlattr *attr;
		int rem, len = 0;

		err = -EOPNOTSUPP;
		if (!ops->ndo_set_vf_vlan)
			return err;

		nla_for_each_nested(attr, tb[IFLA_VF_VLAN_LIST], rem) {
			if (nla_type(attr) != IFLA_VF_VLAN_INFO ||
			    nla_len(attr) < NLA_HDRLEN) {
				return -EINVAL;
			}
			if (len >= MAX_VLAN_LIST_LEN)
				return -EOPNOTSUPP;
			ivvl[len] = nla_data(attr);

			len++;
		}
2064 2065 2066
		if (len == 0)
			return -EINVAL;

2067 2068
		err = ops->ndo_set_vf_vlan(dev, ivvl[0]->vf, ivvl[0]->vlan,
					   ivvl[0]->qos, ivvl[0]->vlan_proto);
2069 2070
		if (err < 0)
			return err;
2071
	}
2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 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

	if (tb[IFLA_VF_TX_RATE]) {
		struct ifla_vf_tx_rate *ivt = nla_data(tb[IFLA_VF_TX_RATE]);
		struct ifla_vf_info ivf;

		err = -EOPNOTSUPP;
		if (ops->ndo_get_vf_config)
			err = ops->ndo_get_vf_config(dev, ivt->vf, &ivf);
		if (err < 0)
			return err;

		err = -EOPNOTSUPP;
		if (ops->ndo_set_vf_rate)
			err = ops->ndo_set_vf_rate(dev, ivt->vf,
						   ivf.min_tx_rate,
						   ivt->rate);
		if (err < 0)
			return err;
	}

	if (tb[IFLA_VF_RATE]) {
		struct ifla_vf_rate *ivt = nla_data(tb[IFLA_VF_RATE]);

		err = -EOPNOTSUPP;
		if (ops->ndo_set_vf_rate)
			err = ops->ndo_set_vf_rate(dev, ivt->vf,
						   ivt->min_tx_rate,
						   ivt->max_tx_rate);
		if (err < 0)
			return err;
	}

	if (tb[IFLA_VF_SPOOFCHK]) {
		struct ifla_vf_spoofchk *ivs = nla_data(tb[IFLA_VF_SPOOFCHK]);

		err = -EOPNOTSUPP;
		if (ops->ndo_set_vf_spoofchk)
			err = ops->ndo_set_vf_spoofchk(dev, ivs->vf,
						       ivs->setting);
		if (err < 0)
			return err;
	}

	if (tb[IFLA_VF_LINK_STATE]) {
		struct ifla_vf_link_state *ivl = nla_data(tb[IFLA_VF_LINK_STATE]);

		err = -EOPNOTSUPP;
		if (ops->ndo_set_vf_link_state)
			err = ops->ndo_set_vf_link_state(dev, ivl->vf,
							 ivl->link_state);
		if (err < 0)
			return err;
	}

	if (tb[IFLA_VF_RSS_QUERY_EN]) {
		struct ifla_vf_rss_query_en *ivrssq_en;

		err = -EOPNOTSUPP;
		ivrssq_en = nla_data(tb[IFLA_VF_RSS_QUERY_EN]);
		if (ops->ndo_set_vf_rss_query_en)
			err = ops->ndo_set_vf_rss_query_en(dev, ivrssq_en->vf,
							   ivrssq_en->setting);
		if (err < 0)
			return err;
	}

H
Hiroshi Shimamoto 已提交
2138 2139 2140 2141 2142 2143 2144 2145 2146 2147
	if (tb[IFLA_VF_TRUST]) {
		struct ifla_vf_trust *ivt = nla_data(tb[IFLA_VF_TRUST]);

		err = -EOPNOTSUPP;
		if (ops->ndo_set_vf_trust)
			err = ops->ndo_set_vf_trust(dev, ivt->vf, ivt->setting);
		if (err < 0)
			return err;
	}

2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165
	if (tb[IFLA_VF_IB_NODE_GUID]) {
		struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_NODE_GUID]);

		if (!ops->ndo_set_vf_guid)
			return -EOPNOTSUPP;

		return handle_vf_guid(dev, ivt, IFLA_VF_IB_NODE_GUID);
	}

	if (tb[IFLA_VF_IB_PORT_GUID]) {
		struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_PORT_GUID]);

		if (!ops->ndo_set_vf_guid)
			return -EOPNOTSUPP;

		return handle_vf_guid(dev, ivt, IFLA_VF_IB_PORT_GUID);
	}

2166 2167 2168
	return err;
}

D
David Ahern 已提交
2169 2170
static int do_set_master(struct net_device *dev, int ifindex,
			 struct netlink_ext_ack *extack)
2171
{
2172
	struct net_device *upper_dev = netdev_master_upper_dev_get(dev);
2173 2174 2175
	const struct net_device_ops *ops;
	int err;

2176 2177
	if (upper_dev) {
		if (upper_dev->ifindex == ifindex)
2178
			return 0;
2179
		ops = upper_dev->netdev_ops;
2180
		if (ops->ndo_del_slave) {
2181
			err = ops->ndo_del_slave(upper_dev, dev);
2182 2183 2184 2185 2186 2187 2188 2189
			if (err)
				return err;
		} else {
			return -EOPNOTSUPP;
		}
	}

	if (ifindex) {
2190 2191
		upper_dev = __dev_get_by_index(dev_net(dev), ifindex);
		if (!upper_dev)
2192
			return -EINVAL;
2193
		ops = upper_dev->netdev_ops;
2194
		if (ops->ndo_add_slave) {
D
David Ahern 已提交
2195
			err = ops->ndo_add_slave(upper_dev, dev, extack);
2196 2197 2198 2199 2200 2201 2202 2203 2204
			if (err)
				return err;
		} else {
			return -EOPNOTSUPP;
		}
	}
	return 0;
}

2205
#define DO_SETLINK_MODIFIED	0x01
2206 2207
/* notify flag means notify + modified. */
#define DO_SETLINK_NOTIFY	0x03
2208 2209
static int do_setlink(const struct sk_buff *skb,
		      struct net_device *dev, struct ifinfomsg *ifm,
2210
		      struct netlink_ext_ack *extack,
2211
		      struct nlattr **tb, char *ifname, int status)
L
Linus Torvalds 已提交
2212
{
2213
	const struct net_device_ops *ops = dev->netdev_ops;
2214
	int err;
L
Linus Torvalds 已提交
2215

2216 2217 2218
	if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD] || tb[IFLA_IF_NETNSID]) {
		struct net *net = rtnl_link_get_net_capable(skb, dev_net(dev),
							    tb, CAP_NET_ADMIN);
2219 2220 2221 2222
		if (IS_ERR(net)) {
			err = PTR_ERR(net);
			goto errout;
		}
2223

2224 2225 2226 2227
		err = dev_change_net_namespace(dev, net, ifname);
		put_net(net);
		if (err)
			goto errout;
2228
		status |= DO_SETLINK_MODIFIED;
2229 2230
	}

2231
	if (tb[IFLA_MAP]) {
L
Linus Torvalds 已提交
2232 2233 2234
		struct rtnl_link_ifmap *u_map;
		struct ifmap k_map;

2235
		if (!ops->ndo_set_config) {
L
Linus Torvalds 已提交
2236
			err = -EOPNOTSUPP;
2237
			goto errout;
L
Linus Torvalds 已提交
2238 2239 2240 2241
		}

		if (!netif_device_present(dev)) {
			err = -ENODEV;
2242
			goto errout;
L
Linus Torvalds 已提交
2243 2244
		}

2245
		u_map = nla_data(tb[IFLA_MAP]);
L
Linus Torvalds 已提交
2246 2247 2248 2249 2250 2251 2252
		k_map.mem_start = (unsigned long) u_map->mem_start;
		k_map.mem_end = (unsigned long) u_map->mem_end;
		k_map.base_addr = (unsigned short) u_map->base_addr;
		k_map.irq = (unsigned char) u_map->irq;
		k_map.dma = (unsigned char) u_map->dma;
		k_map.port = (unsigned char) u_map->port;

2253
		err = ops->ndo_set_config(dev, &k_map);
2254
		if (err < 0)
2255
			goto errout;
L
Linus Torvalds 已提交
2256

2257
		status |= DO_SETLINK_NOTIFY;
L
Linus Torvalds 已提交
2258 2259
	}

2260
	if (tb[IFLA_ADDRESS]) {
2261 2262 2263
		struct sockaddr *sa;
		int len;

2264 2265
		len = sizeof(sa_family_t) + max_t(size_t, dev->addr_len,
						  sizeof(*sa));
2266 2267 2268
		sa = kmalloc(len, GFP_KERNEL);
		if (!sa) {
			err = -ENOMEM;
2269
			goto errout;
2270 2271
		}
		sa->sa_family = dev->type;
2272
		memcpy(sa->sa_data, nla_data(tb[IFLA_ADDRESS]),
2273
		       dev->addr_len);
2274
		err = dev_set_mac_address(dev, sa);
2275
		kfree(sa);
L
Linus Torvalds 已提交
2276
		if (err)
2277
			goto errout;
2278
		status |= DO_SETLINK_MODIFIED;
L
Linus Torvalds 已提交
2279 2280
	}

2281 2282 2283
	if (tb[IFLA_MTU]) {
		err = dev_set_mtu(dev, nla_get_u32(tb[IFLA_MTU]));
		if (err < 0)
2284
			goto errout;
2285
		status |= DO_SETLINK_MODIFIED;
L
Linus Torvalds 已提交
2286 2287
	}

2288 2289
	if (tb[IFLA_GROUP]) {
		dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP]));
2290
		status |= DO_SETLINK_NOTIFY;
2291 2292
	}

2293 2294 2295 2296 2297
	/*
	 * Interface selected by interface index but interface
	 * name provided implies that a name change has been
	 * requested.
	 */
2298
	if (ifm->ifi_index > 0 && ifname[0]) {
2299 2300
		err = dev_change_name(dev, ifname);
		if (err < 0)
2301
			goto errout;
2302
		status |= DO_SETLINK_MODIFIED;
L
Linus Torvalds 已提交
2303 2304
	}

2305 2306 2307 2308 2309
	if (tb[IFLA_IFALIAS]) {
		err = dev_set_alias(dev, nla_data(tb[IFLA_IFALIAS]),
				    nla_len(tb[IFLA_IFALIAS]));
		if (err < 0)
			goto errout;
2310
		status |= DO_SETLINK_NOTIFY;
2311 2312
	}

2313 2314
	if (tb[IFLA_BROADCAST]) {
		nla_memcpy(dev->broadcast, tb[IFLA_BROADCAST], dev->addr_len);
2315
		call_netdevice_notifiers(NETDEV_CHANGEADDR, dev);
L
Linus Torvalds 已提交
2316 2317
	}

2318
	if (ifm->ifi_flags || ifm->ifi_change) {
2319
		err = dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm));
2320 2321
		if (err < 0)
			goto errout;
2322
	}
L
Linus Torvalds 已提交
2323

2324
	if (tb[IFLA_MASTER]) {
D
David Ahern 已提交
2325
		err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]), extack);
2326 2327
		if (err)
			goto errout;
2328
		status |= DO_SETLINK_MODIFIED;
2329 2330
	}

2331 2332 2333 2334
	if (tb[IFLA_CARRIER]) {
		err = dev_change_carrier(dev, nla_get_u8(tb[IFLA_CARRIER]));
		if (err)
			goto errout;
2335
		status |= DO_SETLINK_MODIFIED;
2336 2337
	}

2338
	if (tb[IFLA_TXQLEN]) {
2339 2340
		unsigned int value = nla_get_u32(tb[IFLA_TXQLEN]);
		unsigned int orig_len = dev->tx_queue_len;
2341 2342 2343 2344 2345 2346 2347 2348 2349 2350

		if (dev->tx_queue_len ^ value) {
			dev->tx_queue_len = value;
			err = call_netdevice_notifiers(
			      NETDEV_CHANGE_TX_QUEUE_LEN, dev);
			err = notifier_to_errno(err);
			if (err) {
				dev->tx_queue_len = orig_len;
				goto errout;
			}
2351
			status |= DO_SETLINK_MODIFIED;
2352
		}
2353
	}
S
Stefan Rompf 已提交
2354

2355 2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382
	if (tb[IFLA_GSO_MAX_SIZE]) {
		u32 max_size = nla_get_u32(tb[IFLA_GSO_MAX_SIZE]);

		if (max_size > GSO_MAX_SIZE) {
			err = -EINVAL;
			goto errout;
		}

		if (dev->gso_max_size ^ max_size) {
			netif_set_gso_max_size(dev, max_size);
			status |= DO_SETLINK_MODIFIED;
		}
	}

	if (tb[IFLA_GSO_MAX_SEGS]) {
		u32 max_segs = nla_get_u32(tb[IFLA_GSO_MAX_SEGS]);

		if (max_segs > GSO_MAX_SEGS) {
			err = -EINVAL;
			goto errout;
		}

		if (dev->gso_max_segs ^ max_segs) {
			dev->gso_max_segs = max_segs;
			status |= DO_SETLINK_MODIFIED;
		}
	}

2383
	if (tb[IFLA_OPERSTATE])
2384
		set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE]));
S
Stefan Rompf 已提交
2385

2386
	if (tb[IFLA_LINKMODE]) {
2387 2388
		unsigned char value = nla_get_u8(tb[IFLA_LINKMODE]);

2389
		write_lock_bh(&dev_base_lock);
2390
		if (dev->link_mode ^ value)
2391
			status |= DO_SETLINK_NOTIFY;
2392
		dev->link_mode = value;
2393
		write_unlock_bh(&dev_base_lock);
S
Stefan Rompf 已提交
2394 2395
	}

2396
	if (tb[IFLA_VFINFO_LIST]) {
2397
		struct nlattr *vfinfo[IFLA_VF_MAX + 1];
2398 2399
		struct nlattr *attr;
		int rem;
2400

2401
		nla_for_each_nested(attr, tb[IFLA_VFINFO_LIST], rem) {
2402 2403
			if (nla_type(attr) != IFLA_VF_INFO ||
			    nla_len(attr) < NLA_HDRLEN) {
2404
				err = -EINVAL;
2405
				goto errout;
2406
			}
2407
			err = nla_parse_nested(vfinfo, IFLA_VF_MAX, attr,
2408
					       ifla_vf_policy, NULL);
2409 2410 2411
			if (err < 0)
				goto errout;
			err = do_setvfinfo(dev, vfinfo);
2412 2413
			if (err < 0)
				goto errout;
2414
			status |= DO_SETLINK_NOTIFY;
2415
		}
2416
	}
L
Linus Torvalds 已提交
2417 2418
	err = 0;

2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429
	if (tb[IFLA_VF_PORTS]) {
		struct nlattr *port[IFLA_PORT_MAX+1];
		struct nlattr *attr;
		int vf;
		int rem;

		err = -EOPNOTSUPP;
		if (!ops->ndo_set_vf_port)
			goto errout;

		nla_for_each_nested(attr, tb[IFLA_VF_PORTS], rem) {
2430 2431 2432 2433 2434 2435
			if (nla_type(attr) != IFLA_VF_PORT ||
			    nla_len(attr) < NLA_HDRLEN) {
				err = -EINVAL;
				goto errout;
			}
			err = nla_parse_nested(port, IFLA_PORT_MAX, attr,
2436
					       ifla_port_policy, NULL);
2437 2438 2439 2440 2441 2442 2443 2444 2445 2446
			if (err < 0)
				goto errout;
			if (!port[IFLA_PORT_VF]) {
				err = -EOPNOTSUPP;
				goto errout;
			}
			vf = nla_get_u32(port[IFLA_PORT_VF]);
			err = ops->ndo_set_vf_port(dev, vf, port);
			if (err < 0)
				goto errout;
2447
			status |= DO_SETLINK_NOTIFY;
2448 2449 2450 2451 2452 2453 2454 2455
		}
	}
	err = 0;

	if (tb[IFLA_PORT_SELF]) {
		struct nlattr *port[IFLA_PORT_MAX+1];

		err = nla_parse_nested(port, IFLA_PORT_MAX,
2456 2457
				       tb[IFLA_PORT_SELF], ifla_port_policy,
				       NULL);
2458 2459 2460 2461 2462 2463 2464 2465
		if (err < 0)
			goto errout;

		err = -EOPNOTSUPP;
		if (ops->ndo_set_vf_port)
			err = ops->ndo_set_vf_port(dev, PORT_SELF_VF, port);
		if (err < 0)
			goto errout;
2466
		status |= DO_SETLINK_NOTIFY;
2467
	}
T
Thomas Graf 已提交
2468 2469 2470 2471 2472 2473 2474 2475

	if (tb[IFLA_AF_SPEC]) {
		struct nlattr *af;
		int rem;

		nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) {
			const struct rtnl_af_ops *af_ops;

F
Florian Westphal 已提交
2476 2477
			rcu_read_lock();

2478
			BUG_ON(!(af_ops = rtnl_af_lookup(nla_type(af))));
T
Thomas Graf 已提交
2479

2480
			err = af_ops->set_link_af(dev, af);
F
Florian Westphal 已提交
2481 2482
			if (err < 0) {
				rcu_read_unlock();
T
Thomas Graf 已提交
2483
				goto errout;
F
Florian Westphal 已提交
2484
			}
T
Thomas Graf 已提交
2485

F
Florian Westphal 已提交
2486
			rcu_read_unlock();
2487
			status |= DO_SETLINK_NOTIFY;
T
Thomas Graf 已提交
2488 2489
		}
	}
2490 2491
	err = 0;

2492 2493 2494 2495 2496 2497 2498 2499
	if (tb[IFLA_PROTO_DOWN]) {
		err = dev_change_proto_down(dev,
					    nla_get_u8(tb[IFLA_PROTO_DOWN]));
		if (err)
			goto errout;
		status |= DO_SETLINK_NOTIFY;
	}

2500 2501
	if (tb[IFLA_XDP]) {
		struct nlattr *xdp[IFLA_XDP_MAX + 1];
2502
		u32 xdp_flags = 0;
2503 2504

		err = nla_parse_nested(xdp, IFLA_XDP_MAX, tb[IFLA_XDP],
2505
				       ifla_xdp_policy, NULL);
2506 2507 2508
		if (err < 0)
			goto errout;

M
Martin KaFai Lau 已提交
2509
		if (xdp[IFLA_XDP_ATTACHED] || xdp[IFLA_XDP_PROG_ID]) {
2510 2511 2512
			err = -EINVAL;
			goto errout;
		}
2513 2514 2515 2516 2517 2518 2519

		if (xdp[IFLA_XDP_FLAGS]) {
			xdp_flags = nla_get_u32(xdp[IFLA_XDP_FLAGS]);
			if (xdp_flags & ~XDP_FLAGS_MASK) {
				err = -EINVAL;
				goto errout;
			}
2520
			if (hweight32(xdp_flags & XDP_FLAGS_MODES) > 1) {
2521 2522 2523
				err = -EINVAL;
				goto errout;
			}
2524 2525
		}

2526
		if (xdp[IFLA_XDP_FD]) {
2527
			err = dev_change_xdp_fd(dev, extack,
2528 2529
						nla_get_s32(xdp[IFLA_XDP_FD]),
						xdp_flags);
2530 2531 2532 2533 2534 2535
			if (err)
				goto errout;
			status |= DO_SETLINK_NOTIFY;
		}
	}

2536
errout:
2537
	if (status & DO_SETLINK_MODIFIED) {
2538
		if ((status & DO_SETLINK_NOTIFY) == DO_SETLINK_NOTIFY)
2539 2540 2541 2542 2543 2544
			netdev_state_change(dev);

		if (err < 0)
			net_warn_ratelimited("A link change request failed with some changes committed already. Interface %s may have been left with an inconsistent configuration, please check.\n",
					     dev->name);
	}
2545

2546 2547
	return err;
}
L
Linus Torvalds 已提交
2548

2549 2550
static int rtnl_setlink(struct sk_buff *skb, struct nlmsghdr *nlh,
			struct netlink_ext_ack *extack)
2551
{
2552
	struct net *net = sock_net(skb->sk);
2553 2554 2555 2556 2557 2558
	struct ifinfomsg *ifm;
	struct net_device *dev;
	int err;
	struct nlattr *tb[IFLA_MAX+1];
	char ifname[IFNAMSIZ];

2559 2560
	err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy,
			  extack);
2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571
	if (err < 0)
		goto errout;

	if (tb[IFLA_IFNAME])
		nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
	else
		ifname[0] = '\0';

	err = -EINVAL;
	ifm = nlmsg_data(nlh);
	if (ifm->ifi_index > 0)
2572
		dev = __dev_get_by_index(net, ifm->ifi_index);
2573
	else if (tb[IFLA_IFNAME])
2574
		dev = __dev_get_by_name(net, ifname);
2575 2576 2577 2578 2579 2580 2581 2582
	else
		goto errout;

	if (dev == NULL) {
		err = -ENODEV;
		goto errout;
	}

E
Eric Dumazet 已提交
2583 2584
	err = validate_linkmsg(dev, tb);
	if (err < 0)
2585
		goto errout;
2586

2587
	err = do_setlink(skb, dev, ifm, extack, tb, ifname, 0);
2588
errout:
L
Linus Torvalds 已提交
2589 2590 2591
	return err;
}

2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626 2627
static int rtnl_group_dellink(const struct net *net, int group)
{
	struct net_device *dev, *aux;
	LIST_HEAD(list_kill);
	bool found = false;

	if (!group)
		return -EPERM;

	for_each_netdev(net, dev) {
		if (dev->group == group) {
			const struct rtnl_link_ops *ops;

			found = true;
			ops = dev->rtnl_link_ops;
			if (!ops || !ops->dellink)
				return -EOPNOTSUPP;
		}
	}

	if (!found)
		return -ENODEV;

	for_each_netdev_safe(net, dev, aux) {
		if (dev->group == group) {
			const struct rtnl_link_ops *ops;

			ops = dev->rtnl_link_ops;
			ops->dellink(dev, &list_kill);
		}
	}
	unregister_netdevice_many(&list_kill);

	return 0;
}

2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643
int rtnl_delete_link(struct net_device *dev)
{
	const struct rtnl_link_ops *ops;
	LIST_HEAD(list_kill);

	ops = dev->rtnl_link_ops;
	if (!ops || !ops->dellink)
		return -EOPNOTSUPP;

	ops->dellink(dev, &list_kill);
	unregister_netdevice_many(&list_kill);

	return 0;
}
EXPORT_SYMBOL_GPL(rtnl_delete_link);

2644 2645
static int rtnl_dellink(struct sk_buff *skb, struct nlmsghdr *nlh,
			struct netlink_ext_ack *extack)
P
Patrick McHardy 已提交
2646
{
2647
	struct net *net = sock_net(skb->sk);
2648 2649
	struct net *tgt_net = net;
	struct net_device *dev = NULL;
P
Patrick McHardy 已提交
2650 2651 2652 2653
	struct ifinfomsg *ifm;
	char ifname[IFNAMSIZ];
	struct nlattr *tb[IFLA_MAX+1];
	int err;
2654
	int netnsid = -1;
P
Patrick McHardy 已提交
2655

2656
	err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack);
P
Patrick McHardy 已提交
2657 2658 2659 2660 2661 2662
	if (err < 0)
		return err;

	if (tb[IFLA_IFNAME])
		nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);

2663 2664 2665 2666 2667 2668 2669 2670
	if (tb[IFLA_IF_NETNSID]) {
		netnsid = nla_get_s32(tb[IFLA_IF_NETNSID]);
		tgt_net = get_target_net(NETLINK_CB(skb).sk, netnsid);
		if (IS_ERR(tgt_net))
			return PTR_ERR(tgt_net);
	}

	err = -EINVAL;
P
Patrick McHardy 已提交
2671 2672
	ifm = nlmsg_data(nlh);
	if (ifm->ifi_index > 0)
2673
		dev = __dev_get_by_index(tgt_net, ifm->ifi_index);
P
Patrick McHardy 已提交
2674
	else if (tb[IFLA_IFNAME])
2675
		dev = __dev_get_by_name(tgt_net, ifname);
2676
	else if (tb[IFLA_GROUP])
2677
		err = rtnl_group_dellink(tgt_net, nla_get_u32(tb[IFLA_GROUP]));
P
Patrick McHardy 已提交
2678
	else
2679
		goto out;
P
Patrick McHardy 已提交
2680

2681 2682 2683 2684 2685 2686 2687 2688
	if (!dev) {
		if (tb[IFLA_IFNAME] || ifm->ifi_index > 0)
			err = -ENODEV;

		goto out;
	}

	err = rtnl_delete_link(dev);
P
Patrick McHardy 已提交
2689

2690 2691 2692 2693 2694
out:
	if (netnsid >= 0)
		put_net(tgt_net);

	return err;
P
Patrick McHardy 已提交
2695 2696
}

2697 2698 2699 2700 2701 2702 2703 2704 2705 2706 2707 2708 2709 2710
int rtnl_configure_link(struct net_device *dev, const struct ifinfomsg *ifm)
{
	unsigned int old_flags;
	int err;

	old_flags = dev->flags;
	if (ifm && (ifm->ifi_flags || ifm->ifi_change)) {
		err = __dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm));
		if (err < 0)
			return err;
	}

	dev->rtnl_link_state = RTNL_LINK_INITIALIZED;

2711
	__dev_notify_flags(dev, old_flags, ~0U);
2712 2713 2714 2715
	return 0;
}
EXPORT_SYMBOL(rtnl_configure_link);

2716
struct net_device *rtnl_create_link(struct net *net,
2717
	const char *ifname, unsigned char name_assign_type,
2718
	const struct rtnl_link_ops *ops, struct nlattr *tb[])
2719 2720
{
	struct net_device *dev;
2721 2722
	unsigned int num_tx_queues = 1;
	unsigned int num_rx_queues = 1;
2723

2724 2725 2726
	if (tb[IFLA_NUM_TX_QUEUES])
		num_tx_queues = nla_get_u32(tb[IFLA_NUM_TX_QUEUES]);
	else if (ops->get_num_tx_queues)
2727
		num_tx_queues = ops->get_num_tx_queues();
2728 2729 2730 2731

	if (tb[IFLA_NUM_RX_QUEUES])
		num_rx_queues = nla_get_u32(tb[IFLA_NUM_RX_QUEUES]);
	else if (ops->get_num_rx_queues)
2732
		num_rx_queues = ops->get_num_rx_queues();
2733

2734
	dev = alloc_netdev_mqs(ops->priv_size, ifname, name_assign_type,
2735
			       ops->setup, num_tx_queues, num_rx_queues);
2736
	if (!dev)
2737
		return ERR_PTR(-ENOMEM);
2738

2739 2740
	dev_net_set(dev, net);
	dev->rtnl_link_ops = ops;
2741
	dev->rtnl_link_state = RTNL_LINK_INITIALIZING;
2742

2743 2744
	if (tb[IFLA_MTU])
		dev->mtu = nla_get_u32(tb[IFLA_MTU]);
2745
	if (tb[IFLA_ADDRESS]) {
2746 2747
		memcpy(dev->dev_addr, nla_data(tb[IFLA_ADDRESS]),
				nla_len(tb[IFLA_ADDRESS]));
2748 2749
		dev->addr_assign_type = NET_ADDR_SET;
	}
2750 2751 2752 2753 2754 2755
	if (tb[IFLA_BROADCAST])
		memcpy(dev->broadcast, nla_data(tb[IFLA_BROADCAST]),
				nla_len(tb[IFLA_BROADCAST]));
	if (tb[IFLA_TXQLEN])
		dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]);
	if (tb[IFLA_OPERSTATE])
2756
		set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE]));
2757 2758
	if (tb[IFLA_LINKMODE])
		dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]);
2759 2760
	if (tb[IFLA_GROUP])
		dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP]));
2761 2762 2763
	if (tb[IFLA_GSO_MAX_SIZE])
		netif_set_gso_max_size(dev, nla_get_u32(tb[IFLA_GSO_MAX_SIZE]));
	if (tb[IFLA_GSO_MAX_SEGS])
2764
		dev->gso_max_segs = nla_get_u32(tb[IFLA_GSO_MAX_SEGS]);
2765 2766 2767

	return dev;
}
E
Eric Dumazet 已提交
2768
EXPORT_SYMBOL(rtnl_create_link);
2769

2770 2771
static int rtnl_group_changelink(const struct sk_buff *skb,
		struct net *net, int group,
2772
		struct ifinfomsg *ifm,
2773
		struct netlink_ext_ack *extack,
2774 2775
		struct nlattr **tb)
{
2776
	struct net_device *dev, *aux;
2777 2778
	int err;

2779
	for_each_netdev_safe(net, dev, aux) {
2780
		if (dev->group == group) {
2781
			err = do_setlink(skb, dev, ifm, extack, tb, NULL, 0);
2782 2783 2784 2785 2786 2787 2788 2789
			if (err < 0)
				return err;
		}
	}

	return 0;
}

2790 2791
static int rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh,
			struct netlink_ext_ack *extack)
P
Patrick McHardy 已提交
2792
{
2793
	struct net *net = sock_net(skb->sk);
P
Patrick McHardy 已提交
2794
	const struct rtnl_link_ops *ops;
2795
	const struct rtnl_link_ops *m_ops = NULL;
P
Patrick McHardy 已提交
2796
	struct net_device *dev;
2797
	struct net_device *master_dev = NULL;
P
Patrick McHardy 已提交
2798 2799 2800 2801 2802
	struct ifinfomsg *ifm;
	char kind[MODULE_NAME_LEN];
	char ifname[IFNAMSIZ];
	struct nlattr *tb[IFLA_MAX+1];
	struct nlattr *linkinfo[IFLA_INFO_MAX+1];
2803
	unsigned char name_assign_type = NET_NAME_USER;
P
Patrick McHardy 已提交
2804 2805
	int err;

2806
#ifdef CONFIG_MODULES
P
Patrick McHardy 已提交
2807
replay:
2808
#endif
2809
	err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack);
P
Patrick McHardy 已提交
2810 2811 2812
	if (err < 0)
		return err;

2813 2814 2815
	if (tb[IFLA_IF_NETNSID])
		return -EOPNOTSUPP;

P
Patrick McHardy 已提交
2816 2817 2818 2819 2820 2821 2822
	if (tb[IFLA_IFNAME])
		nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
	else
		ifname[0] = '\0';

	ifm = nlmsg_data(nlh);
	if (ifm->ifi_index > 0)
2823
		dev = __dev_get_by_index(net, ifm->ifi_index);
2824 2825 2826 2827 2828 2829
	else {
		if (ifname[0])
			dev = __dev_get_by_name(net, ifname);
		else
			dev = NULL;
	}
P
Patrick McHardy 已提交
2830

2831 2832 2833 2834 2835 2836
	if (dev) {
		master_dev = netdev_master_upper_dev_get(dev);
		if (master_dev)
			m_ops = master_dev->rtnl_link_ops;
	}

E
Eric Dumazet 已提交
2837 2838
	err = validate_linkmsg(dev, tb);
	if (err < 0)
2839 2840
		return err;

P
Patrick McHardy 已提交
2841 2842
	if (tb[IFLA_LINKINFO]) {
		err = nla_parse_nested(linkinfo, IFLA_INFO_MAX,
2843 2844
				       tb[IFLA_LINKINFO], ifla_info_policy,
				       NULL);
P
Patrick McHardy 已提交
2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858
		if (err < 0)
			return err;
	} else
		memset(linkinfo, 0, sizeof(linkinfo));

	if (linkinfo[IFLA_INFO_KIND]) {
		nla_strlcpy(kind, linkinfo[IFLA_INFO_KIND], sizeof(kind));
		ops = rtnl_link_ops_get(kind);
	} else {
		kind[0] = '\0';
		ops = NULL;
	}

	if (1) {
S
Sasha Levin 已提交
2859 2860
		struct nlattr *attr[ops ? ops->maxtype + 1 : 1];
		struct nlattr *slave_attr[m_ops ? m_ops->slave_maxtype + 1 : 1];
2861 2862
		struct nlattr **data = NULL;
		struct nlattr **slave_data = NULL;
2863
		struct net *dest_net, *link_net = NULL;
P
Patrick McHardy 已提交
2864 2865 2866 2867 2868

		if (ops) {
			if (ops->maxtype && linkinfo[IFLA_INFO_DATA]) {
				err = nla_parse_nested(attr, ops->maxtype,
						       linkinfo[IFLA_INFO_DATA],
2869
						       ops->policy, NULL);
P
Patrick McHardy 已提交
2870 2871 2872 2873 2874
				if (err < 0)
					return err;
				data = attr;
			}
			if (ops->validate) {
2875
				err = ops->validate(tb, data, extack);
P
Patrick McHardy 已提交
2876 2877 2878 2879 2880
				if (err < 0)
					return err;
			}
		}

2881 2882 2883 2884 2885 2886
		if (m_ops) {
			if (m_ops->slave_maxtype &&
			    linkinfo[IFLA_INFO_SLAVE_DATA]) {
				err = nla_parse_nested(slave_attr,
						       m_ops->slave_maxtype,
						       linkinfo[IFLA_INFO_SLAVE_DATA],
2887 2888
						       m_ops->slave_policy,
						       NULL);
2889 2890 2891 2892 2893 2894
				if (err < 0)
					return err;
				slave_data = slave_attr;
			}
		}

P
Patrick McHardy 已提交
2895
		if (dev) {
2896
			int status = 0;
P
Patrick McHardy 已提交
2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907

			if (nlh->nlmsg_flags & NLM_F_EXCL)
				return -EEXIST;
			if (nlh->nlmsg_flags & NLM_F_REPLACE)
				return -EOPNOTSUPP;

			if (linkinfo[IFLA_INFO_DATA]) {
				if (!ops || ops != dev->rtnl_link_ops ||
				    !ops->changelink)
					return -EOPNOTSUPP;

2908
				err = ops->changelink(dev, tb, data, extack);
P
Patrick McHardy 已提交
2909 2910
				if (err < 0)
					return err;
2911
				status |= DO_SETLINK_NOTIFY;
P
Patrick McHardy 已提交
2912 2913
			}

2914 2915 2916 2917 2918
			if (linkinfo[IFLA_INFO_SLAVE_DATA]) {
				if (!m_ops || !m_ops->slave_changelink)
					return -EOPNOTSUPP;

				err = m_ops->slave_changelink(master_dev, dev,
2919 2920
							      tb, slave_data,
							      extack);
2921 2922
				if (err < 0)
					return err;
2923
				status |= DO_SETLINK_NOTIFY;
2924 2925
			}

2926 2927
			return do_setlink(skb, dev, ifm, extack, tb, ifname,
					  status);
P
Patrick McHardy 已提交
2928 2929
		}

2930 2931
		if (!(nlh->nlmsg_flags & NLM_F_CREATE)) {
			if (ifm->ifi_index == 0 && tb[IFLA_GROUP])
2932
				return rtnl_group_changelink(skb, net,
2933
						nla_get_u32(tb[IFLA_GROUP]),
2934
						ifm, extack, tb);
P
Patrick McHardy 已提交
2935
			return -ENODEV;
2936
		}
P
Patrick McHardy 已提交
2937

2938
		if (tb[IFLA_MAP] || tb[IFLA_PROTINFO])
P
Patrick McHardy 已提交
2939 2940 2941
			return -EOPNOTSUPP;

		if (!ops) {
2942
#ifdef CONFIG_MODULES
P
Patrick McHardy 已提交
2943 2944 2945 2946 2947 2948 2949 2950 2951 2952 2953 2954
			if (kind[0]) {
				__rtnl_unlock();
				request_module("rtnl-link-%s", kind);
				rtnl_lock();
				ops = rtnl_link_ops_get(kind);
				if (ops)
					goto replay;
			}
#endif
			return -EOPNOTSUPP;
		}

2955 2956 2957
		if (!ops->setup)
			return -EOPNOTSUPP;

2958
		if (!ifname[0]) {
P
Patrick McHardy 已提交
2959
			snprintf(ifname, IFNAMSIZ, "%s%%d", ops->kind);
2960 2961
			name_assign_type = NET_NAME_ENUM;
		}
2962

2963
		dest_net = rtnl_link_get_net(net, tb);
2964 2965 2966
		if (IS_ERR(dest_net))
			return PTR_ERR(dest_net);

2967 2968 2969 2970
		err = -EPERM;
		if (!netlink_ns_capable(skb, dest_net->user_ns, CAP_NET_ADMIN))
			goto out;

2971 2972 2973 2974 2975 2976 2977 2978
		if (tb[IFLA_LINK_NETNSID]) {
			int id = nla_get_s32(tb[IFLA_LINK_NETNSID]);

			link_net = get_net_ns_by_id(dest_net, id);
			if (!link_net) {
				err =  -EINVAL;
				goto out;
			}
2979 2980 2981
			err = -EPERM;
			if (!netlink_ns_capable(skb, link_net->user_ns, CAP_NET_ADMIN))
				goto out;
2982 2983 2984 2985
		}

		dev = rtnl_create_link(link_net ? : dest_net, ifname,
				       name_assign_type, ops, tb);
2986
		if (IS_ERR(dev)) {
2987
			err = PTR_ERR(dev);
2988 2989 2990 2991 2992
			goto out;
		}

		dev->ifindex = ifm->ifi_index;

2993
		if (ops->newlink) {
2994 2995
			err = ops->newlink(link_net ? : net, dev, tb, data,
					   extack);
2996
			/* Drivers should call free_netdev() in ->destructor
2997 2998
			 * and unregister it on failure after registration
			 * so that device could be finally freed in rtnl_unlock.
2999
			 */
3000 3001 3002 3003
			if (err < 0) {
				/* If device is not registered at all, free it now */
				if (dev->reg_state == NETREG_UNINITIALIZED)
					free_netdev(dev);
3004
				goto out;
3005
			}
3006
		} else {
3007
			err = register_netdevice(dev);
3008 3009 3010 3011
			if (err < 0) {
				free_netdev(dev);
				goto out;
			}
3012
		}
3013
		err = rtnl_configure_link(dev, ifm);
3014 3015
		if (err < 0)
			goto out_unregister;
3016
		if (link_net) {
3017
			err = dev_change_net_namespace(dev, dest_net, ifname);
3018
			if (err < 0)
3019
				goto out_unregister;
3020
		}
3021
		if (tb[IFLA_MASTER]) {
D
David Ahern 已提交
3022 3023
			err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]),
					    extack);
3024 3025 3026
			if (err)
				goto out_unregister;
		}
3027
out:
3028 3029
		if (link_net)
			put_net(link_net);
3030
		put_net(dest_net);
P
Patrick McHardy 已提交
3031
		return err;
3032 3033 3034 3035 3036 3037 3038 3039 3040 3041
out_unregister:
		if (ops->newlink) {
			LIST_HEAD(list_kill);

			ops->dellink(dev, &list_kill);
			unregister_netdevice_many(&list_kill);
		} else {
			unregister_netdevice(dev);
		}
		goto out;
P
Patrick McHardy 已提交
3042 3043 3044
	}
}

3045 3046
static int rtnl_getlink(struct sk_buff *skb, struct nlmsghdr *nlh,
			struct netlink_ext_ack *extack)
3047
{
3048
	struct net *net = sock_net(skb->sk);
3049
	struct net *tgt_net = net;
3050
	struct ifinfomsg *ifm;
3051
	char ifname[IFNAMSIZ];
3052 3053 3054
	struct nlattr *tb[IFLA_MAX+1];
	struct net_device *dev = NULL;
	struct sk_buff *nskb;
3055
	int netnsid = -1;
3056
	int err;
3057
	u32 ext_filter_mask = 0;
3058

3059
	err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack);
3060
	if (err < 0)
3061
		return err;
3062

3063 3064
	if (tb[IFLA_IF_NETNSID]) {
		netnsid = nla_get_s32(tb[IFLA_IF_NETNSID]);
3065
		tgt_net = get_target_net(NETLINK_CB(skb).sk, netnsid);
3066 3067 3068 3069
		if (IS_ERR(tgt_net))
			return PTR_ERR(tgt_net);
	}

3070 3071 3072
	if (tb[IFLA_IFNAME])
		nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);

3073 3074 3075
	if (tb[IFLA_EXT_MASK])
		ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);

3076
	err = -EINVAL;
3077
	ifm = nlmsg_data(nlh);
3078
	if (ifm->ifi_index > 0)
3079
		dev = __dev_get_by_index(tgt_net, ifm->ifi_index);
3080
	else if (tb[IFLA_IFNAME])
3081
		dev = __dev_get_by_name(tgt_net, ifname);
3082
	else
3083
		goto out;
3084

3085
	err = -ENODEV;
3086
	if (dev == NULL)
3087
		goto out;
3088

3089
	err = -ENOBUFS;
3090
	nskb = nlmsg_new(if_nlmsg_size(dev, ext_filter_mask), GFP_KERNEL);
3091
	if (nskb == NULL)
3092
		goto out;
3093

3094 3095 3096
	err = rtnl_fill_ifinfo(nskb, dev, net,
			       RTM_NEWLINK, NETLINK_CB(skb).portid,
			       nlh->nlmsg_seq, 0, 0, ext_filter_mask,
3097
			       0, NULL, 0, netnsid);
3098 3099 3100 3101
	if (err < 0) {
		/* -EMSGSIZE implies BUG in if_nlmsg_size */
		WARN_ON(err == -EMSGSIZE);
		kfree_skb(nskb);
3102
	} else
3103
		err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid);
3104 3105 3106
out:
	if (netnsid >= 0)
		put_net(tgt_net);
3107

3108
	return err;
3109 3110
}

3111
static u16 rtnl_calcit(struct sk_buff *skb, struct nlmsghdr *nlh)
3112
{
3113 3114 3115 3116 3117
	struct net *net = sock_net(skb->sk);
	struct net_device *dev;
	struct nlattr *tb[IFLA_MAX+1];
	u32 ext_filter_mask = 0;
	u16 min_ifinfo_dump_size = 0;
3118 3119 3120 3121 3122
	int hdrlen;

	/* Same kernel<->userspace interface hack as in rtnl_dump_ifinfo. */
	hdrlen = nlmsg_len(nlh) < sizeof(struct ifinfomsg) ?
		 sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg);
3123

3124
	if (nlmsg_parse(nlh, hdrlen, tb, IFLA_MAX, ifla_policy, NULL) >= 0) {
3125 3126 3127
		if (tb[IFLA_EXT_MASK])
			ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
	}
3128 3129 3130 3131 3132 3133 3134

	if (!ext_filter_mask)
		return NLMSG_GOODSIZE;
	/*
	 * traverse the list of net devices and compute the minimum
	 * buffer size based upon the filter mask.
	 */
3135 3136
	rcu_read_lock();
	for_each_netdev_rcu(net, dev) {
3137 3138 3139 3140
		min_ifinfo_dump_size = max_t(u16, min_ifinfo_dump_size,
					     if_nlmsg_size(dev,
						           ext_filter_mask));
	}
3141
	rcu_read_unlock();
3142

3143
	return nlmsg_total_size(min_ifinfo_dump_size);
3144 3145
}

A
Adrian Bunk 已提交
3146
static int rtnl_dump_all(struct sk_buff *skb, struct netlink_callback *cb)
L
Linus Torvalds 已提交
3147 3148 3149 3150 3151 3152
{
	int idx;
	int s_idx = cb->family;

	if (s_idx == 0)
		s_idx = 1;
3153

3154
	for (idx = 1; idx <= RTNL_FAMILY_MAX; idx++) {
3155
		struct rtnl_link **tab;
L
Linus Torvalds 已提交
3156
		int type = cb->nlh->nlmsg_type-RTM_BASE;
3157
		struct rtnl_link *link;
3158 3159
		rtnl_dumpit_func dumpit;

L
Linus Torvalds 已提交
3160 3161
		if (idx < s_idx || idx == PF_PACKET)
			continue;
3162

3163
		if (type < 0 || type >= RTM_NR_MSGTYPES)
L
Linus Torvalds 已提交
3164
			continue;
3165

3166 3167 3168 3169 3170 3171 3172 3173 3174
		tab = rcu_dereference_rtnl(rtnl_msg_handlers[idx]);
		if (!tab)
			continue;

		link = tab[type];
		if (!link)
			continue;

		dumpit = link->dumpit;
3175 3176 3177
		if (!dumpit)
			continue;

3178
		if (idx > s_idx) {
L
Linus Torvalds 已提交
3179
			memset(&cb->args[0], 0, sizeof(cb->args));
3180 3181 3182
			cb->prev_seq = 0;
			cb->seq = 0;
		}
3183
		if (dumpit(skb, cb))
L
Linus Torvalds 已提交
3184 3185 3186 3187 3188 3189 3190
			break;
	}
	cb->family = idx;

	return skb->len;
}

3191
struct sk_buff *rtmsg_ifinfo_build_skb(int type, struct net_device *dev,
3192
				       unsigned int change,
3193 3194
				       u32 event, gfp_t flags, int *new_nsid,
				       int new_ifindex)
L
Linus Torvalds 已提交
3195
{
3196
	struct net *net = dev_net(dev);
L
Linus Torvalds 已提交
3197
	struct sk_buff *skb;
3198
	int err = -ENOBUFS;
3199
	size_t if_info_size;
L
Linus Torvalds 已提交
3200

3201
	skb = nlmsg_new((if_info_size = if_nlmsg_size(dev, 0)), flags);
3202 3203
	if (skb == NULL)
		goto errout;
L
Linus Torvalds 已提交
3204

3205 3206
	err = rtnl_fill_ifinfo(skb, dev, dev_net(dev),
			       type, 0, 0, change, 0, 0, event,
3207
			       new_nsid, new_ifindex, -1);
3208 3209 3210 3211 3212 3213
	if (err < 0) {
		/* -EMSGSIZE implies BUG in if_nlmsg_size() */
		WARN_ON(err == -EMSGSIZE);
		kfree_skb(skb);
		goto errout;
	}
3214
	return skb;
3215 3216
errout:
	if (err < 0)
3217
		rtnl_set_sk_err(net, RTNLGRP_LINK, err);
3218 3219 3220 3221 3222 3223 3224 3225 3226 3227
	return NULL;
}

void rtmsg_ifinfo_send(struct sk_buff *skb, struct net_device *dev, gfp_t flags)
{
	struct net *net = dev_net(dev);

	rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, flags);
}

3228 3229
static void rtmsg_ifinfo_event(int type, struct net_device *dev,
			       unsigned int change, u32 event,
3230
			       gfp_t flags, int *new_nsid, int new_ifindex)
3231 3232 3233
{
	struct sk_buff *skb;

3234 3235 3236
	if (dev->reg_state != NETREG_REGISTERED)
		return;

3237 3238
	skb = rtmsg_ifinfo_build_skb(type, dev, change, event, flags, new_nsid,
				     new_ifindex);
3239 3240
	if (skb)
		rtmsg_ifinfo_send(skb, dev, flags);
L
Linus Torvalds 已提交
3241
}
3242 3243 3244 3245

void rtmsg_ifinfo(int type, struct net_device *dev, unsigned int change,
		  gfp_t flags)
{
3246 3247
	rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags,
			   NULL, 0);
3248
}
L
Linus Torvalds 已提交
3249

3250
void rtmsg_ifinfo_newnet(int type, struct net_device *dev, unsigned int change,
3251
			 gfp_t flags, int *new_nsid, int new_ifindex)
3252 3253
{
	rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags,
3254
			   new_nsid, new_ifindex);
3255 3256
}

3257 3258
static int nlmsg_populate_fdb_fill(struct sk_buff *skb,
				   struct net_device *dev,
3259
				   u8 *addr, u16 vid, u32 pid, u32 seq,
3260
				   int type, unsigned int flags,
3261
				   int nlflags, u16 ndm_state)
3262 3263 3264 3265
{
	struct nlmsghdr *nlh;
	struct ndmsg *ndm;

3266
	nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ndm), nlflags);
3267 3268 3269 3270 3271 3272 3273 3274 3275 3276
	if (!nlh)
		return -EMSGSIZE;

	ndm = nlmsg_data(nlh);
	ndm->ndm_family  = AF_BRIDGE;
	ndm->ndm_pad1	 = 0;
	ndm->ndm_pad2    = 0;
	ndm->ndm_flags	 = flags;
	ndm->ndm_type	 = 0;
	ndm->ndm_ifindex = dev->ifindex;
3277
	ndm->ndm_state   = ndm_state;
3278 3279 3280

	if (nla_put(skb, NDA_LLADDR, ETH_ALEN, addr))
		goto nla_put_failure;
3281 3282 3283
	if (vid)
		if (nla_put(skb, NDA_VLAN, sizeof(u16), &vid))
			goto nla_put_failure;
3284

3285 3286
	nlmsg_end(skb, nlh);
	return 0;
3287 3288 3289 3290 3291 3292

nla_put_failure:
	nlmsg_cancel(skb, nlh);
	return -EMSGSIZE;
}

3293 3294
static inline size_t rtnl_fdb_nlmsg_size(void)
{
3295 3296 3297 3298
	return NLMSG_ALIGN(sizeof(struct ndmsg)) +
	       nla_total_size(ETH_ALEN) +	/* NDA_LLADDR */
	       nla_total_size(sizeof(u16)) +	/* NDA_VLAN */
	       0;
3299 3300
}

3301 3302
static void rtnl_fdb_notify(struct net_device *dev, u8 *addr, u16 vid, int type,
			    u16 ndm_state)
3303 3304 3305 3306 3307 3308 3309 3310 3311
{
	struct net *net = dev_net(dev);
	struct sk_buff *skb;
	int err = -ENOBUFS;

	skb = nlmsg_new(rtnl_fdb_nlmsg_size(), GFP_ATOMIC);
	if (!skb)
		goto errout;

3312
	err = nlmsg_populate_fdb_fill(skb, dev, addr, vid,
3313
				      0, 0, type, NTF_SELF, 0, ndm_state);
3314 3315 3316 3317 3318 3319 3320 3321 3322 3323 3324
	if (err < 0) {
		kfree_skb(skb);
		goto errout;
	}

	rtnl_notify(skb, net, 0, RTNLGRP_NEIGH, NULL, GFP_ATOMIC);
	return;
errout:
	rtnl_set_sk_err(net, RTNLGRP_NEIGH, err);
}

3325 3326 3327 3328 3329 3330
/**
 * ndo_dflt_fdb_add - default netdevice operation to add an FDB entry
 */
int ndo_dflt_fdb_add(struct ndmsg *ndm,
		     struct nlattr *tb[],
		     struct net_device *dev,
3331
		     const unsigned char *addr, u16 vid,
3332 3333 3334 3335 3336 3337 3338 3339 3340 3341 3342 3343
		     u16 flags)
{
	int err = -EINVAL;

	/* If aging addresses are supported device will need to
	 * implement its own handler for this.
	 */
	if (ndm->ndm_state && !(ndm->ndm_state & NUD_PERMANENT)) {
		pr_info("%s: FDB only supports static addresses\n", dev->name);
		return err;
	}

3344 3345 3346 3347 3348
	if (vid) {
		pr_info("%s: vlans aren't supported yet for dev_uc|mc_add()\n", dev->name);
		return err;
	}

3349 3350 3351 3352 3353 3354 3355 3356 3357 3358 3359 3360 3361
	if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr))
		err = dev_uc_add_excl(dev, addr);
	else if (is_multicast_ether_addr(addr))
		err = dev_mc_add_excl(dev, addr);

	/* Only return duplicate errors if NLM_F_EXCL is set */
	if (err == -EEXIST && !(flags & NLM_F_EXCL))
		err = 0;

	return err;
}
EXPORT_SYMBOL(ndo_dflt_fdb_add);

3362 3363
static int fdb_vid_parse(struct nlattr *vlan_attr, u16 *p_vid,
			 struct netlink_ext_ack *extack)
3364 3365 3366 3367 3368
{
	u16 vid = 0;

	if (vlan_attr) {
		if (nla_len(vlan_attr) != sizeof(u16)) {
3369
			NL_SET_ERR_MSG(extack, "invalid vlan attribute size");
3370 3371 3372 3373 3374 3375
			return -EINVAL;
		}

		vid = nla_get_u16(vlan_attr);

		if (!vid || vid >= VLAN_VID_MASK) {
3376
			NL_SET_ERR_MSG(extack, "invalid vlan id");
3377 3378 3379 3380 3381 3382 3383
			return -EINVAL;
		}
	}
	*p_vid = vid;
	return 0;
}

3384 3385
static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh,
			struct netlink_ext_ack *extack)
3386 3387 3388 3389 3390 3391
{
	struct net *net = sock_net(skb->sk);
	struct ndmsg *ndm;
	struct nlattr *tb[NDA_MAX+1];
	struct net_device *dev;
	u8 *addr;
3392
	u16 vid;
3393 3394
	int err;

3395
	err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack);
3396 3397 3398 3399 3400
	if (err < 0)
		return err;

	ndm = nlmsg_data(nlh);
	if (ndm->ndm_ifindex == 0) {
3401
		NL_SET_ERR_MSG(extack, "invalid ifindex");
3402 3403 3404 3405 3406
		return -EINVAL;
	}

	dev = __dev_get_by_index(net, ndm->ndm_ifindex);
	if (dev == NULL) {
3407
		NL_SET_ERR_MSG(extack, "unknown ifindex");
3408 3409 3410 3411
		return -ENODEV;
	}

	if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) {
3412
		NL_SET_ERR_MSG(extack, "invalid address");
3413 3414 3415 3416 3417
		return -EINVAL;
	}

	addr = nla_data(tb[NDA_LLADDR]);

3418
	err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack);
3419 3420 3421
	if (err)
		return err;

3422 3423 3424 3425 3426
	err = -EOPNOTSUPP;

	/* Support fdb on master device the net/bridge default case */
	if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) &&
	    (dev->priv_flags & IFF_BRIDGE_PORT)) {
3427 3428 3429
		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
		const struct net_device_ops *ops = br_dev->netdev_ops;

3430 3431
		err = ops->ndo_fdb_add(ndm, tb, dev, addr, vid,
				       nlh->nlmsg_flags);
3432 3433 3434 3435 3436 3437 3438
		if (err)
			goto out;
		else
			ndm->ndm_flags &= ~NTF_MASTER;
	}

	/* Embedded bridge, macvlan, and any other device support */
3439 3440 3441
	if ((ndm->ndm_flags & NTF_SELF)) {
		if (dev->netdev_ops->ndo_fdb_add)
			err = dev->netdev_ops->ndo_fdb_add(ndm, tb, dev, addr,
3442
							   vid,
3443 3444
							   nlh->nlmsg_flags);
		else
3445
			err = ndo_dflt_fdb_add(ndm, tb, dev, addr, vid,
3446
					       nlh->nlmsg_flags);
3447

3448
		if (!err) {
3449 3450
			rtnl_fdb_notify(dev, addr, vid, RTM_NEWNEIGH,
					ndm->ndm_state);
3451
			ndm->ndm_flags &= ~NTF_SELF;
3452
		}
3453 3454 3455 3456 3457
	}
out:
	return err;
}

3458 3459 3460 3461 3462 3463
/**
 * ndo_dflt_fdb_del - default netdevice operation to delete an FDB entry
 */
int ndo_dflt_fdb_del(struct ndmsg *ndm,
		     struct nlattr *tb[],
		     struct net_device *dev,
3464
		     const unsigned char *addr, u16 vid)
3465
{
3466
	int err = -EINVAL;
3467 3468 3469 3470

	/* If aging addresses are supported device will need to
	 * implement its own handler for this.
	 */
3471
	if (!(ndm->ndm_state & NUD_PERMANENT)) {
3472
		pr_info("%s: FDB only supports static addresses\n", dev->name);
3473
		return err;
3474 3475 3476 3477 3478 3479 3480 3481 3482 3483 3484
	}

	if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr))
		err = dev_uc_del(dev, addr);
	else if (is_multicast_ether_addr(addr))
		err = dev_mc_del(dev, addr);

	return err;
}
EXPORT_SYMBOL(ndo_dflt_fdb_del);

3485 3486
static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh,
			struct netlink_ext_ack *extack)
3487 3488 3489
{
	struct net *net = sock_net(skb->sk);
	struct ndmsg *ndm;
3490
	struct nlattr *tb[NDA_MAX+1];
3491 3492 3493
	struct net_device *dev;
	int err = -EINVAL;
	__u8 *addr;
3494
	u16 vid;
3495

3496
	if (!netlink_capable(skb, CAP_NET_ADMIN))
3497 3498
		return -EPERM;

3499
	err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack);
3500 3501
	if (err < 0)
		return err;
3502 3503 3504

	ndm = nlmsg_data(nlh);
	if (ndm->ndm_ifindex == 0) {
3505
		NL_SET_ERR_MSG(extack, "invalid ifindex");
3506 3507 3508 3509 3510
		return -EINVAL;
	}

	dev = __dev_get_by_index(net, ndm->ndm_ifindex);
	if (dev == NULL) {
3511
		NL_SET_ERR_MSG(extack, "unknown ifindex");
3512 3513 3514
		return -ENODEV;
	}

3515
	if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) {
3516
		NL_SET_ERR_MSG(extack, "invalid address");
3517 3518 3519 3520
		return -EINVAL;
	}

	addr = nla_data(tb[NDA_LLADDR]);
3521

3522
	err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack);
3523 3524 3525
	if (err)
		return err;

3526 3527 3528 3529 3530
	err = -EOPNOTSUPP;

	/* Support fdb on master device the net/bridge default case */
	if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) &&
	    (dev->priv_flags & IFF_BRIDGE_PORT)) {
3531 3532
		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
		const struct net_device_ops *ops = br_dev->netdev_ops;
3533

3534
		if (ops->ndo_fdb_del)
3535
			err = ops->ndo_fdb_del(ndm, tb, dev, addr, vid);
3536 3537 3538 3539 3540 3541 3542 3543

		if (err)
			goto out;
		else
			ndm->ndm_flags &= ~NTF_MASTER;
	}

	/* Embedded bridge, macvlan, and any other device support */
3544 3545
	if (ndm->ndm_flags & NTF_SELF) {
		if (dev->netdev_ops->ndo_fdb_del)
3546 3547
			err = dev->netdev_ops->ndo_fdb_del(ndm, tb, dev, addr,
							   vid);
3548
		else
3549
			err = ndo_dflt_fdb_del(ndm, tb, dev, addr, vid);
3550

3551
		if (!err) {
3552 3553
			rtnl_fdb_notify(dev, addr, vid, RTM_DELNEIGH,
					ndm->ndm_state);
3554
			ndm->ndm_flags &= ~NTF_SELF;
3555
		}
3556 3557 3558 3559 3560
	}
out:
	return err;
}

3561 3562 3563 3564 3565 3566 3567 3568
static int nlmsg_populate_fdb(struct sk_buff *skb,
			      struct netlink_callback *cb,
			      struct net_device *dev,
			      int *idx,
			      struct netdev_hw_addr_list *list)
{
	struct netdev_hw_addr *ha;
	int err;
3569
	u32 portid, seq;
3570

3571
	portid = NETLINK_CB(cb->skb).portid;
3572 3573 3574
	seq = cb->nlh->nlmsg_seq;

	list_for_each_entry(ha, &list->list, list) {
3575
		if (*idx < cb->args[2])
3576 3577
			goto skip;

3578
		err = nlmsg_populate_fdb_fill(skb, dev, ha->addr, 0,
3579
					      portid, seq,
3580
					      RTM_NEWNEIGH, NTF_SELF,
3581
					      NLM_F_MULTI, NUD_PERMANENT);
3582 3583 3584 3585 3586 3587 3588 3589 3590
		if (err < 0)
			return err;
skip:
		*idx += 1;
	}
	return 0;
}

/**
3591
 * ndo_dflt_fdb_dump - default netdevice operation to dump an FDB table.
3592 3593 3594 3595
 * @nlh: netlink message header
 * @dev: netdevice
 *
 * Default netdevice operation to dump the existing unicast address list.
3596
 * Returns number of addresses from list put in skb.
3597 3598 3599 3600
 */
int ndo_dflt_fdb_dump(struct sk_buff *skb,
		      struct netlink_callback *cb,
		      struct net_device *dev,
3601
		      struct net_device *filter_dev,
3602
		      int *idx)
3603 3604 3605 3606
{
	int err;

	netif_addr_lock_bh(dev);
3607
	err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->uc);
3608 3609
	if (err)
		goto out;
3610
	err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->mc);
3611 3612
out:
	netif_addr_unlock_bh(dev);
3613
	return err;
3614 3615 3616
}
EXPORT_SYMBOL(ndo_dflt_fdb_dump);

3617 3618 3619
static int rtnl_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
	struct net_device *dev;
3620 3621 3622 3623 3624 3625
	struct nlattr *tb[IFLA_MAX+1];
	struct net_device *br_dev = NULL;
	const struct net_device_ops *ops = NULL;
	const struct net_device_ops *cops = NULL;
	struct ifinfomsg *ifm = nlmsg_data(cb->nlh);
	struct net *net = sock_net(skb->sk);
3626
	struct hlist_head *head;
3627 3628
	int brport_idx = 0;
	int br_idx = 0;
3629 3630 3631 3632
	int h, s_h;
	int idx = 0, s_idx;
	int err = 0;
	int fidx = 0;
3633

3634 3635 3636 3637 3638
	err = nlmsg_parse(cb->nlh, sizeof(struct ifinfomsg), tb,
			  IFLA_MAX, ifla_policy, NULL);
	if (err < 0) {
		return -EINVAL;
	} else if (err == 0) {
3639 3640 3641 3642 3643 3644 3645 3646 3647 3648 3649 3650 3651 3652
		if (tb[IFLA_MASTER])
			br_idx = nla_get_u32(tb[IFLA_MASTER]);
	}

	brport_idx = ifm->ifi_index;

	if (br_idx) {
		br_dev = __dev_get_by_index(net, br_idx);
		if (!br_dev)
			return -ENODEV;

		ops = br_dev->netdev_ops;
	}

3653 3654
	s_h = cb->args[0];
	s_idx = cb->args[1];
3655

3656 3657 3658 3659
	for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
		idx = 0;
		head = &net->dev_index_head[h];
		hlist_for_each_entry(dev, head, index_hlist) {
3660

3661
			if (brport_idx && (dev->ifindex != brport_idx))
3662 3663
				continue;

3664 3665 3666 3667 3668 3669 3670 3671 3672
			if (!br_idx) { /* user did not specify a specific bridge */
				if (dev->priv_flags & IFF_BRIDGE_PORT) {
					br_dev = netdev_master_upper_dev_get(dev);
					cops = br_dev->netdev_ops;
				}
			} else {
				if (dev != br_dev &&
				    !(dev->priv_flags & IFF_BRIDGE_PORT))
					continue;
3673

3674 3675 3676 3677 3678
				if (br_dev != netdev_master_upper_dev_get(dev) &&
				    !(dev->priv_flags & IFF_EBRIDGE))
					continue;
				cops = ops;
			}
3679

3680 3681
			if (idx < s_idx)
				goto cont;
3682

3683 3684 3685 3686 3687 3688 3689 3690 3691
			if (dev->priv_flags & IFF_BRIDGE_PORT) {
				if (cops && cops->ndo_fdb_dump) {
					err = cops->ndo_fdb_dump(skb, cb,
								br_dev, dev,
								&fidx);
					if (err == -EMSGSIZE)
						goto out;
				}
			}
3692

3693 3694 3695 3696 3697 3698 3699 3700 3701 3702 3703 3704 3705 3706 3707 3708 3709 3710
			if (dev->netdev_ops->ndo_fdb_dump)
				err = dev->netdev_ops->ndo_fdb_dump(skb, cb,
								    dev, NULL,
								    &fidx);
			else
				err = ndo_dflt_fdb_dump(skb, cb, dev, NULL,
							&fidx);
			if (err == -EMSGSIZE)
				goto out;

			cops = NULL;

			/* reset fdb offset to 0 for rest of the interfaces */
			cb->args[2] = 0;
			fidx = 0;
cont:
			idx++;
		}
3711 3712
	}

3713 3714 3715 3716 3717
out:
	cb->args[0] = h;
	cb->args[1] = idx;
	cb->args[2] = fidx;

3718 3719 3720
	return skb->len;
}

3721 3722 3723 3724 3725 3726 3727 3728
static int brport_nla_put_flag(struct sk_buff *skb, u32 flags, u32 mask,
			       unsigned int attrnum, unsigned int flag)
{
	if (mask & flag)
		return nla_put_u8(skb, attrnum, !!(flags & flag));
	return 0;
}

3729
int ndo_dflt_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq,
3730
			    struct net_device *dev, u16 mode,
3731 3732 3733 3734 3735
			    u32 flags, u32 mask, int nlflags,
			    u32 filter_mask,
			    int (*vlan_fill)(struct sk_buff *skb,
					     struct net_device *dev,
					     u32 filter_mask))
3736 3737 3738 3739
{
	struct nlmsghdr *nlh;
	struct ifinfomsg *ifm;
	struct nlattr *br_afspec;
3740
	struct nlattr *protinfo;
3741
	u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN;
3742
	struct net_device *br_dev = netdev_master_upper_dev_get(dev);
3743
	int err = 0;
3744

3745
	nlh = nlmsg_put(skb, pid, seq, RTM_NEWLINK, sizeof(*ifm), nlflags);
3746 3747 3748 3749 3750 3751 3752 3753 3754 3755 3756 3757 3758 3759 3760
	if (nlh == NULL)
		return -EMSGSIZE;

	ifm = nlmsg_data(nlh);
	ifm->ifi_family = AF_BRIDGE;
	ifm->__ifi_pad = 0;
	ifm->ifi_type = dev->type;
	ifm->ifi_index = dev->ifindex;
	ifm->ifi_flags = dev_get_flags(dev);
	ifm->ifi_change = 0;


	if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
	    nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
	    nla_put_u8(skb, IFLA_OPERSTATE, operstate) ||
3761 3762
	    (br_dev &&
	     nla_put_u32(skb, IFLA_MASTER, br_dev->ifindex)) ||
3763 3764
	    (dev->addr_len &&
	     nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) ||
3765 3766
	    (dev->ifindex != dev_get_iflink(dev) &&
	     nla_put_u32(skb, IFLA_LINK, dev_get_iflink(dev))))
3767 3768 3769 3770 3771 3772
		goto nla_put_failure;

	br_afspec = nla_nest_start(skb, IFLA_AF_SPEC);
	if (!br_afspec)
		goto nla_put_failure;

R
Roopa Prabhu 已提交
3773
	if (nla_put_u16(skb, IFLA_BRIDGE_FLAGS, BRIDGE_FLAGS_SELF)) {
3774 3775 3776
		nla_nest_cancel(skb, br_afspec);
		goto nla_put_failure;
	}
R
Roopa Prabhu 已提交
3777 3778 3779 3780 3781 3782 3783

	if (mode != BRIDGE_MODE_UNDEF) {
		if (nla_put_u16(skb, IFLA_BRIDGE_MODE, mode)) {
			nla_nest_cancel(skb, br_afspec);
			goto nla_put_failure;
		}
	}
3784 3785 3786 3787 3788 3789 3790
	if (vlan_fill) {
		err = vlan_fill(skb, dev, filter_mask);
		if (err) {
			nla_nest_cancel(skb, br_afspec);
			goto nla_put_failure;
		}
	}
3791 3792
	nla_nest_end(skb, br_afspec);

3793 3794 3795 3796 3797 3798 3799 3800 3801 3802 3803 3804 3805 3806 3807 3808 3809 3810 3811 3812 3813 3814 3815 3816 3817 3818 3819
	protinfo = nla_nest_start(skb, IFLA_PROTINFO | NLA_F_NESTED);
	if (!protinfo)
		goto nla_put_failure;

	if (brport_nla_put_flag(skb, flags, mask,
				IFLA_BRPORT_MODE, BR_HAIRPIN_MODE) ||
	    brport_nla_put_flag(skb, flags, mask,
				IFLA_BRPORT_GUARD, BR_BPDU_GUARD) ||
	    brport_nla_put_flag(skb, flags, mask,
				IFLA_BRPORT_FAST_LEAVE,
				BR_MULTICAST_FAST_LEAVE) ||
	    brport_nla_put_flag(skb, flags, mask,
				IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK) ||
	    brport_nla_put_flag(skb, flags, mask,
				IFLA_BRPORT_LEARNING, BR_LEARNING) ||
	    brport_nla_put_flag(skb, flags, mask,
				IFLA_BRPORT_LEARNING_SYNC, BR_LEARNING_SYNC) ||
	    brport_nla_put_flag(skb, flags, mask,
				IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD) ||
	    brport_nla_put_flag(skb, flags, mask,
				IFLA_BRPORT_PROXYARP, BR_PROXYARP)) {
		nla_nest_cancel(skb, protinfo);
		goto nla_put_failure;
	}

	nla_nest_end(skb, protinfo);

3820 3821
	nlmsg_end(skb, nlh);
	return 0;
3822 3823
nla_put_failure:
	nlmsg_cancel(skb, nlh);
3824
	return err ? err : -EMSGSIZE;
3825
}
3826
EXPORT_SYMBOL_GPL(ndo_dflt_bridge_getlink);
3827

J
John Fastabend 已提交
3828 3829 3830 3831 3832 3833 3834
static int rtnl_bridge_getlink(struct sk_buff *skb, struct netlink_callback *cb)
{
	struct net *net = sock_net(skb->sk);
	struct net_device *dev;
	int idx = 0;
	u32 portid = NETLINK_CB(cb->skb).portid;
	u32 seq = cb->nlh->nlmsg_seq;
3835
	u32 filter_mask = 0;
3836
	int err;
3837

3838 3839 3840 3841 3842 3843 3844 3845 3846 3847 3848 3849
	if (nlmsg_len(cb->nlh) > sizeof(struct ifinfomsg)) {
		struct nlattr *extfilt;

		extfilt = nlmsg_find_attr(cb->nlh, sizeof(struct ifinfomsg),
					  IFLA_EXT_MASK);
		if (extfilt) {
			if (nla_len(extfilt) < sizeof(filter_mask))
				return -EINVAL;

			filter_mask = nla_get_u32(extfilt);
		}
	}
J
John Fastabend 已提交
3850 3851 3852 3853

	rcu_read_lock();
	for_each_netdev_rcu(net, dev) {
		const struct net_device_ops *ops = dev->netdev_ops;
3854
		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
J
John Fastabend 已提交
3855

3856
		if (br_dev && br_dev->netdev_ops->ndo_bridge_getlink) {
3857 3858 3859 3860
			if (idx >= cb->args[0]) {
				err = br_dev->netdev_ops->ndo_bridge_getlink(
						skb, portid, seq, dev,
						filter_mask, NLM_F_MULTI);
3861 3862 3863 3864 3865 3866
				if (err < 0 && err != -EOPNOTSUPP) {
					if (likely(skb->len))
						break;

					goto out_err;
				}
3867
			}
3868
			idx++;
J
John Fastabend 已提交
3869 3870 3871
		}

		if (ops->ndo_bridge_getlink) {
3872 3873 3874 3875 3876
			if (idx >= cb->args[0]) {
				err = ops->ndo_bridge_getlink(skb, portid,
							      seq, dev,
							      filter_mask,
							      NLM_F_MULTI);
3877 3878 3879 3880 3881 3882
				if (err < 0 && err != -EOPNOTSUPP) {
					if (likely(skb->len))
						break;

					goto out_err;
				}
3883
			}
3884
			idx++;
J
John Fastabend 已提交
3885 3886
		}
	}
3887 3888
	err = skb->len;
out_err:
J
John Fastabend 已提交
3889 3890 3891
	rcu_read_unlock();
	cb->args[0] = idx;

3892
	return err;
J
John Fastabend 已提交
3893 3894
}

3895 3896 3897 3898 3899 3900 3901 3902 3903 3904 3905 3906 3907 3908 3909
static inline size_t bridge_nlmsg_size(void)
{
	return NLMSG_ALIGN(sizeof(struct ifinfomsg))
		+ nla_total_size(IFNAMSIZ)	/* IFLA_IFNAME */
		+ nla_total_size(MAX_ADDR_LEN)	/* IFLA_ADDRESS */
		+ nla_total_size(sizeof(u32))	/* IFLA_MASTER */
		+ nla_total_size(sizeof(u32))	/* IFLA_MTU */
		+ nla_total_size(sizeof(u32))	/* IFLA_LINK */
		+ nla_total_size(sizeof(u32))	/* IFLA_OPERSTATE */
		+ nla_total_size(sizeof(u8))	/* IFLA_PROTINFO */
		+ nla_total_size(sizeof(struct nlattr))	/* IFLA_AF_SPEC */
		+ nla_total_size(sizeof(u16))	/* IFLA_BRIDGE_FLAGS */
		+ nla_total_size(sizeof(u16));	/* IFLA_BRIDGE_MODE */
}

3910
static int rtnl_bridge_notify(struct net_device *dev)
3911 3912 3913 3914 3915
{
	struct net *net = dev_net(dev);
	struct sk_buff *skb;
	int err = -EOPNOTSUPP;

3916 3917 3918
	if (!dev->netdev_ops->ndo_bridge_getlink)
		return 0;

3919 3920 3921 3922 3923 3924
	skb = nlmsg_new(bridge_nlmsg_size(), GFP_ATOMIC);
	if (!skb) {
		err = -ENOMEM;
		goto errout;
	}

3925
	err = dev->netdev_ops->ndo_bridge_getlink(skb, 0, 0, dev, 0, 0);
3926 3927
	if (err < 0)
		goto errout;
3928

3929 3930 3931
	if (!skb->len)
		goto errout;

3932 3933 3934 3935 3936
	rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC);
	return 0;
errout:
	WARN_ON(err == -EMSGSIZE);
	kfree_skb(skb);
3937 3938
	if (err)
		rtnl_set_sk_err(net, RTNLGRP_LINK, err);
3939 3940 3941
	return err;
}

3942 3943
static int rtnl_bridge_setlink(struct sk_buff *skb, struct nlmsghdr *nlh,
			       struct netlink_ext_ack *extack)
J
John Fastabend 已提交
3944 3945 3946 3947
{
	struct net *net = sock_net(skb->sk);
	struct ifinfomsg *ifm;
	struct net_device *dev;
3948 3949
	struct nlattr *br_spec, *attr = NULL;
	int rem, err = -EOPNOTSUPP;
3950
	u16 flags = 0;
3951
	bool have_flags = false;
J
John Fastabend 已提交
3952 3953 3954 3955 3956 3957 3958 3959 3960 3961

	if (nlmsg_len(nlh) < sizeof(*ifm))
		return -EINVAL;

	ifm = nlmsg_data(nlh);
	if (ifm->ifi_family != AF_BRIDGE)
		return -EPFNOSUPPORT;

	dev = __dev_get_by_index(net, ifm->ifi_index);
	if (!dev) {
3962
		NL_SET_ERR_MSG(extack, "unknown ifindex");
J
John Fastabend 已提交
3963 3964 3965
		return -ENODEV;
	}

3966 3967 3968 3969
	br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
	if (br_spec) {
		nla_for_each_nested(attr, br_spec, rem) {
			if (nla_type(attr) == IFLA_BRIDGE_FLAGS) {
3970 3971 3972
				if (nla_len(attr) < sizeof(flags))
					return -EINVAL;

3973
				have_flags = true;
3974 3975 3976 3977 3978 3979 3980
				flags = nla_get_u16(attr);
				break;
			}
		}
	}

	if (!flags || (flags & BRIDGE_FLAGS_MASTER)) {
3981 3982 3983
		struct net_device *br_dev = netdev_master_upper_dev_get(dev);

		if (!br_dev || !br_dev->netdev_ops->ndo_bridge_setlink) {
3984 3985 3986 3987
			err = -EOPNOTSUPP;
			goto out;
		}

3988
		err = br_dev->netdev_ops->ndo_bridge_setlink(dev, nlh, flags);
J
John Fastabend 已提交
3989 3990
		if (err)
			goto out;
3991 3992

		flags &= ~BRIDGE_FLAGS_MASTER;
J
John Fastabend 已提交
3993 3994
	}

3995 3996 3997 3998
	if ((flags & BRIDGE_FLAGS_SELF)) {
		if (!dev->netdev_ops->ndo_bridge_setlink)
			err = -EOPNOTSUPP;
		else
3999 4000
			err = dev->netdev_ops->ndo_bridge_setlink(dev, nlh,
								  flags);
4001
		if (!err) {
4002
			flags &= ~BRIDGE_FLAGS_SELF;
4003 4004 4005 4006 4007 4008

			/* Generate event to notify upper layer of bridge
			 * change
			 */
			err = rtnl_bridge_notify(dev);
		}
4009
	}
J
John Fastabend 已提交
4010

4011
	if (have_flags)
4012
		memcpy(nla_data(attr), &flags, sizeof(flags));
J
John Fastabend 已提交
4013 4014 4015 4016
out:
	return err;
}

4017 4018
static int rtnl_bridge_dellink(struct sk_buff *skb, struct nlmsghdr *nlh,
			       struct netlink_ext_ack *extack)
4019 4020 4021 4022 4023 4024
{
	struct net *net = sock_net(skb->sk);
	struct ifinfomsg *ifm;
	struct net_device *dev;
	struct nlattr *br_spec, *attr = NULL;
	int rem, err = -EOPNOTSUPP;
4025
	u16 flags = 0;
4026 4027 4028 4029 4030 4031 4032 4033 4034 4035 4036
	bool have_flags = false;

	if (nlmsg_len(nlh) < sizeof(*ifm))
		return -EINVAL;

	ifm = nlmsg_data(nlh);
	if (ifm->ifi_family != AF_BRIDGE)
		return -EPFNOSUPPORT;

	dev = __dev_get_by_index(net, ifm->ifi_index);
	if (!dev) {
4037
		NL_SET_ERR_MSG(extack, "unknown ifindex");
4038 4039 4040 4041 4042 4043 4044
		return -ENODEV;
	}

	br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
	if (br_spec) {
		nla_for_each_nested(attr, br_spec, rem) {
			if (nla_type(attr) == IFLA_BRIDGE_FLAGS) {
4045 4046 4047
				if (nla_len(attr) < sizeof(flags))
					return -EINVAL;

4048 4049 4050 4051 4052 4053 4054 4055 4056 4057 4058 4059 4060 4061 4062
				have_flags = true;
				flags = nla_get_u16(attr);
				break;
			}
		}
	}

	if (!flags || (flags & BRIDGE_FLAGS_MASTER)) {
		struct net_device *br_dev = netdev_master_upper_dev_get(dev);

		if (!br_dev || !br_dev->netdev_ops->ndo_bridge_dellink) {
			err = -EOPNOTSUPP;
			goto out;
		}

4063
		err = br_dev->netdev_ops->ndo_bridge_dellink(dev, nlh, flags);
4064 4065 4066 4067 4068 4069 4070 4071 4072 4073
		if (err)
			goto out;

		flags &= ~BRIDGE_FLAGS_MASTER;
	}

	if ((flags & BRIDGE_FLAGS_SELF)) {
		if (!dev->netdev_ops->ndo_bridge_dellink)
			err = -EOPNOTSUPP;
		else
4074 4075
			err = dev->netdev_ops->ndo_bridge_dellink(dev, nlh,
								  flags);
4076

4077
		if (!err) {
4078
			flags &= ~BRIDGE_FLAGS_SELF;
4079 4080 4081 4082 4083 4084

			/* Generate event to notify upper layer of bridge
			 * change
			 */
			err = rtnl_bridge_notify(dev);
		}
4085 4086 4087 4088 4089 4090 4091 4092
	}

	if (have_flags)
		memcpy(nla_data(attr), &flags, sizeof(flags));
out:
	return err;
}

4093 4094 4095 4096 4097 4098
static bool stats_attr_valid(unsigned int mask, int attrid, int idxattr)
{
	return (mask & IFLA_STATS_FILTER_BIT(attrid)) &&
	       (!idxattr || idxattr == attrid);
}

4099 4100 4101 4102 4103 4104 4105 4106 4107 4108 4109 4110 4111 4112 4113 4114 4115 4116 4117 4118 4119 4120 4121 4122 4123 4124 4125 4126 4127 4128 4129 4130
#define IFLA_OFFLOAD_XSTATS_FIRST (IFLA_OFFLOAD_XSTATS_UNSPEC + 1)
static int rtnl_get_offload_stats_attr_size(int attr_id)
{
	switch (attr_id) {
	case IFLA_OFFLOAD_XSTATS_CPU_HIT:
		return sizeof(struct rtnl_link_stats64);
	}

	return 0;
}

static int rtnl_get_offload_stats(struct sk_buff *skb, struct net_device *dev,
				  int *prividx)
{
	struct nlattr *attr = NULL;
	int attr_id, size;
	void *attr_data;
	int err;

	if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats &&
	      dev->netdev_ops->ndo_get_offload_stats))
		return -ENODATA;

	for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST;
	     attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) {
		if (attr_id < *prividx)
			continue;

		size = rtnl_get_offload_stats_attr_size(attr_id);
		if (!size)
			continue;

4131
		if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id))
4132 4133 4134 4135 4136 4137 4138 4139 4140 4141 4142 4143 4144 4145 4146 4147 4148 4149 4150 4151 4152 4153 4154 4155 4156 4157 4158 4159 4160 4161 4162 4163 4164 4165 4166 4167 4168 4169 4170 4171
			continue;

		attr = nla_reserve_64bit(skb, attr_id, size,
					 IFLA_OFFLOAD_XSTATS_UNSPEC);
		if (!attr)
			goto nla_put_failure;

		attr_data = nla_data(attr);
		memset(attr_data, 0, size);
		err = dev->netdev_ops->ndo_get_offload_stats(attr_id, dev,
							     attr_data);
		if (err)
			goto get_offload_stats_failure;
	}

	if (!attr)
		return -ENODATA;

	*prividx = 0;
	return 0;

nla_put_failure:
	err = -EMSGSIZE;
get_offload_stats_failure:
	*prividx = attr_id;
	return err;
}

static int rtnl_get_offload_stats_size(const struct net_device *dev)
{
	int nla_size = 0;
	int attr_id;
	int size;

	if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats &&
	      dev->netdev_ops->ndo_get_offload_stats))
		return 0;

	for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST;
	     attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) {
4172
		if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id))
4173 4174 4175 4176 4177 4178 4179 4180 4181 4182 4183
			continue;
		size = rtnl_get_offload_stats_attr_size(attr_id);
		nla_size += nla_total_size_64bit(size);
	}

	if (nla_size != 0)
		nla_size += nla_total_size(0);

	return nla_size;
}

4184 4185
static int rtnl_fill_statsinfo(struct sk_buff *skb, struct net_device *dev,
			       int type, u32 pid, u32 seq, u32 change,
4186 4187
			       unsigned int flags, unsigned int filter_mask,
			       int *idxattr, int *prividx)
4188 4189 4190 4191
{
	struct if_stats_msg *ifsm;
	struct nlmsghdr *nlh;
	struct nlattr *attr;
4192
	int s_prividx = *prividx;
4193
	int err;
4194 4195 4196 4197 4198 4199 4200 4201

	ASSERT_RTNL();

	nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifsm), flags);
	if (!nlh)
		return -EMSGSIZE;

	ifsm = nlmsg_data(nlh);
4202 4203 4204
	ifsm->family = PF_UNSPEC;
	ifsm->pad1 = 0;
	ifsm->pad2 = 0;
4205 4206 4207
	ifsm->ifindex = dev->ifindex;
	ifsm->filter_mask = filter_mask;

4208
	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, *idxattr)) {
4209 4210
		struct rtnl_link_stats64 *sp;

4211 4212 4213
		attr = nla_reserve_64bit(skb, IFLA_STATS_LINK_64,
					 sizeof(struct rtnl_link_stats64),
					 IFLA_STATS_UNSPEC);
4214 4215 4216 4217 4218 4219 4220
		if (!attr)
			goto nla_put_failure;

		sp = nla_data(attr);
		dev_get_stats(dev, sp);
	}

4221 4222 4223 4224 4225 4226 4227 4228 4229 4230
	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, *idxattr)) {
		const struct rtnl_link_ops *ops = dev->rtnl_link_ops;

		if (ops && ops->fill_linkxstats) {
			*idxattr = IFLA_STATS_LINK_XSTATS;
			attr = nla_nest_start(skb,
					      IFLA_STATS_LINK_XSTATS);
			if (!attr)
				goto nla_put_failure;

4231 4232 4233 4234 4235 4236 4237 4238 4239 4240 4241 4242 4243 4244 4245 4246 4247 4248 4249 4250 4251 4252 4253 4254
			err = ops->fill_linkxstats(skb, dev, prividx, *idxattr);
			nla_nest_end(skb, attr);
			if (err)
				goto nla_put_failure;
			*idxattr = 0;
		}
	}

	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE,
			     *idxattr)) {
		const struct rtnl_link_ops *ops = NULL;
		const struct net_device *master;

		master = netdev_master_upper_dev_get(dev);
		if (master)
			ops = master->rtnl_link_ops;
		if (ops && ops->fill_linkxstats) {
			*idxattr = IFLA_STATS_LINK_XSTATS_SLAVE;
			attr = nla_nest_start(skb,
					      IFLA_STATS_LINK_XSTATS_SLAVE);
			if (!attr)
				goto nla_put_failure;

			err = ops->fill_linkxstats(skb, dev, prividx, *idxattr);
4255 4256 4257 4258 4259 4260 4261
			nla_nest_end(skb, attr);
			if (err)
				goto nla_put_failure;
			*idxattr = 0;
		}
	}

4262 4263 4264 4265 4266 4267 4268 4269 4270 4271 4272 4273 4274 4275 4276 4277 4278 4279
	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS,
			     *idxattr)) {
		*idxattr = IFLA_STATS_LINK_OFFLOAD_XSTATS;
		attr = nla_nest_start(skb, IFLA_STATS_LINK_OFFLOAD_XSTATS);
		if (!attr)
			goto nla_put_failure;

		err = rtnl_get_offload_stats(skb, dev, prividx);
		if (err == -ENODATA)
			nla_nest_cancel(skb, attr);
		else
			nla_nest_end(skb, attr);

		if (err && err != -ENODATA)
			goto nla_put_failure;
		*idxattr = 0;
	}

4280 4281 4282 4283 4284 4285 4286 4287
	if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, *idxattr)) {
		struct rtnl_af_ops *af_ops;

		*idxattr = IFLA_STATS_AF_SPEC;
		attr = nla_nest_start(skb, IFLA_STATS_AF_SPEC);
		if (!attr)
			goto nla_put_failure;

F
Florian Westphal 已提交
4288 4289
		rcu_read_lock();
		list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
4290 4291 4292 4293 4294
			if (af_ops->fill_stats_af) {
				struct nlattr *af;
				int err;

				af = nla_nest_start(skb, af_ops->family);
F
Florian Westphal 已提交
4295 4296
				if (!af) {
					rcu_read_unlock();
4297
					goto nla_put_failure;
F
Florian Westphal 已提交
4298
				}
4299 4300
				err = af_ops->fill_stats_af(skb, dev);

F
Florian Westphal 已提交
4301
				if (err == -ENODATA) {
4302
					nla_nest_cancel(skb, af);
F
Florian Westphal 已提交
4303 4304
				} else if (err < 0) {
					rcu_read_unlock();
4305
					goto nla_put_failure;
F
Florian Westphal 已提交
4306
				}
4307 4308 4309 4310

				nla_nest_end(skb, af);
			}
		}
F
Florian Westphal 已提交
4311
		rcu_read_unlock();
4312 4313 4314 4315 4316 4317

		nla_nest_end(skb, attr);

		*idxattr = 0;
	}

4318 4319 4320 4321 4322
	nlmsg_end(skb, nlh);

	return 0;

nla_put_failure:
4323 4324 4325 4326 4327
	/* not a multi message or no progress mean a real error */
	if (!(flags & NLM_F_MULTI) || s_prividx == *prividx)
		nlmsg_cancel(skb, nlh);
	else
		nlmsg_end(skb, nlh);
4328 4329 4330 4331 4332 4333 4334 4335 4336

	return -EMSGSIZE;
}

static size_t if_nlmsg_stats_size(const struct net_device *dev,
				  u32 filter_mask)
{
	size_t size = 0;

4337
	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, 0))
4338 4339
		size += nla_total_size_64bit(sizeof(struct rtnl_link_stats64));

4340 4341
	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, 0)) {
		const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
4342
		int attr = IFLA_STATS_LINK_XSTATS;
4343 4344

		if (ops && ops->get_linkxstats_size) {
4345 4346
			size += nla_total_size(ops->get_linkxstats_size(dev,
									attr));
4347 4348 4349 4350 4351
			/* for IFLA_STATS_LINK_XSTATS */
			size += nla_total_size(0);
		}
	}

4352 4353 4354 4355 4356 4357 4358 4359 4360 4361 4362 4363 4364 4365 4366 4367 4368 4369 4370
	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 0)) {
		struct net_device *_dev = (struct net_device *)dev;
		const struct rtnl_link_ops *ops = NULL;
		const struct net_device *master;

		/* netdev_master_upper_dev_get can't take const */
		master = netdev_master_upper_dev_get(_dev);
		if (master)
			ops = master->rtnl_link_ops;
		if (ops && ops->get_linkxstats_size) {
			int attr = IFLA_STATS_LINK_XSTATS_SLAVE;

			size += nla_total_size(ops->get_linkxstats_size(dev,
									attr));
			/* for IFLA_STATS_LINK_XSTATS_SLAVE */
			size += nla_total_size(0);
		}
	}

4371 4372 4373
	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 0))
		size += rtnl_get_offload_stats_size(dev);

4374 4375 4376 4377 4378 4379
	if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, 0)) {
		struct rtnl_af_ops *af_ops;

		/* for IFLA_STATS_AF_SPEC */
		size += nla_total_size(0);

F
Florian Westphal 已提交
4380 4381
		rcu_read_lock();
		list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
4382 4383 4384 4385 4386 4387 4388 4389
			if (af_ops->get_stats_af_size) {
				size += nla_total_size(
					af_ops->get_stats_af_size(dev));

				/* for AF_* */
				size += nla_total_size(0);
			}
		}
F
Florian Westphal 已提交
4390
		rcu_read_unlock();
4391 4392
	}

4393 4394 4395
	return size;
}

4396 4397
static int rtnl_stats_get(struct sk_buff *skb, struct nlmsghdr *nlh,
			  struct netlink_ext_ack *extack)
4398 4399 4400
{
	struct net *net = sock_net(skb->sk);
	struct net_device *dev = NULL;
4401 4402
	int idxattr = 0, prividx = 0;
	struct if_stats_msg *ifsm;
4403 4404 4405 4406
	struct sk_buff *nskb;
	u32 filter_mask;
	int err;

4407 4408 4409
	if (nlmsg_len(nlh) < sizeof(*ifsm))
		return -EINVAL;

4410 4411 4412 4413 4414 4415 4416 4417 4418 4419 4420 4421 4422 4423 4424 4425 4426 4427 4428
	ifsm = nlmsg_data(nlh);
	if (ifsm->ifindex > 0)
		dev = __dev_get_by_index(net, ifsm->ifindex);
	else
		return -EINVAL;

	if (!dev)
		return -ENODEV;

	filter_mask = ifsm->filter_mask;
	if (!filter_mask)
		return -EINVAL;

	nskb = nlmsg_new(if_nlmsg_stats_size(dev, filter_mask), GFP_KERNEL);
	if (!nskb)
		return -ENOBUFS;

	err = rtnl_fill_statsinfo(nskb, dev, RTM_NEWSTATS,
				  NETLINK_CB(skb).portid, nlh->nlmsg_seq, 0,
4429
				  0, filter_mask, &idxattr, &prividx);
4430 4431 4432 4433 4434 4435 4436 4437 4438 4439 4440 4441 4442
	if (err < 0) {
		/* -EMSGSIZE implies BUG in if_nlmsg_stats_size */
		WARN_ON(err == -EMSGSIZE);
		kfree_skb(nskb);
	} else {
		err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid);
	}

	return err;
}

static int rtnl_stats_dump(struct sk_buff *skb, struct netlink_callback *cb)
{
4443
	int h, s_h, err, s_idx, s_idxattr, s_prividx;
4444
	struct net *net = sock_net(skb->sk);
4445
	unsigned int flags = NLM_F_MULTI;
4446 4447
	struct if_stats_msg *ifsm;
	struct hlist_head *head;
4448
	struct net_device *dev;
4449
	u32 filter_mask = 0;
4450
	int idx = 0;
4451 4452 4453

	s_h = cb->args[0];
	s_idx = cb->args[1];
4454 4455
	s_idxattr = cb->args[2];
	s_prividx = cb->args[3];
4456 4457 4458

	cb->seq = net->dev_base_seq;

4459 4460 4461
	if (nlmsg_len(cb->nlh) < sizeof(*ifsm))
		return -EINVAL;

4462 4463 4464 4465 4466 4467 4468 4469 4470 4471 4472 4473 4474 4475
	ifsm = nlmsg_data(cb->nlh);
	filter_mask = ifsm->filter_mask;
	if (!filter_mask)
		return -EINVAL;

	for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
		idx = 0;
		head = &net->dev_index_head[h];
		hlist_for_each_entry(dev, head, index_hlist) {
			if (idx < s_idx)
				goto cont;
			err = rtnl_fill_statsinfo(skb, dev, RTM_NEWSTATS,
						  NETLINK_CB(cb->skb).portid,
						  cb->nlh->nlmsg_seq, 0,
4476 4477
						  flags, filter_mask,
						  &s_idxattr, &s_prividx);
4478 4479 4480 4481 4482 4483 4484
			/* If we ran out of room on the first message,
			 * we're in trouble
			 */
			WARN_ON((err == -EMSGSIZE) && (skb->len == 0));

			if (err < 0)
				goto out;
4485 4486
			s_prividx = 0;
			s_idxattr = 0;
4487 4488 4489 4490 4491 4492
			nl_dump_check_consistent(cb, nlmsg_hdr(skb));
cont:
			idx++;
		}
	}
out:
4493 4494
	cb->args[3] = s_prividx;
	cb->args[2] = s_idxattr;
4495 4496 4497 4498 4499 4500
	cb->args[1] = idx;
	cb->args[0] = h;

	return skb->len;
}

L
Linus Torvalds 已提交
4501 4502
/* Process one rtnetlink message. */

J
Johannes Berg 已提交
4503 4504
static int rtnetlink_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh,
			     struct netlink_ext_ack *extack)
L
Linus Torvalds 已提交
4505
{
4506
	struct net *net = sock_net(skb->sk);
4507
	struct rtnl_link *link;
4508
	struct module *owner;
4509
	int err = -EOPNOTSUPP;
4510
	rtnl_doit_func doit;
4511
	unsigned int flags;
4512
	int kind;
L
Linus Torvalds 已提交
4513 4514 4515 4516 4517
	int family;
	int type;

	type = nlh->nlmsg_type;
	if (type > RTM_MAX)
4518
		return -EOPNOTSUPP;
L
Linus Torvalds 已提交
4519 4520 4521 4522

	type -= RTM_BASE;

	/* All the messages must have at least 1 byte length */
4523
	if (nlmsg_len(nlh) < sizeof(struct rtgenmsg))
L
Linus Torvalds 已提交
4524 4525
		return 0;

4526
	family = ((struct rtgenmsg *)nlmsg_data(nlh))->rtgen_family;
L
Linus Torvalds 已提交
4527 4528
	kind = type&3;

4529
	if (kind != 2 && !netlink_net_capable(skb, CAP_NET_ADMIN))
4530
		return -EPERM;
L
Linus Torvalds 已提交
4531

4532
	rcu_read_lock();
4533
	if (kind == 2 && nlh->nlmsg_flags&NLM_F_DUMP) {
4534
		struct sock *rtnl;
4535
		rtnl_dumpit_func dumpit;
4536
		u16 min_dump_alloc = 0;
L
Linus Torvalds 已提交
4537

4538 4539
		link = rtnl_get_link(family, type);
		if (!link || !link->dumpit) {
4540
			family = PF_UNSPEC;
4541 4542
			link = rtnl_get_link(family, type);
			if (!link || !link->dumpit)
4543 4544
				goto err_unlock;
		}
4545
		owner = link->owner;
4546
		dumpit = link->dumpit;
4547

4548
		if (type == RTM_GETLINK - RTM_BASE)
4549
			min_dump_alloc = rtnl_calcit(skb, nlh);
4550

4551 4552 4553 4554 4555
		err = 0;
		/* need to do this before rcu_read_unlock() */
		if (!try_module_get(owner))
			err = -EPROTONOSUPPORT;

4556 4557
		rcu_read_unlock();

4558
		rtnl = net->rtnl;
4559
		if (err == 0) {
4560 4561 4562
			struct netlink_dump_control c = {
				.dump		= dumpit,
				.min_dump_alloc	= min_dump_alloc,
4563
				.module		= owner,
4564 4565
			};
			err = netlink_dump_start(rtnl, skb, nlh, &c);
4566 4567 4568 4569
			/* netlink_dump_start() will keep a reference on
			 * module if dump is still in progress.
			 */
			module_put(owner);
4570
		}
4571
		return err;
L
Linus Torvalds 已提交
4572 4573
	}

4574 4575
	link = rtnl_get_link(family, type);
	if (!link || !link->doit) {
4576
		family = PF_UNSPEC;
4577 4578 4579
		link = rtnl_get_link(PF_UNSPEC, type);
		if (!link || !link->doit)
			goto out_unlock;
4580 4581
	}

4582 4583 4584 4585 4586 4587
	owner = link->owner;
	if (!try_module_get(owner)) {
		err = -EPROTONOSUPPORT;
		goto out_unlock;
	}

4588
	flags = link->flags;
4589
	if (flags & RTNL_FLAG_DOIT_UNLOCKED) {
4590
		doit = link->doit;
4591 4592 4593
		rcu_read_unlock();
		if (doit)
			err = doit(skb, nlh, extack);
4594
		module_put(owner);
4595 4596
		return err;
	}
4597
	rcu_read_unlock();
L
Linus Torvalds 已提交
4598

4599
	rtnl_lock();
4600 4601 4602
	link = rtnl_get_link(family, type);
	if (link && link->doit)
		err = link->doit(skb, nlh, extack);
4603
	rtnl_unlock();
4604

4605 4606
	module_put(owner);

4607 4608 4609 4610
	return err;

out_unlock:
	rcu_read_unlock();
4611 4612 4613
	return err;

err_unlock:
4614
	rcu_read_unlock();
4615
	return -EOPNOTSUPP;
L
Linus Torvalds 已提交
4616 4617
}

4618
static void rtnetlink_rcv(struct sk_buff *skb)
L
Linus Torvalds 已提交
4619
{
4620
	netlink_rcv_skb(skb, &rtnetlink_rcv_msg);
L
Linus Torvalds 已提交
4621 4622
}

4623 4624 4625 4626 4627 4628 4629 4630 4631 4632 4633 4634
static int rtnetlink_bind(struct net *net, int group)
{
	switch (group) {
	case RTNLGRP_IPV4_MROUTE_R:
	case RTNLGRP_IPV6_MROUTE_R:
		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
			return -EPERM;
		break;
	}
	return 0;
}

L
Linus Torvalds 已提交
4635 4636
static int rtnetlink_event(struct notifier_block *this, unsigned long event, void *ptr)
{
4637
	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
4638

L
Linus Torvalds 已提交
4639
	switch (event) {
4640
	case NETDEV_REBOOT:
4641
	case NETDEV_CHANGEMTU:
4642
	case NETDEV_CHANGEADDR:
4643 4644 4645
	case NETDEV_CHANGENAME:
	case NETDEV_FEAT_CHANGE:
	case NETDEV_BONDING_FAILOVER:
4646
	case NETDEV_POST_TYPE_CHANGE:
4647
	case NETDEV_NOTIFY_PEERS:
4648
	case NETDEV_CHANGEUPPER:
4649 4650
	case NETDEV_RESEND_IGMP:
	case NETDEV_CHANGEINFODATA:
4651
	case NETDEV_CHANGELOWERSTATE:
4652
	case NETDEV_CHANGE_TX_QUEUE_LEN:
4653
		rtmsg_ifinfo_event(RTM_NEWLINK, dev, 0, rtnl_get_event(event),
4654
				   GFP_KERNEL, NULL, 0);
L
Linus Torvalds 已提交
4655 4656 4657 4658 4659 4660 4661 4662 4663 4664 4665
		break;
	default:
		break;
	}
	return NOTIFY_DONE;
}

static struct notifier_block rtnetlink_dev_notifier = {
	.notifier_call	= rtnetlink_event,
};

4666

4667
static int __net_init rtnetlink_net_init(struct net *net)
4668 4669
{
	struct sock *sk;
4670 4671 4672 4673
	struct netlink_kernel_cfg cfg = {
		.groups		= RTNLGRP_MAX,
		.input		= rtnetlink_rcv,
		.cb_mutex	= &rtnl_mutex,
4674
		.flags		= NL_CFG_F_NONROOT_RECV,
4675
		.bind		= rtnetlink_bind,
4676 4677
	};

4678
	sk = netlink_kernel_create(net, NETLINK_ROUTE, &cfg);
4679 4680 4681 4682 4683 4684
	if (!sk)
		return -ENOMEM;
	net->rtnl = sk;
	return 0;
}

4685
static void __net_exit rtnetlink_net_exit(struct net *net)
4686
{
4687 4688
	netlink_kernel_release(net->rtnl);
	net->rtnl = NULL;
4689 4690 4691 4692 4693 4694 4695
}

static struct pernet_operations rtnetlink_net_ops = {
	.init = rtnetlink_net_init,
	.exit = rtnetlink_net_exit,
};

L
Linus Torvalds 已提交
4696 4697
void __init rtnetlink_init(void)
{
4698
	if (register_pernet_subsys(&rtnetlink_net_ops))
L
Linus Torvalds 已提交
4699
		panic("rtnetlink_init: cannot initialize rtnetlink\n");
4700

L
Linus Torvalds 已提交
4701
	register_netdevice_notifier(&rtnetlink_dev_notifier);
4702

4703
	rtnl_register(PF_UNSPEC, RTM_GETLINK, rtnl_getlink,
4704 4705 4706 4707
		      rtnl_dump_ifinfo, 0);
	rtnl_register(PF_UNSPEC, RTM_SETLINK, rtnl_setlink, NULL, 0);
	rtnl_register(PF_UNSPEC, RTM_NEWLINK, rtnl_newlink, NULL, 0);
	rtnl_register(PF_UNSPEC, RTM_DELLINK, rtnl_dellink, NULL, 0);
4708

4709 4710 4711
	rtnl_register(PF_UNSPEC, RTM_GETADDR, NULL, rtnl_dump_all, 0);
	rtnl_register(PF_UNSPEC, RTM_GETROUTE, NULL, rtnl_dump_all, 0);
	rtnl_register(PF_UNSPEC, RTM_GETNETCONF, NULL, rtnl_dump_all, 0);
4712

4713 4714 4715
	rtnl_register(PF_BRIDGE, RTM_NEWNEIGH, rtnl_fdb_add, NULL, 0);
	rtnl_register(PF_BRIDGE, RTM_DELNEIGH, rtnl_fdb_del, NULL, 0);
	rtnl_register(PF_BRIDGE, RTM_GETNEIGH, NULL, rtnl_fdb_dump, 0);
J
John Fastabend 已提交
4716

4717 4718 4719
	rtnl_register(PF_BRIDGE, RTM_GETLINK, NULL, rtnl_bridge_getlink, 0);
	rtnl_register(PF_BRIDGE, RTM_DELLINK, rtnl_bridge_dellink, NULL, 0);
	rtnl_register(PF_BRIDGE, RTM_SETLINK, rtnl_bridge_setlink, NULL, 0);
4720 4721

	rtnl_register(PF_UNSPEC, RTM_GETSTATS, rtnl_stats_get, rtnl_stats_dump,
4722
		      0);
L
Linus Torvalds 已提交
4723
}