xref: /openbmc/linux/net/core/rtnetlink.c (revision b694e3c604e999343258c49e574abd7be012e726)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * INET		An implementation of the TCP/IP protocol suite for the LINUX
4  *		operating system.  INET is implemented using the  BSD Socket
5  *		interface as the means of communication with the user level.
6  *
7  *		Routing netlink socket interface: protocol independent part.
8  *
9  * Authors:	Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
10  *
11  *	Fixes:
12  *	Vitaly E. Lavrov		RTA_OK arithmetic was wrong.
13  */
14 
15 #include <linux/bitops.h>
16 #include <linux/errno.h>
17 #include <linux/module.h>
18 #include <linux/types.h>
19 #include <linux/socket.h>
20 #include <linux/kernel.h>
21 #include <linux/timer.h>
22 #include <linux/string.h>
23 #include <linux/sockios.h>
24 #include <linux/net.h>
25 #include <linux/fcntl.h>
26 #include <linux/mm.h>
27 #include <linux/slab.h>
28 #include <linux/interrupt.h>
29 #include <linux/capability.h>
30 #include <linux/skbuff.h>
31 #include <linux/init.h>
32 #include <linux/security.h>
33 #include <linux/mutex.h>
34 #include <linux/if_addr.h>
35 #include <linux/if_bridge.h>
36 #include <linux/if_vlan.h>
37 #include <linux/pci.h>
38 #include <linux/etherdevice.h>
39 #include <linux/bpf.h>
40 
41 #include <linux/uaccess.h>
42 
43 #include <linux/inet.h>
44 #include <linux/netdevice.h>
45 #include <net/ip.h>
46 #include <net/protocol.h>
47 #include <net/arp.h>
48 #include <net/route.h>
49 #include <net/udp.h>
50 #include <net/tcp.h>
51 #include <net/sock.h>
52 #include <net/pkt_sched.h>
53 #include <net/fib_rules.h>
54 #include <net/rtnetlink.h>
55 #include <net/net_namespace.h>
56 #include <net/devlink.h>
57 #if IS_ENABLED(CONFIG_IPV6)
58 #include <net/addrconf.h>
59 #endif
60 
61 #include "dev.h"
62 
63 #define RTNL_MAX_TYPE		50
64 #define RTNL_SLAVE_MAX_TYPE	44
65 
66 struct rtnl_link {
67 	rtnl_doit_func		doit;
68 	rtnl_dumpit_func	dumpit;
69 	struct module		*owner;
70 	unsigned int		flags;
71 	struct rcu_head		rcu;
72 };
73 
74 static DEFINE_MUTEX(rtnl_mutex);
75 
rtnl_lock(void)76 void rtnl_lock(void)
77 {
78 	mutex_lock(&rtnl_mutex);
79 }
80 EXPORT_SYMBOL(rtnl_lock);
81 
rtnl_lock_killable(void)82 int rtnl_lock_killable(void)
83 {
84 	return mutex_lock_killable(&rtnl_mutex);
85 }
86 EXPORT_SYMBOL(rtnl_lock_killable);
87 
88 static struct sk_buff *defer_kfree_skb_list;
rtnl_kfree_skbs(struct sk_buff * head,struct sk_buff * tail)89 void rtnl_kfree_skbs(struct sk_buff *head, struct sk_buff *tail)
90 {
91 	if (head && tail) {
92 		tail->next = defer_kfree_skb_list;
93 		defer_kfree_skb_list = head;
94 	}
95 }
96 EXPORT_SYMBOL(rtnl_kfree_skbs);
97 
__rtnl_unlock(void)98 void __rtnl_unlock(void)
99 {
100 	struct sk_buff *head = defer_kfree_skb_list;
101 
102 	defer_kfree_skb_list = NULL;
103 
104 	/* Ensure that we didn't actually add any TODO item when __rtnl_unlock()
105 	 * is used. In some places, e.g. in cfg80211, we have code that will do
106 	 * something like
107 	 *   rtnl_lock()
108 	 *   wiphy_lock()
109 	 *   ...
110 	 *   rtnl_unlock()
111 	 *
112 	 * and because netdev_run_todo() acquires the RTNL for items on the list
113 	 * we could cause a situation such as this:
114 	 * Thread 1			Thread 2
115 	 *				  rtnl_lock()
116 	 *				  unregister_netdevice()
117 	 *				  __rtnl_unlock()
118 	 * rtnl_lock()
119 	 * wiphy_lock()
120 	 * rtnl_unlock()
121 	 *   netdev_run_todo()
122 	 *     __rtnl_unlock()
123 	 *
124 	 *     // list not empty now
125 	 *     // because of thread 2
126 	 *				  rtnl_lock()
127 	 *     while (!list_empty(...))
128 	 *       rtnl_lock()
129 	 *				  wiphy_lock()
130 	 * **** DEADLOCK ****
131 	 *
132 	 * However, usage of __rtnl_unlock() is rare, and so we can ensure that
133 	 * it's not used in cases where something is added to do the list.
134 	 */
135 	WARN_ON(!list_empty(&net_todo_list));
136 
137 	mutex_unlock(&rtnl_mutex);
138 
139 	while (head) {
140 		struct sk_buff *next = head->next;
141 
142 		kfree_skb(head);
143 		cond_resched();
144 		head = next;
145 	}
146 }
147 
rtnl_unlock(void)148 void rtnl_unlock(void)
149 {
150 	/* This fellow will unlock it for us. */
151 	netdev_run_todo();
152 }
153 EXPORT_SYMBOL(rtnl_unlock);
154 
rtnl_trylock(void)155 int rtnl_trylock(void)
156 {
157 	return mutex_trylock(&rtnl_mutex);
158 }
159 EXPORT_SYMBOL(rtnl_trylock);
160 
rtnl_is_locked(void)161 int rtnl_is_locked(void)
162 {
163 	return mutex_is_locked(&rtnl_mutex);
164 }
165 EXPORT_SYMBOL(rtnl_is_locked);
166 
refcount_dec_and_rtnl_lock(refcount_t * r)167 bool refcount_dec_and_rtnl_lock(refcount_t *r)
168 {
169 	return refcount_dec_and_mutex_lock(r, &rtnl_mutex);
170 }
171 EXPORT_SYMBOL(refcount_dec_and_rtnl_lock);
172 
173 #ifdef CONFIG_PROVE_LOCKING
lockdep_rtnl_is_held(void)174 bool lockdep_rtnl_is_held(void)
175 {
176 	return lockdep_is_held(&rtnl_mutex);
177 }
178 EXPORT_SYMBOL(lockdep_rtnl_is_held);
179 #endif /* #ifdef CONFIG_PROVE_LOCKING */
180 
181 static struct rtnl_link __rcu *__rcu *rtnl_msg_handlers[RTNL_FAMILY_MAX + 1];
182 
rtm_msgindex(int msgtype)183 static inline int rtm_msgindex(int msgtype)
184 {
185 	int msgindex = msgtype - RTM_BASE;
186 
187 	/*
188 	 * msgindex < 0 implies someone tried to register a netlink
189 	 * control code. msgindex >= RTM_NR_MSGTYPES may indicate that
190 	 * the message type has not been added to linux/rtnetlink.h
191 	 */
192 	BUG_ON(msgindex < 0 || msgindex >= RTM_NR_MSGTYPES);
193 
194 	return msgindex;
195 }
196 
rtnl_get_link(int protocol,int msgtype)197 static struct rtnl_link *rtnl_get_link(int protocol, int msgtype)
198 {
199 	struct rtnl_link __rcu **tab;
200 
201 	if (protocol >= ARRAY_SIZE(rtnl_msg_handlers))
202 		protocol = PF_UNSPEC;
203 
204 	tab = rcu_dereference_rtnl(rtnl_msg_handlers[protocol]);
205 	if (!tab)
206 		tab = rcu_dereference_rtnl(rtnl_msg_handlers[PF_UNSPEC]);
207 
208 	return rcu_dereference_rtnl(tab[msgtype]);
209 }
210 
rtnl_register_internal(struct module * owner,int protocol,int msgtype,rtnl_doit_func doit,rtnl_dumpit_func dumpit,unsigned int flags)211 static int rtnl_register_internal(struct module *owner,
212 				  int protocol, int msgtype,
213 				  rtnl_doit_func doit, rtnl_dumpit_func dumpit,
214 				  unsigned int flags)
215 {
216 	struct rtnl_link *link, *old;
217 	struct rtnl_link __rcu **tab;
218 	int msgindex;
219 	int ret = -ENOBUFS;
220 
221 	BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
222 	msgindex = rtm_msgindex(msgtype);
223 
224 	rtnl_lock();
225 	tab = rtnl_dereference(rtnl_msg_handlers[protocol]);
226 	if (tab == NULL) {
227 		tab = kcalloc(RTM_NR_MSGTYPES, sizeof(void *), GFP_KERNEL);
228 		if (!tab)
229 			goto unlock;
230 
231 		/* ensures we see the 0 stores */
232 		rcu_assign_pointer(rtnl_msg_handlers[protocol], tab);
233 	}
234 
235 	old = rtnl_dereference(tab[msgindex]);
236 	if (old) {
237 		link = kmemdup(old, sizeof(*old), GFP_KERNEL);
238 		if (!link)
239 			goto unlock;
240 	} else {
241 		link = kzalloc(sizeof(*link), GFP_KERNEL);
242 		if (!link)
243 			goto unlock;
244 	}
245 
246 	WARN_ON(link->owner && link->owner != owner);
247 	link->owner = owner;
248 
249 	WARN_ON(doit && link->doit && link->doit != doit);
250 	if (doit)
251 		link->doit = doit;
252 	WARN_ON(dumpit && link->dumpit && link->dumpit != dumpit);
253 	if (dumpit)
254 		link->dumpit = dumpit;
255 
256 	WARN_ON(rtnl_msgtype_kind(msgtype) != RTNL_KIND_DEL &&
257 		(flags & RTNL_FLAG_BULK_DEL_SUPPORTED));
258 	link->flags |= flags;
259 
260 	/* publish protocol:msgtype */
261 	rcu_assign_pointer(tab[msgindex], link);
262 	ret = 0;
263 	if (old)
264 		kfree_rcu(old, rcu);
265 unlock:
266 	rtnl_unlock();
267 	return ret;
268 }
269 
270 /**
271  * rtnl_register_module - Register a rtnetlink message type
272  *
273  * @owner: module registering the hook (THIS_MODULE)
274  * @protocol: Protocol family or PF_UNSPEC
275  * @msgtype: rtnetlink message type
276  * @doit: Function pointer called for each request message
277  * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message
278  * @flags: rtnl_link_flags to modify behaviour of doit/dumpit functions
279  *
280  * Like rtnl_register, but for use by removable modules.
281  */
rtnl_register_module(struct module * owner,int protocol,int msgtype,rtnl_doit_func doit,rtnl_dumpit_func dumpit,unsigned int flags)282 int rtnl_register_module(struct module *owner,
283 			 int protocol, int msgtype,
284 			 rtnl_doit_func doit, rtnl_dumpit_func dumpit,
285 			 unsigned int flags)
286 {
287 	return rtnl_register_internal(owner, protocol, msgtype,
288 				      doit, dumpit, flags);
289 }
290 EXPORT_SYMBOL_GPL(rtnl_register_module);
291 
292 /**
293  * rtnl_register - Register a rtnetlink message type
294  * @protocol: Protocol family or PF_UNSPEC
295  * @msgtype: rtnetlink message type
296  * @doit: Function pointer called for each request message
297  * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message
298  * @flags: rtnl_link_flags to modify behaviour of doit/dumpit functions
299  *
300  * Registers the specified function pointers (at least one of them has
301  * to be non-NULL) to be called whenever a request message for the
302  * specified protocol family and message type is received.
303  *
304  * The special protocol family PF_UNSPEC may be used to define fallback
305  * function pointers for the case when no entry for the specific protocol
306  * family exists.
307  */
rtnl_register(int protocol,int msgtype,rtnl_doit_func doit,rtnl_dumpit_func dumpit,unsigned int flags)308 void rtnl_register(int protocol, int msgtype,
309 		   rtnl_doit_func doit, rtnl_dumpit_func dumpit,
310 		   unsigned int flags)
311 {
312 	int err;
313 
314 	err = rtnl_register_internal(NULL, protocol, msgtype, doit, dumpit,
315 				     flags);
316 	if (err)
317 		pr_err("Unable to register rtnetlink message handler, "
318 		       "protocol = %d, message type = %d\n", protocol, msgtype);
319 }
320 
321 /**
322  * rtnl_unregister - Unregister a rtnetlink message type
323  * @protocol: Protocol family or PF_UNSPEC
324  * @msgtype: rtnetlink message type
325  *
326  * Returns 0 on success or a negative error code.
327  */
rtnl_unregister(int protocol,int msgtype)328 int rtnl_unregister(int protocol, int msgtype)
329 {
330 	struct rtnl_link __rcu **tab;
331 	struct rtnl_link *link;
332 	int msgindex;
333 
334 	BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
335 	msgindex = rtm_msgindex(msgtype);
336 
337 	rtnl_lock();
338 	tab = rtnl_dereference(rtnl_msg_handlers[protocol]);
339 	if (!tab) {
340 		rtnl_unlock();
341 		return -ENOENT;
342 	}
343 
344 	link = rtnl_dereference(tab[msgindex]);
345 	RCU_INIT_POINTER(tab[msgindex], NULL);
346 	rtnl_unlock();
347 
348 	kfree_rcu(link, rcu);
349 
350 	return 0;
351 }
352 EXPORT_SYMBOL_GPL(rtnl_unregister);
353 
354 /**
355  * rtnl_unregister_all - Unregister all rtnetlink message type of a protocol
356  * @protocol : Protocol family or PF_UNSPEC
357  *
358  * Identical to calling rtnl_unregster() for all registered message types
359  * of a certain protocol family.
360  */
rtnl_unregister_all(int protocol)361 void rtnl_unregister_all(int protocol)
362 {
363 	struct rtnl_link __rcu **tab;
364 	struct rtnl_link *link;
365 	int msgindex;
366 
367 	BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
368 
369 	rtnl_lock();
370 	tab = rtnl_dereference(rtnl_msg_handlers[protocol]);
371 	if (!tab) {
372 		rtnl_unlock();
373 		return;
374 	}
375 	RCU_INIT_POINTER(rtnl_msg_handlers[protocol], NULL);
376 	for (msgindex = 0; msgindex < RTM_NR_MSGTYPES; msgindex++) {
377 		link = rtnl_dereference(tab[msgindex]);
378 		if (!link)
379 			continue;
380 
381 		RCU_INIT_POINTER(tab[msgindex], NULL);
382 		kfree_rcu(link, rcu);
383 	}
384 	rtnl_unlock();
385 
386 	synchronize_net();
387 
388 	kfree(tab);
389 }
390 EXPORT_SYMBOL_GPL(rtnl_unregister_all);
391 
__rtnl_register_many(const struct rtnl_msg_handler * handlers,int n)392 int __rtnl_register_many(const struct rtnl_msg_handler *handlers, int n)
393 {
394 	const struct rtnl_msg_handler *handler;
395 	int i, err;
396 
397 	for (i = 0, handler = handlers; i < n; i++, handler++) {
398 		err = rtnl_register_internal(handler->owner, handler->protocol,
399 					     handler->msgtype, handler->doit,
400 					     handler->dumpit, handler->flags);
401 		if (err) {
402 			__rtnl_unregister_many(handlers, i);
403 			break;
404 		}
405 	}
406 
407 	return err;
408 }
409 EXPORT_SYMBOL_GPL(__rtnl_register_many);
410 
__rtnl_unregister_many(const struct rtnl_msg_handler * handlers,int n)411 void __rtnl_unregister_many(const struct rtnl_msg_handler *handlers, int n)
412 {
413 	const struct rtnl_msg_handler *handler;
414 	int i;
415 
416 	for (i = n - 1, handler = handlers + n - 1; i >= 0; i--, handler--)
417 		rtnl_unregister(handler->protocol, handler->msgtype);
418 }
419 EXPORT_SYMBOL_GPL(__rtnl_unregister_many);
420 
421 static LIST_HEAD(link_ops);
422 
rtnl_link_ops_get(const char * kind)423 static const struct rtnl_link_ops *rtnl_link_ops_get(const char *kind)
424 {
425 	const struct rtnl_link_ops *ops;
426 
427 	list_for_each_entry(ops, &link_ops, list) {
428 		if (!strcmp(ops->kind, kind))
429 			return ops;
430 	}
431 	return NULL;
432 }
433 
434 /**
435  * __rtnl_link_register - Register rtnl_link_ops with rtnetlink.
436  * @ops: struct rtnl_link_ops * to register
437  *
438  * The caller must hold the rtnl_mutex. This function should be used
439  * by drivers that create devices during module initialization. It
440  * must be called before registering the devices.
441  *
442  * Returns 0 on success or a negative error code.
443  */
__rtnl_link_register(struct rtnl_link_ops * ops)444 int __rtnl_link_register(struct rtnl_link_ops *ops)
445 {
446 	if (rtnl_link_ops_get(ops->kind))
447 		return -EEXIST;
448 
449 	/* The check for alloc/setup is here because if ops
450 	 * does not have that filled up, it is not possible
451 	 * to use the ops for creating device. So do not
452 	 * fill up dellink as well. That disables rtnl_dellink.
453 	 */
454 	if ((ops->alloc || ops->setup) && !ops->dellink)
455 		ops->dellink = unregister_netdevice_queue;
456 
457 	list_add_tail(&ops->list, &link_ops);
458 	return 0;
459 }
460 EXPORT_SYMBOL_GPL(__rtnl_link_register);
461 
462 /**
463  * rtnl_link_register - Register rtnl_link_ops with rtnetlink.
464  * @ops: struct rtnl_link_ops * to register
465  *
466  * Returns 0 on success or a negative error code.
467  */
rtnl_link_register(struct rtnl_link_ops * ops)468 int rtnl_link_register(struct rtnl_link_ops *ops)
469 {
470 	int err;
471 
472 	/* Sanity-check max sizes to avoid stack buffer overflow. */
473 	if (WARN_ON(ops->maxtype > RTNL_MAX_TYPE ||
474 		    ops->slave_maxtype > RTNL_SLAVE_MAX_TYPE))
475 		return -EINVAL;
476 
477 	rtnl_lock();
478 	err = __rtnl_link_register(ops);
479 	rtnl_unlock();
480 	return err;
481 }
482 EXPORT_SYMBOL_GPL(rtnl_link_register);
483 
__rtnl_kill_links(struct net * net,struct rtnl_link_ops * ops)484 static void __rtnl_kill_links(struct net *net, struct rtnl_link_ops *ops)
485 {
486 	struct net_device *dev;
487 	LIST_HEAD(list_kill);
488 
489 	for_each_netdev(net, dev) {
490 		if (dev->rtnl_link_ops == ops)
491 			ops->dellink(dev, &list_kill);
492 	}
493 	unregister_netdevice_many(&list_kill);
494 }
495 
496 /**
497  * __rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink.
498  * @ops: struct rtnl_link_ops * to unregister
499  *
500  * The caller must hold the rtnl_mutex and guarantee net_namespace_list
501  * integrity (hold pernet_ops_rwsem for writing to close the race
502  * with setup_net() and cleanup_net()).
503  */
__rtnl_link_unregister(struct rtnl_link_ops * ops)504 void __rtnl_link_unregister(struct rtnl_link_ops *ops)
505 {
506 	struct net *net;
507 
508 	for_each_net(net) {
509 		__rtnl_kill_links(net, ops);
510 	}
511 	list_del(&ops->list);
512 }
513 EXPORT_SYMBOL_GPL(__rtnl_link_unregister);
514 
515 /* Return with the rtnl_lock held when there are no network
516  * devices unregistering in any network namespace.
517  */
rtnl_lock_unregistering_all(void)518 static void rtnl_lock_unregistering_all(void)
519 {
520 	struct net *net;
521 	bool unregistering;
522 	DEFINE_WAIT_FUNC(wait, woken_wake_function);
523 
524 	add_wait_queue(&netdev_unregistering_wq, &wait);
525 	for (;;) {
526 		unregistering = false;
527 		rtnl_lock();
528 		/* We held write locked pernet_ops_rwsem, and parallel
529 		 * setup_net() and cleanup_net() are not possible.
530 		 */
531 		for_each_net(net) {
532 			if (atomic_read(&net->dev_unreg_count) > 0) {
533 				unregistering = true;
534 				break;
535 			}
536 		}
537 		if (!unregistering)
538 			break;
539 		__rtnl_unlock();
540 
541 		wait_woken(&wait, TASK_UNINTERRUPTIBLE, MAX_SCHEDULE_TIMEOUT);
542 	}
543 	remove_wait_queue(&netdev_unregistering_wq, &wait);
544 }
545 
546 /**
547  * rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink.
548  * @ops: struct rtnl_link_ops * to unregister
549  */
rtnl_link_unregister(struct rtnl_link_ops * ops)550 void rtnl_link_unregister(struct rtnl_link_ops *ops)
551 {
552 	/* Close the race with setup_net() and cleanup_net() */
553 	down_write(&pernet_ops_rwsem);
554 	rtnl_lock_unregistering_all();
555 	__rtnl_link_unregister(ops);
556 	rtnl_unlock();
557 	up_write(&pernet_ops_rwsem);
558 }
559 EXPORT_SYMBOL_GPL(rtnl_link_unregister);
560 
rtnl_link_get_slave_info_data_size(const struct net_device * dev)561 static size_t rtnl_link_get_slave_info_data_size(const struct net_device *dev)
562 {
563 	struct net_device *master_dev;
564 	const struct rtnl_link_ops *ops;
565 	size_t size = 0;
566 
567 	rcu_read_lock();
568 
569 	master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev);
570 	if (!master_dev)
571 		goto out;
572 
573 	ops = master_dev->rtnl_link_ops;
574 	if (!ops || !ops->get_slave_size)
575 		goto out;
576 	/* IFLA_INFO_SLAVE_DATA + nested data */
577 	size = nla_total_size(sizeof(struct nlattr)) +
578 	       ops->get_slave_size(master_dev, dev);
579 
580 out:
581 	rcu_read_unlock();
582 	return size;
583 }
584 
rtnl_link_get_size(const struct net_device * dev)585 static size_t rtnl_link_get_size(const struct net_device *dev)
586 {
587 	const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
588 	size_t size;
589 
590 	if (!ops)
591 		return 0;
592 
593 	size = nla_total_size(sizeof(struct nlattr)) + /* IFLA_LINKINFO */
594 	       nla_total_size(strlen(ops->kind) + 1);  /* IFLA_INFO_KIND */
595 
596 	if (ops->get_size)
597 		/* IFLA_INFO_DATA + nested data */
598 		size += nla_total_size(sizeof(struct nlattr)) +
599 			ops->get_size(dev);
600 
601 	if (ops->get_xstats_size)
602 		/* IFLA_INFO_XSTATS */
603 		size += nla_total_size(ops->get_xstats_size(dev));
604 
605 	size += rtnl_link_get_slave_info_data_size(dev);
606 
607 	return size;
608 }
609 
610 static LIST_HEAD(rtnl_af_ops);
611 
rtnl_af_lookup(const int family)612 static const struct rtnl_af_ops *rtnl_af_lookup(const int family)
613 {
614 	const struct rtnl_af_ops *ops;
615 
616 	ASSERT_RTNL();
617 
618 	list_for_each_entry(ops, &rtnl_af_ops, list) {
619 		if (ops->family == family)
620 			return ops;
621 	}
622 
623 	return NULL;
624 }
625 
626 /**
627  * rtnl_af_register - Register rtnl_af_ops with rtnetlink.
628  * @ops: struct rtnl_af_ops * to register
629  *
630  * Returns 0 on success or a negative error code.
631  */
rtnl_af_register(struct rtnl_af_ops * ops)632 void rtnl_af_register(struct rtnl_af_ops *ops)
633 {
634 	rtnl_lock();
635 	list_add_tail_rcu(&ops->list, &rtnl_af_ops);
636 	rtnl_unlock();
637 }
638 EXPORT_SYMBOL_GPL(rtnl_af_register);
639 
640 /**
641  * rtnl_af_unregister - Unregister rtnl_af_ops from rtnetlink.
642  * @ops: struct rtnl_af_ops * to unregister
643  */
rtnl_af_unregister(struct rtnl_af_ops * ops)644 void rtnl_af_unregister(struct rtnl_af_ops *ops)
645 {
646 	rtnl_lock();
647 	list_del_rcu(&ops->list);
648 	rtnl_unlock();
649 
650 	synchronize_rcu();
651 }
652 EXPORT_SYMBOL_GPL(rtnl_af_unregister);
653 
rtnl_link_get_af_size(const struct net_device * dev,u32 ext_filter_mask)654 static size_t rtnl_link_get_af_size(const struct net_device *dev,
655 				    u32 ext_filter_mask)
656 {
657 	struct rtnl_af_ops *af_ops;
658 	size_t size;
659 
660 	/* IFLA_AF_SPEC */
661 	size = nla_total_size(sizeof(struct nlattr));
662 
663 	rcu_read_lock();
664 	list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
665 		if (af_ops->get_link_af_size) {
666 			/* AF_* + nested data */
667 			size += nla_total_size(sizeof(struct nlattr)) +
668 				af_ops->get_link_af_size(dev, ext_filter_mask);
669 		}
670 	}
671 	rcu_read_unlock();
672 
673 	return size;
674 }
675 
rtnl_have_link_slave_info(const struct net_device * dev)676 static bool rtnl_have_link_slave_info(const struct net_device *dev)
677 {
678 	struct net_device *master_dev;
679 	bool ret = false;
680 
681 	rcu_read_lock();
682 
683 	master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev);
684 	if (master_dev && master_dev->rtnl_link_ops)
685 		ret = true;
686 	rcu_read_unlock();
687 	return ret;
688 }
689 
rtnl_link_slave_info_fill(struct sk_buff * skb,const struct net_device * dev)690 static int rtnl_link_slave_info_fill(struct sk_buff *skb,
691 				     const struct net_device *dev)
692 {
693 	struct net_device *master_dev;
694 	const struct rtnl_link_ops *ops;
695 	struct nlattr *slave_data;
696 	int err;
697 
698 	master_dev = netdev_master_upper_dev_get((struct net_device *) dev);
699 	if (!master_dev)
700 		return 0;
701 	ops = master_dev->rtnl_link_ops;
702 	if (!ops)
703 		return 0;
704 	if (nla_put_string(skb, IFLA_INFO_SLAVE_KIND, ops->kind) < 0)
705 		return -EMSGSIZE;
706 	if (ops->fill_slave_info) {
707 		slave_data = nla_nest_start_noflag(skb, IFLA_INFO_SLAVE_DATA);
708 		if (!slave_data)
709 			return -EMSGSIZE;
710 		err = ops->fill_slave_info(skb, master_dev, dev);
711 		if (err < 0)
712 			goto err_cancel_slave_data;
713 		nla_nest_end(skb, slave_data);
714 	}
715 	return 0;
716 
717 err_cancel_slave_data:
718 	nla_nest_cancel(skb, slave_data);
719 	return err;
720 }
721 
rtnl_link_info_fill(struct sk_buff * skb,const struct net_device * dev)722 static int rtnl_link_info_fill(struct sk_buff *skb,
723 			       const struct net_device *dev)
724 {
725 	const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
726 	struct nlattr *data;
727 	int err;
728 
729 	if (!ops)
730 		return 0;
731 	if (nla_put_string(skb, IFLA_INFO_KIND, ops->kind) < 0)
732 		return -EMSGSIZE;
733 	if (ops->fill_xstats) {
734 		err = ops->fill_xstats(skb, dev);
735 		if (err < 0)
736 			return err;
737 	}
738 	if (ops->fill_info) {
739 		data = nla_nest_start_noflag(skb, IFLA_INFO_DATA);
740 		if (data == NULL)
741 			return -EMSGSIZE;
742 		err = ops->fill_info(skb, dev);
743 		if (err < 0)
744 			goto err_cancel_data;
745 		nla_nest_end(skb, data);
746 	}
747 	return 0;
748 
749 err_cancel_data:
750 	nla_nest_cancel(skb, data);
751 	return err;
752 }
753 
rtnl_link_fill(struct sk_buff * skb,const struct net_device * dev)754 static int rtnl_link_fill(struct sk_buff *skb, const struct net_device *dev)
755 {
756 	struct nlattr *linkinfo;
757 	int err = -EMSGSIZE;
758 
759 	linkinfo = nla_nest_start_noflag(skb, IFLA_LINKINFO);
760 	if (linkinfo == NULL)
761 		goto out;
762 
763 	err = rtnl_link_info_fill(skb, dev);
764 	if (err < 0)
765 		goto err_cancel_link;
766 
767 	err = rtnl_link_slave_info_fill(skb, dev);
768 	if (err < 0)
769 		goto err_cancel_link;
770 
771 	nla_nest_end(skb, linkinfo);
772 	return 0;
773 
774 err_cancel_link:
775 	nla_nest_cancel(skb, linkinfo);
776 out:
777 	return err;
778 }
779 
rtnetlink_send(struct sk_buff * skb,struct net * net,u32 pid,unsigned int group,int echo)780 int rtnetlink_send(struct sk_buff *skb, struct net *net, u32 pid, unsigned int group, int echo)
781 {
782 	struct sock *rtnl = net->rtnl;
783 
784 	return nlmsg_notify(rtnl, skb, pid, group, echo, GFP_KERNEL);
785 }
786 
rtnl_unicast(struct sk_buff * skb,struct net * net,u32 pid)787 int rtnl_unicast(struct sk_buff *skb, struct net *net, u32 pid)
788 {
789 	struct sock *rtnl = net->rtnl;
790 
791 	return nlmsg_unicast(rtnl, skb, pid);
792 }
793 EXPORT_SYMBOL(rtnl_unicast);
794 
rtnl_notify(struct sk_buff * skb,struct net * net,u32 pid,u32 group,const struct nlmsghdr * nlh,gfp_t flags)795 void rtnl_notify(struct sk_buff *skb, struct net *net, u32 pid, u32 group,
796 		 const struct nlmsghdr *nlh, gfp_t flags)
797 {
798 	struct sock *rtnl = net->rtnl;
799 
800 	nlmsg_notify(rtnl, skb, pid, group, nlmsg_report(nlh), flags);
801 }
802 EXPORT_SYMBOL(rtnl_notify);
803 
rtnl_set_sk_err(struct net * net,u32 group,int error)804 void rtnl_set_sk_err(struct net *net, u32 group, int error)
805 {
806 	struct sock *rtnl = net->rtnl;
807 
808 	netlink_set_err(rtnl, 0, group, error);
809 }
810 EXPORT_SYMBOL(rtnl_set_sk_err);
811 
rtnetlink_put_metrics(struct sk_buff * skb,u32 * metrics)812 int rtnetlink_put_metrics(struct sk_buff *skb, u32 *metrics)
813 {
814 	struct nlattr *mx;
815 	int i, valid = 0;
816 
817 	/* nothing is dumped for dst_default_metrics, so just skip the loop */
818 	if (metrics == dst_default_metrics.metrics)
819 		return 0;
820 
821 	mx = nla_nest_start_noflag(skb, RTA_METRICS);
822 	if (mx == NULL)
823 		return -ENOBUFS;
824 
825 	for (i = 0; i < RTAX_MAX; i++) {
826 		if (metrics[i]) {
827 			if (i == RTAX_CC_ALGO - 1) {
828 				char tmp[TCP_CA_NAME_MAX], *name;
829 
830 				name = tcp_ca_get_name_by_key(metrics[i], tmp);
831 				if (!name)
832 					continue;
833 				if (nla_put_string(skb, i + 1, name))
834 					goto nla_put_failure;
835 			} else if (i == RTAX_FEATURES - 1) {
836 				u32 user_features = metrics[i] & RTAX_FEATURE_MASK;
837 
838 				if (!user_features)
839 					continue;
840 				BUILD_BUG_ON(RTAX_FEATURE_MASK & DST_FEATURE_MASK);
841 				if (nla_put_u32(skb, i + 1, user_features))
842 					goto nla_put_failure;
843 			} else {
844 				if (nla_put_u32(skb, i + 1, metrics[i]))
845 					goto nla_put_failure;
846 			}
847 			valid++;
848 		}
849 	}
850 
851 	if (!valid) {
852 		nla_nest_cancel(skb, mx);
853 		return 0;
854 	}
855 
856 	return nla_nest_end(skb, mx);
857 
858 nla_put_failure:
859 	nla_nest_cancel(skb, mx);
860 	return -EMSGSIZE;
861 }
862 EXPORT_SYMBOL(rtnetlink_put_metrics);
863 
rtnl_put_cacheinfo(struct sk_buff * skb,struct dst_entry * dst,u32 id,long expires,u32 error)864 int rtnl_put_cacheinfo(struct sk_buff *skb, struct dst_entry *dst, u32 id,
865 		       long expires, u32 error)
866 {
867 	struct rta_cacheinfo ci = {
868 		.rta_error = error,
869 		.rta_id =  id,
870 	};
871 
872 	if (dst) {
873 		ci.rta_lastuse = jiffies_delta_to_clock_t(jiffies - dst->lastuse);
874 		ci.rta_used = dst->__use;
875 		ci.rta_clntref = rcuref_read(&dst->__rcuref);
876 	}
877 	if (expires) {
878 		unsigned long clock;
879 
880 		clock = jiffies_to_clock_t(abs(expires));
881 		clock = min_t(unsigned long, clock, INT_MAX);
882 		ci.rta_expires = (expires > 0) ? clock : -clock;
883 	}
884 	return nla_put(skb, RTA_CACHEINFO, sizeof(ci), &ci);
885 }
886 EXPORT_SYMBOL_GPL(rtnl_put_cacheinfo);
887 
set_operstate(struct net_device * dev,unsigned char transition)888 static void set_operstate(struct net_device *dev, unsigned char transition)
889 {
890 	unsigned char operstate = dev->operstate;
891 
892 	switch (transition) {
893 	case IF_OPER_UP:
894 		if ((operstate == IF_OPER_DORMANT ||
895 		     operstate == IF_OPER_TESTING ||
896 		     operstate == IF_OPER_UNKNOWN) &&
897 		    !netif_dormant(dev) && !netif_testing(dev))
898 			operstate = IF_OPER_UP;
899 		break;
900 
901 	case IF_OPER_TESTING:
902 		if (netif_oper_up(dev))
903 			operstate = IF_OPER_TESTING;
904 		break;
905 
906 	case IF_OPER_DORMANT:
907 		if (netif_oper_up(dev))
908 			operstate = IF_OPER_DORMANT;
909 		break;
910 	}
911 
912 	if (READ_ONCE(dev->operstate) != operstate) {
913 		write_lock(&dev_base_lock);
914 		WRITE_ONCE(dev->operstate, operstate);
915 		write_unlock(&dev_base_lock);
916 		netdev_state_change(dev);
917 	}
918 }
919 
rtnl_dev_get_flags(const struct net_device * dev)920 static unsigned int rtnl_dev_get_flags(const struct net_device *dev)
921 {
922 	return (dev->flags & ~(IFF_PROMISC | IFF_ALLMULTI)) |
923 	       (dev->gflags & (IFF_PROMISC | IFF_ALLMULTI));
924 }
925 
rtnl_dev_combine_flags(const struct net_device * dev,const struct ifinfomsg * ifm)926 static unsigned int rtnl_dev_combine_flags(const struct net_device *dev,
927 					   const struct ifinfomsg *ifm)
928 {
929 	unsigned int flags = ifm->ifi_flags;
930 
931 	/* bugwards compatibility: ifi_change == 0 is treated as ~0 */
932 	if (ifm->ifi_change)
933 		flags = (flags & ifm->ifi_change) |
934 			(rtnl_dev_get_flags(dev) & ~ifm->ifi_change);
935 
936 	return flags;
937 }
938 
copy_rtnl_link_stats(struct rtnl_link_stats * a,const struct rtnl_link_stats64 * b)939 static void copy_rtnl_link_stats(struct rtnl_link_stats *a,
940 				 const struct rtnl_link_stats64 *b)
941 {
942 	a->rx_packets = b->rx_packets;
943 	a->tx_packets = b->tx_packets;
944 	a->rx_bytes = b->rx_bytes;
945 	a->tx_bytes = b->tx_bytes;
946 	a->rx_errors = b->rx_errors;
947 	a->tx_errors = b->tx_errors;
948 	a->rx_dropped = b->rx_dropped;
949 	a->tx_dropped = b->tx_dropped;
950 
951 	a->multicast = b->multicast;
952 	a->collisions = b->collisions;
953 
954 	a->rx_length_errors = b->rx_length_errors;
955 	a->rx_over_errors = b->rx_over_errors;
956 	a->rx_crc_errors = b->rx_crc_errors;
957 	a->rx_frame_errors = b->rx_frame_errors;
958 	a->rx_fifo_errors = b->rx_fifo_errors;
959 	a->rx_missed_errors = b->rx_missed_errors;
960 
961 	a->tx_aborted_errors = b->tx_aborted_errors;
962 	a->tx_carrier_errors = b->tx_carrier_errors;
963 	a->tx_fifo_errors = b->tx_fifo_errors;
964 	a->tx_heartbeat_errors = b->tx_heartbeat_errors;
965 	a->tx_window_errors = b->tx_window_errors;
966 
967 	a->rx_compressed = b->rx_compressed;
968 	a->tx_compressed = b->tx_compressed;
969 
970 	a->rx_nohandler = b->rx_nohandler;
971 }
972 
973 /* All VF info */
rtnl_vfinfo_size(const struct net_device * dev,u32 ext_filter_mask)974 static inline int rtnl_vfinfo_size(const struct net_device *dev,
975 				   u32 ext_filter_mask)
976 {
977 	if (dev->dev.parent && (ext_filter_mask & RTEXT_FILTER_VF)) {
978 		int num_vfs = dev_num_vf(dev->dev.parent);
979 		size_t size = nla_total_size(0);
980 		size += num_vfs *
981 			(nla_total_size(0) +
982 			 nla_total_size(sizeof(struct ifla_vf_mac)) +
983 			 nla_total_size(sizeof(struct ifla_vf_broadcast)) +
984 			 nla_total_size(sizeof(struct ifla_vf_vlan)) +
985 			 nla_total_size(0) + /* nest IFLA_VF_VLAN_LIST */
986 			 nla_total_size(MAX_VLAN_LIST_LEN *
987 					sizeof(struct ifla_vf_vlan_info)) +
988 			 nla_total_size(sizeof(struct ifla_vf_spoofchk)) +
989 			 nla_total_size(sizeof(struct ifla_vf_tx_rate)) +
990 			 nla_total_size(sizeof(struct ifla_vf_rate)) +
991 			 nla_total_size(sizeof(struct ifla_vf_link_state)) +
992 			 nla_total_size(sizeof(struct ifla_vf_rss_query_en)) +
993 			 nla_total_size(sizeof(struct ifla_vf_trust)));
994 		if (~ext_filter_mask & RTEXT_FILTER_SKIP_STATS) {
995 			size += num_vfs *
996 				(nla_total_size(0) + /* nest IFLA_VF_STATS */
997 				 /* IFLA_VF_STATS_RX_PACKETS */
998 				 nla_total_size_64bit(sizeof(__u64)) +
999 				 /* IFLA_VF_STATS_TX_PACKETS */
1000 				 nla_total_size_64bit(sizeof(__u64)) +
1001 				 /* IFLA_VF_STATS_RX_BYTES */
1002 				 nla_total_size_64bit(sizeof(__u64)) +
1003 				 /* IFLA_VF_STATS_TX_BYTES */
1004 				 nla_total_size_64bit(sizeof(__u64)) +
1005 				 /* IFLA_VF_STATS_BROADCAST */
1006 				 nla_total_size_64bit(sizeof(__u64)) +
1007 				 /* IFLA_VF_STATS_MULTICAST */
1008 				 nla_total_size_64bit(sizeof(__u64)) +
1009 				 /* IFLA_VF_STATS_RX_DROPPED */
1010 				 nla_total_size_64bit(sizeof(__u64)) +
1011 				 /* IFLA_VF_STATS_TX_DROPPED */
1012 				 nla_total_size_64bit(sizeof(__u64)));
1013 		}
1014 		if (dev->netdev_ops->ndo_get_vf_guid)
1015 			size += num_vfs * 2 *
1016 				nla_total_size(sizeof(struct ifla_vf_guid));
1017 		return size;
1018 	} else
1019 		return 0;
1020 }
1021 
rtnl_port_size(const struct net_device * dev,u32 ext_filter_mask)1022 static size_t rtnl_port_size(const struct net_device *dev,
1023 			     u32 ext_filter_mask)
1024 {
1025 	size_t port_size = nla_total_size(4)		/* PORT_VF */
1026 		+ nla_total_size(PORT_PROFILE_MAX)	/* PORT_PROFILE */
1027 		+ nla_total_size(PORT_UUID_MAX)		/* PORT_INSTANCE_UUID */
1028 		+ nla_total_size(PORT_UUID_MAX)		/* PORT_HOST_UUID */
1029 		+ nla_total_size(1)			/* PROT_VDP_REQUEST */
1030 		+ nla_total_size(2);			/* PORT_VDP_RESPONSE */
1031 	size_t vf_ports_size = nla_total_size(sizeof(struct nlattr));
1032 	size_t vf_port_size = nla_total_size(sizeof(struct nlattr))
1033 		+ port_size;
1034 	size_t port_self_size = nla_total_size(sizeof(struct nlattr))
1035 		+ port_size;
1036 
1037 	if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent ||
1038 	    !(ext_filter_mask & RTEXT_FILTER_VF))
1039 		return 0;
1040 	if (dev_num_vf(dev->dev.parent))
1041 		return port_self_size + vf_ports_size +
1042 			vf_port_size * dev_num_vf(dev->dev.parent);
1043 	else
1044 		return port_self_size;
1045 }
1046 
rtnl_xdp_size(void)1047 static size_t rtnl_xdp_size(void)
1048 {
1049 	size_t xdp_size = nla_total_size(0) +	/* nest IFLA_XDP */
1050 			  nla_total_size(1) +	/* XDP_ATTACHED */
1051 			  nla_total_size(4) +	/* XDP_PROG_ID (or 1st mode) */
1052 			  nla_total_size(4);	/* XDP_<mode>_PROG_ID */
1053 
1054 	return xdp_size;
1055 }
1056 
rtnl_prop_list_size(const struct net_device * dev)1057 static size_t rtnl_prop_list_size(const struct net_device *dev)
1058 {
1059 	struct netdev_name_node *name_node;
1060 	size_t size;
1061 
1062 	if (list_empty(&dev->name_node->list))
1063 		return 0;
1064 	size = nla_total_size(0);
1065 	list_for_each_entry(name_node, &dev->name_node->list, list)
1066 		size += nla_total_size(ALTIFNAMSIZ);
1067 	return size;
1068 }
1069 
rtnl_proto_down_size(const struct net_device * dev)1070 static size_t rtnl_proto_down_size(const struct net_device *dev)
1071 {
1072 	size_t size = nla_total_size(1);
1073 
1074 	if (dev->proto_down_reason)
1075 		size += nla_total_size(0) + nla_total_size(4);
1076 
1077 	return size;
1078 }
1079 
rtnl_devlink_port_size(const struct net_device * dev)1080 static size_t rtnl_devlink_port_size(const struct net_device *dev)
1081 {
1082 	size_t size = nla_total_size(0); /* nest IFLA_DEVLINK_PORT */
1083 
1084 	if (dev->devlink_port)
1085 		size += devlink_nl_port_handle_size(dev->devlink_port);
1086 
1087 	return size;
1088 }
1089 
if_nlmsg_size(const struct net_device * dev,u32 ext_filter_mask)1090 static noinline size_t if_nlmsg_size(const struct net_device *dev,
1091 				     u32 ext_filter_mask)
1092 {
1093 	return NLMSG_ALIGN(sizeof(struct ifinfomsg))
1094 	       + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
1095 	       + nla_total_size(IFALIASZ) /* IFLA_IFALIAS */
1096 	       + nla_total_size(IFNAMSIZ) /* IFLA_QDISC */
1097 	       + nla_total_size_64bit(sizeof(struct rtnl_link_ifmap))
1098 	       + nla_total_size(sizeof(struct rtnl_link_stats))
1099 	       + nla_total_size_64bit(sizeof(struct rtnl_link_stats64))
1100 	       + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
1101 	       + nla_total_size(MAX_ADDR_LEN) /* IFLA_BROADCAST */
1102 	       + nla_total_size(4) /* IFLA_TXQLEN */
1103 	       + nla_total_size(4) /* IFLA_WEIGHT */
1104 	       + nla_total_size(4) /* IFLA_MTU */
1105 	       + nla_total_size(4) /* IFLA_LINK */
1106 	       + nla_total_size(4) /* IFLA_MASTER */
1107 	       + nla_total_size(1) /* IFLA_CARRIER */
1108 	       + nla_total_size(4) /* IFLA_PROMISCUITY */
1109 	       + nla_total_size(4) /* IFLA_ALLMULTI */
1110 	       + nla_total_size(4) /* IFLA_NUM_TX_QUEUES */
1111 	       + nla_total_size(4) /* IFLA_NUM_RX_QUEUES */
1112 	       + nla_total_size(4) /* IFLA_GSO_MAX_SEGS */
1113 	       + nla_total_size(4) /* IFLA_GSO_MAX_SIZE */
1114 	       + nla_total_size(4) /* IFLA_GRO_MAX_SIZE */
1115 	       + nla_total_size(4) /* IFLA_GSO_IPV4_MAX_SIZE */
1116 	       + nla_total_size(4) /* IFLA_GRO_IPV4_MAX_SIZE */
1117 	       + nla_total_size(4) /* IFLA_TSO_MAX_SIZE */
1118 	       + nla_total_size(4) /* IFLA_TSO_MAX_SEGS */
1119 	       + nla_total_size(1) /* IFLA_OPERSTATE */
1120 	       + nla_total_size(1) /* IFLA_LINKMODE */
1121 	       + nla_total_size(4) /* IFLA_CARRIER_CHANGES */
1122 	       + nla_total_size(4) /* IFLA_LINK_NETNSID */
1123 	       + nla_total_size(4) /* IFLA_GROUP */
1124 	       + nla_total_size(ext_filter_mask
1125 			        & RTEXT_FILTER_VF ? 4 : 0) /* IFLA_NUM_VF */
1126 	       + rtnl_vfinfo_size(dev, ext_filter_mask) /* IFLA_VFINFO_LIST */
1127 	       + rtnl_port_size(dev, ext_filter_mask) /* IFLA_VF_PORTS + IFLA_PORT_SELF */
1128 	       + rtnl_link_get_size(dev) /* IFLA_LINKINFO */
1129 	       + rtnl_link_get_af_size(dev, ext_filter_mask) /* IFLA_AF_SPEC */
1130 	       + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_PORT_ID */
1131 	       + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_SWITCH_ID */
1132 	       + nla_total_size(IFNAMSIZ) /* IFLA_PHYS_PORT_NAME */
1133 	       + rtnl_xdp_size() /* IFLA_XDP */
1134 	       + nla_total_size(4)  /* IFLA_EVENT */
1135 	       + nla_total_size(4)  /* IFLA_NEW_NETNSID */
1136 	       + nla_total_size(4)  /* IFLA_NEW_IFINDEX */
1137 	       + rtnl_proto_down_size(dev)  /* proto down */
1138 	       + nla_total_size(4)  /* IFLA_TARGET_NETNSID */
1139 	       + nla_total_size(4)  /* IFLA_CARRIER_UP_COUNT */
1140 	       + nla_total_size(4)  /* IFLA_CARRIER_DOWN_COUNT */
1141 	       + nla_total_size(4)  /* IFLA_MIN_MTU */
1142 	       + nla_total_size(4)  /* IFLA_MAX_MTU */
1143 	       + rtnl_prop_list_size(dev)
1144 	       + nla_total_size(MAX_ADDR_LEN) /* IFLA_PERM_ADDRESS */
1145 	       + rtnl_devlink_port_size(dev)
1146 	       + 0;
1147 }
1148 
rtnl_vf_ports_fill(struct sk_buff * skb,struct net_device * dev)1149 static int rtnl_vf_ports_fill(struct sk_buff *skb, struct net_device *dev)
1150 {
1151 	struct nlattr *vf_ports;
1152 	struct nlattr *vf_port;
1153 	int vf;
1154 	int err;
1155 
1156 	vf_ports = nla_nest_start_noflag(skb, IFLA_VF_PORTS);
1157 	if (!vf_ports)
1158 		return -EMSGSIZE;
1159 
1160 	for (vf = 0; vf < dev_num_vf(dev->dev.parent); vf++) {
1161 		vf_port = nla_nest_start_noflag(skb, IFLA_VF_PORT);
1162 		if (!vf_port)
1163 			goto nla_put_failure;
1164 		if (nla_put_u32(skb, IFLA_PORT_VF, vf))
1165 			goto nla_put_failure;
1166 		err = dev->netdev_ops->ndo_get_vf_port(dev, vf, skb);
1167 		if (err == -EMSGSIZE)
1168 			goto nla_put_failure;
1169 		if (err) {
1170 			nla_nest_cancel(skb, vf_port);
1171 			continue;
1172 		}
1173 		nla_nest_end(skb, vf_port);
1174 	}
1175 
1176 	nla_nest_end(skb, vf_ports);
1177 
1178 	return 0;
1179 
1180 nla_put_failure:
1181 	nla_nest_cancel(skb, vf_ports);
1182 	return -EMSGSIZE;
1183 }
1184 
rtnl_port_self_fill(struct sk_buff * skb,struct net_device * dev)1185 static int rtnl_port_self_fill(struct sk_buff *skb, struct net_device *dev)
1186 {
1187 	struct nlattr *port_self;
1188 	int err;
1189 
1190 	port_self = nla_nest_start_noflag(skb, IFLA_PORT_SELF);
1191 	if (!port_self)
1192 		return -EMSGSIZE;
1193 
1194 	err = dev->netdev_ops->ndo_get_vf_port(dev, PORT_SELF_VF, skb);
1195 	if (err) {
1196 		nla_nest_cancel(skb, port_self);
1197 		return (err == -EMSGSIZE) ? err : 0;
1198 	}
1199 
1200 	nla_nest_end(skb, port_self);
1201 
1202 	return 0;
1203 }
1204 
rtnl_port_fill(struct sk_buff * skb,struct net_device * dev,u32 ext_filter_mask)1205 static int rtnl_port_fill(struct sk_buff *skb, struct net_device *dev,
1206 			  u32 ext_filter_mask)
1207 {
1208 	int err;
1209 
1210 	if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent ||
1211 	    !(ext_filter_mask & RTEXT_FILTER_VF))
1212 		return 0;
1213 
1214 	err = rtnl_port_self_fill(skb, dev);
1215 	if (err)
1216 		return err;
1217 
1218 	if (dev_num_vf(dev->dev.parent)) {
1219 		err = rtnl_vf_ports_fill(skb, dev);
1220 		if (err)
1221 			return err;
1222 	}
1223 
1224 	return 0;
1225 }
1226 
rtnl_phys_port_id_fill(struct sk_buff * skb,struct net_device * dev)1227 static int rtnl_phys_port_id_fill(struct sk_buff *skb, struct net_device *dev)
1228 {
1229 	int err;
1230 	struct netdev_phys_item_id ppid;
1231 
1232 	err = dev_get_phys_port_id(dev, &ppid);
1233 	if (err) {
1234 		if (err == -EOPNOTSUPP)
1235 			return 0;
1236 		return err;
1237 	}
1238 
1239 	if (nla_put(skb, IFLA_PHYS_PORT_ID, ppid.id_len, ppid.id))
1240 		return -EMSGSIZE;
1241 
1242 	return 0;
1243 }
1244 
rtnl_phys_port_name_fill(struct sk_buff * skb,struct net_device * dev)1245 static int rtnl_phys_port_name_fill(struct sk_buff *skb, struct net_device *dev)
1246 {
1247 	char name[IFNAMSIZ];
1248 	int err;
1249 
1250 	err = dev_get_phys_port_name(dev, name, sizeof(name));
1251 	if (err) {
1252 		if (err == -EOPNOTSUPP)
1253 			return 0;
1254 		return err;
1255 	}
1256 
1257 	if (nla_put_string(skb, IFLA_PHYS_PORT_NAME, name))
1258 		return -EMSGSIZE;
1259 
1260 	return 0;
1261 }
1262 
rtnl_phys_switch_id_fill(struct sk_buff * skb,struct net_device * dev)1263 static int rtnl_phys_switch_id_fill(struct sk_buff *skb, struct net_device *dev)
1264 {
1265 	struct netdev_phys_item_id ppid = { };
1266 	int err;
1267 
1268 	err = dev_get_port_parent_id(dev, &ppid, false);
1269 	if (err) {
1270 		if (err == -EOPNOTSUPP)
1271 			return 0;
1272 		return err;
1273 	}
1274 
1275 	if (nla_put(skb, IFLA_PHYS_SWITCH_ID, ppid.id_len, ppid.id))
1276 		return -EMSGSIZE;
1277 
1278 	return 0;
1279 }
1280 
rtnl_fill_stats(struct sk_buff * skb,struct net_device * dev)1281 static noinline_for_stack int rtnl_fill_stats(struct sk_buff *skb,
1282 					      struct net_device *dev)
1283 {
1284 	struct rtnl_link_stats64 *sp;
1285 	struct nlattr *attr;
1286 
1287 	attr = nla_reserve_64bit(skb, IFLA_STATS64,
1288 				 sizeof(struct rtnl_link_stats64), IFLA_PAD);
1289 	if (!attr)
1290 		return -EMSGSIZE;
1291 
1292 	sp = nla_data(attr);
1293 	dev_get_stats(dev, sp);
1294 
1295 	attr = nla_reserve(skb, IFLA_STATS,
1296 			   sizeof(struct rtnl_link_stats));
1297 	if (!attr)
1298 		return -EMSGSIZE;
1299 
1300 	copy_rtnl_link_stats(nla_data(attr), sp);
1301 
1302 	return 0;
1303 }
1304 
rtnl_fill_vfinfo(struct sk_buff * skb,struct net_device * dev,int vfs_num,u32 ext_filter_mask)1305 static noinline_for_stack int rtnl_fill_vfinfo(struct sk_buff *skb,
1306 					       struct net_device *dev,
1307 					       int vfs_num,
1308 					       u32 ext_filter_mask)
1309 {
1310 	struct ifla_vf_rss_query_en vf_rss_query_en;
1311 	struct nlattr *vf, *vfstats, *vfvlanlist;
1312 	struct ifla_vf_link_state vf_linkstate;
1313 	struct ifla_vf_vlan_info vf_vlan_info;
1314 	struct ifla_vf_spoofchk vf_spoofchk;
1315 	struct ifla_vf_tx_rate vf_tx_rate;
1316 	struct ifla_vf_stats vf_stats;
1317 	struct ifla_vf_trust vf_trust;
1318 	struct ifla_vf_vlan vf_vlan;
1319 	struct ifla_vf_rate vf_rate;
1320 	struct ifla_vf_mac vf_mac;
1321 	struct ifla_vf_broadcast vf_broadcast;
1322 	struct ifla_vf_info ivi;
1323 	struct ifla_vf_guid node_guid;
1324 	struct ifla_vf_guid port_guid;
1325 
1326 	memset(&ivi, 0, sizeof(ivi));
1327 
1328 	/* Not all SR-IOV capable drivers support the
1329 	 * spoofcheck and "RSS query enable" query.  Preset to
1330 	 * -1 so the user space tool can detect that the driver
1331 	 * didn't report anything.
1332 	 */
1333 	ivi.spoofchk = -1;
1334 	ivi.rss_query_en = -1;
1335 	ivi.trusted = -1;
1336 	/* The default value for VF link state is "auto"
1337 	 * IFLA_VF_LINK_STATE_AUTO which equals zero
1338 	 */
1339 	ivi.linkstate = 0;
1340 	/* VLAN Protocol by default is 802.1Q */
1341 	ivi.vlan_proto = htons(ETH_P_8021Q);
1342 	if (dev->netdev_ops->ndo_get_vf_config(dev, vfs_num, &ivi))
1343 		return 0;
1344 
1345 	memset(&vf_vlan_info, 0, sizeof(vf_vlan_info));
1346 	memset(&node_guid, 0, sizeof(node_guid));
1347 	memset(&port_guid, 0, sizeof(port_guid));
1348 
1349 	vf_mac.vf =
1350 		vf_vlan.vf =
1351 		vf_vlan_info.vf =
1352 		vf_rate.vf =
1353 		vf_tx_rate.vf =
1354 		vf_spoofchk.vf =
1355 		vf_linkstate.vf =
1356 		vf_rss_query_en.vf =
1357 		vf_trust.vf =
1358 		node_guid.vf =
1359 		port_guid.vf = ivi.vf;
1360 
1361 	memcpy(vf_mac.mac, ivi.mac, sizeof(ivi.mac));
1362 	memcpy(vf_broadcast.broadcast, dev->broadcast, dev->addr_len);
1363 	vf_vlan.vlan = ivi.vlan;
1364 	vf_vlan.qos = ivi.qos;
1365 	vf_vlan_info.vlan = ivi.vlan;
1366 	vf_vlan_info.qos = ivi.qos;
1367 	vf_vlan_info.vlan_proto = ivi.vlan_proto;
1368 	vf_tx_rate.rate = ivi.max_tx_rate;
1369 	vf_rate.min_tx_rate = ivi.min_tx_rate;
1370 	vf_rate.max_tx_rate = ivi.max_tx_rate;
1371 	vf_spoofchk.setting = ivi.spoofchk;
1372 	vf_linkstate.link_state = ivi.linkstate;
1373 	vf_rss_query_en.setting = ivi.rss_query_en;
1374 	vf_trust.setting = ivi.trusted;
1375 	vf = nla_nest_start_noflag(skb, IFLA_VF_INFO);
1376 	if (!vf)
1377 		return -EMSGSIZE;
1378 	if (nla_put(skb, IFLA_VF_MAC, sizeof(vf_mac), &vf_mac) ||
1379 	    nla_put(skb, IFLA_VF_BROADCAST, sizeof(vf_broadcast), &vf_broadcast) ||
1380 	    nla_put(skb, IFLA_VF_VLAN, sizeof(vf_vlan), &vf_vlan) ||
1381 	    nla_put(skb, IFLA_VF_RATE, sizeof(vf_rate),
1382 		    &vf_rate) ||
1383 	    nla_put(skb, IFLA_VF_TX_RATE, sizeof(vf_tx_rate),
1384 		    &vf_tx_rate) ||
1385 	    nla_put(skb, IFLA_VF_SPOOFCHK, sizeof(vf_spoofchk),
1386 		    &vf_spoofchk) ||
1387 	    nla_put(skb, IFLA_VF_LINK_STATE, sizeof(vf_linkstate),
1388 		    &vf_linkstate) ||
1389 	    nla_put(skb, IFLA_VF_RSS_QUERY_EN,
1390 		    sizeof(vf_rss_query_en),
1391 		    &vf_rss_query_en) ||
1392 	    nla_put(skb, IFLA_VF_TRUST,
1393 		    sizeof(vf_trust), &vf_trust))
1394 		goto nla_put_vf_failure;
1395 
1396 	if (dev->netdev_ops->ndo_get_vf_guid &&
1397 	    !dev->netdev_ops->ndo_get_vf_guid(dev, vfs_num, &node_guid,
1398 					      &port_guid)) {
1399 		if (nla_put(skb, IFLA_VF_IB_NODE_GUID, sizeof(node_guid),
1400 			    &node_guid) ||
1401 		    nla_put(skb, IFLA_VF_IB_PORT_GUID, sizeof(port_guid),
1402 			    &port_guid))
1403 			goto nla_put_vf_failure;
1404 	}
1405 	vfvlanlist = nla_nest_start_noflag(skb, IFLA_VF_VLAN_LIST);
1406 	if (!vfvlanlist)
1407 		goto nla_put_vf_failure;
1408 	if (nla_put(skb, IFLA_VF_VLAN_INFO, sizeof(vf_vlan_info),
1409 		    &vf_vlan_info)) {
1410 		nla_nest_cancel(skb, vfvlanlist);
1411 		goto nla_put_vf_failure;
1412 	}
1413 	nla_nest_end(skb, vfvlanlist);
1414 	if (~ext_filter_mask & RTEXT_FILTER_SKIP_STATS) {
1415 		memset(&vf_stats, 0, sizeof(vf_stats));
1416 		if (dev->netdev_ops->ndo_get_vf_stats)
1417 			dev->netdev_ops->ndo_get_vf_stats(dev, vfs_num,
1418 							  &vf_stats);
1419 		vfstats = nla_nest_start_noflag(skb, IFLA_VF_STATS);
1420 		if (!vfstats)
1421 			goto nla_put_vf_failure;
1422 		if (nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_PACKETS,
1423 				      vf_stats.rx_packets, IFLA_VF_STATS_PAD) ||
1424 		    nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_PACKETS,
1425 				      vf_stats.tx_packets, IFLA_VF_STATS_PAD) ||
1426 		    nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_BYTES,
1427 				      vf_stats.rx_bytes, IFLA_VF_STATS_PAD) ||
1428 		    nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_BYTES,
1429 				      vf_stats.tx_bytes, IFLA_VF_STATS_PAD) ||
1430 		    nla_put_u64_64bit(skb, IFLA_VF_STATS_BROADCAST,
1431 				      vf_stats.broadcast, IFLA_VF_STATS_PAD) ||
1432 		    nla_put_u64_64bit(skb, IFLA_VF_STATS_MULTICAST,
1433 				      vf_stats.multicast, IFLA_VF_STATS_PAD) ||
1434 		    nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_DROPPED,
1435 				      vf_stats.rx_dropped, IFLA_VF_STATS_PAD) ||
1436 		    nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_DROPPED,
1437 				      vf_stats.tx_dropped, IFLA_VF_STATS_PAD)) {
1438 			nla_nest_cancel(skb, vfstats);
1439 			goto nla_put_vf_failure;
1440 		}
1441 		nla_nest_end(skb, vfstats);
1442 	}
1443 	nla_nest_end(skb, vf);
1444 	return 0;
1445 
1446 nla_put_vf_failure:
1447 	nla_nest_cancel(skb, vf);
1448 	return -EMSGSIZE;
1449 }
1450 
rtnl_fill_vf(struct sk_buff * skb,struct net_device * dev,u32 ext_filter_mask)1451 static noinline_for_stack int rtnl_fill_vf(struct sk_buff *skb,
1452 					   struct net_device *dev,
1453 					   u32 ext_filter_mask)
1454 {
1455 	struct nlattr *vfinfo;
1456 	int i, num_vfs;
1457 
1458 	if (!dev->dev.parent || ((ext_filter_mask & RTEXT_FILTER_VF) == 0))
1459 		return 0;
1460 
1461 	num_vfs = dev_num_vf(dev->dev.parent);
1462 	if (nla_put_u32(skb, IFLA_NUM_VF, num_vfs))
1463 		return -EMSGSIZE;
1464 
1465 	if (!dev->netdev_ops->ndo_get_vf_config)
1466 		return 0;
1467 
1468 	vfinfo = nla_nest_start_noflag(skb, IFLA_VFINFO_LIST);
1469 	if (!vfinfo)
1470 		return -EMSGSIZE;
1471 
1472 	for (i = 0; i < num_vfs; i++) {
1473 		if (rtnl_fill_vfinfo(skb, dev, i, ext_filter_mask)) {
1474 			nla_nest_cancel(skb, vfinfo);
1475 			return -EMSGSIZE;
1476 		}
1477 	}
1478 
1479 	nla_nest_end(skb, vfinfo);
1480 	return 0;
1481 }
1482 
rtnl_fill_link_ifmap(struct sk_buff * skb,struct net_device * dev)1483 static int rtnl_fill_link_ifmap(struct sk_buff *skb, struct net_device *dev)
1484 {
1485 	struct rtnl_link_ifmap map;
1486 
1487 	memset(&map, 0, sizeof(map));
1488 	map.mem_start   = dev->mem_start;
1489 	map.mem_end     = dev->mem_end;
1490 	map.base_addr   = dev->base_addr;
1491 	map.irq         = dev->irq;
1492 	map.dma         = dev->dma;
1493 	map.port        = dev->if_port;
1494 
1495 	if (nla_put_64bit(skb, IFLA_MAP, sizeof(map), &map, IFLA_PAD))
1496 		return -EMSGSIZE;
1497 
1498 	return 0;
1499 }
1500 
rtnl_xdp_prog_skb(struct net_device * dev)1501 static u32 rtnl_xdp_prog_skb(struct net_device *dev)
1502 {
1503 	const struct bpf_prog *generic_xdp_prog;
1504 
1505 	ASSERT_RTNL();
1506 
1507 	generic_xdp_prog = rtnl_dereference(dev->xdp_prog);
1508 	if (!generic_xdp_prog)
1509 		return 0;
1510 	return generic_xdp_prog->aux->id;
1511 }
1512 
rtnl_xdp_prog_drv(struct net_device * dev)1513 static u32 rtnl_xdp_prog_drv(struct net_device *dev)
1514 {
1515 	return dev_xdp_prog_id(dev, XDP_MODE_DRV);
1516 }
1517 
rtnl_xdp_prog_hw(struct net_device * dev)1518 static u32 rtnl_xdp_prog_hw(struct net_device *dev)
1519 {
1520 	return dev_xdp_prog_id(dev, XDP_MODE_HW);
1521 }
1522 
rtnl_xdp_report_one(struct sk_buff * skb,struct net_device * dev,u32 * prog_id,u8 * mode,u8 tgt_mode,u32 attr,u32 (* get_prog_id)(struct net_device * dev))1523 static int rtnl_xdp_report_one(struct sk_buff *skb, struct net_device *dev,
1524 			       u32 *prog_id, u8 *mode, u8 tgt_mode, u32 attr,
1525 			       u32 (*get_prog_id)(struct net_device *dev))
1526 {
1527 	u32 curr_id;
1528 	int err;
1529 
1530 	curr_id = get_prog_id(dev);
1531 	if (!curr_id)
1532 		return 0;
1533 
1534 	*prog_id = curr_id;
1535 	err = nla_put_u32(skb, attr, curr_id);
1536 	if (err)
1537 		return err;
1538 
1539 	if (*mode != XDP_ATTACHED_NONE)
1540 		*mode = XDP_ATTACHED_MULTI;
1541 	else
1542 		*mode = tgt_mode;
1543 
1544 	return 0;
1545 }
1546 
rtnl_xdp_fill(struct sk_buff * skb,struct net_device * dev)1547 static int rtnl_xdp_fill(struct sk_buff *skb, struct net_device *dev)
1548 {
1549 	struct nlattr *xdp;
1550 	u32 prog_id;
1551 	int err;
1552 	u8 mode;
1553 
1554 	xdp = nla_nest_start_noflag(skb, IFLA_XDP);
1555 	if (!xdp)
1556 		return -EMSGSIZE;
1557 
1558 	prog_id = 0;
1559 	mode = XDP_ATTACHED_NONE;
1560 	err = rtnl_xdp_report_one(skb, dev, &prog_id, &mode, XDP_ATTACHED_SKB,
1561 				  IFLA_XDP_SKB_PROG_ID, rtnl_xdp_prog_skb);
1562 	if (err)
1563 		goto err_cancel;
1564 	err = rtnl_xdp_report_one(skb, dev, &prog_id, &mode, XDP_ATTACHED_DRV,
1565 				  IFLA_XDP_DRV_PROG_ID, rtnl_xdp_prog_drv);
1566 	if (err)
1567 		goto err_cancel;
1568 	err = rtnl_xdp_report_one(skb, dev, &prog_id, &mode, XDP_ATTACHED_HW,
1569 				  IFLA_XDP_HW_PROG_ID, rtnl_xdp_prog_hw);
1570 	if (err)
1571 		goto err_cancel;
1572 
1573 	err = nla_put_u8(skb, IFLA_XDP_ATTACHED, mode);
1574 	if (err)
1575 		goto err_cancel;
1576 
1577 	if (prog_id && mode != XDP_ATTACHED_MULTI) {
1578 		err = nla_put_u32(skb, IFLA_XDP_PROG_ID, prog_id);
1579 		if (err)
1580 			goto err_cancel;
1581 	}
1582 
1583 	nla_nest_end(skb, xdp);
1584 	return 0;
1585 
1586 err_cancel:
1587 	nla_nest_cancel(skb, xdp);
1588 	return err;
1589 }
1590 
rtnl_get_event(unsigned long event)1591 static u32 rtnl_get_event(unsigned long event)
1592 {
1593 	u32 rtnl_event_type = IFLA_EVENT_NONE;
1594 
1595 	switch (event) {
1596 	case NETDEV_REBOOT:
1597 		rtnl_event_type = IFLA_EVENT_REBOOT;
1598 		break;
1599 	case NETDEV_FEAT_CHANGE:
1600 		rtnl_event_type = IFLA_EVENT_FEATURES;
1601 		break;
1602 	case NETDEV_BONDING_FAILOVER:
1603 		rtnl_event_type = IFLA_EVENT_BONDING_FAILOVER;
1604 		break;
1605 	case NETDEV_NOTIFY_PEERS:
1606 		rtnl_event_type = IFLA_EVENT_NOTIFY_PEERS;
1607 		break;
1608 	case NETDEV_RESEND_IGMP:
1609 		rtnl_event_type = IFLA_EVENT_IGMP_RESEND;
1610 		break;
1611 	case NETDEV_CHANGEINFODATA:
1612 		rtnl_event_type = IFLA_EVENT_BONDING_OPTIONS;
1613 		break;
1614 	default:
1615 		break;
1616 	}
1617 
1618 	return rtnl_event_type;
1619 }
1620 
put_master_ifindex(struct sk_buff * skb,struct net_device * dev)1621 static int put_master_ifindex(struct sk_buff *skb, struct net_device *dev)
1622 {
1623 	const struct net_device *upper_dev;
1624 	int ret = 0;
1625 
1626 	rcu_read_lock();
1627 
1628 	upper_dev = netdev_master_upper_dev_get_rcu(dev);
1629 	if (upper_dev)
1630 		ret = nla_put_u32(skb, IFLA_MASTER, upper_dev->ifindex);
1631 
1632 	rcu_read_unlock();
1633 	return ret;
1634 }
1635 
nla_put_iflink(struct sk_buff * skb,const struct net_device * dev,bool force)1636 static int nla_put_iflink(struct sk_buff *skb, const struct net_device *dev,
1637 			  bool force)
1638 {
1639 	int ifindex = dev_get_iflink(dev);
1640 
1641 	if (force || dev->ifindex != ifindex)
1642 		return nla_put_u32(skb, IFLA_LINK, ifindex);
1643 
1644 	return 0;
1645 }
1646 
nla_put_ifalias(struct sk_buff * skb,struct net_device * dev)1647 static noinline_for_stack int nla_put_ifalias(struct sk_buff *skb,
1648 					      struct net_device *dev)
1649 {
1650 	char buf[IFALIASZ];
1651 	int ret;
1652 
1653 	ret = dev_get_alias(dev, buf, sizeof(buf));
1654 	return ret > 0 ? nla_put_string(skb, IFLA_IFALIAS, buf) : 0;
1655 }
1656 
rtnl_fill_link_netnsid(struct sk_buff * skb,const struct net_device * dev,struct net * src_net,gfp_t gfp)1657 static int rtnl_fill_link_netnsid(struct sk_buff *skb,
1658 				  const struct net_device *dev,
1659 				  struct net *src_net, gfp_t gfp)
1660 {
1661 	bool put_iflink = false;
1662 
1663 	if (dev->rtnl_link_ops && dev->rtnl_link_ops->get_link_net) {
1664 		struct net *link_net = dev->rtnl_link_ops->get_link_net(dev);
1665 
1666 		if (!net_eq(dev_net(dev), link_net)) {
1667 			int id = peernet2id_alloc(src_net, link_net, gfp);
1668 
1669 			if (nla_put_s32(skb, IFLA_LINK_NETNSID, id))
1670 				return -EMSGSIZE;
1671 
1672 			put_iflink = true;
1673 		}
1674 	}
1675 
1676 	return nla_put_iflink(skb, dev, put_iflink);
1677 }
1678 
rtnl_fill_link_af(struct sk_buff * skb,const struct net_device * dev,u32 ext_filter_mask)1679 static int rtnl_fill_link_af(struct sk_buff *skb,
1680 			     const struct net_device *dev,
1681 			     u32 ext_filter_mask)
1682 {
1683 	const struct rtnl_af_ops *af_ops;
1684 	struct nlattr *af_spec;
1685 
1686 	af_spec = nla_nest_start_noflag(skb, IFLA_AF_SPEC);
1687 	if (!af_spec)
1688 		return -EMSGSIZE;
1689 
1690 	list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
1691 		struct nlattr *af;
1692 		int err;
1693 
1694 		if (!af_ops->fill_link_af)
1695 			continue;
1696 
1697 		af = nla_nest_start_noflag(skb, af_ops->family);
1698 		if (!af)
1699 			return -EMSGSIZE;
1700 
1701 		err = af_ops->fill_link_af(skb, dev, ext_filter_mask);
1702 		/*
1703 		 * Caller may return ENODATA to indicate that there
1704 		 * was no data to be dumped. This is not an error, it
1705 		 * means we should trim the attribute header and
1706 		 * continue.
1707 		 */
1708 		if (err == -ENODATA)
1709 			nla_nest_cancel(skb, af);
1710 		else if (err < 0)
1711 			return -EMSGSIZE;
1712 
1713 		nla_nest_end(skb, af);
1714 	}
1715 
1716 	nla_nest_end(skb, af_spec);
1717 	return 0;
1718 }
1719 
rtnl_fill_alt_ifnames(struct sk_buff * skb,const struct net_device * dev)1720 static int rtnl_fill_alt_ifnames(struct sk_buff *skb,
1721 				 const struct net_device *dev)
1722 {
1723 	struct netdev_name_node *name_node;
1724 	int count = 0;
1725 
1726 	list_for_each_entry(name_node, &dev->name_node->list, list) {
1727 		if (nla_put_string(skb, IFLA_ALT_IFNAME, name_node->name))
1728 			return -EMSGSIZE;
1729 		count++;
1730 	}
1731 	return count;
1732 }
1733 
rtnl_fill_prop_list(struct sk_buff * skb,const struct net_device * dev)1734 static int rtnl_fill_prop_list(struct sk_buff *skb,
1735 			       const struct net_device *dev)
1736 {
1737 	struct nlattr *prop_list;
1738 	int ret;
1739 
1740 	prop_list = nla_nest_start(skb, IFLA_PROP_LIST);
1741 	if (!prop_list)
1742 		return -EMSGSIZE;
1743 
1744 	ret = rtnl_fill_alt_ifnames(skb, dev);
1745 	if (ret <= 0)
1746 		goto nest_cancel;
1747 
1748 	nla_nest_end(skb, prop_list);
1749 	return 0;
1750 
1751 nest_cancel:
1752 	nla_nest_cancel(skb, prop_list);
1753 	return ret;
1754 }
1755 
rtnl_fill_proto_down(struct sk_buff * skb,const struct net_device * dev)1756 static int rtnl_fill_proto_down(struct sk_buff *skb,
1757 				const struct net_device *dev)
1758 {
1759 	struct nlattr *pr;
1760 	u32 preason;
1761 
1762 	if (nla_put_u8(skb, IFLA_PROTO_DOWN, dev->proto_down))
1763 		goto nla_put_failure;
1764 
1765 	preason = dev->proto_down_reason;
1766 	if (!preason)
1767 		return 0;
1768 
1769 	pr = nla_nest_start(skb, IFLA_PROTO_DOWN_REASON);
1770 	if (!pr)
1771 		return -EMSGSIZE;
1772 
1773 	if (nla_put_u32(skb, IFLA_PROTO_DOWN_REASON_VALUE, preason)) {
1774 		nla_nest_cancel(skb, pr);
1775 		goto nla_put_failure;
1776 	}
1777 
1778 	nla_nest_end(skb, pr);
1779 	return 0;
1780 
1781 nla_put_failure:
1782 	return -EMSGSIZE;
1783 }
1784 
rtnl_fill_devlink_port(struct sk_buff * skb,const struct net_device * dev)1785 static int rtnl_fill_devlink_port(struct sk_buff *skb,
1786 				  const struct net_device *dev)
1787 {
1788 	struct nlattr *devlink_port_nest;
1789 	int ret;
1790 
1791 	devlink_port_nest = nla_nest_start(skb, IFLA_DEVLINK_PORT);
1792 	if (!devlink_port_nest)
1793 		return -EMSGSIZE;
1794 
1795 	if (dev->devlink_port) {
1796 		ret = devlink_nl_port_handle_fill(skb, dev->devlink_port);
1797 		if (ret < 0)
1798 			goto nest_cancel;
1799 	}
1800 
1801 	nla_nest_end(skb, devlink_port_nest);
1802 	return 0;
1803 
1804 nest_cancel:
1805 	nla_nest_cancel(skb, devlink_port_nest);
1806 	return ret;
1807 }
1808 
rtnl_fill_ifinfo(struct sk_buff * skb,struct net_device * dev,struct net * src_net,int type,u32 pid,u32 seq,u32 change,unsigned int flags,u32 ext_filter_mask,u32 event,int * new_nsid,int new_ifindex,int tgt_netnsid,gfp_t gfp)1809 static int rtnl_fill_ifinfo(struct sk_buff *skb,
1810 			    struct net_device *dev, struct net *src_net,
1811 			    int type, u32 pid, u32 seq, u32 change,
1812 			    unsigned int flags, u32 ext_filter_mask,
1813 			    u32 event, int *new_nsid, int new_ifindex,
1814 			    int tgt_netnsid, gfp_t gfp)
1815 {
1816 	struct ifinfomsg *ifm;
1817 	struct nlmsghdr *nlh;
1818 	struct Qdisc *qdisc;
1819 
1820 	ASSERT_RTNL();
1821 	nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifm), flags);
1822 	if (nlh == NULL)
1823 		return -EMSGSIZE;
1824 
1825 	ifm = nlmsg_data(nlh);
1826 	ifm->ifi_family = AF_UNSPEC;
1827 	ifm->__ifi_pad = 0;
1828 	ifm->ifi_type = dev->type;
1829 	ifm->ifi_index = dev->ifindex;
1830 	ifm->ifi_flags = dev_get_flags(dev);
1831 	ifm->ifi_change = change;
1832 
1833 	if (tgt_netnsid >= 0 && nla_put_s32(skb, IFLA_TARGET_NETNSID, tgt_netnsid))
1834 		goto nla_put_failure;
1835 
1836 	qdisc = rtnl_dereference(dev->qdisc);
1837 	if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
1838 	    nla_put_u32(skb, IFLA_TXQLEN, dev->tx_queue_len) ||
1839 	    nla_put_u8(skb, IFLA_OPERSTATE,
1840 		       netif_running(dev) ? dev->operstate : IF_OPER_DOWN) ||
1841 	    nla_put_u8(skb, IFLA_LINKMODE, dev->link_mode) ||
1842 	    nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
1843 	    nla_put_u32(skb, IFLA_MIN_MTU, dev->min_mtu) ||
1844 	    nla_put_u32(skb, IFLA_MAX_MTU, dev->max_mtu) ||
1845 	    nla_put_u32(skb, IFLA_GROUP, dev->group) ||
1846 	    nla_put_u32(skb, IFLA_PROMISCUITY, dev->promiscuity) ||
1847 	    nla_put_u32(skb, IFLA_ALLMULTI, dev->allmulti) ||
1848 	    nla_put_u32(skb, IFLA_NUM_TX_QUEUES, dev->num_tx_queues) ||
1849 	    nla_put_u32(skb, IFLA_GSO_MAX_SEGS, dev->gso_max_segs) ||
1850 	    nla_put_u32(skb, IFLA_GSO_MAX_SIZE, dev->gso_max_size) ||
1851 	    nla_put_u32(skb, IFLA_GRO_MAX_SIZE, dev->gro_max_size) ||
1852 	    nla_put_u32(skb, IFLA_GSO_IPV4_MAX_SIZE, dev->gso_ipv4_max_size) ||
1853 	    nla_put_u32(skb, IFLA_GRO_IPV4_MAX_SIZE, dev->gro_ipv4_max_size) ||
1854 	    nla_put_u32(skb, IFLA_TSO_MAX_SIZE, dev->tso_max_size) ||
1855 	    nla_put_u32(skb, IFLA_TSO_MAX_SEGS, dev->tso_max_segs) ||
1856 #ifdef CONFIG_RPS
1857 	    nla_put_u32(skb, IFLA_NUM_RX_QUEUES, dev->num_rx_queues) ||
1858 #endif
1859 	    put_master_ifindex(skb, dev) ||
1860 	    nla_put_u8(skb, IFLA_CARRIER, netif_carrier_ok(dev)) ||
1861 	    (qdisc &&
1862 	     nla_put_string(skb, IFLA_QDISC, qdisc->ops->id)) ||
1863 	    nla_put_ifalias(skb, dev) ||
1864 	    nla_put_u32(skb, IFLA_CARRIER_CHANGES,
1865 			atomic_read(&dev->carrier_up_count) +
1866 			atomic_read(&dev->carrier_down_count)) ||
1867 	    nla_put_u32(skb, IFLA_CARRIER_UP_COUNT,
1868 			atomic_read(&dev->carrier_up_count)) ||
1869 	    nla_put_u32(skb, IFLA_CARRIER_DOWN_COUNT,
1870 			atomic_read(&dev->carrier_down_count)))
1871 		goto nla_put_failure;
1872 
1873 	if (rtnl_fill_proto_down(skb, dev))
1874 		goto nla_put_failure;
1875 
1876 	if (event != IFLA_EVENT_NONE) {
1877 		if (nla_put_u32(skb, IFLA_EVENT, event))
1878 			goto nla_put_failure;
1879 	}
1880 
1881 	if (rtnl_fill_link_ifmap(skb, dev))
1882 		goto nla_put_failure;
1883 
1884 	if (dev->addr_len) {
1885 		if (nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr) ||
1886 		    nla_put(skb, IFLA_BROADCAST, dev->addr_len, dev->broadcast))
1887 			goto nla_put_failure;
1888 	}
1889 
1890 	if (rtnl_phys_port_id_fill(skb, dev))
1891 		goto nla_put_failure;
1892 
1893 	if (rtnl_phys_port_name_fill(skb, dev))
1894 		goto nla_put_failure;
1895 
1896 	if (rtnl_phys_switch_id_fill(skb, dev))
1897 		goto nla_put_failure;
1898 
1899 	if (rtnl_fill_stats(skb, dev))
1900 		goto nla_put_failure;
1901 
1902 	if (rtnl_fill_vf(skb, dev, ext_filter_mask))
1903 		goto nla_put_failure;
1904 
1905 	if (rtnl_port_fill(skb, dev, ext_filter_mask))
1906 		goto nla_put_failure;
1907 
1908 	if (rtnl_xdp_fill(skb, dev))
1909 		goto nla_put_failure;
1910 
1911 	if (dev->rtnl_link_ops || rtnl_have_link_slave_info(dev)) {
1912 		if (rtnl_link_fill(skb, dev) < 0)
1913 			goto nla_put_failure;
1914 	}
1915 
1916 	if (rtnl_fill_link_netnsid(skb, dev, src_net, gfp))
1917 		goto nla_put_failure;
1918 
1919 	if (new_nsid &&
1920 	    nla_put_s32(skb, IFLA_NEW_NETNSID, *new_nsid) < 0)
1921 		goto nla_put_failure;
1922 	if (new_ifindex &&
1923 	    nla_put_s32(skb, IFLA_NEW_IFINDEX, new_ifindex) < 0)
1924 		goto nla_put_failure;
1925 
1926 	if (memchr_inv(dev->perm_addr, '\0', dev->addr_len) &&
1927 	    nla_put(skb, IFLA_PERM_ADDRESS, dev->addr_len, dev->perm_addr))
1928 		goto nla_put_failure;
1929 
1930 	rcu_read_lock();
1931 	if (rtnl_fill_link_af(skb, dev, ext_filter_mask))
1932 		goto nla_put_failure_rcu;
1933 	rcu_read_unlock();
1934 
1935 	if (rtnl_fill_prop_list(skb, dev))
1936 		goto nla_put_failure;
1937 
1938 	if (dev->dev.parent &&
1939 	    nla_put_string(skb, IFLA_PARENT_DEV_NAME,
1940 			   dev_name(dev->dev.parent)))
1941 		goto nla_put_failure;
1942 
1943 	if (dev->dev.parent && dev->dev.parent->bus &&
1944 	    nla_put_string(skb, IFLA_PARENT_DEV_BUS_NAME,
1945 			   dev->dev.parent->bus->name))
1946 		goto nla_put_failure;
1947 
1948 	if (rtnl_fill_devlink_port(skb, dev))
1949 		goto nla_put_failure;
1950 
1951 	nlmsg_end(skb, nlh);
1952 	return 0;
1953 
1954 nla_put_failure_rcu:
1955 	rcu_read_unlock();
1956 nla_put_failure:
1957 	nlmsg_cancel(skb, nlh);
1958 	return -EMSGSIZE;
1959 }
1960 
1961 static const struct nla_policy ifla_policy[IFLA_MAX+1] = {
1962 	[IFLA_IFNAME]		= { .type = NLA_STRING, .len = IFNAMSIZ-1 },
1963 	[IFLA_ADDRESS]		= { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
1964 	[IFLA_BROADCAST]	= { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
1965 	[IFLA_MAP]		= { .len = sizeof(struct rtnl_link_ifmap) },
1966 	[IFLA_MTU]		= { .type = NLA_U32 },
1967 	[IFLA_LINK]		= { .type = NLA_U32 },
1968 	[IFLA_MASTER]		= { .type = NLA_U32 },
1969 	[IFLA_CARRIER]		= { .type = NLA_U8 },
1970 	[IFLA_TXQLEN]		= { .type = NLA_U32 },
1971 	[IFLA_WEIGHT]		= { .type = NLA_U32 },
1972 	[IFLA_OPERSTATE]	= { .type = NLA_U8 },
1973 	[IFLA_LINKMODE]		= { .type = NLA_U8 },
1974 	[IFLA_LINKINFO]		= { .type = NLA_NESTED },
1975 	[IFLA_NET_NS_PID]	= { .type = NLA_U32 },
1976 	[IFLA_NET_NS_FD]	= { .type = NLA_U32 },
1977 	/* IFLA_IFALIAS is a string, but policy is set to NLA_BINARY to
1978 	 * allow 0-length string (needed to remove an alias).
1979 	 */
1980 	[IFLA_IFALIAS]	        = { .type = NLA_BINARY, .len = IFALIASZ - 1 },
1981 	[IFLA_VFINFO_LIST]	= {. type = NLA_NESTED },
1982 	[IFLA_VF_PORTS]		= { .type = NLA_NESTED },
1983 	[IFLA_PORT_SELF]	= { .type = NLA_NESTED },
1984 	[IFLA_AF_SPEC]		= { .type = NLA_NESTED },
1985 	[IFLA_EXT_MASK]		= { .type = NLA_U32 },
1986 	[IFLA_PROMISCUITY]	= { .type = NLA_U32 },
1987 	[IFLA_NUM_TX_QUEUES]	= { .type = NLA_U32 },
1988 	[IFLA_NUM_RX_QUEUES]	= { .type = NLA_U32 },
1989 	[IFLA_GSO_MAX_SEGS]	= { .type = NLA_U32 },
1990 	[IFLA_GSO_MAX_SIZE]	= NLA_POLICY_MIN(NLA_U32, MAX_TCP_HEADER + 1),
1991 	[IFLA_PHYS_PORT_ID]	= { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN },
1992 	[IFLA_CARRIER_CHANGES]	= { .type = NLA_U32 },  /* ignored */
1993 	[IFLA_PHYS_SWITCH_ID]	= { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN },
1994 	[IFLA_LINK_NETNSID]	= { .type = NLA_S32 },
1995 	[IFLA_PROTO_DOWN]	= { .type = NLA_U8 },
1996 	[IFLA_XDP]		= { .type = NLA_NESTED },
1997 	[IFLA_EVENT]		= { .type = NLA_U32 },
1998 	[IFLA_GROUP]		= { .type = NLA_U32 },
1999 	[IFLA_TARGET_NETNSID]	= { .type = NLA_S32 },
2000 	[IFLA_CARRIER_UP_COUNT]	= { .type = NLA_U32 },
2001 	[IFLA_CARRIER_DOWN_COUNT] = { .type = NLA_U32 },
2002 	[IFLA_MIN_MTU]		= { .type = NLA_U32 },
2003 	[IFLA_MAX_MTU]		= { .type = NLA_U32 },
2004 	[IFLA_PROP_LIST]	= { .type = NLA_NESTED },
2005 	[IFLA_ALT_IFNAME]	= { .type = NLA_STRING,
2006 				    .len = ALTIFNAMSIZ - 1 },
2007 	[IFLA_PERM_ADDRESS]	= { .type = NLA_REJECT },
2008 	[IFLA_PROTO_DOWN_REASON] = { .type = NLA_NESTED },
2009 	[IFLA_NEW_IFINDEX]	= NLA_POLICY_MIN(NLA_S32, 1),
2010 	[IFLA_PARENT_DEV_NAME]	= { .type = NLA_NUL_STRING },
2011 	[IFLA_GRO_MAX_SIZE]	= { .type = NLA_U32 },
2012 	[IFLA_TSO_MAX_SIZE]	= { .type = NLA_REJECT },
2013 	[IFLA_TSO_MAX_SEGS]	= { .type = NLA_REJECT },
2014 	[IFLA_ALLMULTI]		= { .type = NLA_REJECT },
2015 	[IFLA_GSO_IPV4_MAX_SIZE]	= NLA_POLICY_MIN(NLA_U32, MAX_TCP_HEADER + 1),
2016 	[IFLA_GRO_IPV4_MAX_SIZE]	= { .type = NLA_U32 },
2017 };
2018 
2019 static const struct nla_policy ifla_info_policy[IFLA_INFO_MAX+1] = {
2020 	[IFLA_INFO_KIND]	= { .type = NLA_STRING },
2021 	[IFLA_INFO_DATA]	= { .type = NLA_NESTED },
2022 	[IFLA_INFO_SLAVE_KIND]	= { .type = NLA_STRING },
2023 	[IFLA_INFO_SLAVE_DATA]	= { .type = NLA_NESTED },
2024 };
2025 
2026 static const struct nla_policy ifla_vf_policy[IFLA_VF_MAX+1] = {
2027 	[IFLA_VF_MAC]		= { .len = sizeof(struct ifla_vf_mac) },
2028 	[IFLA_VF_BROADCAST]	= { .type = NLA_REJECT },
2029 	[IFLA_VF_VLAN]		= { .len = sizeof(struct ifla_vf_vlan) },
2030 	[IFLA_VF_VLAN_LIST]     = { .type = NLA_NESTED },
2031 	[IFLA_VF_TX_RATE]	= { .len = sizeof(struct ifla_vf_tx_rate) },
2032 	[IFLA_VF_SPOOFCHK]	= { .len = sizeof(struct ifla_vf_spoofchk) },
2033 	[IFLA_VF_RATE]		= { .len = sizeof(struct ifla_vf_rate) },
2034 	[IFLA_VF_LINK_STATE]	= { .len = sizeof(struct ifla_vf_link_state) },
2035 	[IFLA_VF_RSS_QUERY_EN]	= { .len = sizeof(struct ifla_vf_rss_query_en) },
2036 	[IFLA_VF_STATS]		= { .type = NLA_NESTED },
2037 	[IFLA_VF_TRUST]		= { .len = sizeof(struct ifla_vf_trust) },
2038 	[IFLA_VF_IB_NODE_GUID]	= { .len = sizeof(struct ifla_vf_guid) },
2039 	[IFLA_VF_IB_PORT_GUID]	= { .len = sizeof(struct ifla_vf_guid) },
2040 };
2041 
2042 static const struct nla_policy ifla_port_policy[IFLA_PORT_MAX+1] = {
2043 	[IFLA_PORT_VF]		= { .type = NLA_U32 },
2044 	[IFLA_PORT_PROFILE]	= { .type = NLA_STRING,
2045 				    .len = PORT_PROFILE_MAX },
2046 	[IFLA_PORT_INSTANCE_UUID] = { .type = NLA_BINARY,
2047 				      .len = PORT_UUID_MAX },
2048 	[IFLA_PORT_HOST_UUID]	= { .type = NLA_STRING,
2049 				    .len = PORT_UUID_MAX },
2050 	[IFLA_PORT_REQUEST]	= { .type = NLA_U8, },
2051 	[IFLA_PORT_RESPONSE]	= { .type = NLA_U16, },
2052 
2053 	/* Unused, but we need to keep it here since user space could
2054 	 * fill it. It's also broken with regard to NLA_BINARY use in
2055 	 * combination with structs.
2056 	 */
2057 	[IFLA_PORT_VSI_TYPE]	= { .type = NLA_BINARY,
2058 				    .len = sizeof(struct ifla_port_vsi) },
2059 };
2060 
2061 static const struct nla_policy ifla_xdp_policy[IFLA_XDP_MAX + 1] = {
2062 	[IFLA_XDP_UNSPEC]	= { .strict_start_type = IFLA_XDP_EXPECTED_FD },
2063 	[IFLA_XDP_FD]		= { .type = NLA_S32 },
2064 	[IFLA_XDP_EXPECTED_FD]	= { .type = NLA_S32 },
2065 	[IFLA_XDP_ATTACHED]	= { .type = NLA_U8 },
2066 	[IFLA_XDP_FLAGS]	= { .type = NLA_U32 },
2067 	[IFLA_XDP_PROG_ID]	= { .type = NLA_U32 },
2068 };
2069 
linkinfo_to_kind_ops(const struct nlattr * nla)2070 static const struct rtnl_link_ops *linkinfo_to_kind_ops(const struct nlattr *nla)
2071 {
2072 	const struct rtnl_link_ops *ops = NULL;
2073 	struct nlattr *linfo[IFLA_INFO_MAX + 1];
2074 
2075 	if (nla_parse_nested_deprecated(linfo, IFLA_INFO_MAX, nla, ifla_info_policy, NULL) < 0)
2076 		return NULL;
2077 
2078 	if (linfo[IFLA_INFO_KIND]) {
2079 		char kind[MODULE_NAME_LEN];
2080 
2081 		nla_strscpy(kind, linfo[IFLA_INFO_KIND], sizeof(kind));
2082 		ops = rtnl_link_ops_get(kind);
2083 	}
2084 
2085 	return ops;
2086 }
2087 
link_master_filtered(struct net_device * dev,int master_idx)2088 static bool link_master_filtered(struct net_device *dev, int master_idx)
2089 {
2090 	struct net_device *master;
2091 
2092 	if (!master_idx)
2093 		return false;
2094 
2095 	master = netdev_master_upper_dev_get(dev);
2096 
2097 	/* 0 is already used to denote IFLA_MASTER wasn't passed, therefore need
2098 	 * another invalid value for ifindex to denote "no master".
2099 	 */
2100 	if (master_idx == -1)
2101 		return !!master;
2102 
2103 	if (!master || master->ifindex != master_idx)
2104 		return true;
2105 
2106 	return false;
2107 }
2108 
link_kind_filtered(const struct net_device * dev,const struct rtnl_link_ops * kind_ops)2109 static bool link_kind_filtered(const struct net_device *dev,
2110 			       const struct rtnl_link_ops *kind_ops)
2111 {
2112 	if (kind_ops && dev->rtnl_link_ops != kind_ops)
2113 		return true;
2114 
2115 	return false;
2116 }
2117 
link_dump_filtered(struct net_device * dev,int master_idx,const struct rtnl_link_ops * kind_ops)2118 static bool link_dump_filtered(struct net_device *dev,
2119 			       int master_idx,
2120 			       const struct rtnl_link_ops *kind_ops)
2121 {
2122 	if (link_master_filtered(dev, master_idx) ||
2123 	    link_kind_filtered(dev, kind_ops))
2124 		return true;
2125 
2126 	return false;
2127 }
2128 
2129 /**
2130  * rtnl_get_net_ns_capable - Get netns if sufficiently privileged.
2131  * @sk: netlink socket
2132  * @netnsid: network namespace identifier
2133  *
2134  * Returns the network namespace identified by netnsid on success or an error
2135  * pointer on failure.
2136  */
rtnl_get_net_ns_capable(struct sock * sk,int netnsid)2137 struct net *rtnl_get_net_ns_capable(struct sock *sk, int netnsid)
2138 {
2139 	struct net *net;
2140 
2141 	net = get_net_ns_by_id(sock_net(sk), netnsid);
2142 	if (!net)
2143 		return ERR_PTR(-EINVAL);
2144 
2145 	/* For now, the caller is required to have CAP_NET_ADMIN in
2146 	 * the user namespace owning the target net ns.
2147 	 */
2148 	if (!sk_ns_capable(sk, net->user_ns, CAP_NET_ADMIN)) {
2149 		put_net(net);
2150 		return ERR_PTR(-EACCES);
2151 	}
2152 	return net;
2153 }
2154 EXPORT_SYMBOL_GPL(rtnl_get_net_ns_capable);
2155 
rtnl_valid_dump_ifinfo_req(const struct nlmsghdr * nlh,bool strict_check,struct nlattr ** tb,struct netlink_ext_ack * extack)2156 static int rtnl_valid_dump_ifinfo_req(const struct nlmsghdr *nlh,
2157 				      bool strict_check, struct nlattr **tb,
2158 				      struct netlink_ext_ack *extack)
2159 {
2160 	int hdrlen;
2161 
2162 	if (strict_check) {
2163 		struct ifinfomsg *ifm;
2164 
2165 		if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ifm))) {
2166 			NL_SET_ERR_MSG(extack, "Invalid header for link dump");
2167 			return -EINVAL;
2168 		}
2169 
2170 		ifm = nlmsg_data(nlh);
2171 		if (ifm->__ifi_pad || ifm->ifi_type || ifm->ifi_flags ||
2172 		    ifm->ifi_change) {
2173 			NL_SET_ERR_MSG(extack, "Invalid values in header for link dump request");
2174 			return -EINVAL;
2175 		}
2176 		if (ifm->ifi_index) {
2177 			NL_SET_ERR_MSG(extack, "Filter by device index not supported for link dumps");
2178 			return -EINVAL;
2179 		}
2180 
2181 		return nlmsg_parse_deprecated_strict(nlh, sizeof(*ifm), tb,
2182 						     IFLA_MAX, ifla_policy,
2183 						     extack);
2184 	}
2185 
2186 	/* A hack to preserve kernel<->userspace interface.
2187 	 * The correct header is ifinfomsg. It is consistent with rtnl_getlink.
2188 	 * However, before Linux v3.9 the code here assumed rtgenmsg and that's
2189 	 * what iproute2 < v3.9.0 used.
2190 	 * We can detect the old iproute2. Even including the IFLA_EXT_MASK
2191 	 * attribute, its netlink message is shorter than struct ifinfomsg.
2192 	 */
2193 	hdrlen = nlmsg_len(nlh) < sizeof(struct ifinfomsg) ?
2194 		 sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg);
2195 
2196 	return nlmsg_parse_deprecated(nlh, hdrlen, tb, IFLA_MAX, ifla_policy,
2197 				      extack);
2198 }
2199 
rtnl_dump_ifinfo(struct sk_buff * skb,struct netlink_callback * cb)2200 static int rtnl_dump_ifinfo(struct sk_buff *skb, struct netlink_callback *cb)
2201 {
2202 	struct netlink_ext_ack *extack = cb->extack;
2203 	const struct nlmsghdr *nlh = cb->nlh;
2204 	struct net *net = sock_net(skb->sk);
2205 	struct net *tgt_net = net;
2206 	int h, s_h;
2207 	int idx = 0, s_idx;
2208 	struct net_device *dev;
2209 	struct hlist_head *head;
2210 	struct nlattr *tb[IFLA_MAX+1];
2211 	u32 ext_filter_mask = 0;
2212 	const struct rtnl_link_ops *kind_ops = NULL;
2213 	unsigned int flags = NLM_F_MULTI;
2214 	int master_idx = 0;
2215 	int netnsid = -1;
2216 	int err, i;
2217 
2218 	s_h = cb->args[0];
2219 	s_idx = cb->args[1];
2220 
2221 	err = rtnl_valid_dump_ifinfo_req(nlh, cb->strict_check, tb, extack);
2222 	if (err < 0) {
2223 		if (cb->strict_check)
2224 			return err;
2225 
2226 		goto walk_entries;
2227 	}
2228 
2229 	for (i = 0; i <= IFLA_MAX; ++i) {
2230 		if (!tb[i])
2231 			continue;
2232 
2233 		/* new attributes should only be added with strict checking */
2234 		switch (i) {
2235 		case IFLA_TARGET_NETNSID:
2236 			netnsid = nla_get_s32(tb[i]);
2237 			tgt_net = rtnl_get_net_ns_capable(skb->sk, netnsid);
2238 			if (IS_ERR(tgt_net)) {
2239 				NL_SET_ERR_MSG(extack, "Invalid target network namespace id");
2240 				return PTR_ERR(tgt_net);
2241 			}
2242 			break;
2243 		case IFLA_EXT_MASK:
2244 			ext_filter_mask = nla_get_u32(tb[i]);
2245 			break;
2246 		case IFLA_MASTER:
2247 			master_idx = nla_get_u32(tb[i]);
2248 			break;
2249 		case IFLA_LINKINFO:
2250 			kind_ops = linkinfo_to_kind_ops(tb[i]);
2251 			break;
2252 		default:
2253 			if (cb->strict_check) {
2254 				NL_SET_ERR_MSG(extack, "Unsupported attribute in link dump request");
2255 				return -EINVAL;
2256 			}
2257 		}
2258 	}
2259 
2260 	if (master_idx || kind_ops)
2261 		flags |= NLM_F_DUMP_FILTERED;
2262 
2263 walk_entries:
2264 	for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
2265 		idx = 0;
2266 		head = &tgt_net->dev_index_head[h];
2267 		hlist_for_each_entry(dev, head, index_hlist) {
2268 			if (link_dump_filtered(dev, master_idx, kind_ops))
2269 				goto cont;
2270 			if (idx < s_idx)
2271 				goto cont;
2272 			err = rtnl_fill_ifinfo(skb, dev, net,
2273 					       RTM_NEWLINK,
2274 					       NETLINK_CB(cb->skb).portid,
2275 					       nlh->nlmsg_seq, 0, flags,
2276 					       ext_filter_mask, 0, NULL, 0,
2277 					       netnsid, GFP_KERNEL);
2278 
2279 			if (err < 0) {
2280 				if (likely(skb->len))
2281 					goto out;
2282 
2283 				goto out_err;
2284 			}
2285 cont:
2286 			idx++;
2287 		}
2288 	}
2289 out:
2290 	err = skb->len;
2291 out_err:
2292 	cb->args[1] = idx;
2293 	cb->args[0] = h;
2294 	cb->seq = tgt_net->dev_base_seq;
2295 	nl_dump_check_consistent(cb, nlmsg_hdr(skb));
2296 	if (netnsid >= 0)
2297 		put_net(tgt_net);
2298 
2299 	return err;
2300 }
2301 
rtnl_nla_parse_ifinfomsg(struct nlattr ** tb,const struct nlattr * nla_peer,struct netlink_ext_ack * exterr)2302 int rtnl_nla_parse_ifinfomsg(struct nlattr **tb, const struct nlattr *nla_peer,
2303 			     struct netlink_ext_ack *exterr)
2304 {
2305 	const struct ifinfomsg *ifmp;
2306 	const struct nlattr *attrs;
2307 	size_t len;
2308 
2309 	ifmp = nla_data(nla_peer);
2310 	attrs = nla_data(nla_peer) + sizeof(struct ifinfomsg);
2311 	len = nla_len(nla_peer) - sizeof(struct ifinfomsg);
2312 
2313 	if (ifmp->ifi_index < 0) {
2314 		NL_SET_ERR_MSG_ATTR(exterr, nla_peer,
2315 				    "ifindex can't be negative");
2316 		return -EINVAL;
2317 	}
2318 
2319 	return nla_parse_deprecated(tb, IFLA_MAX, attrs, len, ifla_policy,
2320 				    exterr);
2321 }
2322 EXPORT_SYMBOL(rtnl_nla_parse_ifinfomsg);
2323 
rtnl_link_get_net(struct net * src_net,struct nlattr * tb[])2324 struct net *rtnl_link_get_net(struct net *src_net, struct nlattr *tb[])
2325 {
2326 	struct net *net;
2327 	/* Examine the link attributes and figure out which
2328 	 * network namespace we are talking about.
2329 	 */
2330 	if (tb[IFLA_NET_NS_PID])
2331 		net = get_net_ns_by_pid(nla_get_u32(tb[IFLA_NET_NS_PID]));
2332 	else if (tb[IFLA_NET_NS_FD])
2333 		net = get_net_ns_by_fd(nla_get_u32(tb[IFLA_NET_NS_FD]));
2334 	else
2335 		net = get_net(src_net);
2336 	return net;
2337 }
2338 EXPORT_SYMBOL(rtnl_link_get_net);
2339 
2340 /* Figure out which network namespace we are talking about by
2341  * examining the link attributes in the following order:
2342  *
2343  * 1. IFLA_NET_NS_PID
2344  * 2. IFLA_NET_NS_FD
2345  * 3. IFLA_TARGET_NETNSID
2346  */
rtnl_link_get_net_by_nlattr(struct net * src_net,struct nlattr * tb[])2347 static struct net *rtnl_link_get_net_by_nlattr(struct net *src_net,
2348 					       struct nlattr *tb[])
2349 {
2350 	struct net *net;
2351 
2352 	if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD])
2353 		return rtnl_link_get_net(src_net, tb);
2354 
2355 	if (!tb[IFLA_TARGET_NETNSID])
2356 		return get_net(src_net);
2357 
2358 	net = get_net_ns_by_id(src_net, nla_get_u32(tb[IFLA_TARGET_NETNSID]));
2359 	if (!net)
2360 		return ERR_PTR(-EINVAL);
2361 
2362 	return net;
2363 }
2364 
rtnl_link_get_net_capable(const struct sk_buff * skb,struct net * src_net,struct nlattr * tb[],int cap)2365 static struct net *rtnl_link_get_net_capable(const struct sk_buff *skb,
2366 					     struct net *src_net,
2367 					     struct nlattr *tb[], int cap)
2368 {
2369 	struct net *net;
2370 
2371 	net = rtnl_link_get_net_by_nlattr(src_net, tb);
2372 	if (IS_ERR(net))
2373 		return net;
2374 
2375 	if (!netlink_ns_capable(skb, net->user_ns, cap)) {
2376 		put_net(net);
2377 		return ERR_PTR(-EPERM);
2378 	}
2379 
2380 	return net;
2381 }
2382 
2383 /* Verify that rtnetlink requests do not pass additional properties
2384  * potentially referring to different network namespaces.
2385  */
rtnl_ensure_unique_netns(struct nlattr * tb[],struct netlink_ext_ack * extack,bool netns_id_only)2386 static int rtnl_ensure_unique_netns(struct nlattr *tb[],
2387 				    struct netlink_ext_ack *extack,
2388 				    bool netns_id_only)
2389 {
2390 
2391 	if (netns_id_only) {
2392 		if (!tb[IFLA_NET_NS_PID] && !tb[IFLA_NET_NS_FD])
2393 			return 0;
2394 
2395 		NL_SET_ERR_MSG(extack, "specified netns attribute not supported");
2396 		return -EOPNOTSUPP;
2397 	}
2398 
2399 	if (tb[IFLA_TARGET_NETNSID] && (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD]))
2400 		goto invalid_attr;
2401 
2402 	if (tb[IFLA_NET_NS_PID] && (tb[IFLA_TARGET_NETNSID] || tb[IFLA_NET_NS_FD]))
2403 		goto invalid_attr;
2404 
2405 	if (tb[IFLA_NET_NS_FD] && (tb[IFLA_TARGET_NETNSID] || tb[IFLA_NET_NS_PID]))
2406 		goto invalid_attr;
2407 
2408 	return 0;
2409 
2410 invalid_attr:
2411 	NL_SET_ERR_MSG(extack, "multiple netns identifying attributes specified");
2412 	return -EINVAL;
2413 }
2414 
rtnl_set_vf_rate(struct net_device * dev,int vf,int min_tx_rate,int max_tx_rate)2415 static	int rtnl_set_vf_rate(struct net_device *dev, int vf, int min_tx_rate,
2416 			     int max_tx_rate)
2417 {
2418 	const struct net_device_ops *ops = dev->netdev_ops;
2419 
2420 	if (!ops->ndo_set_vf_rate)
2421 		return -EOPNOTSUPP;
2422 	if (max_tx_rate && max_tx_rate < min_tx_rate)
2423 		return -EINVAL;
2424 
2425 	return ops->ndo_set_vf_rate(dev, vf, min_tx_rate, max_tx_rate);
2426 }
2427 
validate_linkmsg(struct net_device * dev,struct nlattr * tb[],struct netlink_ext_ack * extack)2428 static int validate_linkmsg(struct net_device *dev, struct nlattr *tb[],
2429 			    struct netlink_ext_ack *extack)
2430 {
2431 	if (tb[IFLA_ADDRESS] &&
2432 	    nla_len(tb[IFLA_ADDRESS]) < dev->addr_len)
2433 		return -EINVAL;
2434 
2435 	if (tb[IFLA_BROADCAST] &&
2436 	    nla_len(tb[IFLA_BROADCAST]) < dev->addr_len)
2437 		return -EINVAL;
2438 
2439 	if (tb[IFLA_GSO_MAX_SIZE] &&
2440 	    nla_get_u32(tb[IFLA_GSO_MAX_SIZE]) > dev->tso_max_size) {
2441 		NL_SET_ERR_MSG(extack, "too big gso_max_size");
2442 		return -EINVAL;
2443 	}
2444 
2445 	if (tb[IFLA_GSO_MAX_SEGS] &&
2446 	    (nla_get_u32(tb[IFLA_GSO_MAX_SEGS]) > GSO_MAX_SEGS ||
2447 	     nla_get_u32(tb[IFLA_GSO_MAX_SEGS]) > dev->tso_max_segs)) {
2448 		NL_SET_ERR_MSG(extack, "too big gso_max_segs");
2449 		return -EINVAL;
2450 	}
2451 
2452 	if (tb[IFLA_GRO_MAX_SIZE] &&
2453 	    nla_get_u32(tb[IFLA_GRO_MAX_SIZE]) > GRO_MAX_SIZE) {
2454 		NL_SET_ERR_MSG(extack, "too big gro_max_size");
2455 		return -EINVAL;
2456 	}
2457 
2458 	if (tb[IFLA_GSO_IPV4_MAX_SIZE] &&
2459 	    nla_get_u32(tb[IFLA_GSO_IPV4_MAX_SIZE]) > dev->tso_max_size) {
2460 		NL_SET_ERR_MSG(extack, "too big gso_ipv4_max_size");
2461 		return -EINVAL;
2462 	}
2463 
2464 	if (tb[IFLA_GRO_IPV4_MAX_SIZE] &&
2465 	    nla_get_u32(tb[IFLA_GRO_IPV4_MAX_SIZE]) > GRO_MAX_SIZE) {
2466 		NL_SET_ERR_MSG(extack, "too big gro_ipv4_max_size");
2467 		return -EINVAL;
2468 	}
2469 
2470 	if (tb[IFLA_AF_SPEC]) {
2471 		struct nlattr *af;
2472 		int rem, err;
2473 
2474 		nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) {
2475 			const struct rtnl_af_ops *af_ops;
2476 
2477 			af_ops = rtnl_af_lookup(nla_type(af));
2478 			if (!af_ops)
2479 				return -EAFNOSUPPORT;
2480 
2481 			if (!af_ops->set_link_af)
2482 				return -EOPNOTSUPP;
2483 
2484 			if (af_ops->validate_link_af) {
2485 				err = af_ops->validate_link_af(dev, af, extack);
2486 				if (err < 0)
2487 					return err;
2488 			}
2489 		}
2490 	}
2491 
2492 	return 0;
2493 }
2494 
handle_infiniband_guid(struct net_device * dev,struct ifla_vf_guid * ivt,int guid_type)2495 static int handle_infiniband_guid(struct net_device *dev, struct ifla_vf_guid *ivt,
2496 				  int guid_type)
2497 {
2498 	const struct net_device_ops *ops = dev->netdev_ops;
2499 
2500 	return ops->ndo_set_vf_guid(dev, ivt->vf, ivt->guid, guid_type);
2501 }
2502 
handle_vf_guid(struct net_device * dev,struct ifla_vf_guid * ivt,int guid_type)2503 static int handle_vf_guid(struct net_device *dev, struct ifla_vf_guid *ivt, int guid_type)
2504 {
2505 	if (dev->type != ARPHRD_INFINIBAND)
2506 		return -EOPNOTSUPP;
2507 
2508 	return handle_infiniband_guid(dev, ivt, guid_type);
2509 }
2510 
do_setvfinfo(struct net_device * dev,struct nlattr ** tb)2511 static int do_setvfinfo(struct net_device *dev, struct nlattr **tb)
2512 {
2513 	const struct net_device_ops *ops = dev->netdev_ops;
2514 	int err = -EINVAL;
2515 
2516 	if (tb[IFLA_VF_MAC]) {
2517 		struct ifla_vf_mac *ivm = nla_data(tb[IFLA_VF_MAC]);
2518 
2519 		if (ivm->vf >= INT_MAX)
2520 			return -EINVAL;
2521 		err = -EOPNOTSUPP;
2522 		if (ops->ndo_set_vf_mac)
2523 			err = ops->ndo_set_vf_mac(dev, ivm->vf,
2524 						  ivm->mac);
2525 		if (err < 0)
2526 			return err;
2527 	}
2528 
2529 	if (tb[IFLA_VF_VLAN]) {
2530 		struct ifla_vf_vlan *ivv = nla_data(tb[IFLA_VF_VLAN]);
2531 
2532 		if (ivv->vf >= INT_MAX)
2533 			return -EINVAL;
2534 		err = -EOPNOTSUPP;
2535 		if (ops->ndo_set_vf_vlan)
2536 			err = ops->ndo_set_vf_vlan(dev, ivv->vf, ivv->vlan,
2537 						   ivv->qos,
2538 						   htons(ETH_P_8021Q));
2539 		if (err < 0)
2540 			return err;
2541 	}
2542 
2543 	if (tb[IFLA_VF_VLAN_LIST]) {
2544 		struct ifla_vf_vlan_info *ivvl[MAX_VLAN_LIST_LEN];
2545 		struct nlattr *attr;
2546 		int rem, len = 0;
2547 
2548 		err = -EOPNOTSUPP;
2549 		if (!ops->ndo_set_vf_vlan)
2550 			return err;
2551 
2552 		nla_for_each_nested(attr, tb[IFLA_VF_VLAN_LIST], rem) {
2553 			if (nla_type(attr) != IFLA_VF_VLAN_INFO ||
2554 			    nla_len(attr) < sizeof(struct ifla_vf_vlan_info)) {
2555 				return -EINVAL;
2556 			}
2557 			if (len >= MAX_VLAN_LIST_LEN)
2558 				return -EOPNOTSUPP;
2559 			ivvl[len] = nla_data(attr);
2560 
2561 			len++;
2562 		}
2563 		if (len == 0)
2564 			return -EINVAL;
2565 
2566 		if (ivvl[0]->vf >= INT_MAX)
2567 			return -EINVAL;
2568 		err = ops->ndo_set_vf_vlan(dev, ivvl[0]->vf, ivvl[0]->vlan,
2569 					   ivvl[0]->qos, ivvl[0]->vlan_proto);
2570 		if (err < 0)
2571 			return err;
2572 	}
2573 
2574 	if (tb[IFLA_VF_TX_RATE]) {
2575 		struct ifla_vf_tx_rate *ivt = nla_data(tb[IFLA_VF_TX_RATE]);
2576 		struct ifla_vf_info ivf;
2577 
2578 		if (ivt->vf >= INT_MAX)
2579 			return -EINVAL;
2580 		err = -EOPNOTSUPP;
2581 		if (ops->ndo_get_vf_config)
2582 			err = ops->ndo_get_vf_config(dev, ivt->vf, &ivf);
2583 		if (err < 0)
2584 			return err;
2585 
2586 		err = rtnl_set_vf_rate(dev, ivt->vf,
2587 				       ivf.min_tx_rate, ivt->rate);
2588 		if (err < 0)
2589 			return err;
2590 	}
2591 
2592 	if (tb[IFLA_VF_RATE]) {
2593 		struct ifla_vf_rate *ivt = nla_data(tb[IFLA_VF_RATE]);
2594 
2595 		if (ivt->vf >= INT_MAX)
2596 			return -EINVAL;
2597 
2598 		err = rtnl_set_vf_rate(dev, ivt->vf,
2599 				       ivt->min_tx_rate, ivt->max_tx_rate);
2600 		if (err < 0)
2601 			return err;
2602 	}
2603 
2604 	if (tb[IFLA_VF_SPOOFCHK]) {
2605 		struct ifla_vf_spoofchk *ivs = nla_data(tb[IFLA_VF_SPOOFCHK]);
2606 
2607 		if (ivs->vf >= INT_MAX)
2608 			return -EINVAL;
2609 		err = -EOPNOTSUPP;
2610 		if (ops->ndo_set_vf_spoofchk)
2611 			err = ops->ndo_set_vf_spoofchk(dev, ivs->vf,
2612 						       ivs->setting);
2613 		if (err < 0)
2614 			return err;
2615 	}
2616 
2617 	if (tb[IFLA_VF_LINK_STATE]) {
2618 		struct ifla_vf_link_state *ivl = nla_data(tb[IFLA_VF_LINK_STATE]);
2619 
2620 		if (ivl->vf >= INT_MAX)
2621 			return -EINVAL;
2622 		err = -EOPNOTSUPP;
2623 		if (ops->ndo_set_vf_link_state)
2624 			err = ops->ndo_set_vf_link_state(dev, ivl->vf,
2625 							 ivl->link_state);
2626 		if (err < 0)
2627 			return err;
2628 	}
2629 
2630 	if (tb[IFLA_VF_RSS_QUERY_EN]) {
2631 		struct ifla_vf_rss_query_en *ivrssq_en;
2632 
2633 		err = -EOPNOTSUPP;
2634 		ivrssq_en = nla_data(tb[IFLA_VF_RSS_QUERY_EN]);
2635 		if (ivrssq_en->vf >= INT_MAX)
2636 			return -EINVAL;
2637 		if (ops->ndo_set_vf_rss_query_en)
2638 			err = ops->ndo_set_vf_rss_query_en(dev, ivrssq_en->vf,
2639 							   ivrssq_en->setting);
2640 		if (err < 0)
2641 			return err;
2642 	}
2643 
2644 	if (tb[IFLA_VF_TRUST]) {
2645 		struct ifla_vf_trust *ivt = nla_data(tb[IFLA_VF_TRUST]);
2646 
2647 		if (ivt->vf >= INT_MAX)
2648 			return -EINVAL;
2649 		err = -EOPNOTSUPP;
2650 		if (ops->ndo_set_vf_trust)
2651 			err = ops->ndo_set_vf_trust(dev, ivt->vf, ivt->setting);
2652 		if (err < 0)
2653 			return err;
2654 	}
2655 
2656 	if (tb[IFLA_VF_IB_NODE_GUID]) {
2657 		struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_NODE_GUID]);
2658 
2659 		if (ivt->vf >= INT_MAX)
2660 			return -EINVAL;
2661 		if (!ops->ndo_set_vf_guid)
2662 			return -EOPNOTSUPP;
2663 		return handle_vf_guid(dev, ivt, IFLA_VF_IB_NODE_GUID);
2664 	}
2665 
2666 	if (tb[IFLA_VF_IB_PORT_GUID]) {
2667 		struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_PORT_GUID]);
2668 
2669 		if (ivt->vf >= INT_MAX)
2670 			return -EINVAL;
2671 		if (!ops->ndo_set_vf_guid)
2672 			return -EOPNOTSUPP;
2673 
2674 		return handle_vf_guid(dev, ivt, IFLA_VF_IB_PORT_GUID);
2675 	}
2676 
2677 	return err;
2678 }
2679 
do_set_master(struct net_device * dev,int ifindex,struct netlink_ext_ack * extack)2680 static int do_set_master(struct net_device *dev, int ifindex,
2681 			 struct netlink_ext_ack *extack)
2682 {
2683 	struct net_device *upper_dev = netdev_master_upper_dev_get(dev);
2684 	const struct net_device_ops *ops;
2685 	int err;
2686 
2687 	if (upper_dev) {
2688 		if (upper_dev->ifindex == ifindex)
2689 			return 0;
2690 		ops = upper_dev->netdev_ops;
2691 		if (ops->ndo_del_slave) {
2692 			err = ops->ndo_del_slave(upper_dev, dev);
2693 			if (err)
2694 				return err;
2695 		} else {
2696 			return -EOPNOTSUPP;
2697 		}
2698 	}
2699 
2700 	if (ifindex) {
2701 		upper_dev = __dev_get_by_index(dev_net(dev), ifindex);
2702 		if (!upper_dev)
2703 			return -EINVAL;
2704 		ops = upper_dev->netdev_ops;
2705 		if (ops->ndo_add_slave) {
2706 			err = ops->ndo_add_slave(upper_dev, dev, extack);
2707 			if (err)
2708 				return err;
2709 		} else {
2710 			return -EOPNOTSUPP;
2711 		}
2712 	}
2713 	return 0;
2714 }
2715 
2716 static const struct nla_policy ifla_proto_down_reason_policy[IFLA_PROTO_DOWN_REASON_VALUE + 1] = {
2717 	[IFLA_PROTO_DOWN_REASON_MASK]	= { .type = NLA_U32 },
2718 	[IFLA_PROTO_DOWN_REASON_VALUE]	= { .type = NLA_U32 },
2719 };
2720 
do_set_proto_down(struct net_device * dev,struct nlattr * nl_proto_down,struct nlattr * nl_proto_down_reason,struct netlink_ext_ack * extack)2721 static int do_set_proto_down(struct net_device *dev,
2722 			     struct nlattr *nl_proto_down,
2723 			     struct nlattr *nl_proto_down_reason,
2724 			     struct netlink_ext_ack *extack)
2725 {
2726 	struct nlattr *pdreason[IFLA_PROTO_DOWN_REASON_MAX + 1];
2727 	unsigned long mask = 0;
2728 	u32 value;
2729 	bool proto_down;
2730 	int err;
2731 
2732 	if (!(dev->priv_flags & IFF_CHANGE_PROTO_DOWN)) {
2733 		NL_SET_ERR_MSG(extack,  "Protodown not supported by device");
2734 		return -EOPNOTSUPP;
2735 	}
2736 
2737 	if (nl_proto_down_reason) {
2738 		err = nla_parse_nested_deprecated(pdreason,
2739 						  IFLA_PROTO_DOWN_REASON_MAX,
2740 						  nl_proto_down_reason,
2741 						  ifla_proto_down_reason_policy,
2742 						  NULL);
2743 		if (err < 0)
2744 			return err;
2745 
2746 		if (!pdreason[IFLA_PROTO_DOWN_REASON_VALUE]) {
2747 			NL_SET_ERR_MSG(extack, "Invalid protodown reason value");
2748 			return -EINVAL;
2749 		}
2750 
2751 		value = nla_get_u32(pdreason[IFLA_PROTO_DOWN_REASON_VALUE]);
2752 
2753 		if (pdreason[IFLA_PROTO_DOWN_REASON_MASK])
2754 			mask = nla_get_u32(pdreason[IFLA_PROTO_DOWN_REASON_MASK]);
2755 
2756 		dev_change_proto_down_reason(dev, mask, value);
2757 	}
2758 
2759 	if (nl_proto_down) {
2760 		proto_down = nla_get_u8(nl_proto_down);
2761 
2762 		/* Don't turn off protodown if there are active reasons */
2763 		if (!proto_down && dev->proto_down_reason) {
2764 			NL_SET_ERR_MSG(extack, "Cannot clear protodown, active reasons");
2765 			return -EBUSY;
2766 		}
2767 		err = dev_change_proto_down(dev,
2768 					    proto_down);
2769 		if (err)
2770 			return err;
2771 	}
2772 
2773 	return 0;
2774 }
2775 
2776 #define DO_SETLINK_MODIFIED	0x01
2777 /* notify flag means notify + modified. */
2778 #define DO_SETLINK_NOTIFY	0x03
do_setlink(const struct sk_buff * skb,struct net_device * dev,struct ifinfomsg * ifm,struct netlink_ext_ack * extack,struct nlattr ** tb,int status)2779 static int do_setlink(const struct sk_buff *skb,
2780 		      struct net_device *dev, struct ifinfomsg *ifm,
2781 		      struct netlink_ext_ack *extack,
2782 		      struct nlattr **tb, int status)
2783 {
2784 	const struct net_device_ops *ops = dev->netdev_ops;
2785 	char ifname[IFNAMSIZ];
2786 	int err;
2787 
2788 	if (tb[IFLA_IFNAME])
2789 		nla_strscpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
2790 	else
2791 		ifname[0] = '\0';
2792 
2793 	if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD] || tb[IFLA_TARGET_NETNSID]) {
2794 		const char *pat = ifname[0] ? ifname : NULL;
2795 		struct net *net;
2796 		int new_ifindex;
2797 
2798 		net = rtnl_link_get_net_capable(skb, dev_net(dev),
2799 						tb, CAP_NET_ADMIN);
2800 		if (IS_ERR(net)) {
2801 			err = PTR_ERR(net);
2802 			goto errout;
2803 		}
2804 
2805 		if (tb[IFLA_NEW_IFINDEX])
2806 			new_ifindex = nla_get_s32(tb[IFLA_NEW_IFINDEX]);
2807 		else
2808 			new_ifindex = 0;
2809 
2810 		err = __dev_change_net_namespace(dev, net, pat, new_ifindex);
2811 		put_net(net);
2812 		if (err)
2813 			goto errout;
2814 		status |= DO_SETLINK_MODIFIED;
2815 	}
2816 
2817 	if (tb[IFLA_MAP]) {
2818 		struct rtnl_link_ifmap *u_map;
2819 		struct ifmap k_map;
2820 
2821 		if (!ops->ndo_set_config) {
2822 			err = -EOPNOTSUPP;
2823 			goto errout;
2824 		}
2825 
2826 		if (!netif_device_present(dev)) {
2827 			err = -ENODEV;
2828 			goto errout;
2829 		}
2830 
2831 		u_map = nla_data(tb[IFLA_MAP]);
2832 		k_map.mem_start = (unsigned long) u_map->mem_start;
2833 		k_map.mem_end = (unsigned long) u_map->mem_end;
2834 		k_map.base_addr = (unsigned short) u_map->base_addr;
2835 		k_map.irq = (unsigned char) u_map->irq;
2836 		k_map.dma = (unsigned char) u_map->dma;
2837 		k_map.port = (unsigned char) u_map->port;
2838 
2839 		err = ops->ndo_set_config(dev, &k_map);
2840 		if (err < 0)
2841 			goto errout;
2842 
2843 		status |= DO_SETLINK_NOTIFY;
2844 	}
2845 
2846 	if (tb[IFLA_ADDRESS]) {
2847 		struct sockaddr *sa;
2848 		int len;
2849 
2850 		len = sizeof(sa_family_t) + max_t(size_t, dev->addr_len,
2851 						  sizeof(*sa));
2852 		sa = kmalloc(len, GFP_KERNEL);
2853 		if (!sa) {
2854 			err = -ENOMEM;
2855 			goto errout;
2856 		}
2857 		sa->sa_family = dev->type;
2858 		memcpy(sa->sa_data, nla_data(tb[IFLA_ADDRESS]),
2859 		       dev->addr_len);
2860 		err = dev_set_mac_address_user(dev, sa, extack);
2861 		kfree(sa);
2862 		if (err)
2863 			goto errout;
2864 		status |= DO_SETLINK_MODIFIED;
2865 	}
2866 
2867 	if (tb[IFLA_MTU]) {
2868 		err = dev_set_mtu_ext(dev, nla_get_u32(tb[IFLA_MTU]), extack);
2869 		if (err < 0)
2870 			goto errout;
2871 		status |= DO_SETLINK_MODIFIED;
2872 	}
2873 
2874 	if (tb[IFLA_GROUP]) {
2875 		dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP]));
2876 		status |= DO_SETLINK_NOTIFY;
2877 	}
2878 
2879 	/*
2880 	 * Interface selected by interface index but interface
2881 	 * name provided implies that a name change has been
2882 	 * requested.
2883 	 */
2884 	if (ifm->ifi_index > 0 && ifname[0]) {
2885 		err = dev_change_name(dev, ifname);
2886 		if (err < 0)
2887 			goto errout;
2888 		status |= DO_SETLINK_MODIFIED;
2889 	}
2890 
2891 	if (tb[IFLA_IFALIAS]) {
2892 		err = dev_set_alias(dev, nla_data(tb[IFLA_IFALIAS]),
2893 				    nla_len(tb[IFLA_IFALIAS]));
2894 		if (err < 0)
2895 			goto errout;
2896 		status |= DO_SETLINK_NOTIFY;
2897 	}
2898 
2899 	if (tb[IFLA_BROADCAST]) {
2900 		nla_memcpy(dev->broadcast, tb[IFLA_BROADCAST], dev->addr_len);
2901 		call_netdevice_notifiers(NETDEV_CHANGEADDR, dev);
2902 	}
2903 
2904 	if (ifm->ifi_flags || ifm->ifi_change) {
2905 		err = dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm),
2906 				       extack);
2907 		if (err < 0)
2908 			goto errout;
2909 	}
2910 
2911 	if (tb[IFLA_MASTER]) {
2912 		err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]), extack);
2913 		if (err)
2914 			goto errout;
2915 		status |= DO_SETLINK_MODIFIED;
2916 	}
2917 
2918 	if (tb[IFLA_CARRIER]) {
2919 		err = dev_change_carrier(dev, nla_get_u8(tb[IFLA_CARRIER]));
2920 		if (err)
2921 			goto errout;
2922 		status |= DO_SETLINK_MODIFIED;
2923 	}
2924 
2925 	if (tb[IFLA_TXQLEN]) {
2926 		unsigned int value = nla_get_u32(tb[IFLA_TXQLEN]);
2927 
2928 		err = dev_change_tx_queue_len(dev, value);
2929 		if (err)
2930 			goto errout;
2931 		status |= DO_SETLINK_MODIFIED;
2932 	}
2933 
2934 	if (tb[IFLA_GSO_MAX_SIZE]) {
2935 		u32 max_size = nla_get_u32(tb[IFLA_GSO_MAX_SIZE]);
2936 
2937 		if (dev->gso_max_size ^ max_size) {
2938 			netif_set_gso_max_size(dev, max_size);
2939 			status |= DO_SETLINK_MODIFIED;
2940 		}
2941 	}
2942 
2943 	if (tb[IFLA_GSO_MAX_SEGS]) {
2944 		u32 max_segs = nla_get_u32(tb[IFLA_GSO_MAX_SEGS]);
2945 
2946 		if (dev->gso_max_segs ^ max_segs) {
2947 			netif_set_gso_max_segs(dev, max_segs);
2948 			status |= DO_SETLINK_MODIFIED;
2949 		}
2950 	}
2951 
2952 	if (tb[IFLA_GRO_MAX_SIZE]) {
2953 		u32 gro_max_size = nla_get_u32(tb[IFLA_GRO_MAX_SIZE]);
2954 
2955 		if (dev->gro_max_size ^ gro_max_size) {
2956 			netif_set_gro_max_size(dev, gro_max_size);
2957 			status |= DO_SETLINK_MODIFIED;
2958 		}
2959 	}
2960 
2961 	if (tb[IFLA_GSO_IPV4_MAX_SIZE]) {
2962 		u32 max_size = nla_get_u32(tb[IFLA_GSO_IPV4_MAX_SIZE]);
2963 
2964 		if (dev->gso_ipv4_max_size ^ max_size) {
2965 			netif_set_gso_ipv4_max_size(dev, max_size);
2966 			status |= DO_SETLINK_MODIFIED;
2967 		}
2968 	}
2969 
2970 	if (tb[IFLA_GRO_IPV4_MAX_SIZE]) {
2971 		u32 gro_max_size = nla_get_u32(tb[IFLA_GRO_IPV4_MAX_SIZE]);
2972 
2973 		if (dev->gro_ipv4_max_size ^ gro_max_size) {
2974 			netif_set_gro_ipv4_max_size(dev, gro_max_size);
2975 			status |= DO_SETLINK_MODIFIED;
2976 		}
2977 	}
2978 
2979 	if (tb[IFLA_OPERSTATE])
2980 		set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE]));
2981 
2982 	if (tb[IFLA_LINKMODE]) {
2983 		unsigned char value = nla_get_u8(tb[IFLA_LINKMODE]);
2984 
2985 		write_lock(&dev_base_lock);
2986 		if (dev->link_mode ^ value)
2987 			status |= DO_SETLINK_NOTIFY;
2988 		dev->link_mode = value;
2989 		write_unlock(&dev_base_lock);
2990 	}
2991 
2992 	if (tb[IFLA_VFINFO_LIST]) {
2993 		struct nlattr *vfinfo[IFLA_VF_MAX + 1];
2994 		struct nlattr *attr;
2995 		int rem;
2996 
2997 		nla_for_each_nested(attr, tb[IFLA_VFINFO_LIST], rem) {
2998 			if (nla_type(attr) != IFLA_VF_INFO ||
2999 			    nla_len(attr) < NLA_HDRLEN) {
3000 				err = -EINVAL;
3001 				goto errout;
3002 			}
3003 			err = nla_parse_nested_deprecated(vfinfo, IFLA_VF_MAX,
3004 							  attr,
3005 							  ifla_vf_policy,
3006 							  NULL);
3007 			if (err < 0)
3008 				goto errout;
3009 			err = do_setvfinfo(dev, vfinfo);
3010 			if (err < 0)
3011 				goto errout;
3012 			status |= DO_SETLINK_NOTIFY;
3013 		}
3014 	}
3015 	err = 0;
3016 
3017 	if (tb[IFLA_VF_PORTS]) {
3018 		struct nlattr *port[IFLA_PORT_MAX+1];
3019 		struct nlattr *attr;
3020 		int vf;
3021 		int rem;
3022 
3023 		err = -EOPNOTSUPP;
3024 		if (!ops->ndo_set_vf_port)
3025 			goto errout;
3026 
3027 		nla_for_each_nested(attr, tb[IFLA_VF_PORTS], rem) {
3028 			if (nla_type(attr) != IFLA_VF_PORT ||
3029 			    nla_len(attr) < NLA_HDRLEN) {
3030 				err = -EINVAL;
3031 				goto errout;
3032 			}
3033 			err = nla_parse_nested_deprecated(port, IFLA_PORT_MAX,
3034 							  attr,
3035 							  ifla_port_policy,
3036 							  NULL);
3037 			if (err < 0)
3038 				goto errout;
3039 			if (!port[IFLA_PORT_VF]) {
3040 				err = -EOPNOTSUPP;
3041 				goto errout;
3042 			}
3043 			vf = nla_get_u32(port[IFLA_PORT_VF]);
3044 			err = ops->ndo_set_vf_port(dev, vf, port);
3045 			if (err < 0)
3046 				goto errout;
3047 			status |= DO_SETLINK_NOTIFY;
3048 		}
3049 	}
3050 	err = 0;
3051 
3052 	if (tb[IFLA_PORT_SELF]) {
3053 		struct nlattr *port[IFLA_PORT_MAX+1];
3054 
3055 		err = nla_parse_nested_deprecated(port, IFLA_PORT_MAX,
3056 						  tb[IFLA_PORT_SELF],
3057 						  ifla_port_policy, NULL);
3058 		if (err < 0)
3059 			goto errout;
3060 
3061 		err = -EOPNOTSUPP;
3062 		if (ops->ndo_set_vf_port)
3063 			err = ops->ndo_set_vf_port(dev, PORT_SELF_VF, port);
3064 		if (err < 0)
3065 			goto errout;
3066 		status |= DO_SETLINK_NOTIFY;
3067 	}
3068 
3069 	if (tb[IFLA_AF_SPEC]) {
3070 		struct nlattr *af;
3071 		int rem;
3072 
3073 		nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) {
3074 			const struct rtnl_af_ops *af_ops;
3075 
3076 			BUG_ON(!(af_ops = rtnl_af_lookup(nla_type(af))));
3077 
3078 			err = af_ops->set_link_af(dev, af, extack);
3079 			if (err < 0)
3080 				goto errout;
3081 
3082 			status |= DO_SETLINK_NOTIFY;
3083 		}
3084 	}
3085 	err = 0;
3086 
3087 	if (tb[IFLA_PROTO_DOWN] || tb[IFLA_PROTO_DOWN_REASON]) {
3088 		err = do_set_proto_down(dev, tb[IFLA_PROTO_DOWN],
3089 					tb[IFLA_PROTO_DOWN_REASON], extack);
3090 		if (err)
3091 			goto errout;
3092 		status |= DO_SETLINK_NOTIFY;
3093 	}
3094 
3095 	if (tb[IFLA_XDP]) {
3096 		struct nlattr *xdp[IFLA_XDP_MAX + 1];
3097 		u32 xdp_flags = 0;
3098 
3099 		err = nla_parse_nested_deprecated(xdp, IFLA_XDP_MAX,
3100 						  tb[IFLA_XDP],
3101 						  ifla_xdp_policy, NULL);
3102 		if (err < 0)
3103 			goto errout;
3104 
3105 		if (xdp[IFLA_XDP_ATTACHED] || xdp[IFLA_XDP_PROG_ID]) {
3106 			err = -EINVAL;
3107 			goto errout;
3108 		}
3109 
3110 		if (xdp[IFLA_XDP_FLAGS]) {
3111 			xdp_flags = nla_get_u32(xdp[IFLA_XDP_FLAGS]);
3112 			if (xdp_flags & ~XDP_FLAGS_MASK) {
3113 				err = -EINVAL;
3114 				goto errout;
3115 			}
3116 			if (hweight32(xdp_flags & XDP_FLAGS_MODES) > 1) {
3117 				err = -EINVAL;
3118 				goto errout;
3119 			}
3120 		}
3121 
3122 		if (xdp[IFLA_XDP_FD]) {
3123 			int expected_fd = -1;
3124 
3125 			if (xdp_flags & XDP_FLAGS_REPLACE) {
3126 				if (!xdp[IFLA_XDP_EXPECTED_FD]) {
3127 					err = -EINVAL;
3128 					goto errout;
3129 				}
3130 				expected_fd =
3131 					nla_get_s32(xdp[IFLA_XDP_EXPECTED_FD]);
3132 			}
3133 
3134 			err = dev_change_xdp_fd(dev, extack,
3135 						nla_get_s32(xdp[IFLA_XDP_FD]),
3136 						expected_fd,
3137 						xdp_flags);
3138 			if (err)
3139 				goto errout;
3140 			status |= DO_SETLINK_NOTIFY;
3141 		}
3142 	}
3143 
3144 errout:
3145 	if (status & DO_SETLINK_MODIFIED) {
3146 		if ((status & DO_SETLINK_NOTIFY) == DO_SETLINK_NOTIFY)
3147 			netdev_state_change(dev);
3148 
3149 		if (err < 0)
3150 			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",
3151 					     dev->name);
3152 	}
3153 
3154 	return err;
3155 }
3156 
rtnl_dev_get(struct net * net,struct nlattr * tb[])3157 static struct net_device *rtnl_dev_get(struct net *net,
3158 				       struct nlattr *tb[])
3159 {
3160 	char ifname[ALTIFNAMSIZ];
3161 
3162 	if (tb[IFLA_IFNAME])
3163 		nla_strscpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
3164 	else if (tb[IFLA_ALT_IFNAME])
3165 		nla_strscpy(ifname, tb[IFLA_ALT_IFNAME], ALTIFNAMSIZ);
3166 	else
3167 		return NULL;
3168 
3169 	return __dev_get_by_name(net, ifname);
3170 }
3171 
rtnl_setlink(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)3172 static int rtnl_setlink(struct sk_buff *skb, struct nlmsghdr *nlh,
3173 			struct netlink_ext_ack *extack)
3174 {
3175 	struct net *net = sock_net(skb->sk);
3176 	struct ifinfomsg *ifm;
3177 	struct net_device *dev;
3178 	int err;
3179 	struct nlattr *tb[IFLA_MAX+1];
3180 
3181 	err = nlmsg_parse_deprecated(nlh, sizeof(*ifm), tb, IFLA_MAX,
3182 				     ifla_policy, extack);
3183 	if (err < 0)
3184 		goto errout;
3185 
3186 	err = rtnl_ensure_unique_netns(tb, extack, false);
3187 	if (err < 0)
3188 		goto errout;
3189 
3190 	err = -EINVAL;
3191 	ifm = nlmsg_data(nlh);
3192 	if (ifm->ifi_index > 0)
3193 		dev = __dev_get_by_index(net, ifm->ifi_index);
3194 	else if (tb[IFLA_IFNAME] || tb[IFLA_ALT_IFNAME])
3195 		dev = rtnl_dev_get(net, tb);
3196 	else
3197 		goto errout;
3198 
3199 	if (dev == NULL) {
3200 		err = -ENODEV;
3201 		goto errout;
3202 	}
3203 
3204 	err = validate_linkmsg(dev, tb, extack);
3205 	if (err < 0)
3206 		goto errout;
3207 
3208 	err = do_setlink(skb, dev, ifm, extack, tb, 0);
3209 errout:
3210 	return err;
3211 }
3212 
rtnl_group_dellink(const struct net * net,int group)3213 static int rtnl_group_dellink(const struct net *net, int group)
3214 {
3215 	struct net_device *dev, *aux;
3216 	LIST_HEAD(list_kill);
3217 	bool found = false;
3218 
3219 	if (!group)
3220 		return -EPERM;
3221 
3222 	for_each_netdev(net, dev) {
3223 		if (dev->group == group) {
3224 			const struct rtnl_link_ops *ops;
3225 
3226 			found = true;
3227 			ops = dev->rtnl_link_ops;
3228 			if (!ops || !ops->dellink)
3229 				return -EOPNOTSUPP;
3230 		}
3231 	}
3232 
3233 	if (!found)
3234 		return -ENODEV;
3235 
3236 	for_each_netdev_safe(net, dev, aux) {
3237 		if (dev->group == group) {
3238 			const struct rtnl_link_ops *ops;
3239 
3240 			ops = dev->rtnl_link_ops;
3241 			ops->dellink(dev, &list_kill);
3242 		}
3243 	}
3244 	unregister_netdevice_many(&list_kill);
3245 
3246 	return 0;
3247 }
3248 
rtnl_delete_link(struct net_device * dev,u32 portid,const struct nlmsghdr * nlh)3249 int rtnl_delete_link(struct net_device *dev, u32 portid, const struct nlmsghdr *nlh)
3250 {
3251 	const struct rtnl_link_ops *ops;
3252 	LIST_HEAD(list_kill);
3253 
3254 	ops = dev->rtnl_link_ops;
3255 	if (!ops || !ops->dellink)
3256 		return -EOPNOTSUPP;
3257 
3258 	ops->dellink(dev, &list_kill);
3259 	unregister_netdevice_many_notify(&list_kill, portid, nlh);
3260 
3261 	return 0;
3262 }
3263 EXPORT_SYMBOL_GPL(rtnl_delete_link);
3264 
rtnl_dellink(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)3265 static int rtnl_dellink(struct sk_buff *skb, struct nlmsghdr *nlh,
3266 			struct netlink_ext_ack *extack)
3267 {
3268 	struct net *net = sock_net(skb->sk);
3269 	u32 portid = NETLINK_CB(skb).portid;
3270 	struct net *tgt_net = net;
3271 	struct net_device *dev = NULL;
3272 	struct ifinfomsg *ifm;
3273 	struct nlattr *tb[IFLA_MAX+1];
3274 	int err;
3275 	int netnsid = -1;
3276 
3277 	err = nlmsg_parse_deprecated(nlh, sizeof(*ifm), tb, IFLA_MAX,
3278 				     ifla_policy, extack);
3279 	if (err < 0)
3280 		return err;
3281 
3282 	err = rtnl_ensure_unique_netns(tb, extack, true);
3283 	if (err < 0)
3284 		return err;
3285 
3286 	if (tb[IFLA_TARGET_NETNSID]) {
3287 		netnsid = nla_get_s32(tb[IFLA_TARGET_NETNSID]);
3288 		tgt_net = rtnl_get_net_ns_capable(NETLINK_CB(skb).sk, netnsid);
3289 		if (IS_ERR(tgt_net))
3290 			return PTR_ERR(tgt_net);
3291 	}
3292 
3293 	err = -EINVAL;
3294 	ifm = nlmsg_data(nlh);
3295 	if (ifm->ifi_index > 0)
3296 		dev = __dev_get_by_index(tgt_net, ifm->ifi_index);
3297 	else if (tb[IFLA_IFNAME] || tb[IFLA_ALT_IFNAME])
3298 		dev = rtnl_dev_get(tgt_net, tb);
3299 	else if (tb[IFLA_GROUP])
3300 		err = rtnl_group_dellink(tgt_net, nla_get_u32(tb[IFLA_GROUP]));
3301 	else
3302 		goto out;
3303 
3304 	if (!dev) {
3305 		if (tb[IFLA_IFNAME] || tb[IFLA_ALT_IFNAME] || ifm->ifi_index > 0)
3306 			err = -ENODEV;
3307 
3308 		goto out;
3309 	}
3310 
3311 	err = rtnl_delete_link(dev, portid, nlh);
3312 
3313 out:
3314 	if (netnsid >= 0)
3315 		put_net(tgt_net);
3316 
3317 	return err;
3318 }
3319 
rtnl_configure_link(struct net_device * dev,const struct ifinfomsg * ifm,u32 portid,const struct nlmsghdr * nlh)3320 int rtnl_configure_link(struct net_device *dev, const struct ifinfomsg *ifm,
3321 			u32 portid, const struct nlmsghdr *nlh)
3322 {
3323 	unsigned int old_flags;
3324 	int err;
3325 
3326 	old_flags = dev->flags;
3327 	if (ifm && (ifm->ifi_flags || ifm->ifi_change)) {
3328 		err = __dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm),
3329 					 NULL);
3330 		if (err < 0)
3331 			return err;
3332 	}
3333 
3334 	if (dev->rtnl_link_state == RTNL_LINK_INITIALIZED) {
3335 		__dev_notify_flags(dev, old_flags, (old_flags ^ dev->flags), portid, nlh);
3336 	} else {
3337 		dev->rtnl_link_state = RTNL_LINK_INITIALIZED;
3338 		__dev_notify_flags(dev, old_flags, ~0U, portid, nlh);
3339 	}
3340 	return 0;
3341 }
3342 EXPORT_SYMBOL(rtnl_configure_link);
3343 
rtnl_create_link(struct net * net,const char * ifname,unsigned char name_assign_type,const struct rtnl_link_ops * ops,struct nlattr * tb[],struct netlink_ext_ack * extack)3344 struct net_device *rtnl_create_link(struct net *net, const char *ifname,
3345 				    unsigned char name_assign_type,
3346 				    const struct rtnl_link_ops *ops,
3347 				    struct nlattr *tb[],
3348 				    struct netlink_ext_ack *extack)
3349 {
3350 	struct net_device *dev;
3351 	unsigned int num_tx_queues = 1;
3352 	unsigned int num_rx_queues = 1;
3353 	int err;
3354 
3355 	if (tb[IFLA_NUM_TX_QUEUES])
3356 		num_tx_queues = nla_get_u32(tb[IFLA_NUM_TX_QUEUES]);
3357 	else if (ops->get_num_tx_queues)
3358 		num_tx_queues = ops->get_num_tx_queues();
3359 
3360 	if (tb[IFLA_NUM_RX_QUEUES])
3361 		num_rx_queues = nla_get_u32(tb[IFLA_NUM_RX_QUEUES]);
3362 	else if (ops->get_num_rx_queues)
3363 		num_rx_queues = ops->get_num_rx_queues();
3364 
3365 	if (num_tx_queues < 1 || num_tx_queues > 4096) {
3366 		NL_SET_ERR_MSG(extack, "Invalid number of transmit queues");
3367 		return ERR_PTR(-EINVAL);
3368 	}
3369 
3370 	if (num_rx_queues < 1 || num_rx_queues > 4096) {
3371 		NL_SET_ERR_MSG(extack, "Invalid number of receive queues");
3372 		return ERR_PTR(-EINVAL);
3373 	}
3374 
3375 	if (ops->alloc) {
3376 		dev = ops->alloc(tb, ifname, name_assign_type,
3377 				 num_tx_queues, num_rx_queues);
3378 		if (IS_ERR(dev))
3379 			return dev;
3380 	} else {
3381 		dev = alloc_netdev_mqs(ops->priv_size, ifname,
3382 				       name_assign_type, ops->setup,
3383 				       num_tx_queues, num_rx_queues);
3384 	}
3385 
3386 	if (!dev)
3387 		return ERR_PTR(-ENOMEM);
3388 
3389 	err = validate_linkmsg(dev, tb, extack);
3390 	if (err < 0) {
3391 		free_netdev(dev);
3392 		return ERR_PTR(err);
3393 	}
3394 
3395 	dev_net_set(dev, net);
3396 	dev->rtnl_link_ops = ops;
3397 	dev->rtnl_link_state = RTNL_LINK_INITIALIZING;
3398 
3399 	if (tb[IFLA_MTU]) {
3400 		u32 mtu = nla_get_u32(tb[IFLA_MTU]);
3401 
3402 		err = dev_validate_mtu(dev, mtu, extack);
3403 		if (err) {
3404 			free_netdev(dev);
3405 			return ERR_PTR(err);
3406 		}
3407 		dev->mtu = mtu;
3408 	}
3409 	if (tb[IFLA_ADDRESS]) {
3410 		__dev_addr_set(dev, nla_data(tb[IFLA_ADDRESS]),
3411 			       nla_len(tb[IFLA_ADDRESS]));
3412 		dev->addr_assign_type = NET_ADDR_SET;
3413 	}
3414 	if (tb[IFLA_BROADCAST])
3415 		memcpy(dev->broadcast, nla_data(tb[IFLA_BROADCAST]),
3416 				nla_len(tb[IFLA_BROADCAST]));
3417 	if (tb[IFLA_TXQLEN])
3418 		dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]);
3419 	if (tb[IFLA_OPERSTATE])
3420 		set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE]));
3421 	if (tb[IFLA_LINKMODE])
3422 		dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]);
3423 	if (tb[IFLA_GROUP])
3424 		dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP]));
3425 	if (tb[IFLA_GSO_MAX_SIZE])
3426 		netif_set_gso_max_size(dev, nla_get_u32(tb[IFLA_GSO_MAX_SIZE]));
3427 	if (tb[IFLA_GSO_MAX_SEGS])
3428 		netif_set_gso_max_segs(dev, nla_get_u32(tb[IFLA_GSO_MAX_SEGS]));
3429 	if (tb[IFLA_GRO_MAX_SIZE])
3430 		netif_set_gro_max_size(dev, nla_get_u32(tb[IFLA_GRO_MAX_SIZE]));
3431 	if (tb[IFLA_GSO_IPV4_MAX_SIZE])
3432 		netif_set_gso_ipv4_max_size(dev, nla_get_u32(tb[IFLA_GSO_IPV4_MAX_SIZE]));
3433 	if (tb[IFLA_GRO_IPV4_MAX_SIZE])
3434 		netif_set_gro_ipv4_max_size(dev, nla_get_u32(tb[IFLA_GRO_IPV4_MAX_SIZE]));
3435 
3436 	return dev;
3437 }
3438 EXPORT_SYMBOL(rtnl_create_link);
3439 
rtnl_group_changelink(const struct sk_buff * skb,struct net * net,int group,struct ifinfomsg * ifm,struct netlink_ext_ack * extack,struct nlattr ** tb)3440 static int rtnl_group_changelink(const struct sk_buff *skb,
3441 		struct net *net, int group,
3442 		struct ifinfomsg *ifm,
3443 		struct netlink_ext_ack *extack,
3444 		struct nlattr **tb)
3445 {
3446 	struct net_device *dev, *aux;
3447 	int err;
3448 
3449 	for_each_netdev_safe(net, dev, aux) {
3450 		if (dev->group == group) {
3451 			err = validate_linkmsg(dev, tb, extack);
3452 			if (err < 0)
3453 				return err;
3454 			err = do_setlink(skb, dev, ifm, extack, tb, 0);
3455 			if (err < 0)
3456 				return err;
3457 		}
3458 	}
3459 
3460 	return 0;
3461 }
3462 
rtnl_newlink_create(struct sk_buff * skb,struct ifinfomsg * ifm,const struct rtnl_link_ops * ops,const struct nlmsghdr * nlh,struct nlattr ** tb,struct nlattr ** data,struct netlink_ext_ack * extack)3463 static int rtnl_newlink_create(struct sk_buff *skb, struct ifinfomsg *ifm,
3464 			       const struct rtnl_link_ops *ops,
3465 			       const struct nlmsghdr *nlh,
3466 			       struct nlattr **tb, struct nlattr **data,
3467 			       struct netlink_ext_ack *extack)
3468 {
3469 	unsigned char name_assign_type = NET_NAME_USER;
3470 	struct net *net = sock_net(skb->sk);
3471 	u32 portid = NETLINK_CB(skb).portid;
3472 	struct net *dest_net, *link_net;
3473 	struct net_device *dev;
3474 	char ifname[IFNAMSIZ];
3475 	int err;
3476 
3477 	if (!ops->alloc && !ops->setup)
3478 		return -EOPNOTSUPP;
3479 
3480 	if (tb[IFLA_IFNAME]) {
3481 		nla_strscpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
3482 	} else {
3483 		snprintf(ifname, IFNAMSIZ, "%s%%d", ops->kind);
3484 		name_assign_type = NET_NAME_ENUM;
3485 	}
3486 
3487 	dest_net = rtnl_link_get_net_capable(skb, net, tb, CAP_NET_ADMIN);
3488 	if (IS_ERR(dest_net))
3489 		return PTR_ERR(dest_net);
3490 
3491 	if (tb[IFLA_LINK_NETNSID]) {
3492 		int id = nla_get_s32(tb[IFLA_LINK_NETNSID]);
3493 
3494 		link_net = get_net_ns_by_id(dest_net, id);
3495 		if (!link_net) {
3496 			NL_SET_ERR_MSG(extack, "Unknown network namespace id");
3497 			err =  -EINVAL;
3498 			goto out;
3499 		}
3500 		err = -EPERM;
3501 		if (!netlink_ns_capable(skb, link_net->user_ns, CAP_NET_ADMIN))
3502 			goto out;
3503 	} else {
3504 		link_net = NULL;
3505 	}
3506 
3507 	dev = rtnl_create_link(link_net ? : dest_net, ifname,
3508 			       name_assign_type, ops, tb, extack);
3509 	if (IS_ERR(dev)) {
3510 		err = PTR_ERR(dev);
3511 		goto out;
3512 	}
3513 
3514 	dev->ifindex = ifm->ifi_index;
3515 
3516 	if (ops->newlink)
3517 		err = ops->newlink(link_net ? : net, dev, tb, data, extack);
3518 	else
3519 		err = register_netdevice(dev);
3520 	if (err < 0) {
3521 		free_netdev(dev);
3522 		goto out;
3523 	}
3524 
3525 	err = rtnl_configure_link(dev, ifm, portid, nlh);
3526 	if (err < 0)
3527 		goto out_unregister;
3528 	if (link_net) {
3529 		err = dev_change_net_namespace(dev, dest_net, ifname);
3530 		if (err < 0)
3531 			goto out_unregister;
3532 	}
3533 	if (tb[IFLA_MASTER]) {
3534 		err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]), extack);
3535 		if (err)
3536 			goto out_unregister;
3537 	}
3538 out:
3539 	if (link_net)
3540 		put_net(link_net);
3541 	put_net(dest_net);
3542 	return err;
3543 out_unregister:
3544 	if (ops->newlink) {
3545 		LIST_HEAD(list_kill);
3546 
3547 		ops->dellink(dev, &list_kill);
3548 		unregister_netdevice_many(&list_kill);
3549 	} else {
3550 		unregister_netdevice(dev);
3551 	}
3552 	goto out;
3553 }
3554 
3555 struct rtnl_newlink_tbs {
3556 	struct nlattr *tb[IFLA_MAX + 1];
3557 	struct nlattr *attr[RTNL_MAX_TYPE + 1];
3558 	struct nlattr *slave_attr[RTNL_SLAVE_MAX_TYPE + 1];
3559 };
3560 
__rtnl_newlink(struct sk_buff * skb,struct nlmsghdr * nlh,struct rtnl_newlink_tbs * tbs,struct netlink_ext_ack * extack)3561 static int __rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh,
3562 			  struct rtnl_newlink_tbs *tbs,
3563 			  struct netlink_ext_ack *extack)
3564 {
3565 	struct nlattr *linkinfo[IFLA_INFO_MAX + 1];
3566 	struct nlattr ** const tb = tbs->tb;
3567 	const struct rtnl_link_ops *m_ops;
3568 	struct net_device *master_dev;
3569 	struct net *net = sock_net(skb->sk);
3570 	const struct rtnl_link_ops *ops;
3571 	struct nlattr **slave_data;
3572 	char kind[MODULE_NAME_LEN];
3573 	struct net_device *dev;
3574 	struct ifinfomsg *ifm;
3575 	struct nlattr **data;
3576 	bool link_specified;
3577 	int err;
3578 
3579 #ifdef CONFIG_MODULES
3580 replay:
3581 #endif
3582 	err = nlmsg_parse_deprecated(nlh, sizeof(*ifm), tb, IFLA_MAX,
3583 				     ifla_policy, extack);
3584 	if (err < 0)
3585 		return err;
3586 
3587 	err = rtnl_ensure_unique_netns(tb, extack, false);
3588 	if (err < 0)
3589 		return err;
3590 
3591 	ifm = nlmsg_data(nlh);
3592 	if (ifm->ifi_index > 0) {
3593 		link_specified = true;
3594 		dev = __dev_get_by_index(net, ifm->ifi_index);
3595 	} else if (ifm->ifi_index < 0) {
3596 		NL_SET_ERR_MSG(extack, "ifindex can't be negative");
3597 		return -EINVAL;
3598 	} else if (tb[IFLA_IFNAME] || tb[IFLA_ALT_IFNAME]) {
3599 		link_specified = true;
3600 		dev = rtnl_dev_get(net, tb);
3601 	} else {
3602 		link_specified = false;
3603 		dev = NULL;
3604 	}
3605 
3606 	master_dev = NULL;
3607 	m_ops = NULL;
3608 	if (dev) {
3609 		master_dev = netdev_master_upper_dev_get(dev);
3610 		if (master_dev)
3611 			m_ops = master_dev->rtnl_link_ops;
3612 	}
3613 
3614 	if (tb[IFLA_LINKINFO]) {
3615 		err = nla_parse_nested_deprecated(linkinfo, IFLA_INFO_MAX,
3616 						  tb[IFLA_LINKINFO],
3617 						  ifla_info_policy, NULL);
3618 		if (err < 0)
3619 			return err;
3620 	} else
3621 		memset(linkinfo, 0, sizeof(linkinfo));
3622 
3623 	if (linkinfo[IFLA_INFO_KIND]) {
3624 		nla_strscpy(kind, linkinfo[IFLA_INFO_KIND], sizeof(kind));
3625 		ops = rtnl_link_ops_get(kind);
3626 	} else {
3627 		kind[0] = '\0';
3628 		ops = NULL;
3629 	}
3630 
3631 	data = NULL;
3632 	if (ops) {
3633 		if (ops->maxtype > RTNL_MAX_TYPE)
3634 			return -EINVAL;
3635 
3636 		if (ops->maxtype && linkinfo[IFLA_INFO_DATA]) {
3637 			err = nla_parse_nested_deprecated(tbs->attr, ops->maxtype,
3638 							  linkinfo[IFLA_INFO_DATA],
3639 							  ops->policy, extack);
3640 			if (err < 0)
3641 				return err;
3642 			data = tbs->attr;
3643 		}
3644 		if (ops->validate) {
3645 			err = ops->validate(tb, data, extack);
3646 			if (err < 0)
3647 				return err;
3648 		}
3649 	}
3650 
3651 	slave_data = NULL;
3652 	if (m_ops) {
3653 		if (m_ops->slave_maxtype > RTNL_SLAVE_MAX_TYPE)
3654 			return -EINVAL;
3655 
3656 		if (m_ops->slave_maxtype &&
3657 		    linkinfo[IFLA_INFO_SLAVE_DATA]) {
3658 			err = nla_parse_nested_deprecated(tbs->slave_attr,
3659 							  m_ops->slave_maxtype,
3660 							  linkinfo[IFLA_INFO_SLAVE_DATA],
3661 							  m_ops->slave_policy,
3662 							  extack);
3663 			if (err < 0)
3664 				return err;
3665 			slave_data = tbs->slave_attr;
3666 		}
3667 	}
3668 
3669 	if (dev) {
3670 		int status = 0;
3671 
3672 		if (nlh->nlmsg_flags & NLM_F_EXCL)
3673 			return -EEXIST;
3674 		if (nlh->nlmsg_flags & NLM_F_REPLACE)
3675 			return -EOPNOTSUPP;
3676 
3677 		err = validate_linkmsg(dev, tb, extack);
3678 		if (err < 0)
3679 			return err;
3680 
3681 		if (linkinfo[IFLA_INFO_DATA]) {
3682 			if (!ops || ops != dev->rtnl_link_ops ||
3683 			    !ops->changelink)
3684 				return -EOPNOTSUPP;
3685 
3686 			err = ops->changelink(dev, tb, data, extack);
3687 			if (err < 0)
3688 				return err;
3689 			status |= DO_SETLINK_NOTIFY;
3690 		}
3691 
3692 		if (linkinfo[IFLA_INFO_SLAVE_DATA]) {
3693 			if (!m_ops || !m_ops->slave_changelink)
3694 				return -EOPNOTSUPP;
3695 
3696 			err = m_ops->slave_changelink(master_dev, dev, tb,
3697 						      slave_data, extack);
3698 			if (err < 0)
3699 				return err;
3700 			status |= DO_SETLINK_NOTIFY;
3701 		}
3702 
3703 		return do_setlink(skb, dev, ifm, extack, tb, status);
3704 	}
3705 
3706 	if (!(nlh->nlmsg_flags & NLM_F_CREATE)) {
3707 		/* No dev found and NLM_F_CREATE not set. Requested dev does not exist,
3708 		 * or it's for a group
3709 		*/
3710 		if (link_specified)
3711 			return -ENODEV;
3712 		if (tb[IFLA_GROUP])
3713 			return rtnl_group_changelink(skb, net,
3714 						nla_get_u32(tb[IFLA_GROUP]),
3715 						ifm, extack, tb);
3716 		return -ENODEV;
3717 	}
3718 
3719 	if (tb[IFLA_MAP] || tb[IFLA_PROTINFO])
3720 		return -EOPNOTSUPP;
3721 
3722 	if (!ops) {
3723 #ifdef CONFIG_MODULES
3724 		if (kind[0]) {
3725 			__rtnl_unlock();
3726 			request_module("rtnl-link-%s", kind);
3727 			rtnl_lock();
3728 			ops = rtnl_link_ops_get(kind);
3729 			if (ops)
3730 				goto replay;
3731 		}
3732 #endif
3733 		NL_SET_ERR_MSG(extack, "Unknown device type");
3734 		return -EOPNOTSUPP;
3735 	}
3736 
3737 	return rtnl_newlink_create(skb, ifm, ops, nlh, tb, data, extack);
3738 }
3739 
rtnl_newlink(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)3740 static int rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh,
3741 			struct netlink_ext_ack *extack)
3742 {
3743 	struct rtnl_newlink_tbs *tbs;
3744 	int ret;
3745 
3746 	tbs = kmalloc(sizeof(*tbs), GFP_KERNEL);
3747 	if (!tbs)
3748 		return -ENOMEM;
3749 
3750 	ret = __rtnl_newlink(skb, nlh, tbs, extack);
3751 	kfree(tbs);
3752 	return ret;
3753 }
3754 
rtnl_valid_getlink_req(struct sk_buff * skb,const struct nlmsghdr * nlh,struct nlattr ** tb,struct netlink_ext_ack * extack)3755 static int rtnl_valid_getlink_req(struct sk_buff *skb,
3756 				  const struct nlmsghdr *nlh,
3757 				  struct nlattr **tb,
3758 				  struct netlink_ext_ack *extack)
3759 {
3760 	struct ifinfomsg *ifm;
3761 	int i, err;
3762 
3763 	if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ifm))) {
3764 		NL_SET_ERR_MSG(extack, "Invalid header for get link");
3765 		return -EINVAL;
3766 	}
3767 
3768 	if (!netlink_strict_get_check(skb))
3769 		return nlmsg_parse_deprecated(nlh, sizeof(*ifm), tb, IFLA_MAX,
3770 					      ifla_policy, extack);
3771 
3772 	ifm = nlmsg_data(nlh);
3773 	if (ifm->__ifi_pad || ifm->ifi_type || ifm->ifi_flags ||
3774 	    ifm->ifi_change) {
3775 		NL_SET_ERR_MSG(extack, "Invalid values in header for get link request");
3776 		return -EINVAL;
3777 	}
3778 
3779 	err = nlmsg_parse_deprecated_strict(nlh, sizeof(*ifm), tb, IFLA_MAX,
3780 					    ifla_policy, extack);
3781 	if (err)
3782 		return err;
3783 
3784 	for (i = 0; i <= IFLA_MAX; i++) {
3785 		if (!tb[i])
3786 			continue;
3787 
3788 		switch (i) {
3789 		case IFLA_IFNAME:
3790 		case IFLA_ALT_IFNAME:
3791 		case IFLA_EXT_MASK:
3792 		case IFLA_TARGET_NETNSID:
3793 			break;
3794 		default:
3795 			NL_SET_ERR_MSG(extack, "Unsupported attribute in get link request");
3796 			return -EINVAL;
3797 		}
3798 	}
3799 
3800 	return 0;
3801 }
3802 
rtnl_getlink(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)3803 static int rtnl_getlink(struct sk_buff *skb, struct nlmsghdr *nlh,
3804 			struct netlink_ext_ack *extack)
3805 {
3806 	struct net *net = sock_net(skb->sk);
3807 	struct net *tgt_net = net;
3808 	struct ifinfomsg *ifm;
3809 	struct nlattr *tb[IFLA_MAX+1];
3810 	struct net_device *dev = NULL;
3811 	struct sk_buff *nskb;
3812 	int netnsid = -1;
3813 	int err;
3814 	u32 ext_filter_mask = 0;
3815 
3816 	err = rtnl_valid_getlink_req(skb, nlh, tb, extack);
3817 	if (err < 0)
3818 		return err;
3819 
3820 	err = rtnl_ensure_unique_netns(tb, extack, true);
3821 	if (err < 0)
3822 		return err;
3823 
3824 	if (tb[IFLA_TARGET_NETNSID]) {
3825 		netnsid = nla_get_s32(tb[IFLA_TARGET_NETNSID]);
3826 		tgt_net = rtnl_get_net_ns_capable(NETLINK_CB(skb).sk, netnsid);
3827 		if (IS_ERR(tgt_net))
3828 			return PTR_ERR(tgt_net);
3829 	}
3830 
3831 	if (tb[IFLA_EXT_MASK])
3832 		ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
3833 
3834 	err = -EINVAL;
3835 	ifm = nlmsg_data(nlh);
3836 	if (ifm->ifi_index > 0)
3837 		dev = __dev_get_by_index(tgt_net, ifm->ifi_index);
3838 	else if (tb[IFLA_IFNAME] || tb[IFLA_ALT_IFNAME])
3839 		dev = rtnl_dev_get(tgt_net, tb);
3840 	else
3841 		goto out;
3842 
3843 	err = -ENODEV;
3844 	if (dev == NULL)
3845 		goto out;
3846 
3847 	err = -ENOBUFS;
3848 	nskb = nlmsg_new(if_nlmsg_size(dev, ext_filter_mask), GFP_KERNEL);
3849 	if (nskb == NULL)
3850 		goto out;
3851 
3852 	err = rtnl_fill_ifinfo(nskb, dev, net,
3853 			       RTM_NEWLINK, NETLINK_CB(skb).portid,
3854 			       nlh->nlmsg_seq, 0, 0, ext_filter_mask,
3855 			       0, NULL, 0, netnsid, GFP_KERNEL);
3856 	if (err < 0) {
3857 		/* -EMSGSIZE implies BUG in if_nlmsg_size */
3858 		WARN_ON(err == -EMSGSIZE);
3859 		kfree_skb(nskb);
3860 	} else
3861 		err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid);
3862 out:
3863 	if (netnsid >= 0)
3864 		put_net(tgt_net);
3865 
3866 	return err;
3867 }
3868 
rtnl_alt_ifname(int cmd,struct net_device * dev,struct nlattr * attr,bool * changed,struct netlink_ext_ack * extack)3869 static int rtnl_alt_ifname(int cmd, struct net_device *dev, struct nlattr *attr,
3870 			   bool *changed, struct netlink_ext_ack *extack)
3871 {
3872 	char *alt_ifname;
3873 	size_t size;
3874 	int err;
3875 
3876 	err = nla_validate(attr, attr->nla_len, IFLA_MAX, ifla_policy, extack);
3877 	if (err)
3878 		return err;
3879 
3880 	if (cmd == RTM_NEWLINKPROP) {
3881 		size = rtnl_prop_list_size(dev);
3882 		size += nla_total_size(ALTIFNAMSIZ);
3883 		if (size >= U16_MAX) {
3884 			NL_SET_ERR_MSG(extack,
3885 				       "effective property list too long");
3886 			return -EINVAL;
3887 		}
3888 	}
3889 
3890 	alt_ifname = nla_strdup(attr, GFP_KERNEL_ACCOUNT);
3891 	if (!alt_ifname)
3892 		return -ENOMEM;
3893 
3894 	if (cmd == RTM_NEWLINKPROP) {
3895 		err = netdev_name_node_alt_create(dev, alt_ifname);
3896 		if (!err)
3897 			alt_ifname = NULL;
3898 	} else if (cmd == RTM_DELLINKPROP) {
3899 		err = netdev_name_node_alt_destroy(dev, alt_ifname);
3900 	} else {
3901 		WARN_ON_ONCE(1);
3902 		err = -EINVAL;
3903 	}
3904 
3905 	kfree(alt_ifname);
3906 	if (!err)
3907 		*changed = true;
3908 	return err;
3909 }
3910 
rtnl_linkprop(int cmd,struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)3911 static int rtnl_linkprop(int cmd, struct sk_buff *skb, struct nlmsghdr *nlh,
3912 			 struct netlink_ext_ack *extack)
3913 {
3914 	struct net *net = sock_net(skb->sk);
3915 	struct nlattr *tb[IFLA_MAX + 1];
3916 	struct net_device *dev;
3917 	struct ifinfomsg *ifm;
3918 	bool changed = false;
3919 	struct nlattr *attr;
3920 	int err, rem;
3921 
3922 	err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack);
3923 	if (err)
3924 		return err;
3925 
3926 	err = rtnl_ensure_unique_netns(tb, extack, true);
3927 	if (err)
3928 		return err;
3929 
3930 	ifm = nlmsg_data(nlh);
3931 	if (ifm->ifi_index > 0)
3932 		dev = __dev_get_by_index(net, ifm->ifi_index);
3933 	else if (tb[IFLA_IFNAME] || tb[IFLA_ALT_IFNAME])
3934 		dev = rtnl_dev_get(net, tb);
3935 	else
3936 		return -EINVAL;
3937 
3938 	if (!dev)
3939 		return -ENODEV;
3940 
3941 	if (!tb[IFLA_PROP_LIST])
3942 		return 0;
3943 
3944 	nla_for_each_nested(attr, tb[IFLA_PROP_LIST], rem) {
3945 		switch (nla_type(attr)) {
3946 		case IFLA_ALT_IFNAME:
3947 			err = rtnl_alt_ifname(cmd, dev, attr, &changed, extack);
3948 			if (err)
3949 				return err;
3950 			break;
3951 		}
3952 	}
3953 
3954 	if (changed)
3955 		netdev_state_change(dev);
3956 	return 0;
3957 }
3958 
rtnl_newlinkprop(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)3959 static int rtnl_newlinkprop(struct sk_buff *skb, struct nlmsghdr *nlh,
3960 			    struct netlink_ext_ack *extack)
3961 {
3962 	return rtnl_linkprop(RTM_NEWLINKPROP, skb, nlh, extack);
3963 }
3964 
rtnl_dellinkprop(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)3965 static int rtnl_dellinkprop(struct sk_buff *skb, struct nlmsghdr *nlh,
3966 			    struct netlink_ext_ack *extack)
3967 {
3968 	return rtnl_linkprop(RTM_DELLINKPROP, skb, nlh, extack);
3969 }
3970 
rtnl_calcit(struct sk_buff * skb,struct nlmsghdr * nlh)3971 static u32 rtnl_calcit(struct sk_buff *skb, struct nlmsghdr *nlh)
3972 {
3973 	struct net *net = sock_net(skb->sk);
3974 	size_t min_ifinfo_dump_size = 0;
3975 	struct nlattr *tb[IFLA_MAX+1];
3976 	u32 ext_filter_mask = 0;
3977 	struct net_device *dev;
3978 	int hdrlen;
3979 
3980 	/* Same kernel<->userspace interface hack as in rtnl_dump_ifinfo. */
3981 	hdrlen = nlmsg_len(nlh) < sizeof(struct ifinfomsg) ?
3982 		 sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg);
3983 
3984 	if (nlmsg_parse_deprecated(nlh, hdrlen, tb, IFLA_MAX, ifla_policy, NULL) >= 0) {
3985 		if (tb[IFLA_EXT_MASK])
3986 			ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
3987 	}
3988 
3989 	if (!ext_filter_mask)
3990 		return NLMSG_GOODSIZE;
3991 	/*
3992 	 * traverse the list of net devices and compute the minimum
3993 	 * buffer size based upon the filter mask.
3994 	 */
3995 	rcu_read_lock();
3996 	for_each_netdev_rcu(net, dev) {
3997 		min_ifinfo_dump_size = max(min_ifinfo_dump_size,
3998 					   if_nlmsg_size(dev, ext_filter_mask));
3999 	}
4000 	rcu_read_unlock();
4001 
4002 	return nlmsg_total_size(min_ifinfo_dump_size);
4003 }
4004 
rtnl_dump_all(struct sk_buff * skb,struct netlink_callback * cb)4005 static int rtnl_dump_all(struct sk_buff *skb, struct netlink_callback *cb)
4006 {
4007 	int idx;
4008 	int s_idx = cb->family;
4009 	int type = cb->nlh->nlmsg_type - RTM_BASE;
4010 	int ret = 0;
4011 
4012 	if (s_idx == 0)
4013 		s_idx = 1;
4014 
4015 	for (idx = 1; idx <= RTNL_FAMILY_MAX; idx++) {
4016 		struct rtnl_link __rcu **tab;
4017 		struct rtnl_link *link;
4018 		rtnl_dumpit_func dumpit;
4019 
4020 		if (idx < s_idx || idx == PF_PACKET)
4021 			continue;
4022 
4023 		if (type < 0 || type >= RTM_NR_MSGTYPES)
4024 			continue;
4025 
4026 		tab = rcu_dereference_rtnl(rtnl_msg_handlers[idx]);
4027 		if (!tab)
4028 			continue;
4029 
4030 		link = rcu_dereference_rtnl(tab[type]);
4031 		if (!link)
4032 			continue;
4033 
4034 		dumpit = link->dumpit;
4035 		if (!dumpit)
4036 			continue;
4037 
4038 		if (idx > s_idx) {
4039 			memset(&cb->args[0], 0, sizeof(cb->args));
4040 			cb->prev_seq = 0;
4041 			cb->seq = 0;
4042 		}
4043 		ret = dumpit(skb, cb);
4044 		if (ret)
4045 			break;
4046 	}
4047 	cb->family = idx;
4048 
4049 	return skb->len ? : ret;
4050 }
4051 
rtmsg_ifinfo_build_skb(int type,struct net_device * dev,unsigned int change,u32 event,gfp_t flags,int * new_nsid,int new_ifindex,u32 portid,const struct nlmsghdr * nlh)4052 struct sk_buff *rtmsg_ifinfo_build_skb(int type, struct net_device *dev,
4053 				       unsigned int change,
4054 				       u32 event, gfp_t flags, int *new_nsid,
4055 				       int new_ifindex, u32 portid,
4056 				       const struct nlmsghdr *nlh)
4057 {
4058 	struct net *net = dev_net(dev);
4059 	struct sk_buff *skb;
4060 	int err = -ENOBUFS;
4061 	u32 seq = 0;
4062 
4063 	skb = nlmsg_new(if_nlmsg_size(dev, 0), flags);
4064 	if (skb == NULL)
4065 		goto errout;
4066 
4067 	if (nlmsg_report(nlh))
4068 		seq = nlmsg_seq(nlh);
4069 	else
4070 		portid = 0;
4071 
4072 	err = rtnl_fill_ifinfo(skb, dev, dev_net(dev),
4073 			       type, portid, seq, change, 0, 0, event,
4074 			       new_nsid, new_ifindex, -1, flags);
4075 	if (err < 0) {
4076 		/* -EMSGSIZE implies BUG in if_nlmsg_size() */
4077 		WARN_ON(err == -EMSGSIZE);
4078 		kfree_skb(skb);
4079 		goto errout;
4080 	}
4081 	return skb;
4082 errout:
4083 	if (err < 0)
4084 		rtnl_set_sk_err(net, RTNLGRP_LINK, err);
4085 	return NULL;
4086 }
4087 
rtmsg_ifinfo_send(struct sk_buff * skb,struct net_device * dev,gfp_t flags,u32 portid,const struct nlmsghdr * nlh)4088 void rtmsg_ifinfo_send(struct sk_buff *skb, struct net_device *dev, gfp_t flags,
4089 		       u32 portid, const struct nlmsghdr *nlh)
4090 {
4091 	struct net *net = dev_net(dev);
4092 
4093 	rtnl_notify(skb, net, portid, RTNLGRP_LINK, nlh, flags);
4094 }
4095 
rtmsg_ifinfo_event(int type,struct net_device * dev,unsigned int change,u32 event,gfp_t flags,int * new_nsid,int new_ifindex,u32 portid,const struct nlmsghdr * nlh)4096 static void rtmsg_ifinfo_event(int type, struct net_device *dev,
4097 			       unsigned int change, u32 event,
4098 			       gfp_t flags, int *new_nsid, int new_ifindex,
4099 			       u32 portid, const struct nlmsghdr *nlh)
4100 {
4101 	struct sk_buff *skb;
4102 
4103 	if (dev->reg_state != NETREG_REGISTERED)
4104 		return;
4105 
4106 	skb = rtmsg_ifinfo_build_skb(type, dev, change, event, flags, new_nsid,
4107 				     new_ifindex, portid, nlh);
4108 	if (skb)
4109 		rtmsg_ifinfo_send(skb, dev, flags, portid, nlh);
4110 }
4111 
rtmsg_ifinfo(int type,struct net_device * dev,unsigned int change,gfp_t flags,u32 portid,const struct nlmsghdr * nlh)4112 void rtmsg_ifinfo(int type, struct net_device *dev, unsigned int change,
4113 		  gfp_t flags, u32 portid, const struct nlmsghdr *nlh)
4114 {
4115 	rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags,
4116 			   NULL, 0, portid, nlh);
4117 }
4118 
rtmsg_ifinfo_newnet(int type,struct net_device * dev,unsigned int change,gfp_t flags,int * new_nsid,int new_ifindex)4119 void rtmsg_ifinfo_newnet(int type, struct net_device *dev, unsigned int change,
4120 			 gfp_t flags, int *new_nsid, int new_ifindex)
4121 {
4122 	rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags,
4123 			   new_nsid, new_ifindex, 0, NULL);
4124 }
4125 
nlmsg_populate_fdb_fill(struct sk_buff * skb,struct net_device * dev,u8 * addr,u16 vid,u32 pid,u32 seq,int type,unsigned int flags,int nlflags,u16 ndm_state)4126 static int nlmsg_populate_fdb_fill(struct sk_buff *skb,
4127 				   struct net_device *dev,
4128 				   u8 *addr, u16 vid, u32 pid, u32 seq,
4129 				   int type, unsigned int flags,
4130 				   int nlflags, u16 ndm_state)
4131 {
4132 	struct nlmsghdr *nlh;
4133 	struct ndmsg *ndm;
4134 
4135 	nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ndm), nlflags);
4136 	if (!nlh)
4137 		return -EMSGSIZE;
4138 
4139 	ndm = nlmsg_data(nlh);
4140 	ndm->ndm_family  = AF_BRIDGE;
4141 	ndm->ndm_pad1	 = 0;
4142 	ndm->ndm_pad2    = 0;
4143 	ndm->ndm_flags	 = flags;
4144 	ndm->ndm_type	 = 0;
4145 	ndm->ndm_ifindex = dev->ifindex;
4146 	ndm->ndm_state   = ndm_state;
4147 
4148 	if (nla_put(skb, NDA_LLADDR, dev->addr_len, addr))
4149 		goto nla_put_failure;
4150 	if (vid)
4151 		if (nla_put(skb, NDA_VLAN, sizeof(u16), &vid))
4152 			goto nla_put_failure;
4153 
4154 	nlmsg_end(skb, nlh);
4155 	return 0;
4156 
4157 nla_put_failure:
4158 	nlmsg_cancel(skb, nlh);
4159 	return -EMSGSIZE;
4160 }
4161 
rtnl_fdb_nlmsg_size(const struct net_device * dev)4162 static inline size_t rtnl_fdb_nlmsg_size(const struct net_device *dev)
4163 {
4164 	return NLMSG_ALIGN(sizeof(struct ndmsg)) +
4165 	       nla_total_size(dev->addr_len) +	/* NDA_LLADDR */
4166 	       nla_total_size(sizeof(u16)) +	/* NDA_VLAN */
4167 	       0;
4168 }
4169 
rtnl_fdb_notify(struct net_device * dev,u8 * addr,u16 vid,int type,u16 ndm_state)4170 static void rtnl_fdb_notify(struct net_device *dev, u8 *addr, u16 vid, int type,
4171 			    u16 ndm_state)
4172 {
4173 	struct net *net = dev_net(dev);
4174 	struct sk_buff *skb;
4175 	int err = -ENOBUFS;
4176 
4177 	skb = nlmsg_new(rtnl_fdb_nlmsg_size(dev), GFP_ATOMIC);
4178 	if (!skb)
4179 		goto errout;
4180 
4181 	err = nlmsg_populate_fdb_fill(skb, dev, addr, vid,
4182 				      0, 0, type, NTF_SELF, 0, ndm_state);
4183 	if (err < 0) {
4184 		kfree_skb(skb);
4185 		goto errout;
4186 	}
4187 
4188 	rtnl_notify(skb, net, 0, RTNLGRP_NEIGH, NULL, GFP_ATOMIC);
4189 	return;
4190 errout:
4191 	rtnl_set_sk_err(net, RTNLGRP_NEIGH, err);
4192 }
4193 
4194 /*
4195  * ndo_dflt_fdb_add - default netdevice operation to add an FDB entry
4196  */
ndo_dflt_fdb_add(struct ndmsg * ndm,struct nlattr * tb[],struct net_device * dev,const unsigned char * addr,u16 vid,u16 flags)4197 int ndo_dflt_fdb_add(struct ndmsg *ndm,
4198 		     struct nlattr *tb[],
4199 		     struct net_device *dev,
4200 		     const unsigned char *addr, u16 vid,
4201 		     u16 flags)
4202 {
4203 	int err = -EINVAL;
4204 
4205 	/* If aging addresses are supported device will need to
4206 	 * implement its own handler for this.
4207 	 */
4208 	if (ndm->ndm_state && !(ndm->ndm_state & NUD_PERMANENT)) {
4209 		netdev_info(dev, "default FDB implementation only supports local addresses\n");
4210 		return err;
4211 	}
4212 
4213 	if (tb[NDA_FLAGS_EXT]) {
4214 		netdev_info(dev, "invalid flags given to default FDB implementation\n");
4215 		return err;
4216 	}
4217 
4218 	if (vid) {
4219 		netdev_info(dev, "vlans aren't supported yet for dev_uc|mc_add()\n");
4220 		return err;
4221 	}
4222 
4223 	if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr))
4224 		err = dev_uc_add_excl(dev, addr);
4225 	else if (is_multicast_ether_addr(addr))
4226 		err = dev_mc_add_excl(dev, addr);
4227 
4228 	/* Only return duplicate errors if NLM_F_EXCL is set */
4229 	if (err == -EEXIST && !(flags & NLM_F_EXCL))
4230 		err = 0;
4231 
4232 	return err;
4233 }
4234 EXPORT_SYMBOL(ndo_dflt_fdb_add);
4235 
fdb_vid_parse(struct nlattr * vlan_attr,u16 * p_vid,struct netlink_ext_ack * extack)4236 static int fdb_vid_parse(struct nlattr *vlan_attr, u16 *p_vid,
4237 			 struct netlink_ext_ack *extack)
4238 {
4239 	u16 vid = 0;
4240 
4241 	if (vlan_attr) {
4242 		if (nla_len(vlan_attr) != sizeof(u16)) {
4243 			NL_SET_ERR_MSG(extack, "invalid vlan attribute size");
4244 			return -EINVAL;
4245 		}
4246 
4247 		vid = nla_get_u16(vlan_attr);
4248 
4249 		if (!vid || vid >= VLAN_VID_MASK) {
4250 			NL_SET_ERR_MSG(extack, "invalid vlan id");
4251 			return -EINVAL;
4252 		}
4253 	}
4254 	*p_vid = vid;
4255 	return 0;
4256 }
4257 
rtnl_fdb_add(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)4258 static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh,
4259 			struct netlink_ext_ack *extack)
4260 {
4261 	struct net *net = sock_net(skb->sk);
4262 	struct ndmsg *ndm;
4263 	struct nlattr *tb[NDA_MAX+1];
4264 	struct net_device *dev;
4265 	u8 *addr;
4266 	u16 vid;
4267 	int err;
4268 
4269 	err = nlmsg_parse_deprecated(nlh, sizeof(*ndm), tb, NDA_MAX, NULL,
4270 				     extack);
4271 	if (err < 0)
4272 		return err;
4273 
4274 	ndm = nlmsg_data(nlh);
4275 	if (ndm->ndm_ifindex == 0) {
4276 		NL_SET_ERR_MSG(extack, "invalid ifindex");
4277 		return -EINVAL;
4278 	}
4279 
4280 	dev = __dev_get_by_index(net, ndm->ndm_ifindex);
4281 	if (dev == NULL) {
4282 		NL_SET_ERR_MSG(extack, "unknown ifindex");
4283 		return -ENODEV;
4284 	}
4285 
4286 	if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) {
4287 		NL_SET_ERR_MSG(extack, "invalid address");
4288 		return -EINVAL;
4289 	}
4290 
4291 	if (dev->type != ARPHRD_ETHER) {
4292 		NL_SET_ERR_MSG(extack, "FDB add only supported for Ethernet devices");
4293 		return -EINVAL;
4294 	}
4295 
4296 	addr = nla_data(tb[NDA_LLADDR]);
4297 
4298 	err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack);
4299 	if (err)
4300 		return err;
4301 
4302 	err = -EOPNOTSUPP;
4303 
4304 	/* Support fdb on master device the net/bridge default case */
4305 	if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) &&
4306 	    netif_is_bridge_port(dev)) {
4307 		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
4308 		const struct net_device_ops *ops = br_dev->netdev_ops;
4309 
4310 		err = ops->ndo_fdb_add(ndm, tb, dev, addr, vid,
4311 				       nlh->nlmsg_flags, extack);
4312 		if (err)
4313 			goto out;
4314 		else
4315 			ndm->ndm_flags &= ~NTF_MASTER;
4316 	}
4317 
4318 	/* Embedded bridge, macvlan, and any other device support */
4319 	if ((ndm->ndm_flags & NTF_SELF)) {
4320 		if (dev->netdev_ops->ndo_fdb_add)
4321 			err = dev->netdev_ops->ndo_fdb_add(ndm, tb, dev, addr,
4322 							   vid,
4323 							   nlh->nlmsg_flags,
4324 							   extack);
4325 		else
4326 			err = ndo_dflt_fdb_add(ndm, tb, dev, addr, vid,
4327 					       nlh->nlmsg_flags);
4328 
4329 		if (!err) {
4330 			rtnl_fdb_notify(dev, addr, vid, RTM_NEWNEIGH,
4331 					ndm->ndm_state);
4332 			ndm->ndm_flags &= ~NTF_SELF;
4333 		}
4334 	}
4335 out:
4336 	return err;
4337 }
4338 
4339 /*
4340  * ndo_dflt_fdb_del - default netdevice operation to delete an FDB entry
4341  */
ndo_dflt_fdb_del(struct ndmsg * ndm,struct nlattr * tb[],struct net_device * dev,const unsigned char * addr,u16 vid)4342 int ndo_dflt_fdb_del(struct ndmsg *ndm,
4343 		     struct nlattr *tb[],
4344 		     struct net_device *dev,
4345 		     const unsigned char *addr, u16 vid)
4346 {
4347 	int err = -EINVAL;
4348 
4349 	/* If aging addresses are supported device will need to
4350 	 * implement its own handler for this.
4351 	 */
4352 	if (!(ndm->ndm_state & NUD_PERMANENT)) {
4353 		netdev_info(dev, "default FDB implementation only supports local addresses\n");
4354 		return err;
4355 	}
4356 
4357 	if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr))
4358 		err = dev_uc_del(dev, addr);
4359 	else if (is_multicast_ether_addr(addr))
4360 		err = dev_mc_del(dev, addr);
4361 
4362 	return err;
4363 }
4364 EXPORT_SYMBOL(ndo_dflt_fdb_del);
4365 
4366 static const struct nla_policy fdb_del_bulk_policy[NDA_MAX + 1] = {
4367 	[NDA_VLAN]	= { .type = NLA_U16 },
4368 	[NDA_IFINDEX]	= NLA_POLICY_MIN(NLA_S32, 1),
4369 	[NDA_NDM_STATE_MASK]	= { .type = NLA_U16  },
4370 	[NDA_NDM_FLAGS_MASK]	= { .type = NLA_U8 },
4371 };
4372 
rtnl_fdb_del(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)4373 static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh,
4374 			struct netlink_ext_ack *extack)
4375 {
4376 	bool del_bulk = !!(nlh->nlmsg_flags & NLM_F_BULK);
4377 	struct net *net = sock_net(skb->sk);
4378 	const struct net_device_ops *ops;
4379 	struct ndmsg *ndm;
4380 	struct nlattr *tb[NDA_MAX+1];
4381 	struct net_device *dev;
4382 	__u8 *addr = NULL;
4383 	int err;
4384 	u16 vid;
4385 
4386 	if (!netlink_capable(skb, CAP_NET_ADMIN))
4387 		return -EPERM;
4388 
4389 	if (!del_bulk) {
4390 		err = nlmsg_parse_deprecated(nlh, sizeof(*ndm), tb, NDA_MAX,
4391 					     NULL, extack);
4392 	} else {
4393 		err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX,
4394 				  fdb_del_bulk_policy, extack);
4395 	}
4396 	if (err < 0)
4397 		return err;
4398 
4399 	ndm = nlmsg_data(nlh);
4400 	if (ndm->ndm_ifindex == 0) {
4401 		NL_SET_ERR_MSG(extack, "invalid ifindex");
4402 		return -EINVAL;
4403 	}
4404 
4405 	dev = __dev_get_by_index(net, ndm->ndm_ifindex);
4406 	if (dev == NULL) {
4407 		NL_SET_ERR_MSG(extack, "unknown ifindex");
4408 		return -ENODEV;
4409 	}
4410 
4411 	if (!del_bulk) {
4412 		if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) {
4413 			NL_SET_ERR_MSG(extack, "invalid address");
4414 			return -EINVAL;
4415 		}
4416 		addr = nla_data(tb[NDA_LLADDR]);
4417 	}
4418 
4419 	if (dev->type != ARPHRD_ETHER) {
4420 		NL_SET_ERR_MSG(extack, "FDB delete only supported for Ethernet devices");
4421 		return -EINVAL;
4422 	}
4423 
4424 	err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack);
4425 	if (err)
4426 		return err;
4427 
4428 	err = -EOPNOTSUPP;
4429 
4430 	/* Support fdb on master device the net/bridge default case */
4431 	if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) &&
4432 	    netif_is_bridge_port(dev)) {
4433 		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
4434 
4435 		ops = br_dev->netdev_ops;
4436 		if (!del_bulk) {
4437 			if (ops->ndo_fdb_del)
4438 				err = ops->ndo_fdb_del(ndm, tb, dev, addr, vid, extack);
4439 		} else {
4440 			if (ops->ndo_fdb_del_bulk)
4441 				err = ops->ndo_fdb_del_bulk(ndm, tb, dev, vid,
4442 							    extack);
4443 		}
4444 
4445 		if (err)
4446 			goto out;
4447 		else
4448 			ndm->ndm_flags &= ~NTF_MASTER;
4449 	}
4450 
4451 	/* Embedded bridge, macvlan, and any other device support */
4452 	if (ndm->ndm_flags & NTF_SELF) {
4453 		ops = dev->netdev_ops;
4454 		if (!del_bulk) {
4455 			if (ops->ndo_fdb_del)
4456 				err = ops->ndo_fdb_del(ndm, tb, dev, addr, vid, extack);
4457 			else
4458 				err = ndo_dflt_fdb_del(ndm, tb, dev, addr, vid);
4459 		} else {
4460 			/* in case err was cleared by NTF_MASTER call */
4461 			err = -EOPNOTSUPP;
4462 			if (ops->ndo_fdb_del_bulk)
4463 				err = ops->ndo_fdb_del_bulk(ndm, tb, dev, vid,
4464 							    extack);
4465 		}
4466 
4467 		if (!err) {
4468 			if (!del_bulk)
4469 				rtnl_fdb_notify(dev, addr, vid, RTM_DELNEIGH,
4470 						ndm->ndm_state);
4471 			ndm->ndm_flags &= ~NTF_SELF;
4472 		}
4473 	}
4474 out:
4475 	return err;
4476 }
4477 
nlmsg_populate_fdb(struct sk_buff * skb,struct netlink_callback * cb,struct net_device * dev,int * idx,struct netdev_hw_addr_list * list)4478 static int nlmsg_populate_fdb(struct sk_buff *skb,
4479 			      struct netlink_callback *cb,
4480 			      struct net_device *dev,
4481 			      int *idx,
4482 			      struct netdev_hw_addr_list *list)
4483 {
4484 	struct netdev_hw_addr *ha;
4485 	int err;
4486 	u32 portid, seq;
4487 
4488 	portid = NETLINK_CB(cb->skb).portid;
4489 	seq = cb->nlh->nlmsg_seq;
4490 
4491 	list_for_each_entry(ha, &list->list, list) {
4492 		if (*idx < cb->args[2])
4493 			goto skip;
4494 
4495 		err = nlmsg_populate_fdb_fill(skb, dev, ha->addr, 0,
4496 					      portid, seq,
4497 					      RTM_NEWNEIGH, NTF_SELF,
4498 					      NLM_F_MULTI, NUD_PERMANENT);
4499 		if (err < 0)
4500 			return err;
4501 skip:
4502 		*idx += 1;
4503 	}
4504 	return 0;
4505 }
4506 
4507 /**
4508  * ndo_dflt_fdb_dump - default netdevice operation to dump an FDB table.
4509  * @skb: socket buffer to store message in
4510  * @cb: netlink callback
4511  * @dev: netdevice
4512  * @filter_dev: ignored
4513  * @idx: the number of FDB table entries dumped is added to *@idx
4514  *
4515  * Default netdevice operation to dump the existing unicast address list.
4516  * Returns number of addresses from list put in skb.
4517  */
ndo_dflt_fdb_dump(struct sk_buff * skb,struct netlink_callback * cb,struct net_device * dev,struct net_device * filter_dev,int * idx)4518 int ndo_dflt_fdb_dump(struct sk_buff *skb,
4519 		      struct netlink_callback *cb,
4520 		      struct net_device *dev,
4521 		      struct net_device *filter_dev,
4522 		      int *idx)
4523 {
4524 	int err;
4525 
4526 	if (dev->type != ARPHRD_ETHER)
4527 		return -EINVAL;
4528 
4529 	netif_addr_lock_bh(dev);
4530 	err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->uc);
4531 	if (err)
4532 		goto out;
4533 	err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->mc);
4534 out:
4535 	netif_addr_unlock_bh(dev);
4536 	return err;
4537 }
4538 EXPORT_SYMBOL(ndo_dflt_fdb_dump);
4539 
valid_fdb_dump_strict(const struct nlmsghdr * nlh,int * br_idx,int * brport_idx,struct netlink_ext_ack * extack)4540 static int valid_fdb_dump_strict(const struct nlmsghdr *nlh,
4541 				 int *br_idx, int *brport_idx,
4542 				 struct netlink_ext_ack *extack)
4543 {
4544 	struct nlattr *tb[NDA_MAX + 1];
4545 	struct ndmsg *ndm;
4546 	int err, i;
4547 
4548 	if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ndm))) {
4549 		NL_SET_ERR_MSG(extack, "Invalid header for fdb dump request");
4550 		return -EINVAL;
4551 	}
4552 
4553 	ndm = nlmsg_data(nlh);
4554 	if (ndm->ndm_pad1  || ndm->ndm_pad2  || ndm->ndm_state ||
4555 	    ndm->ndm_flags || ndm->ndm_type) {
4556 		NL_SET_ERR_MSG(extack, "Invalid values in header for fdb dump request");
4557 		return -EINVAL;
4558 	}
4559 
4560 	err = nlmsg_parse_deprecated_strict(nlh, sizeof(struct ndmsg), tb,
4561 					    NDA_MAX, NULL, extack);
4562 	if (err < 0)
4563 		return err;
4564 
4565 	*brport_idx = ndm->ndm_ifindex;
4566 	for (i = 0; i <= NDA_MAX; ++i) {
4567 		if (!tb[i])
4568 			continue;
4569 
4570 		switch (i) {
4571 		case NDA_IFINDEX:
4572 			if (nla_len(tb[i]) != sizeof(u32)) {
4573 				NL_SET_ERR_MSG(extack, "Invalid IFINDEX attribute in fdb dump request");
4574 				return -EINVAL;
4575 			}
4576 			*brport_idx = nla_get_u32(tb[NDA_IFINDEX]);
4577 			break;
4578 		case NDA_MASTER:
4579 			if (nla_len(tb[i]) != sizeof(u32)) {
4580 				NL_SET_ERR_MSG(extack, "Invalid MASTER attribute in fdb dump request");
4581 				return -EINVAL;
4582 			}
4583 			*br_idx = nla_get_u32(tb[NDA_MASTER]);
4584 			break;
4585 		default:
4586 			NL_SET_ERR_MSG(extack, "Unsupported attribute in fdb dump request");
4587 			return -EINVAL;
4588 		}
4589 	}
4590 
4591 	return 0;
4592 }
4593 
valid_fdb_dump_legacy(const struct nlmsghdr * nlh,int * br_idx,int * brport_idx,struct netlink_ext_ack * extack)4594 static int valid_fdb_dump_legacy(const struct nlmsghdr *nlh,
4595 				 int *br_idx, int *brport_idx,
4596 				 struct netlink_ext_ack *extack)
4597 {
4598 	struct nlattr *tb[IFLA_MAX+1];
4599 	int err;
4600 
4601 	/* A hack to preserve kernel<->userspace interface.
4602 	 * Before Linux v4.12 this code accepted ndmsg since iproute2 v3.3.0.
4603 	 * However, ndmsg is shorter than ifinfomsg thus nlmsg_parse() bails.
4604 	 * So, check for ndmsg with an optional u32 attribute (not used here).
4605 	 * Fortunately these sizes don't conflict with the size of ifinfomsg
4606 	 * with an optional attribute.
4607 	 */
4608 	if (nlmsg_len(nlh) != sizeof(struct ndmsg) &&
4609 	    (nlmsg_len(nlh) != sizeof(struct ndmsg) +
4610 	     nla_attr_size(sizeof(u32)))) {
4611 		struct ifinfomsg *ifm;
4612 
4613 		err = nlmsg_parse_deprecated(nlh, sizeof(struct ifinfomsg),
4614 					     tb, IFLA_MAX, ifla_policy,
4615 					     extack);
4616 		if (err < 0) {
4617 			return -EINVAL;
4618 		} else if (err == 0) {
4619 			if (tb[IFLA_MASTER])
4620 				*br_idx = nla_get_u32(tb[IFLA_MASTER]);
4621 		}
4622 
4623 		ifm = nlmsg_data(nlh);
4624 		*brport_idx = ifm->ifi_index;
4625 	}
4626 	return 0;
4627 }
4628 
rtnl_fdb_dump(struct sk_buff * skb,struct netlink_callback * cb)4629 static int rtnl_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb)
4630 {
4631 	struct net_device *dev;
4632 	struct net_device *br_dev = NULL;
4633 	const struct net_device_ops *ops = NULL;
4634 	const struct net_device_ops *cops = NULL;
4635 	struct net *net = sock_net(skb->sk);
4636 	struct hlist_head *head;
4637 	int brport_idx = 0;
4638 	int br_idx = 0;
4639 	int h, s_h;
4640 	int idx = 0, s_idx;
4641 	int err = 0;
4642 	int fidx = 0;
4643 
4644 	if (cb->strict_check)
4645 		err = valid_fdb_dump_strict(cb->nlh, &br_idx, &brport_idx,
4646 					    cb->extack);
4647 	else
4648 		err = valid_fdb_dump_legacy(cb->nlh, &br_idx, &brport_idx,
4649 					    cb->extack);
4650 	if (err < 0)
4651 		return err;
4652 
4653 	if (br_idx) {
4654 		br_dev = __dev_get_by_index(net, br_idx);
4655 		if (!br_dev)
4656 			return -ENODEV;
4657 
4658 		ops = br_dev->netdev_ops;
4659 	}
4660 
4661 	s_h = cb->args[0];
4662 	s_idx = cb->args[1];
4663 
4664 	for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
4665 		idx = 0;
4666 		head = &net->dev_index_head[h];
4667 		hlist_for_each_entry(dev, head, index_hlist) {
4668 
4669 			if (brport_idx && (dev->ifindex != brport_idx))
4670 				continue;
4671 
4672 			if (!br_idx) { /* user did not specify a specific bridge */
4673 				if (netif_is_bridge_port(dev)) {
4674 					br_dev = netdev_master_upper_dev_get(dev);
4675 					cops = br_dev->netdev_ops;
4676 				}
4677 			} else {
4678 				if (dev != br_dev &&
4679 				    !netif_is_bridge_port(dev))
4680 					continue;
4681 
4682 				if (br_dev != netdev_master_upper_dev_get(dev) &&
4683 				    !netif_is_bridge_master(dev))
4684 					continue;
4685 				cops = ops;
4686 			}
4687 
4688 			if (idx < s_idx)
4689 				goto cont;
4690 
4691 			if (netif_is_bridge_port(dev)) {
4692 				if (cops && cops->ndo_fdb_dump) {
4693 					err = cops->ndo_fdb_dump(skb, cb,
4694 								br_dev, dev,
4695 								&fidx);
4696 					if (err == -EMSGSIZE)
4697 						goto out;
4698 				}
4699 			}
4700 
4701 			if (dev->netdev_ops->ndo_fdb_dump)
4702 				err = dev->netdev_ops->ndo_fdb_dump(skb, cb,
4703 								    dev, NULL,
4704 								    &fidx);
4705 			else
4706 				err = ndo_dflt_fdb_dump(skb, cb, dev, NULL,
4707 							&fidx);
4708 			if (err == -EMSGSIZE)
4709 				goto out;
4710 
4711 			cops = NULL;
4712 
4713 			/* reset fdb offset to 0 for rest of the interfaces */
4714 			cb->args[2] = 0;
4715 			fidx = 0;
4716 cont:
4717 			idx++;
4718 		}
4719 	}
4720 
4721 out:
4722 	cb->args[0] = h;
4723 	cb->args[1] = idx;
4724 	cb->args[2] = fidx;
4725 
4726 	return skb->len;
4727 }
4728 
valid_fdb_get_strict(const struct nlmsghdr * nlh,struct nlattr ** tb,u8 * ndm_flags,int * br_idx,int * brport_idx,u8 ** addr,u16 * vid,struct netlink_ext_ack * extack)4729 static int valid_fdb_get_strict(const struct nlmsghdr *nlh,
4730 				struct nlattr **tb, u8 *ndm_flags,
4731 				int *br_idx, int *brport_idx, u8 **addr,
4732 				u16 *vid, struct netlink_ext_ack *extack)
4733 {
4734 	struct ndmsg *ndm;
4735 	int err, i;
4736 
4737 	if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ndm))) {
4738 		NL_SET_ERR_MSG(extack, "Invalid header for fdb get request");
4739 		return -EINVAL;
4740 	}
4741 
4742 	ndm = nlmsg_data(nlh);
4743 	if (ndm->ndm_pad1  || ndm->ndm_pad2  || ndm->ndm_state ||
4744 	    ndm->ndm_type) {
4745 		NL_SET_ERR_MSG(extack, "Invalid values in header for fdb get request");
4746 		return -EINVAL;
4747 	}
4748 
4749 	if (ndm->ndm_flags & ~(NTF_MASTER | NTF_SELF)) {
4750 		NL_SET_ERR_MSG(extack, "Invalid flags in header for fdb get request");
4751 		return -EINVAL;
4752 	}
4753 
4754 	err = nlmsg_parse_deprecated_strict(nlh, sizeof(struct ndmsg), tb,
4755 					    NDA_MAX, nda_policy, extack);
4756 	if (err < 0)
4757 		return err;
4758 
4759 	*ndm_flags = ndm->ndm_flags;
4760 	*brport_idx = ndm->ndm_ifindex;
4761 	for (i = 0; i <= NDA_MAX; ++i) {
4762 		if (!tb[i])
4763 			continue;
4764 
4765 		switch (i) {
4766 		case NDA_MASTER:
4767 			*br_idx = nla_get_u32(tb[i]);
4768 			break;
4769 		case NDA_LLADDR:
4770 			if (nla_len(tb[i]) != ETH_ALEN) {
4771 				NL_SET_ERR_MSG(extack, "Invalid address in fdb get request");
4772 				return -EINVAL;
4773 			}
4774 			*addr = nla_data(tb[i]);
4775 			break;
4776 		case NDA_VLAN:
4777 			err = fdb_vid_parse(tb[i], vid, extack);
4778 			if (err)
4779 				return err;
4780 			break;
4781 		case NDA_VNI:
4782 			break;
4783 		default:
4784 			NL_SET_ERR_MSG(extack, "Unsupported attribute in fdb get request");
4785 			return -EINVAL;
4786 		}
4787 	}
4788 
4789 	return 0;
4790 }
4791 
rtnl_fdb_get(struct sk_buff * in_skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)4792 static int rtnl_fdb_get(struct sk_buff *in_skb, struct nlmsghdr *nlh,
4793 			struct netlink_ext_ack *extack)
4794 {
4795 	struct net_device *dev = NULL, *br_dev = NULL;
4796 	const struct net_device_ops *ops = NULL;
4797 	struct net *net = sock_net(in_skb->sk);
4798 	struct nlattr *tb[NDA_MAX + 1];
4799 	struct sk_buff *skb;
4800 	int brport_idx = 0;
4801 	u8 ndm_flags = 0;
4802 	int br_idx = 0;
4803 	u8 *addr = NULL;
4804 	u16 vid = 0;
4805 	int err;
4806 
4807 	err = valid_fdb_get_strict(nlh, tb, &ndm_flags, &br_idx,
4808 				   &brport_idx, &addr, &vid, extack);
4809 	if (err < 0)
4810 		return err;
4811 
4812 	if (!addr) {
4813 		NL_SET_ERR_MSG(extack, "Missing lookup address for fdb get request");
4814 		return -EINVAL;
4815 	}
4816 
4817 	if (brport_idx) {
4818 		dev = __dev_get_by_index(net, brport_idx);
4819 		if (!dev) {
4820 			NL_SET_ERR_MSG(extack, "Unknown device ifindex");
4821 			return -ENODEV;
4822 		}
4823 	}
4824 
4825 	if (br_idx) {
4826 		if (dev) {
4827 			NL_SET_ERR_MSG(extack, "Master and device are mutually exclusive");
4828 			return -EINVAL;
4829 		}
4830 
4831 		br_dev = __dev_get_by_index(net, br_idx);
4832 		if (!br_dev) {
4833 			NL_SET_ERR_MSG(extack, "Invalid master ifindex");
4834 			return -EINVAL;
4835 		}
4836 		ops = br_dev->netdev_ops;
4837 	}
4838 
4839 	if (dev) {
4840 		if (!ndm_flags || (ndm_flags & NTF_MASTER)) {
4841 			if (!netif_is_bridge_port(dev)) {
4842 				NL_SET_ERR_MSG(extack, "Device is not a bridge port");
4843 				return -EINVAL;
4844 			}
4845 			br_dev = netdev_master_upper_dev_get(dev);
4846 			if (!br_dev) {
4847 				NL_SET_ERR_MSG(extack, "Master of device not found");
4848 				return -EINVAL;
4849 			}
4850 			ops = br_dev->netdev_ops;
4851 		} else {
4852 			if (!(ndm_flags & NTF_SELF)) {
4853 				NL_SET_ERR_MSG(extack, "Missing NTF_SELF");
4854 				return -EINVAL;
4855 			}
4856 			ops = dev->netdev_ops;
4857 		}
4858 	}
4859 
4860 	if (!br_dev && !dev) {
4861 		NL_SET_ERR_MSG(extack, "No device specified");
4862 		return -ENODEV;
4863 	}
4864 
4865 	if (!ops || !ops->ndo_fdb_get) {
4866 		NL_SET_ERR_MSG(extack, "Fdb get operation not supported by device");
4867 		return -EOPNOTSUPP;
4868 	}
4869 
4870 	skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
4871 	if (!skb)
4872 		return -ENOBUFS;
4873 
4874 	if (br_dev)
4875 		dev = br_dev;
4876 	err = ops->ndo_fdb_get(skb, tb, dev, addr, vid,
4877 			       NETLINK_CB(in_skb).portid,
4878 			       nlh->nlmsg_seq, extack);
4879 	if (err)
4880 		goto out;
4881 
4882 	return rtnl_unicast(skb, net, NETLINK_CB(in_skb).portid);
4883 out:
4884 	kfree_skb(skb);
4885 	return err;
4886 }
4887 
brport_nla_put_flag(struct sk_buff * skb,u32 flags,u32 mask,unsigned int attrnum,unsigned int flag)4888 static int brport_nla_put_flag(struct sk_buff *skb, u32 flags, u32 mask,
4889 			       unsigned int attrnum, unsigned int flag)
4890 {
4891 	if (mask & flag)
4892 		return nla_put_u8(skb, attrnum, !!(flags & flag));
4893 	return 0;
4894 }
4895 
ndo_dflt_bridge_getlink(struct sk_buff * skb,u32 pid,u32 seq,struct net_device * dev,u16 mode,u32 flags,u32 mask,int nlflags,u32 filter_mask,int (* vlan_fill)(struct sk_buff * skb,struct net_device * dev,u32 filter_mask))4896 int ndo_dflt_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq,
4897 			    struct net_device *dev, u16 mode,
4898 			    u32 flags, u32 mask, int nlflags,
4899 			    u32 filter_mask,
4900 			    int (*vlan_fill)(struct sk_buff *skb,
4901 					     struct net_device *dev,
4902 					     u32 filter_mask))
4903 {
4904 	struct nlmsghdr *nlh;
4905 	struct ifinfomsg *ifm;
4906 	struct nlattr *br_afspec;
4907 	struct nlattr *protinfo;
4908 	u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN;
4909 	struct net_device *br_dev = netdev_master_upper_dev_get(dev);
4910 	int err = 0;
4911 
4912 	nlh = nlmsg_put(skb, pid, seq, RTM_NEWLINK, sizeof(*ifm), nlflags);
4913 	if (nlh == NULL)
4914 		return -EMSGSIZE;
4915 
4916 	ifm = nlmsg_data(nlh);
4917 	ifm->ifi_family = AF_BRIDGE;
4918 	ifm->__ifi_pad = 0;
4919 	ifm->ifi_type = dev->type;
4920 	ifm->ifi_index = dev->ifindex;
4921 	ifm->ifi_flags = dev_get_flags(dev);
4922 	ifm->ifi_change = 0;
4923 
4924 
4925 	if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
4926 	    nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
4927 	    nla_put_u8(skb, IFLA_OPERSTATE, operstate) ||
4928 	    (br_dev &&
4929 	     nla_put_u32(skb, IFLA_MASTER, br_dev->ifindex)) ||
4930 	    (dev->addr_len &&
4931 	     nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) ||
4932 	    (dev->ifindex != dev_get_iflink(dev) &&
4933 	     nla_put_u32(skb, IFLA_LINK, dev_get_iflink(dev))))
4934 		goto nla_put_failure;
4935 
4936 	br_afspec = nla_nest_start_noflag(skb, IFLA_AF_SPEC);
4937 	if (!br_afspec)
4938 		goto nla_put_failure;
4939 
4940 	if (nla_put_u16(skb, IFLA_BRIDGE_FLAGS, BRIDGE_FLAGS_SELF)) {
4941 		nla_nest_cancel(skb, br_afspec);
4942 		goto nla_put_failure;
4943 	}
4944 
4945 	if (mode != BRIDGE_MODE_UNDEF) {
4946 		if (nla_put_u16(skb, IFLA_BRIDGE_MODE, mode)) {
4947 			nla_nest_cancel(skb, br_afspec);
4948 			goto nla_put_failure;
4949 		}
4950 	}
4951 	if (vlan_fill) {
4952 		err = vlan_fill(skb, dev, filter_mask);
4953 		if (err) {
4954 			nla_nest_cancel(skb, br_afspec);
4955 			goto nla_put_failure;
4956 		}
4957 	}
4958 	nla_nest_end(skb, br_afspec);
4959 
4960 	protinfo = nla_nest_start(skb, IFLA_PROTINFO);
4961 	if (!protinfo)
4962 		goto nla_put_failure;
4963 
4964 	if (brport_nla_put_flag(skb, flags, mask,
4965 				IFLA_BRPORT_MODE, BR_HAIRPIN_MODE) ||
4966 	    brport_nla_put_flag(skb, flags, mask,
4967 				IFLA_BRPORT_GUARD, BR_BPDU_GUARD) ||
4968 	    brport_nla_put_flag(skb, flags, mask,
4969 				IFLA_BRPORT_FAST_LEAVE,
4970 				BR_MULTICAST_FAST_LEAVE) ||
4971 	    brport_nla_put_flag(skb, flags, mask,
4972 				IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK) ||
4973 	    brport_nla_put_flag(skb, flags, mask,
4974 				IFLA_BRPORT_LEARNING, BR_LEARNING) ||
4975 	    brport_nla_put_flag(skb, flags, mask,
4976 				IFLA_BRPORT_LEARNING_SYNC, BR_LEARNING_SYNC) ||
4977 	    brport_nla_put_flag(skb, flags, mask,
4978 				IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD) ||
4979 	    brport_nla_put_flag(skb, flags, mask,
4980 				IFLA_BRPORT_PROXYARP, BR_PROXYARP) ||
4981 	    brport_nla_put_flag(skb, flags, mask,
4982 				IFLA_BRPORT_MCAST_FLOOD, BR_MCAST_FLOOD) ||
4983 	    brport_nla_put_flag(skb, flags, mask,
4984 				IFLA_BRPORT_BCAST_FLOOD, BR_BCAST_FLOOD)) {
4985 		nla_nest_cancel(skb, protinfo);
4986 		goto nla_put_failure;
4987 	}
4988 
4989 	nla_nest_end(skb, protinfo);
4990 
4991 	nlmsg_end(skb, nlh);
4992 	return 0;
4993 nla_put_failure:
4994 	nlmsg_cancel(skb, nlh);
4995 	return err ? err : -EMSGSIZE;
4996 }
4997 EXPORT_SYMBOL_GPL(ndo_dflt_bridge_getlink);
4998 
valid_bridge_getlink_req(const struct nlmsghdr * nlh,bool strict_check,u32 * filter_mask,struct netlink_ext_ack * extack)4999 static int valid_bridge_getlink_req(const struct nlmsghdr *nlh,
5000 				    bool strict_check, u32 *filter_mask,
5001 				    struct netlink_ext_ack *extack)
5002 {
5003 	struct nlattr *tb[IFLA_MAX+1];
5004 	int err, i;
5005 
5006 	if (strict_check) {
5007 		struct ifinfomsg *ifm;
5008 
5009 		if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ifm))) {
5010 			NL_SET_ERR_MSG(extack, "Invalid header for bridge link dump");
5011 			return -EINVAL;
5012 		}
5013 
5014 		ifm = nlmsg_data(nlh);
5015 		if (ifm->__ifi_pad || ifm->ifi_type || ifm->ifi_flags ||
5016 		    ifm->ifi_change || ifm->ifi_index) {
5017 			NL_SET_ERR_MSG(extack, "Invalid values in header for bridge link dump request");
5018 			return -EINVAL;
5019 		}
5020 
5021 		err = nlmsg_parse_deprecated_strict(nlh,
5022 						    sizeof(struct ifinfomsg),
5023 						    tb, IFLA_MAX, ifla_policy,
5024 						    extack);
5025 	} else {
5026 		err = nlmsg_parse_deprecated(nlh, sizeof(struct ifinfomsg),
5027 					     tb, IFLA_MAX, ifla_policy,
5028 					     extack);
5029 	}
5030 	if (err < 0)
5031 		return err;
5032 
5033 	/* new attributes should only be added with strict checking */
5034 	for (i = 0; i <= IFLA_MAX; ++i) {
5035 		if (!tb[i])
5036 			continue;
5037 
5038 		switch (i) {
5039 		case IFLA_EXT_MASK:
5040 			*filter_mask = nla_get_u32(tb[i]);
5041 			break;
5042 		default:
5043 			if (strict_check) {
5044 				NL_SET_ERR_MSG(extack, "Unsupported attribute in bridge link dump request");
5045 				return -EINVAL;
5046 			}
5047 		}
5048 	}
5049 
5050 	return 0;
5051 }
5052 
rtnl_bridge_getlink(struct sk_buff * skb,struct netlink_callback * cb)5053 static int rtnl_bridge_getlink(struct sk_buff *skb, struct netlink_callback *cb)
5054 {
5055 	const struct nlmsghdr *nlh = cb->nlh;
5056 	struct net *net = sock_net(skb->sk);
5057 	struct net_device *dev;
5058 	int idx = 0;
5059 	u32 portid = NETLINK_CB(cb->skb).portid;
5060 	u32 seq = nlh->nlmsg_seq;
5061 	u32 filter_mask = 0;
5062 	int err;
5063 
5064 	err = valid_bridge_getlink_req(nlh, cb->strict_check, &filter_mask,
5065 				       cb->extack);
5066 	if (err < 0 && cb->strict_check)
5067 		return err;
5068 
5069 	rcu_read_lock();
5070 	for_each_netdev_rcu(net, dev) {
5071 		const struct net_device_ops *ops = dev->netdev_ops;
5072 		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
5073 
5074 		if (br_dev && br_dev->netdev_ops->ndo_bridge_getlink) {
5075 			if (idx >= cb->args[0]) {
5076 				err = br_dev->netdev_ops->ndo_bridge_getlink(
5077 						skb, portid, seq, dev,
5078 						filter_mask, NLM_F_MULTI);
5079 				if (err < 0 && err != -EOPNOTSUPP) {
5080 					if (likely(skb->len))
5081 						break;
5082 
5083 					goto out_err;
5084 				}
5085 			}
5086 			idx++;
5087 		}
5088 
5089 		if (ops->ndo_bridge_getlink) {
5090 			if (idx >= cb->args[0]) {
5091 				err = ops->ndo_bridge_getlink(skb, portid,
5092 							      seq, dev,
5093 							      filter_mask,
5094 							      NLM_F_MULTI);
5095 				if (err < 0 && err != -EOPNOTSUPP) {
5096 					if (likely(skb->len))
5097 						break;
5098 
5099 					goto out_err;
5100 				}
5101 			}
5102 			idx++;
5103 		}
5104 	}
5105 	err = skb->len;
5106 out_err:
5107 	rcu_read_unlock();
5108 	cb->args[0] = idx;
5109 
5110 	return err;
5111 }
5112 
bridge_nlmsg_size(void)5113 static inline size_t bridge_nlmsg_size(void)
5114 {
5115 	return NLMSG_ALIGN(sizeof(struct ifinfomsg))
5116 		+ nla_total_size(IFNAMSIZ)	/* IFLA_IFNAME */
5117 		+ nla_total_size(MAX_ADDR_LEN)	/* IFLA_ADDRESS */
5118 		+ nla_total_size(sizeof(u32))	/* IFLA_MASTER */
5119 		+ nla_total_size(sizeof(u32))	/* IFLA_MTU */
5120 		+ nla_total_size(sizeof(u32))	/* IFLA_LINK */
5121 		+ nla_total_size(sizeof(u32))	/* IFLA_OPERSTATE */
5122 		+ nla_total_size(sizeof(u8))	/* IFLA_PROTINFO */
5123 		+ nla_total_size(sizeof(struct nlattr))	/* IFLA_AF_SPEC */
5124 		+ nla_total_size(sizeof(u16))	/* IFLA_BRIDGE_FLAGS */
5125 		+ nla_total_size(sizeof(u16));	/* IFLA_BRIDGE_MODE */
5126 }
5127 
rtnl_bridge_notify(struct net_device * dev)5128 static int rtnl_bridge_notify(struct net_device *dev)
5129 {
5130 	struct net *net = dev_net(dev);
5131 	struct sk_buff *skb;
5132 	int err = -EOPNOTSUPP;
5133 
5134 	if (!dev->netdev_ops->ndo_bridge_getlink)
5135 		return 0;
5136 
5137 	skb = nlmsg_new(bridge_nlmsg_size(), GFP_ATOMIC);
5138 	if (!skb) {
5139 		err = -ENOMEM;
5140 		goto errout;
5141 	}
5142 
5143 	err = dev->netdev_ops->ndo_bridge_getlink(skb, 0, 0, dev, 0, 0);
5144 	if (err < 0)
5145 		goto errout;
5146 
5147 	/* Notification info is only filled for bridge ports, not the bridge
5148 	 * device itself. Therefore, a zero notification length is valid and
5149 	 * should not result in an error.
5150 	 */
5151 	if (!skb->len)
5152 		goto errout;
5153 
5154 	rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC);
5155 	return 0;
5156 errout:
5157 	WARN_ON(err == -EMSGSIZE);
5158 	kfree_skb(skb);
5159 	if (err)
5160 		rtnl_set_sk_err(net, RTNLGRP_LINK, err);
5161 	return err;
5162 }
5163 
rtnl_bridge_setlink(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)5164 static int rtnl_bridge_setlink(struct sk_buff *skb, struct nlmsghdr *nlh,
5165 			       struct netlink_ext_ack *extack)
5166 {
5167 	struct net *net = sock_net(skb->sk);
5168 	struct ifinfomsg *ifm;
5169 	struct net_device *dev;
5170 	struct nlattr *br_spec, *attr, *br_flags_attr = NULL;
5171 	int rem, err = -EOPNOTSUPP;
5172 	u16 flags = 0;
5173 
5174 	if (nlmsg_len(nlh) < sizeof(*ifm))
5175 		return -EINVAL;
5176 
5177 	ifm = nlmsg_data(nlh);
5178 	if (ifm->ifi_family != AF_BRIDGE)
5179 		return -EPFNOSUPPORT;
5180 
5181 	dev = __dev_get_by_index(net, ifm->ifi_index);
5182 	if (!dev) {
5183 		NL_SET_ERR_MSG(extack, "unknown ifindex");
5184 		return -ENODEV;
5185 	}
5186 
5187 	br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
5188 	if (br_spec) {
5189 		nla_for_each_nested(attr, br_spec, rem) {
5190 			if (nla_type(attr) == IFLA_BRIDGE_FLAGS && !br_flags_attr) {
5191 				if (nla_len(attr) < sizeof(flags))
5192 					return -EINVAL;
5193 
5194 				br_flags_attr = attr;
5195 				flags = nla_get_u16(attr);
5196 			}
5197 
5198 			if (nla_type(attr) == IFLA_BRIDGE_MODE) {
5199 				if (nla_len(attr) < sizeof(u16))
5200 					return -EINVAL;
5201 			}
5202 		}
5203 	}
5204 
5205 	if (!flags || (flags & BRIDGE_FLAGS_MASTER)) {
5206 		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
5207 
5208 		if (!br_dev || !br_dev->netdev_ops->ndo_bridge_setlink) {
5209 			err = -EOPNOTSUPP;
5210 			goto out;
5211 		}
5212 
5213 		err = br_dev->netdev_ops->ndo_bridge_setlink(dev, nlh, flags,
5214 							     extack);
5215 		if (err)
5216 			goto out;
5217 
5218 		flags &= ~BRIDGE_FLAGS_MASTER;
5219 	}
5220 
5221 	if ((flags & BRIDGE_FLAGS_SELF)) {
5222 		if (!dev->netdev_ops->ndo_bridge_setlink)
5223 			err = -EOPNOTSUPP;
5224 		else
5225 			err = dev->netdev_ops->ndo_bridge_setlink(dev, nlh,
5226 								  flags,
5227 								  extack);
5228 		if (!err) {
5229 			flags &= ~BRIDGE_FLAGS_SELF;
5230 
5231 			/* Generate event to notify upper layer of bridge
5232 			 * change
5233 			 */
5234 			err = rtnl_bridge_notify(dev);
5235 		}
5236 	}
5237 
5238 	if (br_flags_attr)
5239 		memcpy(nla_data(br_flags_attr), &flags, sizeof(flags));
5240 out:
5241 	return err;
5242 }
5243 
rtnl_bridge_dellink(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)5244 static int rtnl_bridge_dellink(struct sk_buff *skb, struct nlmsghdr *nlh,
5245 			       struct netlink_ext_ack *extack)
5246 {
5247 	struct net *net = sock_net(skb->sk);
5248 	struct ifinfomsg *ifm;
5249 	struct net_device *dev;
5250 	struct nlattr *br_spec, *attr = NULL;
5251 	int rem, err = -EOPNOTSUPP;
5252 	u16 flags = 0;
5253 	bool have_flags = false;
5254 
5255 	if (nlmsg_len(nlh) < sizeof(*ifm))
5256 		return -EINVAL;
5257 
5258 	ifm = nlmsg_data(nlh);
5259 	if (ifm->ifi_family != AF_BRIDGE)
5260 		return -EPFNOSUPPORT;
5261 
5262 	dev = __dev_get_by_index(net, ifm->ifi_index);
5263 	if (!dev) {
5264 		NL_SET_ERR_MSG(extack, "unknown ifindex");
5265 		return -ENODEV;
5266 	}
5267 
5268 	br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
5269 	if (br_spec) {
5270 		nla_for_each_nested(attr, br_spec, rem) {
5271 			if (nla_type(attr) == IFLA_BRIDGE_FLAGS) {
5272 				if (nla_len(attr) < sizeof(flags))
5273 					return -EINVAL;
5274 
5275 				have_flags = true;
5276 				flags = nla_get_u16(attr);
5277 				break;
5278 			}
5279 		}
5280 	}
5281 
5282 	if (!flags || (flags & BRIDGE_FLAGS_MASTER)) {
5283 		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
5284 
5285 		if (!br_dev || !br_dev->netdev_ops->ndo_bridge_dellink) {
5286 			err = -EOPNOTSUPP;
5287 			goto out;
5288 		}
5289 
5290 		err = br_dev->netdev_ops->ndo_bridge_dellink(dev, nlh, flags);
5291 		if (err)
5292 			goto out;
5293 
5294 		flags &= ~BRIDGE_FLAGS_MASTER;
5295 	}
5296 
5297 	if ((flags & BRIDGE_FLAGS_SELF)) {
5298 		if (!dev->netdev_ops->ndo_bridge_dellink)
5299 			err = -EOPNOTSUPP;
5300 		else
5301 			err = dev->netdev_ops->ndo_bridge_dellink(dev, nlh,
5302 								  flags);
5303 
5304 		if (!err) {
5305 			flags &= ~BRIDGE_FLAGS_SELF;
5306 
5307 			/* Generate event to notify upper layer of bridge
5308 			 * change
5309 			 */
5310 			err = rtnl_bridge_notify(dev);
5311 		}
5312 	}
5313 
5314 	if (have_flags)
5315 		memcpy(nla_data(attr), &flags, sizeof(flags));
5316 out:
5317 	return err;
5318 }
5319 
stats_attr_valid(unsigned int mask,int attrid,int idxattr)5320 static bool stats_attr_valid(unsigned int mask, int attrid, int idxattr)
5321 {
5322 	return (mask & IFLA_STATS_FILTER_BIT(attrid)) &&
5323 	       (!idxattr || idxattr == attrid);
5324 }
5325 
5326 static bool
rtnl_offload_xstats_have_ndo(const struct net_device * dev,int attr_id)5327 rtnl_offload_xstats_have_ndo(const struct net_device *dev, int attr_id)
5328 {
5329 	return dev->netdev_ops &&
5330 	       dev->netdev_ops->ndo_has_offload_stats &&
5331 	       dev->netdev_ops->ndo_get_offload_stats &&
5332 	       dev->netdev_ops->ndo_has_offload_stats(dev, attr_id);
5333 }
5334 
5335 static unsigned int
rtnl_offload_xstats_get_size_ndo(const struct net_device * dev,int attr_id)5336 rtnl_offload_xstats_get_size_ndo(const struct net_device *dev, int attr_id)
5337 {
5338 	return rtnl_offload_xstats_have_ndo(dev, attr_id) ?
5339 	       sizeof(struct rtnl_link_stats64) : 0;
5340 }
5341 
5342 static int
rtnl_offload_xstats_fill_ndo(struct net_device * dev,int attr_id,struct sk_buff * skb)5343 rtnl_offload_xstats_fill_ndo(struct net_device *dev, int attr_id,
5344 			     struct sk_buff *skb)
5345 {
5346 	unsigned int size = rtnl_offload_xstats_get_size_ndo(dev, attr_id);
5347 	struct nlattr *attr = NULL;
5348 	void *attr_data;
5349 	int err;
5350 
5351 	if (!size)
5352 		return -ENODATA;
5353 
5354 	attr = nla_reserve_64bit(skb, attr_id, size,
5355 				 IFLA_OFFLOAD_XSTATS_UNSPEC);
5356 	if (!attr)
5357 		return -EMSGSIZE;
5358 
5359 	attr_data = nla_data(attr);
5360 	memset(attr_data, 0, size);
5361 
5362 	err = dev->netdev_ops->ndo_get_offload_stats(attr_id, dev, attr_data);
5363 	if (err)
5364 		return err;
5365 
5366 	return 0;
5367 }
5368 
5369 static unsigned int
rtnl_offload_xstats_get_size_stats(const struct net_device * dev,enum netdev_offload_xstats_type type)5370 rtnl_offload_xstats_get_size_stats(const struct net_device *dev,
5371 				   enum netdev_offload_xstats_type type)
5372 {
5373 	bool enabled = netdev_offload_xstats_enabled(dev, type);
5374 
5375 	return enabled ? sizeof(struct rtnl_hw_stats64) : 0;
5376 }
5377 
5378 struct rtnl_offload_xstats_request_used {
5379 	bool request;
5380 	bool used;
5381 };
5382 
5383 static int
rtnl_offload_xstats_get_stats(struct net_device * dev,enum netdev_offload_xstats_type type,struct rtnl_offload_xstats_request_used * ru,struct rtnl_hw_stats64 * stats,struct netlink_ext_ack * extack)5384 rtnl_offload_xstats_get_stats(struct net_device *dev,
5385 			      enum netdev_offload_xstats_type type,
5386 			      struct rtnl_offload_xstats_request_used *ru,
5387 			      struct rtnl_hw_stats64 *stats,
5388 			      struct netlink_ext_ack *extack)
5389 {
5390 	bool request;
5391 	bool used;
5392 	int err;
5393 
5394 	request = netdev_offload_xstats_enabled(dev, type);
5395 	if (!request) {
5396 		used = false;
5397 		goto out;
5398 	}
5399 
5400 	err = netdev_offload_xstats_get(dev, type, stats, &used, extack);
5401 	if (err)
5402 		return err;
5403 
5404 out:
5405 	if (ru) {
5406 		ru->request = request;
5407 		ru->used = used;
5408 	}
5409 	return 0;
5410 }
5411 
5412 static int
rtnl_offload_xstats_fill_hw_s_info_one(struct sk_buff * skb,int attr_id,struct rtnl_offload_xstats_request_used * ru)5413 rtnl_offload_xstats_fill_hw_s_info_one(struct sk_buff *skb, int attr_id,
5414 				       struct rtnl_offload_xstats_request_used *ru)
5415 {
5416 	struct nlattr *nest;
5417 
5418 	nest = nla_nest_start(skb, attr_id);
5419 	if (!nest)
5420 		return -EMSGSIZE;
5421 
5422 	if (nla_put_u8(skb, IFLA_OFFLOAD_XSTATS_HW_S_INFO_REQUEST, ru->request))
5423 		goto nla_put_failure;
5424 
5425 	if (nla_put_u8(skb, IFLA_OFFLOAD_XSTATS_HW_S_INFO_USED, ru->used))
5426 		goto nla_put_failure;
5427 
5428 	nla_nest_end(skb, nest);
5429 	return 0;
5430 
5431 nla_put_failure:
5432 	nla_nest_cancel(skb, nest);
5433 	return -EMSGSIZE;
5434 }
5435 
5436 static int
rtnl_offload_xstats_fill_hw_s_info(struct sk_buff * skb,struct net_device * dev,struct netlink_ext_ack * extack)5437 rtnl_offload_xstats_fill_hw_s_info(struct sk_buff *skb, struct net_device *dev,
5438 				   struct netlink_ext_ack *extack)
5439 {
5440 	enum netdev_offload_xstats_type t_l3 = NETDEV_OFFLOAD_XSTATS_TYPE_L3;
5441 	struct rtnl_offload_xstats_request_used ru_l3;
5442 	struct nlattr *nest;
5443 	int err;
5444 
5445 	err = rtnl_offload_xstats_get_stats(dev, t_l3, &ru_l3, NULL, extack);
5446 	if (err)
5447 		return err;
5448 
5449 	nest = nla_nest_start(skb, IFLA_OFFLOAD_XSTATS_HW_S_INFO);
5450 	if (!nest)
5451 		return -EMSGSIZE;
5452 
5453 	if (rtnl_offload_xstats_fill_hw_s_info_one(skb,
5454 						   IFLA_OFFLOAD_XSTATS_L3_STATS,
5455 						   &ru_l3))
5456 		goto nla_put_failure;
5457 
5458 	nla_nest_end(skb, nest);
5459 	return 0;
5460 
5461 nla_put_failure:
5462 	nla_nest_cancel(skb, nest);
5463 	return -EMSGSIZE;
5464 }
5465 
rtnl_offload_xstats_fill(struct sk_buff * skb,struct net_device * dev,int * prividx,u32 off_filter_mask,struct netlink_ext_ack * extack)5466 static int rtnl_offload_xstats_fill(struct sk_buff *skb, struct net_device *dev,
5467 				    int *prividx, u32 off_filter_mask,
5468 				    struct netlink_ext_ack *extack)
5469 {
5470 	enum netdev_offload_xstats_type t_l3 = NETDEV_OFFLOAD_XSTATS_TYPE_L3;
5471 	int attr_id_hw_s_info = IFLA_OFFLOAD_XSTATS_HW_S_INFO;
5472 	int attr_id_l3_stats = IFLA_OFFLOAD_XSTATS_L3_STATS;
5473 	int attr_id_cpu_hit = IFLA_OFFLOAD_XSTATS_CPU_HIT;
5474 	bool have_data = false;
5475 	int err;
5476 
5477 	if (*prividx <= attr_id_cpu_hit &&
5478 	    (off_filter_mask &
5479 	     IFLA_STATS_FILTER_BIT(attr_id_cpu_hit))) {
5480 		err = rtnl_offload_xstats_fill_ndo(dev, attr_id_cpu_hit, skb);
5481 		if (!err) {
5482 			have_data = true;
5483 		} else if (err != -ENODATA) {
5484 			*prividx = attr_id_cpu_hit;
5485 			return err;
5486 		}
5487 	}
5488 
5489 	if (*prividx <= attr_id_hw_s_info &&
5490 	    (off_filter_mask & IFLA_STATS_FILTER_BIT(attr_id_hw_s_info))) {
5491 		*prividx = attr_id_hw_s_info;
5492 
5493 		err = rtnl_offload_xstats_fill_hw_s_info(skb, dev, extack);
5494 		if (err)
5495 			return err;
5496 
5497 		have_data = true;
5498 		*prividx = 0;
5499 	}
5500 
5501 	if (*prividx <= attr_id_l3_stats &&
5502 	    (off_filter_mask & IFLA_STATS_FILTER_BIT(attr_id_l3_stats))) {
5503 		unsigned int size_l3;
5504 		struct nlattr *attr;
5505 
5506 		*prividx = attr_id_l3_stats;
5507 
5508 		size_l3 = rtnl_offload_xstats_get_size_stats(dev, t_l3);
5509 		if (!size_l3)
5510 			goto skip_l3_stats;
5511 		attr = nla_reserve_64bit(skb, attr_id_l3_stats, size_l3,
5512 					 IFLA_OFFLOAD_XSTATS_UNSPEC);
5513 		if (!attr)
5514 			return -EMSGSIZE;
5515 
5516 		err = rtnl_offload_xstats_get_stats(dev, t_l3, NULL,
5517 						    nla_data(attr), extack);
5518 		if (err)
5519 			return err;
5520 
5521 		have_data = true;
5522 skip_l3_stats:
5523 		*prividx = 0;
5524 	}
5525 
5526 	if (!have_data)
5527 		return -ENODATA;
5528 
5529 	*prividx = 0;
5530 	return 0;
5531 }
5532 
5533 static unsigned int
rtnl_offload_xstats_get_size_hw_s_info_one(const struct net_device * dev,enum netdev_offload_xstats_type type)5534 rtnl_offload_xstats_get_size_hw_s_info_one(const struct net_device *dev,
5535 					   enum netdev_offload_xstats_type type)
5536 {
5537 	return nla_total_size(0) +
5538 		/* IFLA_OFFLOAD_XSTATS_HW_S_INFO_REQUEST */
5539 		nla_total_size(sizeof(u8)) +
5540 		/* IFLA_OFFLOAD_XSTATS_HW_S_INFO_USED */
5541 		nla_total_size(sizeof(u8)) +
5542 		0;
5543 }
5544 
5545 static unsigned int
rtnl_offload_xstats_get_size_hw_s_info(const struct net_device * dev)5546 rtnl_offload_xstats_get_size_hw_s_info(const struct net_device *dev)
5547 {
5548 	enum netdev_offload_xstats_type t_l3 = NETDEV_OFFLOAD_XSTATS_TYPE_L3;
5549 
5550 	return nla_total_size(0) +
5551 		/* IFLA_OFFLOAD_XSTATS_L3_STATS */
5552 		rtnl_offload_xstats_get_size_hw_s_info_one(dev, t_l3) +
5553 		0;
5554 }
5555 
rtnl_offload_xstats_get_size(const struct net_device * dev,u32 off_filter_mask)5556 static int rtnl_offload_xstats_get_size(const struct net_device *dev,
5557 					u32 off_filter_mask)
5558 {
5559 	enum netdev_offload_xstats_type t_l3 = NETDEV_OFFLOAD_XSTATS_TYPE_L3;
5560 	int attr_id_cpu_hit = IFLA_OFFLOAD_XSTATS_CPU_HIT;
5561 	int nla_size = 0;
5562 	int size;
5563 
5564 	if (off_filter_mask &
5565 	    IFLA_STATS_FILTER_BIT(attr_id_cpu_hit)) {
5566 		size = rtnl_offload_xstats_get_size_ndo(dev, attr_id_cpu_hit);
5567 		nla_size += nla_total_size_64bit(size);
5568 	}
5569 
5570 	if (off_filter_mask &
5571 	    IFLA_STATS_FILTER_BIT(IFLA_OFFLOAD_XSTATS_HW_S_INFO))
5572 		nla_size += rtnl_offload_xstats_get_size_hw_s_info(dev);
5573 
5574 	if (off_filter_mask &
5575 	    IFLA_STATS_FILTER_BIT(IFLA_OFFLOAD_XSTATS_L3_STATS)) {
5576 		size = rtnl_offload_xstats_get_size_stats(dev, t_l3);
5577 		nla_size += nla_total_size_64bit(size);
5578 	}
5579 
5580 	if (nla_size != 0)
5581 		nla_size += nla_total_size(0);
5582 
5583 	return nla_size;
5584 }
5585 
5586 struct rtnl_stats_dump_filters {
5587 	/* mask[0] filters outer attributes. Then individual nests have their
5588 	 * filtering mask at the index of the nested attribute.
5589 	 */
5590 	u32 mask[IFLA_STATS_MAX + 1];
5591 };
5592 
rtnl_fill_statsinfo(struct sk_buff * skb,struct net_device * dev,int type,u32 pid,u32 seq,u32 change,unsigned int flags,const struct rtnl_stats_dump_filters * filters,int * idxattr,int * prividx,struct netlink_ext_ack * extack)5593 static int rtnl_fill_statsinfo(struct sk_buff *skb, struct net_device *dev,
5594 			       int type, u32 pid, u32 seq, u32 change,
5595 			       unsigned int flags,
5596 			       const struct rtnl_stats_dump_filters *filters,
5597 			       int *idxattr, int *prividx,
5598 			       struct netlink_ext_ack *extack)
5599 {
5600 	unsigned int filter_mask = filters->mask[0];
5601 	struct if_stats_msg *ifsm;
5602 	struct nlmsghdr *nlh;
5603 	struct nlattr *attr;
5604 	int s_prividx = *prividx;
5605 	int err;
5606 
5607 	ASSERT_RTNL();
5608 
5609 	nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifsm), flags);
5610 	if (!nlh)
5611 		return -EMSGSIZE;
5612 
5613 	ifsm = nlmsg_data(nlh);
5614 	ifsm->family = PF_UNSPEC;
5615 	ifsm->pad1 = 0;
5616 	ifsm->pad2 = 0;
5617 	ifsm->ifindex = dev->ifindex;
5618 	ifsm->filter_mask = filter_mask;
5619 
5620 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, *idxattr)) {
5621 		struct rtnl_link_stats64 *sp;
5622 
5623 		attr = nla_reserve_64bit(skb, IFLA_STATS_LINK_64,
5624 					 sizeof(struct rtnl_link_stats64),
5625 					 IFLA_STATS_UNSPEC);
5626 		if (!attr) {
5627 			err = -EMSGSIZE;
5628 			goto nla_put_failure;
5629 		}
5630 
5631 		sp = nla_data(attr);
5632 		dev_get_stats(dev, sp);
5633 	}
5634 
5635 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, *idxattr)) {
5636 		const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
5637 
5638 		if (ops && ops->fill_linkxstats) {
5639 			*idxattr = IFLA_STATS_LINK_XSTATS;
5640 			attr = nla_nest_start_noflag(skb,
5641 						     IFLA_STATS_LINK_XSTATS);
5642 			if (!attr) {
5643 				err = -EMSGSIZE;
5644 				goto nla_put_failure;
5645 			}
5646 
5647 			err = ops->fill_linkxstats(skb, dev, prividx, *idxattr);
5648 			nla_nest_end(skb, attr);
5649 			if (err)
5650 				goto nla_put_failure;
5651 			*idxattr = 0;
5652 		}
5653 	}
5654 
5655 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE,
5656 			     *idxattr)) {
5657 		const struct rtnl_link_ops *ops = NULL;
5658 		const struct net_device *master;
5659 
5660 		master = netdev_master_upper_dev_get(dev);
5661 		if (master)
5662 			ops = master->rtnl_link_ops;
5663 		if (ops && ops->fill_linkxstats) {
5664 			*idxattr = IFLA_STATS_LINK_XSTATS_SLAVE;
5665 			attr = nla_nest_start_noflag(skb,
5666 						     IFLA_STATS_LINK_XSTATS_SLAVE);
5667 			if (!attr) {
5668 				err = -EMSGSIZE;
5669 				goto nla_put_failure;
5670 			}
5671 
5672 			err = ops->fill_linkxstats(skb, dev, prividx, *idxattr);
5673 			nla_nest_end(skb, attr);
5674 			if (err)
5675 				goto nla_put_failure;
5676 			*idxattr = 0;
5677 		}
5678 	}
5679 
5680 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS,
5681 			     *idxattr)) {
5682 		u32 off_filter_mask;
5683 
5684 		off_filter_mask = filters->mask[IFLA_STATS_LINK_OFFLOAD_XSTATS];
5685 		*idxattr = IFLA_STATS_LINK_OFFLOAD_XSTATS;
5686 		attr = nla_nest_start_noflag(skb,
5687 					     IFLA_STATS_LINK_OFFLOAD_XSTATS);
5688 		if (!attr) {
5689 			err = -EMSGSIZE;
5690 			goto nla_put_failure;
5691 		}
5692 
5693 		err = rtnl_offload_xstats_fill(skb, dev, prividx,
5694 					       off_filter_mask, extack);
5695 		if (err == -ENODATA)
5696 			nla_nest_cancel(skb, attr);
5697 		else
5698 			nla_nest_end(skb, attr);
5699 
5700 		if (err && err != -ENODATA)
5701 			goto nla_put_failure;
5702 		*idxattr = 0;
5703 	}
5704 
5705 	if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, *idxattr)) {
5706 		struct rtnl_af_ops *af_ops;
5707 
5708 		*idxattr = IFLA_STATS_AF_SPEC;
5709 		attr = nla_nest_start_noflag(skb, IFLA_STATS_AF_SPEC);
5710 		if (!attr) {
5711 			err = -EMSGSIZE;
5712 			goto nla_put_failure;
5713 		}
5714 
5715 		rcu_read_lock();
5716 		list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
5717 			if (af_ops->fill_stats_af) {
5718 				struct nlattr *af;
5719 
5720 				af = nla_nest_start_noflag(skb,
5721 							   af_ops->family);
5722 				if (!af) {
5723 					rcu_read_unlock();
5724 					err = -EMSGSIZE;
5725 					goto nla_put_failure;
5726 				}
5727 				err = af_ops->fill_stats_af(skb, dev);
5728 
5729 				if (err == -ENODATA) {
5730 					nla_nest_cancel(skb, af);
5731 				} else if (err < 0) {
5732 					rcu_read_unlock();
5733 					goto nla_put_failure;
5734 				}
5735 
5736 				nla_nest_end(skb, af);
5737 			}
5738 		}
5739 		rcu_read_unlock();
5740 
5741 		nla_nest_end(skb, attr);
5742 
5743 		*idxattr = 0;
5744 	}
5745 
5746 	nlmsg_end(skb, nlh);
5747 
5748 	return 0;
5749 
5750 nla_put_failure:
5751 	/* not a multi message or no progress mean a real error */
5752 	if (!(flags & NLM_F_MULTI) || s_prividx == *prividx)
5753 		nlmsg_cancel(skb, nlh);
5754 	else
5755 		nlmsg_end(skb, nlh);
5756 
5757 	return err;
5758 }
5759 
if_nlmsg_stats_size(const struct net_device * dev,const struct rtnl_stats_dump_filters * filters)5760 static size_t if_nlmsg_stats_size(const struct net_device *dev,
5761 				  const struct rtnl_stats_dump_filters *filters)
5762 {
5763 	size_t size = NLMSG_ALIGN(sizeof(struct if_stats_msg));
5764 	unsigned int filter_mask = filters->mask[0];
5765 
5766 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, 0))
5767 		size += nla_total_size_64bit(sizeof(struct rtnl_link_stats64));
5768 
5769 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, 0)) {
5770 		const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
5771 		int attr = IFLA_STATS_LINK_XSTATS;
5772 
5773 		if (ops && ops->get_linkxstats_size) {
5774 			size += nla_total_size(ops->get_linkxstats_size(dev,
5775 									attr));
5776 			/* for IFLA_STATS_LINK_XSTATS */
5777 			size += nla_total_size(0);
5778 		}
5779 	}
5780 
5781 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 0)) {
5782 		struct net_device *_dev = (struct net_device *)dev;
5783 		const struct rtnl_link_ops *ops = NULL;
5784 		const struct net_device *master;
5785 
5786 		/* netdev_master_upper_dev_get can't take const */
5787 		master = netdev_master_upper_dev_get(_dev);
5788 		if (master)
5789 			ops = master->rtnl_link_ops;
5790 		if (ops && ops->get_linkxstats_size) {
5791 			int attr = IFLA_STATS_LINK_XSTATS_SLAVE;
5792 
5793 			size += nla_total_size(ops->get_linkxstats_size(dev,
5794 									attr));
5795 			/* for IFLA_STATS_LINK_XSTATS_SLAVE */
5796 			size += nla_total_size(0);
5797 		}
5798 	}
5799 
5800 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 0)) {
5801 		u32 off_filter_mask;
5802 
5803 		off_filter_mask = filters->mask[IFLA_STATS_LINK_OFFLOAD_XSTATS];
5804 		size += rtnl_offload_xstats_get_size(dev, off_filter_mask);
5805 	}
5806 
5807 	if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, 0)) {
5808 		struct rtnl_af_ops *af_ops;
5809 
5810 		/* for IFLA_STATS_AF_SPEC */
5811 		size += nla_total_size(0);
5812 
5813 		rcu_read_lock();
5814 		list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
5815 			if (af_ops->get_stats_af_size) {
5816 				size += nla_total_size(
5817 					af_ops->get_stats_af_size(dev));
5818 
5819 				/* for AF_* */
5820 				size += nla_total_size(0);
5821 			}
5822 		}
5823 		rcu_read_unlock();
5824 	}
5825 
5826 	return size;
5827 }
5828 
5829 #define RTNL_STATS_OFFLOAD_XSTATS_VALID ((1 << __IFLA_OFFLOAD_XSTATS_MAX) - 1)
5830 
5831 static const struct nla_policy
5832 rtnl_stats_get_policy_filters[IFLA_STATS_MAX + 1] = {
5833 	[IFLA_STATS_LINK_OFFLOAD_XSTATS] =
5834 		    NLA_POLICY_MASK(NLA_U32, RTNL_STATS_OFFLOAD_XSTATS_VALID),
5835 };
5836 
5837 static const struct nla_policy
5838 rtnl_stats_get_policy[IFLA_STATS_GETSET_MAX + 1] = {
5839 	[IFLA_STATS_GET_FILTERS] =
5840 		    NLA_POLICY_NESTED(rtnl_stats_get_policy_filters),
5841 };
5842 
5843 static const struct nla_policy
5844 ifla_stats_set_policy[IFLA_STATS_GETSET_MAX + 1] = {
5845 	[IFLA_STATS_SET_OFFLOAD_XSTATS_L3_STATS] = NLA_POLICY_MAX(NLA_U8, 1),
5846 };
5847 
rtnl_stats_get_parse_filters(struct nlattr * ifla_filters,struct rtnl_stats_dump_filters * filters,struct netlink_ext_ack * extack)5848 static int rtnl_stats_get_parse_filters(struct nlattr *ifla_filters,
5849 					struct rtnl_stats_dump_filters *filters,
5850 					struct netlink_ext_ack *extack)
5851 {
5852 	struct nlattr *tb[IFLA_STATS_MAX + 1];
5853 	int err;
5854 	int at;
5855 
5856 	err = nla_parse_nested(tb, IFLA_STATS_MAX, ifla_filters,
5857 			       rtnl_stats_get_policy_filters, extack);
5858 	if (err < 0)
5859 		return err;
5860 
5861 	for (at = 1; at <= IFLA_STATS_MAX; at++) {
5862 		if (tb[at]) {
5863 			if (!(filters->mask[0] & IFLA_STATS_FILTER_BIT(at))) {
5864 				NL_SET_ERR_MSG(extack, "Filtered attribute not enabled in filter_mask");
5865 				return -EINVAL;
5866 			}
5867 			filters->mask[at] = nla_get_u32(tb[at]);
5868 		}
5869 	}
5870 
5871 	return 0;
5872 }
5873 
rtnl_stats_get_parse(const struct nlmsghdr * nlh,u32 filter_mask,struct rtnl_stats_dump_filters * filters,struct netlink_ext_ack * extack)5874 static int rtnl_stats_get_parse(const struct nlmsghdr *nlh,
5875 				u32 filter_mask,
5876 				struct rtnl_stats_dump_filters *filters,
5877 				struct netlink_ext_ack *extack)
5878 {
5879 	struct nlattr *tb[IFLA_STATS_GETSET_MAX + 1];
5880 	int err;
5881 	int i;
5882 
5883 	filters->mask[0] = filter_mask;
5884 	for (i = 1; i < ARRAY_SIZE(filters->mask); i++)
5885 		filters->mask[i] = -1U;
5886 
5887 	err = nlmsg_parse(nlh, sizeof(struct if_stats_msg), tb,
5888 			  IFLA_STATS_GETSET_MAX, rtnl_stats_get_policy, extack);
5889 	if (err < 0)
5890 		return err;
5891 
5892 	if (tb[IFLA_STATS_GET_FILTERS]) {
5893 		err = rtnl_stats_get_parse_filters(tb[IFLA_STATS_GET_FILTERS],
5894 						   filters, extack);
5895 		if (err)
5896 			return err;
5897 	}
5898 
5899 	return 0;
5900 }
5901 
rtnl_valid_stats_req(const struct nlmsghdr * nlh,bool strict_check,bool is_dump,struct netlink_ext_ack * extack)5902 static int rtnl_valid_stats_req(const struct nlmsghdr *nlh, bool strict_check,
5903 				bool is_dump, struct netlink_ext_ack *extack)
5904 {
5905 	struct if_stats_msg *ifsm;
5906 
5907 	if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*ifsm))) {
5908 		NL_SET_ERR_MSG(extack, "Invalid header for stats dump");
5909 		return -EINVAL;
5910 	}
5911 
5912 	if (!strict_check)
5913 		return 0;
5914 
5915 	ifsm = nlmsg_data(nlh);
5916 
5917 	/* only requests using strict checks can pass data to influence
5918 	 * the dump. The legacy exception is filter_mask.
5919 	 */
5920 	if (ifsm->pad1 || ifsm->pad2 || (is_dump && ifsm->ifindex)) {
5921 		NL_SET_ERR_MSG(extack, "Invalid values in header for stats dump request");
5922 		return -EINVAL;
5923 	}
5924 	if (ifsm->filter_mask >= IFLA_STATS_FILTER_BIT(IFLA_STATS_MAX + 1)) {
5925 		NL_SET_ERR_MSG(extack, "Invalid stats requested through filter mask");
5926 		return -EINVAL;
5927 	}
5928 
5929 	return 0;
5930 }
5931 
rtnl_stats_get(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)5932 static int rtnl_stats_get(struct sk_buff *skb, struct nlmsghdr *nlh,
5933 			  struct netlink_ext_ack *extack)
5934 {
5935 	struct rtnl_stats_dump_filters filters;
5936 	struct net *net = sock_net(skb->sk);
5937 	struct net_device *dev = NULL;
5938 	int idxattr = 0, prividx = 0;
5939 	struct if_stats_msg *ifsm;
5940 	struct sk_buff *nskb;
5941 	int err;
5942 
5943 	err = rtnl_valid_stats_req(nlh, netlink_strict_get_check(skb),
5944 				   false, extack);
5945 	if (err)
5946 		return err;
5947 
5948 	ifsm = nlmsg_data(nlh);
5949 	if (ifsm->ifindex > 0)
5950 		dev = __dev_get_by_index(net, ifsm->ifindex);
5951 	else
5952 		return -EINVAL;
5953 
5954 	if (!dev)
5955 		return -ENODEV;
5956 
5957 	if (!ifsm->filter_mask) {
5958 		NL_SET_ERR_MSG(extack, "Filter mask must be set for stats get");
5959 		return -EINVAL;
5960 	}
5961 
5962 	err = rtnl_stats_get_parse(nlh, ifsm->filter_mask, &filters, extack);
5963 	if (err)
5964 		return err;
5965 
5966 	nskb = nlmsg_new(if_nlmsg_stats_size(dev, &filters), GFP_KERNEL);
5967 	if (!nskb)
5968 		return -ENOBUFS;
5969 
5970 	err = rtnl_fill_statsinfo(nskb, dev, RTM_NEWSTATS,
5971 				  NETLINK_CB(skb).portid, nlh->nlmsg_seq, 0,
5972 				  0, &filters, &idxattr, &prividx, extack);
5973 	if (err < 0) {
5974 		/* -EMSGSIZE implies BUG in if_nlmsg_stats_size */
5975 		WARN_ON(err == -EMSGSIZE);
5976 		kfree_skb(nskb);
5977 	} else {
5978 		err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid);
5979 	}
5980 
5981 	return err;
5982 }
5983 
rtnl_stats_dump(struct sk_buff * skb,struct netlink_callback * cb)5984 static int rtnl_stats_dump(struct sk_buff *skb, struct netlink_callback *cb)
5985 {
5986 	struct netlink_ext_ack *extack = cb->extack;
5987 	int h, s_h, err, s_idx, s_idxattr, s_prividx;
5988 	struct rtnl_stats_dump_filters filters;
5989 	struct net *net = sock_net(skb->sk);
5990 	unsigned int flags = NLM_F_MULTI;
5991 	struct if_stats_msg *ifsm;
5992 	struct hlist_head *head;
5993 	struct net_device *dev;
5994 	int idx = 0;
5995 
5996 	s_h = cb->args[0];
5997 	s_idx = cb->args[1];
5998 	s_idxattr = cb->args[2];
5999 	s_prividx = cb->args[3];
6000 
6001 	cb->seq = net->dev_base_seq;
6002 
6003 	err = rtnl_valid_stats_req(cb->nlh, cb->strict_check, true, extack);
6004 	if (err)
6005 		return err;
6006 
6007 	ifsm = nlmsg_data(cb->nlh);
6008 	if (!ifsm->filter_mask) {
6009 		NL_SET_ERR_MSG(extack, "Filter mask must be set for stats dump");
6010 		return -EINVAL;
6011 	}
6012 
6013 	err = rtnl_stats_get_parse(cb->nlh, ifsm->filter_mask, &filters,
6014 				   extack);
6015 	if (err)
6016 		return err;
6017 
6018 	for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
6019 		idx = 0;
6020 		head = &net->dev_index_head[h];
6021 		hlist_for_each_entry(dev, head, index_hlist) {
6022 			if (idx < s_idx)
6023 				goto cont;
6024 			err = rtnl_fill_statsinfo(skb, dev, RTM_NEWSTATS,
6025 						  NETLINK_CB(cb->skb).portid,
6026 						  cb->nlh->nlmsg_seq, 0,
6027 						  flags, &filters,
6028 						  &s_idxattr, &s_prividx,
6029 						  extack);
6030 			/* If we ran out of room on the first message,
6031 			 * we're in trouble
6032 			 */
6033 			WARN_ON((err == -EMSGSIZE) && (skb->len == 0));
6034 
6035 			if (err < 0)
6036 				goto out;
6037 			s_prividx = 0;
6038 			s_idxattr = 0;
6039 			nl_dump_check_consistent(cb, nlmsg_hdr(skb));
6040 cont:
6041 			idx++;
6042 		}
6043 	}
6044 out:
6045 	cb->args[3] = s_prividx;
6046 	cb->args[2] = s_idxattr;
6047 	cb->args[1] = idx;
6048 	cb->args[0] = h;
6049 
6050 	return skb->len;
6051 }
6052 
rtnl_offload_xstats_notify(struct net_device * dev)6053 void rtnl_offload_xstats_notify(struct net_device *dev)
6054 {
6055 	struct rtnl_stats_dump_filters response_filters = {};
6056 	struct net *net = dev_net(dev);
6057 	int idxattr = 0, prividx = 0;
6058 	struct sk_buff *skb;
6059 	int err = -ENOBUFS;
6060 
6061 	ASSERT_RTNL();
6062 
6063 	response_filters.mask[0] |=
6064 		IFLA_STATS_FILTER_BIT(IFLA_STATS_LINK_OFFLOAD_XSTATS);
6065 	response_filters.mask[IFLA_STATS_LINK_OFFLOAD_XSTATS] |=
6066 		IFLA_STATS_FILTER_BIT(IFLA_OFFLOAD_XSTATS_HW_S_INFO);
6067 
6068 	skb = nlmsg_new(if_nlmsg_stats_size(dev, &response_filters),
6069 			GFP_KERNEL);
6070 	if (!skb)
6071 		goto errout;
6072 
6073 	err = rtnl_fill_statsinfo(skb, dev, RTM_NEWSTATS, 0, 0, 0, 0,
6074 				  &response_filters, &idxattr, &prividx, NULL);
6075 	if (err < 0) {
6076 		kfree_skb(skb);
6077 		goto errout;
6078 	}
6079 
6080 	rtnl_notify(skb, net, 0, RTNLGRP_STATS, NULL, GFP_KERNEL);
6081 	return;
6082 
6083 errout:
6084 	rtnl_set_sk_err(net, RTNLGRP_STATS, err);
6085 }
6086 EXPORT_SYMBOL(rtnl_offload_xstats_notify);
6087 
rtnl_stats_set(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)6088 static int rtnl_stats_set(struct sk_buff *skb, struct nlmsghdr *nlh,
6089 			  struct netlink_ext_ack *extack)
6090 {
6091 	enum netdev_offload_xstats_type t_l3 = NETDEV_OFFLOAD_XSTATS_TYPE_L3;
6092 	struct rtnl_stats_dump_filters response_filters = {};
6093 	struct nlattr *tb[IFLA_STATS_GETSET_MAX + 1];
6094 	struct net *net = sock_net(skb->sk);
6095 	struct net_device *dev = NULL;
6096 	struct if_stats_msg *ifsm;
6097 	bool notify = false;
6098 	int err;
6099 
6100 	err = rtnl_valid_stats_req(nlh, netlink_strict_get_check(skb),
6101 				   false, extack);
6102 	if (err)
6103 		return err;
6104 
6105 	ifsm = nlmsg_data(nlh);
6106 	if (ifsm->family != AF_UNSPEC) {
6107 		NL_SET_ERR_MSG(extack, "Address family should be AF_UNSPEC");
6108 		return -EINVAL;
6109 	}
6110 
6111 	if (ifsm->ifindex > 0)
6112 		dev = __dev_get_by_index(net, ifsm->ifindex);
6113 	else
6114 		return -EINVAL;
6115 
6116 	if (!dev)
6117 		return -ENODEV;
6118 
6119 	if (ifsm->filter_mask) {
6120 		NL_SET_ERR_MSG(extack, "Filter mask must be 0 for stats set");
6121 		return -EINVAL;
6122 	}
6123 
6124 	err = nlmsg_parse(nlh, sizeof(*ifsm), tb, IFLA_STATS_GETSET_MAX,
6125 			  ifla_stats_set_policy, extack);
6126 	if (err < 0)
6127 		return err;
6128 
6129 	if (tb[IFLA_STATS_SET_OFFLOAD_XSTATS_L3_STATS]) {
6130 		u8 req = nla_get_u8(tb[IFLA_STATS_SET_OFFLOAD_XSTATS_L3_STATS]);
6131 
6132 		if (req)
6133 			err = netdev_offload_xstats_enable(dev, t_l3, extack);
6134 		else
6135 			err = netdev_offload_xstats_disable(dev, t_l3);
6136 
6137 		if (!err)
6138 			notify = true;
6139 		else if (err != -EALREADY)
6140 			return err;
6141 
6142 		response_filters.mask[0] |=
6143 			IFLA_STATS_FILTER_BIT(IFLA_STATS_LINK_OFFLOAD_XSTATS);
6144 		response_filters.mask[IFLA_STATS_LINK_OFFLOAD_XSTATS] |=
6145 			IFLA_STATS_FILTER_BIT(IFLA_OFFLOAD_XSTATS_HW_S_INFO);
6146 	}
6147 
6148 	if (notify)
6149 		rtnl_offload_xstats_notify(dev);
6150 
6151 	return 0;
6152 }
6153 
rtnl_mdb_valid_dump_req(const struct nlmsghdr * nlh,struct netlink_ext_ack * extack)6154 static int rtnl_mdb_valid_dump_req(const struct nlmsghdr *nlh,
6155 				   struct netlink_ext_ack *extack)
6156 {
6157 	struct br_port_msg *bpm;
6158 
6159 	if (nlh->nlmsg_len < nlmsg_msg_size(sizeof(*bpm))) {
6160 		NL_SET_ERR_MSG(extack, "Invalid header for mdb dump request");
6161 		return -EINVAL;
6162 	}
6163 
6164 	bpm = nlmsg_data(nlh);
6165 	if (bpm->ifindex) {
6166 		NL_SET_ERR_MSG(extack, "Filtering by device index is not supported for mdb dump request");
6167 		return -EINVAL;
6168 	}
6169 	if (nlmsg_attrlen(nlh, sizeof(*bpm))) {
6170 		NL_SET_ERR_MSG(extack, "Invalid data after header in mdb dump request");
6171 		return -EINVAL;
6172 	}
6173 
6174 	return 0;
6175 }
6176 
6177 struct rtnl_mdb_dump_ctx {
6178 	long idx;
6179 };
6180 
rtnl_mdb_dump(struct sk_buff * skb,struct netlink_callback * cb)6181 static int rtnl_mdb_dump(struct sk_buff *skb, struct netlink_callback *cb)
6182 {
6183 	struct rtnl_mdb_dump_ctx *ctx = (void *)cb->ctx;
6184 	struct net *net = sock_net(skb->sk);
6185 	struct net_device *dev;
6186 	int idx, s_idx;
6187 	int err;
6188 
6189 	NL_ASSERT_DUMP_CTX_FITS(struct rtnl_mdb_dump_ctx);
6190 
6191 	if (cb->strict_check) {
6192 		err = rtnl_mdb_valid_dump_req(cb->nlh, cb->extack);
6193 		if (err)
6194 			return err;
6195 	}
6196 
6197 	s_idx = ctx->idx;
6198 	idx = 0;
6199 
6200 	for_each_netdev(net, dev) {
6201 		if (idx < s_idx)
6202 			goto skip;
6203 		if (!dev->netdev_ops->ndo_mdb_dump)
6204 			goto skip;
6205 
6206 		err = dev->netdev_ops->ndo_mdb_dump(dev, skb, cb);
6207 		if (err == -EMSGSIZE)
6208 			goto out;
6209 		/* Moving on to next device, reset markers and sequence
6210 		 * counters since they are all maintained per-device.
6211 		 */
6212 		memset(cb->ctx, 0, sizeof(cb->ctx));
6213 		cb->prev_seq = 0;
6214 		cb->seq = 0;
6215 skip:
6216 		idx++;
6217 	}
6218 
6219 out:
6220 	ctx->idx = idx;
6221 	return skb->len;
6222 }
6223 
rtnl_validate_mdb_entry(const struct nlattr * attr,struct netlink_ext_ack * extack)6224 static int rtnl_validate_mdb_entry(const struct nlattr *attr,
6225 				   struct netlink_ext_ack *extack)
6226 {
6227 	struct br_mdb_entry *entry = nla_data(attr);
6228 
6229 	if (nla_len(attr) != sizeof(struct br_mdb_entry)) {
6230 		NL_SET_ERR_MSG_ATTR(extack, attr, "Invalid attribute length");
6231 		return -EINVAL;
6232 	}
6233 
6234 	if (entry->ifindex == 0) {
6235 		NL_SET_ERR_MSG(extack, "Zero entry ifindex is not allowed");
6236 		return -EINVAL;
6237 	}
6238 
6239 	if (entry->addr.proto == htons(ETH_P_IP)) {
6240 		if (!ipv4_is_multicast(entry->addr.u.ip4) &&
6241 		    !ipv4_is_zeronet(entry->addr.u.ip4)) {
6242 			NL_SET_ERR_MSG(extack, "IPv4 entry group address is not multicast or 0.0.0.0");
6243 			return -EINVAL;
6244 		}
6245 		if (ipv4_is_local_multicast(entry->addr.u.ip4)) {
6246 			NL_SET_ERR_MSG(extack, "IPv4 entry group address is local multicast");
6247 			return -EINVAL;
6248 		}
6249 #if IS_ENABLED(CONFIG_IPV6)
6250 	} else if (entry->addr.proto == htons(ETH_P_IPV6)) {
6251 		if (ipv6_addr_is_ll_all_nodes(&entry->addr.u.ip6)) {
6252 			NL_SET_ERR_MSG(extack, "IPv6 entry group address is link-local all nodes");
6253 			return -EINVAL;
6254 		}
6255 #endif
6256 	} else if (entry->addr.proto == 0) {
6257 		/* L2 mdb */
6258 		if (!is_multicast_ether_addr(entry->addr.u.mac_addr)) {
6259 			NL_SET_ERR_MSG(extack, "L2 entry group is not multicast");
6260 			return -EINVAL;
6261 		}
6262 	} else {
6263 		NL_SET_ERR_MSG(extack, "Unknown entry protocol");
6264 		return -EINVAL;
6265 	}
6266 
6267 	if (entry->state != MDB_PERMANENT && entry->state != MDB_TEMPORARY) {
6268 		NL_SET_ERR_MSG(extack, "Unknown entry state");
6269 		return -EINVAL;
6270 	}
6271 	if (entry->vid >= VLAN_VID_MASK) {
6272 		NL_SET_ERR_MSG(extack, "Invalid entry VLAN id");
6273 		return -EINVAL;
6274 	}
6275 
6276 	return 0;
6277 }
6278 
6279 static const struct nla_policy mdba_policy[MDBA_SET_ENTRY_MAX + 1] = {
6280 	[MDBA_SET_ENTRY_UNSPEC] = { .strict_start_type = MDBA_SET_ENTRY_ATTRS + 1 },
6281 	[MDBA_SET_ENTRY] = NLA_POLICY_VALIDATE_FN(NLA_BINARY,
6282 						  rtnl_validate_mdb_entry,
6283 						  sizeof(struct br_mdb_entry)),
6284 	[MDBA_SET_ENTRY_ATTRS] = { .type = NLA_NESTED },
6285 };
6286 
rtnl_mdb_add(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)6287 static int rtnl_mdb_add(struct sk_buff *skb, struct nlmsghdr *nlh,
6288 			struct netlink_ext_ack *extack)
6289 {
6290 	struct nlattr *tb[MDBA_SET_ENTRY_MAX + 1];
6291 	struct net *net = sock_net(skb->sk);
6292 	struct br_port_msg *bpm;
6293 	struct net_device *dev;
6294 	int err;
6295 
6296 	err = nlmsg_parse_deprecated(nlh, sizeof(*bpm), tb,
6297 				     MDBA_SET_ENTRY_MAX, mdba_policy, extack);
6298 	if (err)
6299 		return err;
6300 
6301 	bpm = nlmsg_data(nlh);
6302 	if (!bpm->ifindex) {
6303 		NL_SET_ERR_MSG(extack, "Invalid ifindex");
6304 		return -EINVAL;
6305 	}
6306 
6307 	dev = __dev_get_by_index(net, bpm->ifindex);
6308 	if (!dev) {
6309 		NL_SET_ERR_MSG(extack, "Device doesn't exist");
6310 		return -ENODEV;
6311 	}
6312 
6313 	if (NL_REQ_ATTR_CHECK(extack, NULL, tb, MDBA_SET_ENTRY)) {
6314 		NL_SET_ERR_MSG(extack, "Missing MDBA_SET_ENTRY attribute");
6315 		return -EINVAL;
6316 	}
6317 
6318 	if (!dev->netdev_ops->ndo_mdb_add) {
6319 		NL_SET_ERR_MSG(extack, "Device does not support MDB operations");
6320 		return -EOPNOTSUPP;
6321 	}
6322 
6323 	return dev->netdev_ops->ndo_mdb_add(dev, tb, nlh->nlmsg_flags, extack);
6324 }
6325 
rtnl_mdb_del(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)6326 static int rtnl_mdb_del(struct sk_buff *skb, struct nlmsghdr *nlh,
6327 			struct netlink_ext_ack *extack)
6328 {
6329 	struct nlattr *tb[MDBA_SET_ENTRY_MAX + 1];
6330 	struct net *net = sock_net(skb->sk);
6331 	struct br_port_msg *bpm;
6332 	struct net_device *dev;
6333 	int err;
6334 
6335 	err = nlmsg_parse_deprecated(nlh, sizeof(*bpm), tb,
6336 				     MDBA_SET_ENTRY_MAX, mdba_policy, extack);
6337 	if (err)
6338 		return err;
6339 
6340 	bpm = nlmsg_data(nlh);
6341 	if (!bpm->ifindex) {
6342 		NL_SET_ERR_MSG(extack, "Invalid ifindex");
6343 		return -EINVAL;
6344 	}
6345 
6346 	dev = __dev_get_by_index(net, bpm->ifindex);
6347 	if (!dev) {
6348 		NL_SET_ERR_MSG(extack, "Device doesn't exist");
6349 		return -ENODEV;
6350 	}
6351 
6352 	if (NL_REQ_ATTR_CHECK(extack, NULL, tb, MDBA_SET_ENTRY)) {
6353 		NL_SET_ERR_MSG(extack, "Missing MDBA_SET_ENTRY attribute");
6354 		return -EINVAL;
6355 	}
6356 
6357 	if (!dev->netdev_ops->ndo_mdb_del) {
6358 		NL_SET_ERR_MSG(extack, "Device does not support MDB operations");
6359 		return -EOPNOTSUPP;
6360 	}
6361 
6362 	return dev->netdev_ops->ndo_mdb_del(dev, tb, extack);
6363 }
6364 
6365 /* Process one rtnetlink message. */
6366 
rtnetlink_rcv_msg(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)6367 static int rtnetlink_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh,
6368 			     struct netlink_ext_ack *extack)
6369 {
6370 	struct net *net = sock_net(skb->sk);
6371 	struct rtnl_link *link;
6372 	enum rtnl_kinds kind;
6373 	struct module *owner;
6374 	int err = -EOPNOTSUPP;
6375 	rtnl_doit_func doit;
6376 	unsigned int flags;
6377 	int family;
6378 	int type;
6379 
6380 	type = nlh->nlmsg_type;
6381 	if (type > RTM_MAX)
6382 		return -EOPNOTSUPP;
6383 
6384 	type -= RTM_BASE;
6385 
6386 	/* All the messages must have at least 1 byte length */
6387 	if (nlmsg_len(nlh) < sizeof(struct rtgenmsg))
6388 		return 0;
6389 
6390 	family = ((struct rtgenmsg *)nlmsg_data(nlh))->rtgen_family;
6391 	kind = rtnl_msgtype_kind(type);
6392 
6393 	if (kind != RTNL_KIND_GET && !netlink_net_capable(skb, CAP_NET_ADMIN))
6394 		return -EPERM;
6395 
6396 	rcu_read_lock();
6397 	if (kind == RTNL_KIND_GET && (nlh->nlmsg_flags & NLM_F_DUMP)) {
6398 		struct sock *rtnl;
6399 		rtnl_dumpit_func dumpit;
6400 		u32 min_dump_alloc = 0;
6401 
6402 		link = rtnl_get_link(family, type);
6403 		if (!link || !link->dumpit) {
6404 			family = PF_UNSPEC;
6405 			link = rtnl_get_link(family, type);
6406 			if (!link || !link->dumpit)
6407 				goto err_unlock;
6408 		}
6409 		owner = link->owner;
6410 		dumpit = link->dumpit;
6411 		flags = link->flags;
6412 
6413 		if (type == RTM_GETLINK - RTM_BASE)
6414 			min_dump_alloc = rtnl_calcit(skb, nlh);
6415 
6416 		err = 0;
6417 		/* need to do this before rcu_read_unlock() */
6418 		if (!try_module_get(owner))
6419 			err = -EPROTONOSUPPORT;
6420 
6421 		rcu_read_unlock();
6422 
6423 		rtnl = net->rtnl;
6424 		if (err == 0) {
6425 			struct netlink_dump_control c = {
6426 				.dump		= dumpit,
6427 				.min_dump_alloc	= min_dump_alloc,
6428 				.module		= owner,
6429 				.flags		= flags,
6430 			};
6431 			err = netlink_dump_start(rtnl, skb, nlh, &c);
6432 			/* netlink_dump_start() will keep a reference on
6433 			 * module if dump is still in progress.
6434 			 */
6435 			module_put(owner);
6436 		}
6437 		return err;
6438 	}
6439 
6440 	link = rtnl_get_link(family, type);
6441 	if (!link || !link->doit) {
6442 		family = PF_UNSPEC;
6443 		link = rtnl_get_link(PF_UNSPEC, type);
6444 		if (!link || !link->doit)
6445 			goto out_unlock;
6446 	}
6447 
6448 	owner = link->owner;
6449 	if (!try_module_get(owner)) {
6450 		err = -EPROTONOSUPPORT;
6451 		goto out_unlock;
6452 	}
6453 
6454 	flags = link->flags;
6455 	if (kind == RTNL_KIND_DEL && (nlh->nlmsg_flags & NLM_F_BULK) &&
6456 	    !(flags & RTNL_FLAG_BULK_DEL_SUPPORTED)) {
6457 		NL_SET_ERR_MSG(extack, "Bulk delete is not supported");
6458 		module_put(owner);
6459 		goto err_unlock;
6460 	}
6461 
6462 	if (flags & RTNL_FLAG_DOIT_UNLOCKED) {
6463 		doit = link->doit;
6464 		rcu_read_unlock();
6465 		if (doit)
6466 			err = doit(skb, nlh, extack);
6467 		module_put(owner);
6468 		return err;
6469 	}
6470 	rcu_read_unlock();
6471 
6472 	rtnl_lock();
6473 	link = rtnl_get_link(family, type);
6474 	if (link && link->doit)
6475 		err = link->doit(skb, nlh, extack);
6476 	rtnl_unlock();
6477 
6478 	module_put(owner);
6479 
6480 	return err;
6481 
6482 out_unlock:
6483 	rcu_read_unlock();
6484 	return err;
6485 
6486 err_unlock:
6487 	rcu_read_unlock();
6488 	return -EOPNOTSUPP;
6489 }
6490 
rtnetlink_rcv(struct sk_buff * skb)6491 static void rtnetlink_rcv(struct sk_buff *skb)
6492 {
6493 	netlink_rcv_skb(skb, &rtnetlink_rcv_msg);
6494 }
6495 
rtnetlink_bind(struct net * net,int group)6496 static int rtnetlink_bind(struct net *net, int group)
6497 {
6498 	switch (group) {
6499 	case RTNLGRP_IPV4_MROUTE_R:
6500 	case RTNLGRP_IPV6_MROUTE_R:
6501 		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
6502 			return -EPERM;
6503 		break;
6504 	}
6505 	return 0;
6506 }
6507 
rtnetlink_event(struct notifier_block * this,unsigned long event,void * ptr)6508 static int rtnetlink_event(struct notifier_block *this, unsigned long event, void *ptr)
6509 {
6510 	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
6511 
6512 	switch (event) {
6513 	case NETDEV_REBOOT:
6514 	case NETDEV_CHANGEMTU:
6515 	case NETDEV_CHANGEADDR:
6516 	case NETDEV_CHANGENAME:
6517 	case NETDEV_FEAT_CHANGE:
6518 	case NETDEV_BONDING_FAILOVER:
6519 	case NETDEV_POST_TYPE_CHANGE:
6520 	case NETDEV_NOTIFY_PEERS:
6521 	case NETDEV_CHANGEUPPER:
6522 	case NETDEV_RESEND_IGMP:
6523 	case NETDEV_CHANGEINFODATA:
6524 	case NETDEV_CHANGELOWERSTATE:
6525 	case NETDEV_CHANGE_TX_QUEUE_LEN:
6526 		rtmsg_ifinfo_event(RTM_NEWLINK, dev, 0, rtnl_get_event(event),
6527 				   GFP_KERNEL, NULL, 0, 0, NULL);
6528 		break;
6529 	default:
6530 		break;
6531 	}
6532 	return NOTIFY_DONE;
6533 }
6534 
6535 static struct notifier_block rtnetlink_dev_notifier = {
6536 	.notifier_call	= rtnetlink_event,
6537 };
6538 
6539 
rtnetlink_net_init(struct net * net)6540 static int __net_init rtnetlink_net_init(struct net *net)
6541 {
6542 	struct sock *sk;
6543 	struct netlink_kernel_cfg cfg = {
6544 		.groups		= RTNLGRP_MAX,
6545 		.input		= rtnetlink_rcv,
6546 		.cb_mutex	= &rtnl_mutex,
6547 		.flags		= NL_CFG_F_NONROOT_RECV,
6548 		.bind		= rtnetlink_bind,
6549 	};
6550 
6551 	sk = netlink_kernel_create(net, NETLINK_ROUTE, &cfg);
6552 	if (!sk)
6553 		return -ENOMEM;
6554 	net->rtnl = sk;
6555 	return 0;
6556 }
6557 
rtnetlink_net_exit(struct net * net)6558 static void __net_exit rtnetlink_net_exit(struct net *net)
6559 {
6560 	netlink_kernel_release(net->rtnl);
6561 	net->rtnl = NULL;
6562 }
6563 
6564 static struct pernet_operations rtnetlink_net_ops = {
6565 	.init = rtnetlink_net_init,
6566 	.exit = rtnetlink_net_exit,
6567 };
6568 
rtnetlink_init(void)6569 void __init rtnetlink_init(void)
6570 {
6571 	if (register_pernet_subsys(&rtnetlink_net_ops))
6572 		panic("rtnetlink_init: cannot initialize rtnetlink\n");
6573 
6574 	register_netdevice_notifier(&rtnetlink_dev_notifier);
6575 
6576 	rtnl_register(PF_UNSPEC, RTM_GETLINK, rtnl_getlink,
6577 		      rtnl_dump_ifinfo, 0);
6578 	rtnl_register(PF_UNSPEC, RTM_SETLINK, rtnl_setlink, NULL, 0);
6579 	rtnl_register(PF_UNSPEC, RTM_NEWLINK, rtnl_newlink, NULL, 0);
6580 	rtnl_register(PF_UNSPEC, RTM_DELLINK, rtnl_dellink, NULL, 0);
6581 
6582 	rtnl_register(PF_UNSPEC, RTM_GETADDR, NULL, rtnl_dump_all, 0);
6583 	rtnl_register(PF_UNSPEC, RTM_GETROUTE, NULL, rtnl_dump_all, 0);
6584 	rtnl_register(PF_UNSPEC, RTM_GETNETCONF, NULL, rtnl_dump_all, 0);
6585 
6586 	rtnl_register(PF_UNSPEC, RTM_NEWLINKPROP, rtnl_newlinkprop, NULL, 0);
6587 	rtnl_register(PF_UNSPEC, RTM_DELLINKPROP, rtnl_dellinkprop, NULL, 0);
6588 
6589 	rtnl_register(PF_BRIDGE, RTM_NEWNEIGH, rtnl_fdb_add, NULL, 0);
6590 	rtnl_register(PF_BRIDGE, RTM_DELNEIGH, rtnl_fdb_del, NULL,
6591 		      RTNL_FLAG_BULK_DEL_SUPPORTED);
6592 	rtnl_register(PF_BRIDGE, RTM_GETNEIGH, rtnl_fdb_get, rtnl_fdb_dump, 0);
6593 
6594 	rtnl_register(PF_BRIDGE, RTM_GETLINK, NULL, rtnl_bridge_getlink, 0);
6595 	rtnl_register(PF_BRIDGE, RTM_DELLINK, rtnl_bridge_dellink, NULL, 0);
6596 	rtnl_register(PF_BRIDGE, RTM_SETLINK, rtnl_bridge_setlink, NULL, 0);
6597 
6598 	rtnl_register(PF_UNSPEC, RTM_GETSTATS, rtnl_stats_get, rtnl_stats_dump,
6599 		      0);
6600 	rtnl_register(PF_UNSPEC, RTM_SETSTATS, rtnl_stats_set, NULL, 0);
6601 
6602 	rtnl_register(PF_BRIDGE, RTM_GETMDB, NULL, rtnl_mdb_dump, 0);
6603 	rtnl_register(PF_BRIDGE, RTM_NEWMDB, rtnl_mdb_add, NULL, 0);
6604 	rtnl_register(PF_BRIDGE, RTM_DELMDB, rtnl_mdb_del, NULL, 0);
6605 }
6606