xref: /openbmc/linux/net/core/rtnetlink.c (revision b0e9fe1ba7f8305dc1c640fbeb1b8c5c609e604c)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * INET		An implementation of the TCP/IP protocol suite for the LINUX
31da177e4SLinus Torvalds  *		operating system.  INET is implemented using the  BSD Socket
41da177e4SLinus Torvalds  *		interface as the means of communication with the user level.
51da177e4SLinus Torvalds  *
61da177e4SLinus Torvalds  *		Routing netlink socket interface: protocol independent part.
71da177e4SLinus Torvalds  *
81da177e4SLinus Torvalds  * Authors:	Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
91da177e4SLinus Torvalds  *
101da177e4SLinus Torvalds  *		This program is free software; you can redistribute it and/or
111da177e4SLinus Torvalds  *		modify it under the terms of the GNU General Public License
121da177e4SLinus Torvalds  *		as published by the Free Software Foundation; either version
131da177e4SLinus Torvalds  *		2 of the License, or (at your option) any later version.
141da177e4SLinus Torvalds  *
151da177e4SLinus Torvalds  *	Fixes:
161da177e4SLinus Torvalds  *	Vitaly E. Lavrov		RTA_OK arithmetics was wrong.
171da177e4SLinus Torvalds  */
181da177e4SLinus Torvalds 
19ee5d032fSJakub Kicinski #include <linux/bitops.h>
201da177e4SLinus Torvalds #include <linux/errno.h>
211da177e4SLinus Torvalds #include <linux/module.h>
221da177e4SLinus Torvalds #include <linux/types.h>
231da177e4SLinus Torvalds #include <linux/socket.h>
241da177e4SLinus Torvalds #include <linux/kernel.h>
251da177e4SLinus Torvalds #include <linux/timer.h>
261da177e4SLinus Torvalds #include <linux/string.h>
271da177e4SLinus Torvalds #include <linux/sockios.h>
281da177e4SLinus Torvalds #include <linux/net.h>
291da177e4SLinus Torvalds #include <linux/fcntl.h>
301da177e4SLinus Torvalds #include <linux/mm.h>
311da177e4SLinus Torvalds #include <linux/slab.h>
321da177e4SLinus Torvalds #include <linux/interrupt.h>
331da177e4SLinus Torvalds #include <linux/capability.h>
341da177e4SLinus Torvalds #include <linux/skbuff.h>
351da177e4SLinus Torvalds #include <linux/init.h>
361da177e4SLinus Torvalds #include <linux/security.h>
376756ae4bSStephen Hemminger #include <linux/mutex.h>
381823730fSThomas Graf #include <linux/if_addr.h>
3977162022SJohn Fastabend #include <linux/if_bridge.h>
40f6f6424bSJiri Pirko #include <linux/if_vlan.h>
41ebc08a6fSWilliams, Mitch A #include <linux/pci.h>
4277162022SJohn Fastabend #include <linux/etherdevice.h>
4358038695SMartin KaFai Lau #include <linux/bpf.h>
441da177e4SLinus Torvalds 
457c0f6ba6SLinus Torvalds #include <linux/uaccess.h>
461da177e4SLinus Torvalds 
471da177e4SLinus Torvalds #include <linux/inet.h>
481da177e4SLinus Torvalds #include <linux/netdevice.h>
4982f28412SJiri Pirko #include <net/switchdev.h>
501da177e4SLinus Torvalds #include <net/ip.h>
511da177e4SLinus Torvalds #include <net/protocol.h>
521da177e4SLinus Torvalds #include <net/arp.h>
531da177e4SLinus Torvalds #include <net/route.h>
541da177e4SLinus Torvalds #include <net/udp.h>
55ea697639SDaniel Borkmann #include <net/tcp.h>
561da177e4SLinus Torvalds #include <net/sock.h>
571da177e4SLinus Torvalds #include <net/pkt_sched.h>
5814c0b97dSThomas Graf #include <net/fib_rules.h>
59e2849863SThomas Graf #include <net/rtnetlink.h>
6030ffee84SJohannes Berg #include <net/net_namespace.h>
611da177e4SLinus Torvalds 
62e0d087afSEric Dumazet struct rtnl_link {
63e2849863SThomas Graf 	rtnl_doit_func		doit;
64e2849863SThomas Graf 	rtnl_dumpit_func	dumpit;
65e4202511SFlorian Westphal 	struct module		*owner;
6662256f98SFlorian Westphal 	unsigned int		flags;
67addf9b90SFlorian Westphal 	struct rcu_head		rcu;
68e2849863SThomas Graf };
69e2849863SThomas Graf 
706756ae4bSStephen Hemminger static DEFINE_MUTEX(rtnl_mutex);
711da177e4SLinus Torvalds 
721da177e4SLinus Torvalds void rtnl_lock(void)
731da177e4SLinus Torvalds {
746756ae4bSStephen Hemminger 	mutex_lock(&rtnl_mutex);
751da177e4SLinus Torvalds }
76e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_lock);
771da177e4SLinus Torvalds 
781b5c5493SEric Dumazet static struct sk_buff *defer_kfree_skb_list;
791b5c5493SEric Dumazet void rtnl_kfree_skbs(struct sk_buff *head, struct sk_buff *tail)
801b5c5493SEric Dumazet {
811b5c5493SEric Dumazet 	if (head && tail) {
821b5c5493SEric Dumazet 		tail->next = defer_kfree_skb_list;
831b5c5493SEric Dumazet 		defer_kfree_skb_list = head;
841b5c5493SEric Dumazet 	}
851b5c5493SEric Dumazet }
861b5c5493SEric Dumazet EXPORT_SYMBOL(rtnl_kfree_skbs);
871b5c5493SEric Dumazet 
886756ae4bSStephen Hemminger void __rtnl_unlock(void)
891da177e4SLinus Torvalds {
901b5c5493SEric Dumazet 	struct sk_buff *head = defer_kfree_skb_list;
911b5c5493SEric Dumazet 
921b5c5493SEric Dumazet 	defer_kfree_skb_list = NULL;
931b5c5493SEric Dumazet 
946756ae4bSStephen Hemminger 	mutex_unlock(&rtnl_mutex);
951b5c5493SEric Dumazet 
961b5c5493SEric Dumazet 	while (head) {
971b5c5493SEric Dumazet 		struct sk_buff *next = head->next;
981b5c5493SEric Dumazet 
991b5c5493SEric Dumazet 		kfree_skb(head);
1001b5c5493SEric Dumazet 		cond_resched();
1011b5c5493SEric Dumazet 		head = next;
1021b5c5493SEric Dumazet 	}
1031da177e4SLinus Torvalds }
1041da177e4SLinus Torvalds 
1051da177e4SLinus Torvalds void rtnl_unlock(void)
1061da177e4SLinus Torvalds {
10758ec3b4dSHerbert Xu 	/* This fellow will unlock it for us. */
1081da177e4SLinus Torvalds 	netdev_run_todo();
1091da177e4SLinus Torvalds }
110e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_unlock);
1111da177e4SLinus Torvalds 
1126756ae4bSStephen Hemminger int rtnl_trylock(void)
1136756ae4bSStephen Hemminger {
1146756ae4bSStephen Hemminger 	return mutex_trylock(&rtnl_mutex);
1156756ae4bSStephen Hemminger }
116e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_trylock);
1176756ae4bSStephen Hemminger 
118c9c1014bSPatrick McHardy int rtnl_is_locked(void)
119c9c1014bSPatrick McHardy {
120c9c1014bSPatrick McHardy 	return mutex_is_locked(&rtnl_mutex);
121c9c1014bSPatrick McHardy }
122e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_is_locked);
123c9c1014bSPatrick McHardy 
124a898def2SPaul E. McKenney #ifdef CONFIG_PROVE_LOCKING
1250cbf3343SYaowei Bai bool lockdep_rtnl_is_held(void)
126a898def2SPaul E. McKenney {
127a898def2SPaul E. McKenney 	return lockdep_is_held(&rtnl_mutex);
128a898def2SPaul E. McKenney }
129a898def2SPaul E. McKenney EXPORT_SYMBOL(lockdep_rtnl_is_held);
130a898def2SPaul E. McKenney #endif /* #ifdef CONFIG_PROVE_LOCKING */
131a898def2SPaul E. McKenney 
132*b0e9fe1bSFlorian Westphal static struct rtnl_link *__rcu *rtnl_msg_handlers[RTNL_FAMILY_MAX + 1];
133e2849863SThomas Graf 
134e2849863SThomas Graf static inline int rtm_msgindex(int msgtype)
135e2849863SThomas Graf {
136e2849863SThomas Graf 	int msgindex = msgtype - RTM_BASE;
137e2849863SThomas Graf 
138e2849863SThomas Graf 	/*
139e2849863SThomas Graf 	 * msgindex < 0 implies someone tried to register a netlink
140e2849863SThomas Graf 	 * control code. msgindex >= RTM_NR_MSGTYPES may indicate that
141e2849863SThomas Graf 	 * the message type has not been added to linux/rtnetlink.h
142e2849863SThomas Graf 	 */
143e2849863SThomas Graf 	BUG_ON(msgindex < 0 || msgindex >= RTM_NR_MSGTYPES);
144e2849863SThomas Graf 
145e2849863SThomas Graf 	return msgindex;
146e2849863SThomas Graf }
147e2849863SThomas Graf 
148addf9b90SFlorian Westphal static struct rtnl_link *rtnl_get_link(int protocol, int msgtype)
149addf9b90SFlorian Westphal {
150addf9b90SFlorian Westphal 	struct rtnl_link **tab;
151addf9b90SFlorian Westphal 
152addf9b90SFlorian Westphal 	if (protocol >= ARRAY_SIZE(rtnl_msg_handlers))
153addf9b90SFlorian Westphal 		protocol = PF_UNSPEC;
154addf9b90SFlorian Westphal 
155addf9b90SFlorian Westphal 	tab = rcu_dereference_rtnl(rtnl_msg_handlers[protocol]);
156addf9b90SFlorian Westphal 	if (!tab)
157addf9b90SFlorian Westphal 		tab = rcu_dereference_rtnl(rtnl_msg_handlers[PF_UNSPEC]);
158addf9b90SFlorian Westphal 
159addf9b90SFlorian Westphal 	return tab[msgtype];
160addf9b90SFlorian Westphal }
161addf9b90SFlorian Westphal 
162e4202511SFlorian Westphal static int rtnl_register_internal(struct module *owner,
163e4202511SFlorian Westphal 				  int protocol, int msgtype,
164c7ac8679SGreg Rose 				  rtnl_doit_func doit, rtnl_dumpit_func dumpit,
165b97bac64SFlorian Westphal 				  unsigned int flags)
166e2849863SThomas Graf {
167*b0e9fe1bSFlorian Westphal 	struct rtnl_link *link, *old;
168*b0e9fe1bSFlorian Westphal 	struct rtnl_link __rcu **tab;
169e2849863SThomas Graf 	int msgindex;
170addf9b90SFlorian Westphal 	int ret = -ENOBUFS;
171e2849863SThomas Graf 
17225239ceeSPatrick McHardy 	BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
173e2849863SThomas Graf 	msgindex = rtm_msgindex(msgtype);
174e2849863SThomas Graf 
175addf9b90SFlorian Westphal 	rtnl_lock();
176addf9b90SFlorian Westphal 	tab = rtnl_msg_handlers[protocol];
177e2849863SThomas Graf 	if (tab == NULL) {
178addf9b90SFlorian Westphal 		tab = kcalloc(RTM_NR_MSGTYPES, sizeof(void *), GFP_KERNEL);
179addf9b90SFlorian Westphal 		if (!tab)
180addf9b90SFlorian Westphal 			goto unlock;
181e2849863SThomas Graf 
182addf9b90SFlorian Westphal 		/* ensures we see the 0 stores */
1836853dd48SFlorian Westphal 		rcu_assign_pointer(rtnl_msg_handlers[protocol], tab);
184e2849863SThomas Graf 	}
185e2849863SThomas Graf 
186addf9b90SFlorian Westphal 	old = rtnl_dereference(tab[msgindex]);
187addf9b90SFlorian Westphal 	if (old) {
188addf9b90SFlorian Westphal 		link = kmemdup(old, sizeof(*old), GFP_KERNEL);
189addf9b90SFlorian Westphal 		if (!link)
190addf9b90SFlorian Westphal 			goto unlock;
191addf9b90SFlorian Westphal 	} else {
192addf9b90SFlorian Westphal 		link = kzalloc(sizeof(*link), GFP_KERNEL);
193addf9b90SFlorian Westphal 		if (!link)
194addf9b90SFlorian Westphal 			goto unlock;
195addf9b90SFlorian Westphal 	}
196e2849863SThomas Graf 
197e4202511SFlorian Westphal 	WARN_ON(link->owner && link->owner != owner);
198e4202511SFlorian Westphal 	link->owner = owner;
199e4202511SFlorian Westphal 
200addf9b90SFlorian Westphal 	WARN_ON(doit && link->doit && link->doit != doit);
201addf9b90SFlorian Westphal 	if (doit)
202addf9b90SFlorian Westphal 		link->doit = doit;
203addf9b90SFlorian Westphal 	WARN_ON(dumpit && link->dumpit && link->dumpit != dumpit);
204addf9b90SFlorian Westphal 	if (dumpit)
205addf9b90SFlorian Westphal 		link->dumpit = dumpit;
206addf9b90SFlorian Westphal 
207addf9b90SFlorian Westphal 	link->flags |= flags;
208addf9b90SFlorian Westphal 
209addf9b90SFlorian Westphal 	/* publish protocol:msgtype */
210addf9b90SFlorian Westphal 	rcu_assign_pointer(tab[msgindex], link);
211addf9b90SFlorian Westphal 	ret = 0;
212addf9b90SFlorian Westphal 	if (old)
213addf9b90SFlorian Westphal 		kfree_rcu(old, rcu);
214addf9b90SFlorian Westphal unlock:
215addf9b90SFlorian Westphal 	rtnl_unlock();
216addf9b90SFlorian Westphal 	return ret;
217e2849863SThomas Graf }
218e4202511SFlorian Westphal 
219e4202511SFlorian Westphal /**
220e4202511SFlorian Westphal  * rtnl_register_module - Register a rtnetlink message type
221e4202511SFlorian Westphal  *
222e4202511SFlorian Westphal  * @owner: module registering the hook (THIS_MODULE)
223e4202511SFlorian Westphal  * @protocol: Protocol family or PF_UNSPEC
224e4202511SFlorian Westphal  * @msgtype: rtnetlink message type
225e4202511SFlorian Westphal  * @doit: Function pointer called for each request message
226e4202511SFlorian Westphal  * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message
227e4202511SFlorian Westphal  * @flags: rtnl_link_flags to modifiy behaviour of doit/dumpit functions
228e4202511SFlorian Westphal  *
229e4202511SFlorian Westphal  * Like rtnl_register, but for use by removable modules.
230e4202511SFlorian Westphal  */
231e4202511SFlorian Westphal int rtnl_register_module(struct module *owner,
232e4202511SFlorian Westphal 			 int protocol, int msgtype,
233e4202511SFlorian Westphal 			 rtnl_doit_func doit, rtnl_dumpit_func dumpit,
234e4202511SFlorian Westphal 			 unsigned int flags)
235e4202511SFlorian Westphal {
236e4202511SFlorian Westphal 	return rtnl_register_internal(owner, protocol, msgtype,
237e4202511SFlorian Westphal 				      doit, dumpit, flags);
238e4202511SFlorian Westphal }
239e4202511SFlorian Westphal EXPORT_SYMBOL_GPL(rtnl_register_module);
240e4202511SFlorian Westphal 
241e4202511SFlorian Westphal /**
24216feebcfSFlorian Westphal  * rtnl_register - Register a rtnetlink message type
243e4202511SFlorian Westphal  * @protocol: Protocol family or PF_UNSPEC
244e4202511SFlorian Westphal  * @msgtype: rtnetlink message type
245e4202511SFlorian Westphal  * @doit: Function pointer called for each request message
246e4202511SFlorian Westphal  * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message
247e4202511SFlorian Westphal  * @flags: rtnl_link_flags to modifiy behaviour of doit/dumpit functions
248e4202511SFlorian Westphal  *
249e4202511SFlorian Westphal  * Registers the specified function pointers (at least one of them has
250e4202511SFlorian Westphal  * to be non-NULL) to be called whenever a request message for the
251e4202511SFlorian Westphal  * specified protocol family and message type is received.
252e4202511SFlorian Westphal  *
253e4202511SFlorian Westphal  * The special protocol family PF_UNSPEC may be used to define fallback
254e4202511SFlorian Westphal  * function pointers for the case when no entry for the specific protocol
255e4202511SFlorian Westphal  * family exists.
256e2849863SThomas Graf  */
257e2849863SThomas Graf void rtnl_register(int protocol, int msgtype,
258c7ac8679SGreg Rose 		   rtnl_doit_func doit, rtnl_dumpit_func dumpit,
259b97bac64SFlorian Westphal 		   unsigned int flags)
260e2849863SThomas Graf {
26116feebcfSFlorian Westphal 	int err;
26216feebcfSFlorian Westphal 
26316feebcfSFlorian Westphal 	err = rtnl_register_internal(NULL, protocol, msgtype, doit, dumpit,
26416feebcfSFlorian Westphal 				     flags);
26516feebcfSFlorian Westphal 	if (err)
26616feebcfSFlorian Westphal 		pr_err("Unable to register rtnetlink message handler, "
26716feebcfSFlorian Westphal 		       "protocol = %d, message type = %d\n", protocol, msgtype);
268e2849863SThomas Graf }
269e2849863SThomas Graf 
270e2849863SThomas Graf /**
271e2849863SThomas Graf  * rtnl_unregister - Unregister a rtnetlink message type
272e2849863SThomas Graf  * @protocol: Protocol family or PF_UNSPEC
273e2849863SThomas Graf  * @msgtype: rtnetlink message type
274e2849863SThomas Graf  *
275e2849863SThomas Graf  * Returns 0 on success or a negative error code.
276e2849863SThomas Graf  */
277e2849863SThomas Graf int rtnl_unregister(int protocol, int msgtype)
278e2849863SThomas Graf {
279addf9b90SFlorian Westphal 	struct rtnl_link **tab, *link;
280e2849863SThomas Graf 	int msgindex;
281e2849863SThomas Graf 
28225239ceeSPatrick McHardy 	BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
283e2849863SThomas Graf 	msgindex = rtm_msgindex(msgtype);
284e2849863SThomas Graf 
2856853dd48SFlorian Westphal 	rtnl_lock();
286addf9b90SFlorian Westphal 	tab = rtnl_dereference(rtnl_msg_handlers[protocol]);
287addf9b90SFlorian Westphal 	if (!tab) {
2886853dd48SFlorian Westphal 		rtnl_unlock();
289e2849863SThomas Graf 		return -ENOENT;
2906853dd48SFlorian Westphal 	}
291e2849863SThomas Graf 
292addf9b90SFlorian Westphal 	link = tab[msgindex];
293addf9b90SFlorian Westphal 	rcu_assign_pointer(tab[msgindex], NULL);
2946853dd48SFlorian Westphal 	rtnl_unlock();
295e2849863SThomas Graf 
296addf9b90SFlorian Westphal 	kfree_rcu(link, rcu);
297addf9b90SFlorian Westphal 
298e2849863SThomas Graf 	return 0;
299e2849863SThomas Graf }
300e2849863SThomas Graf EXPORT_SYMBOL_GPL(rtnl_unregister);
301e2849863SThomas Graf 
302e2849863SThomas Graf /**
303e2849863SThomas Graf  * rtnl_unregister_all - Unregister all rtnetlink message type of a protocol
304e2849863SThomas Graf  * @protocol : Protocol family or PF_UNSPEC
305e2849863SThomas Graf  *
306e2849863SThomas Graf  * Identical to calling rtnl_unregster() for all registered message types
307e2849863SThomas Graf  * of a certain protocol family.
308e2849863SThomas Graf  */
309e2849863SThomas Graf void rtnl_unregister_all(int protocol)
310e2849863SThomas Graf {
311addf9b90SFlorian Westphal 	struct rtnl_link **tab, *link;
312addf9b90SFlorian Westphal 	int msgindex;
313019a3169SFlorian Westphal 
31425239ceeSPatrick McHardy 	BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
315e2849863SThomas Graf 
316019a3169SFlorian Westphal 	rtnl_lock();
317addf9b90SFlorian Westphal 	tab = rtnl_msg_handlers[protocol];
3186853dd48SFlorian Westphal 	RCU_INIT_POINTER(rtnl_msg_handlers[protocol], NULL);
319addf9b90SFlorian Westphal 	for (msgindex = 0; msgindex < RTM_NR_MSGTYPES; msgindex++) {
320addf9b90SFlorian Westphal 		link = tab[msgindex];
321addf9b90SFlorian Westphal 		if (!link)
322addf9b90SFlorian Westphal 			continue;
323addf9b90SFlorian Westphal 
324addf9b90SFlorian Westphal 		rcu_assign_pointer(tab[msgindex], NULL);
325addf9b90SFlorian Westphal 		kfree_rcu(link, rcu);
326addf9b90SFlorian Westphal 	}
327019a3169SFlorian Westphal 	rtnl_unlock();
328019a3169SFlorian Westphal 
3296853dd48SFlorian Westphal 	synchronize_net();
3306853dd48SFlorian Westphal 
331addf9b90SFlorian Westphal 	kfree(tab);
332e2849863SThomas Graf }
333e2849863SThomas Graf EXPORT_SYMBOL_GPL(rtnl_unregister_all);
3341da177e4SLinus Torvalds 
33538f7b870SPatrick McHardy static LIST_HEAD(link_ops);
33638f7b870SPatrick McHardy 
337c63044f0SEric Dumazet static const struct rtnl_link_ops *rtnl_link_ops_get(const char *kind)
338c63044f0SEric Dumazet {
339c63044f0SEric Dumazet 	const struct rtnl_link_ops *ops;
340c63044f0SEric Dumazet 
341c63044f0SEric Dumazet 	list_for_each_entry(ops, &link_ops, list) {
342c63044f0SEric Dumazet 		if (!strcmp(ops->kind, kind))
343c63044f0SEric Dumazet 			return ops;
344c63044f0SEric Dumazet 	}
345c63044f0SEric Dumazet 	return NULL;
346c63044f0SEric Dumazet }
347c63044f0SEric Dumazet 
34838f7b870SPatrick McHardy /**
34938f7b870SPatrick McHardy  * __rtnl_link_register - Register rtnl_link_ops with rtnetlink.
35038f7b870SPatrick McHardy  * @ops: struct rtnl_link_ops * to register
35138f7b870SPatrick McHardy  *
35238f7b870SPatrick McHardy  * The caller must hold the rtnl_mutex. This function should be used
35338f7b870SPatrick McHardy  * by drivers that create devices during module initialization. It
35438f7b870SPatrick McHardy  * must be called before registering the devices.
35538f7b870SPatrick McHardy  *
35638f7b870SPatrick McHardy  * Returns 0 on success or a negative error code.
35738f7b870SPatrick McHardy  */
35838f7b870SPatrick McHardy int __rtnl_link_register(struct rtnl_link_ops *ops)
35938f7b870SPatrick McHardy {
360c63044f0SEric Dumazet 	if (rtnl_link_ops_get(ops->kind))
361c63044f0SEric Dumazet 		return -EEXIST;
362c63044f0SEric Dumazet 
363b0ab2fabSJiri Pirko 	/* The check for setup is here because if ops
364b0ab2fabSJiri Pirko 	 * does not have that filled up, it is not possible
365b0ab2fabSJiri Pirko 	 * to use the ops for creating device. So do not
366b0ab2fabSJiri Pirko 	 * fill up dellink as well. That disables rtnl_dellink.
367b0ab2fabSJiri Pirko 	 */
368b0ab2fabSJiri Pirko 	if (ops->setup && !ops->dellink)
36923289a37SEric Dumazet 		ops->dellink = unregister_netdevice_queue;
3702d85cba2SPatrick McHardy 
37138f7b870SPatrick McHardy 	list_add_tail(&ops->list, &link_ops);
37238f7b870SPatrick McHardy 	return 0;
37338f7b870SPatrick McHardy }
37438f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(__rtnl_link_register);
37538f7b870SPatrick McHardy 
37638f7b870SPatrick McHardy /**
37738f7b870SPatrick McHardy  * rtnl_link_register - Register rtnl_link_ops with rtnetlink.
37838f7b870SPatrick McHardy  * @ops: struct rtnl_link_ops * to register
37938f7b870SPatrick McHardy  *
38038f7b870SPatrick McHardy  * Returns 0 on success or a negative error code.
38138f7b870SPatrick McHardy  */
38238f7b870SPatrick McHardy int rtnl_link_register(struct rtnl_link_ops *ops)
38338f7b870SPatrick McHardy {
38438f7b870SPatrick McHardy 	int err;
38538f7b870SPatrick McHardy 
38638f7b870SPatrick McHardy 	rtnl_lock();
38738f7b870SPatrick McHardy 	err = __rtnl_link_register(ops);
38838f7b870SPatrick McHardy 	rtnl_unlock();
38938f7b870SPatrick McHardy 	return err;
39038f7b870SPatrick McHardy }
39138f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(rtnl_link_register);
39238f7b870SPatrick McHardy 
393669f87baSPavel Emelyanov static void __rtnl_kill_links(struct net *net, struct rtnl_link_ops *ops)
394669f87baSPavel Emelyanov {
395669f87baSPavel Emelyanov 	struct net_device *dev;
39623289a37SEric Dumazet 	LIST_HEAD(list_kill);
39723289a37SEric Dumazet 
398669f87baSPavel Emelyanov 	for_each_netdev(net, dev) {
39923289a37SEric Dumazet 		if (dev->rtnl_link_ops == ops)
40023289a37SEric Dumazet 			ops->dellink(dev, &list_kill);
401669f87baSPavel Emelyanov 	}
40223289a37SEric Dumazet 	unregister_netdevice_many(&list_kill);
403669f87baSPavel Emelyanov }
404669f87baSPavel Emelyanov 
40538f7b870SPatrick McHardy /**
40638f7b870SPatrick McHardy  * __rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink.
40738f7b870SPatrick McHardy  * @ops: struct rtnl_link_ops * to unregister
40838f7b870SPatrick McHardy  *
4092d85cba2SPatrick McHardy  * The caller must hold the rtnl_mutex.
41038f7b870SPatrick McHardy  */
41138f7b870SPatrick McHardy void __rtnl_link_unregister(struct rtnl_link_ops *ops)
41238f7b870SPatrick McHardy {
413881d966bSEric W. Biederman 	struct net *net;
4142d85cba2SPatrick McHardy 
415881d966bSEric W. Biederman 	for_each_net(net) {
416669f87baSPavel Emelyanov 		__rtnl_kill_links(net, ops);
417881d966bSEric W. Biederman 	}
41838f7b870SPatrick McHardy 	list_del(&ops->list);
41938f7b870SPatrick McHardy }
42038f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(__rtnl_link_unregister);
42138f7b870SPatrick McHardy 
422200b916fSCong Wang /* Return with the rtnl_lock held when there are no network
423200b916fSCong Wang  * devices unregistering in any network namespace.
424200b916fSCong Wang  */
425200b916fSCong Wang static void rtnl_lock_unregistering_all(void)
426200b916fSCong Wang {
427200b916fSCong Wang 	struct net *net;
428200b916fSCong Wang 	bool unregistering;
429ff960a73SPeter Zijlstra 	DEFINE_WAIT_FUNC(wait, woken_wake_function);
430200b916fSCong Wang 
431ff960a73SPeter Zijlstra 	add_wait_queue(&netdev_unregistering_wq, &wait);
432200b916fSCong Wang 	for (;;) {
433200b916fSCong Wang 		unregistering = false;
434200b916fSCong Wang 		rtnl_lock();
435200b916fSCong Wang 		for_each_net(net) {
436200b916fSCong Wang 			if (net->dev_unreg_count > 0) {
437200b916fSCong Wang 				unregistering = true;
438200b916fSCong Wang 				break;
439200b916fSCong Wang 			}
440200b916fSCong Wang 		}
441200b916fSCong Wang 		if (!unregistering)
442200b916fSCong Wang 			break;
443200b916fSCong Wang 		__rtnl_unlock();
444ff960a73SPeter Zijlstra 
445ff960a73SPeter Zijlstra 		wait_woken(&wait, TASK_UNINTERRUPTIBLE, MAX_SCHEDULE_TIMEOUT);
446200b916fSCong Wang 	}
447ff960a73SPeter Zijlstra 	remove_wait_queue(&netdev_unregistering_wq, &wait);
448200b916fSCong Wang }
449200b916fSCong Wang 
45038f7b870SPatrick McHardy /**
45138f7b870SPatrick McHardy  * rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink.
45238f7b870SPatrick McHardy  * @ops: struct rtnl_link_ops * to unregister
45338f7b870SPatrick McHardy  */
45438f7b870SPatrick McHardy void rtnl_link_unregister(struct rtnl_link_ops *ops)
45538f7b870SPatrick McHardy {
456200b916fSCong Wang 	/* Close the race with cleanup_net() */
457200b916fSCong Wang 	mutex_lock(&net_mutex);
458200b916fSCong Wang 	rtnl_lock_unregistering_all();
45938f7b870SPatrick McHardy 	__rtnl_link_unregister(ops);
46038f7b870SPatrick McHardy 	rtnl_unlock();
461200b916fSCong Wang 	mutex_unlock(&net_mutex);
46238f7b870SPatrick McHardy }
46338f7b870SPatrick McHardy EXPORT_SYMBOL_GPL(rtnl_link_unregister);
46438f7b870SPatrick McHardy 
465ba7d49b1SJiri Pirko static size_t rtnl_link_get_slave_info_data_size(const struct net_device *dev)
466ba7d49b1SJiri Pirko {
467ba7d49b1SJiri Pirko 	struct net_device *master_dev;
468ba7d49b1SJiri Pirko 	const struct rtnl_link_ops *ops;
4698515ae38SFlorian Westphal 	size_t size = 0;
470ba7d49b1SJiri Pirko 
4718515ae38SFlorian Westphal 	rcu_read_lock();
4728515ae38SFlorian Westphal 
4738515ae38SFlorian Westphal 	master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev);
474ba7d49b1SJiri Pirko 	if (!master_dev)
4758515ae38SFlorian Westphal 		goto out;
4768515ae38SFlorian Westphal 
477ba7d49b1SJiri Pirko 	ops = master_dev->rtnl_link_ops;
4786049f253SFernando Luis Vazquez Cao 	if (!ops || !ops->get_slave_size)
4798515ae38SFlorian Westphal 		goto out;
480ba7d49b1SJiri Pirko 	/* IFLA_INFO_SLAVE_DATA + nested data */
4818515ae38SFlorian Westphal 	size = nla_total_size(sizeof(struct nlattr)) +
482ba7d49b1SJiri Pirko 	       ops->get_slave_size(master_dev, dev);
4838515ae38SFlorian Westphal 
4848515ae38SFlorian Westphal out:
4858515ae38SFlorian Westphal 	rcu_read_unlock();
4868515ae38SFlorian Westphal 	return size;
487ba7d49b1SJiri Pirko }
488ba7d49b1SJiri Pirko 
48938f7b870SPatrick McHardy static size_t rtnl_link_get_size(const struct net_device *dev)
49038f7b870SPatrick McHardy {
49138f7b870SPatrick McHardy 	const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
49238f7b870SPatrick McHardy 	size_t size;
49338f7b870SPatrick McHardy 
49438f7b870SPatrick McHardy 	if (!ops)
49538f7b870SPatrick McHardy 		return 0;
49638f7b870SPatrick McHardy 
497369cf77aSThomas Graf 	size = nla_total_size(sizeof(struct nlattr)) + /* IFLA_LINKINFO */
498369cf77aSThomas Graf 	       nla_total_size(strlen(ops->kind) + 1);  /* IFLA_INFO_KIND */
49938f7b870SPatrick McHardy 
50038f7b870SPatrick McHardy 	if (ops->get_size)
50138f7b870SPatrick McHardy 		/* IFLA_INFO_DATA + nested data */
502369cf77aSThomas Graf 		size += nla_total_size(sizeof(struct nlattr)) +
50338f7b870SPatrick McHardy 			ops->get_size(dev);
50438f7b870SPatrick McHardy 
50538f7b870SPatrick McHardy 	if (ops->get_xstats_size)
506369cf77aSThomas Graf 		/* IFLA_INFO_XSTATS */
507369cf77aSThomas Graf 		size += nla_total_size(ops->get_xstats_size(dev));
50838f7b870SPatrick McHardy 
509ba7d49b1SJiri Pirko 	size += rtnl_link_get_slave_info_data_size(dev);
510ba7d49b1SJiri Pirko 
51138f7b870SPatrick McHardy 	return size;
51238f7b870SPatrick McHardy }
51338f7b870SPatrick McHardy 
514f8ff182cSThomas Graf static LIST_HEAD(rtnl_af_ops);
515f8ff182cSThomas Graf 
516f8ff182cSThomas Graf static const struct rtnl_af_ops *rtnl_af_lookup(const int family)
517f8ff182cSThomas Graf {
518f8ff182cSThomas Graf 	const struct rtnl_af_ops *ops;
519f8ff182cSThomas Graf 
5205fa85a09SFlorian Westphal 	list_for_each_entry_rcu(ops, &rtnl_af_ops, list) {
521f8ff182cSThomas Graf 		if (ops->family == family)
522f8ff182cSThomas Graf 			return ops;
523f8ff182cSThomas Graf 	}
524f8ff182cSThomas Graf 
525f8ff182cSThomas Graf 	return NULL;
526f8ff182cSThomas Graf }
527f8ff182cSThomas Graf 
528f8ff182cSThomas Graf /**
529f8ff182cSThomas Graf  * rtnl_af_register - Register rtnl_af_ops with rtnetlink.
530f8ff182cSThomas Graf  * @ops: struct rtnl_af_ops * to register
531f8ff182cSThomas Graf  *
532f8ff182cSThomas Graf  * Returns 0 on success or a negative error code.
533f8ff182cSThomas Graf  */
5343678a9d8Sstephen hemminger void rtnl_af_register(struct rtnl_af_ops *ops)
535f8ff182cSThomas Graf {
536f8ff182cSThomas Graf 	rtnl_lock();
5375fa85a09SFlorian Westphal 	list_add_tail_rcu(&ops->list, &rtnl_af_ops);
538f8ff182cSThomas Graf 	rtnl_unlock();
539f8ff182cSThomas Graf }
540f8ff182cSThomas Graf EXPORT_SYMBOL_GPL(rtnl_af_register);
541f8ff182cSThomas Graf 
542f8ff182cSThomas Graf /**
543f8ff182cSThomas Graf  * rtnl_af_unregister - Unregister rtnl_af_ops from rtnetlink.
544f8ff182cSThomas Graf  * @ops: struct rtnl_af_ops * to unregister
545f8ff182cSThomas Graf  */
546f8ff182cSThomas Graf void rtnl_af_unregister(struct rtnl_af_ops *ops)
547f8ff182cSThomas Graf {
548f8ff182cSThomas Graf 	rtnl_lock();
5495fa85a09SFlorian Westphal 	list_del_rcu(&ops->list);
550f8ff182cSThomas Graf 	rtnl_unlock();
5515fa85a09SFlorian Westphal 
5525fa85a09SFlorian Westphal 	synchronize_rcu();
553f8ff182cSThomas Graf }
554f8ff182cSThomas Graf EXPORT_SYMBOL_GPL(rtnl_af_unregister);
555f8ff182cSThomas Graf 
556b1974ed0SArad, Ronen static size_t rtnl_link_get_af_size(const struct net_device *dev,
557b1974ed0SArad, Ronen 				    u32 ext_filter_mask)
558f8ff182cSThomas Graf {
559f8ff182cSThomas Graf 	struct rtnl_af_ops *af_ops;
560f8ff182cSThomas Graf 	size_t size;
561f8ff182cSThomas Graf 
562f8ff182cSThomas Graf 	/* IFLA_AF_SPEC */
563f8ff182cSThomas Graf 	size = nla_total_size(sizeof(struct nlattr));
564f8ff182cSThomas Graf 
5655fa85a09SFlorian Westphal 	rcu_read_lock();
5665fa85a09SFlorian Westphal 	list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
567f8ff182cSThomas Graf 		if (af_ops->get_link_af_size) {
568f8ff182cSThomas Graf 			/* AF_* + nested data */
569f8ff182cSThomas Graf 			size += nla_total_size(sizeof(struct nlattr)) +
570b1974ed0SArad, Ronen 				af_ops->get_link_af_size(dev, ext_filter_mask);
571f8ff182cSThomas Graf 		}
572f8ff182cSThomas Graf 	}
5735fa85a09SFlorian Westphal 	rcu_read_unlock();
574f8ff182cSThomas Graf 
575f8ff182cSThomas Graf 	return size;
576f8ff182cSThomas Graf }
577f8ff182cSThomas Graf 
578ba7d49b1SJiri Pirko static bool rtnl_have_link_slave_info(const struct net_device *dev)
579ba7d49b1SJiri Pirko {
580ba7d49b1SJiri Pirko 	struct net_device *master_dev;
5814c82a95eSFlorian Westphal 	bool ret = false;
582ba7d49b1SJiri Pirko 
5834c82a95eSFlorian Westphal 	rcu_read_lock();
5844c82a95eSFlorian Westphal 
5854c82a95eSFlorian Westphal 	master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev);
586813f020cSJiri Pirko 	if (master_dev && master_dev->rtnl_link_ops)
5874c82a95eSFlorian Westphal 		ret = true;
5884c82a95eSFlorian Westphal 	rcu_read_unlock();
5894c82a95eSFlorian Westphal 	return ret;
590ba7d49b1SJiri Pirko }
591ba7d49b1SJiri Pirko 
592ba7d49b1SJiri Pirko static int rtnl_link_slave_info_fill(struct sk_buff *skb,
593ba7d49b1SJiri Pirko 				     const struct net_device *dev)
594ba7d49b1SJiri Pirko {
595ba7d49b1SJiri Pirko 	struct net_device *master_dev;
596ba7d49b1SJiri Pirko 	const struct rtnl_link_ops *ops;
597ba7d49b1SJiri Pirko 	struct nlattr *slave_data;
598ba7d49b1SJiri Pirko 	int err;
599ba7d49b1SJiri Pirko 
600ba7d49b1SJiri Pirko 	master_dev = netdev_master_upper_dev_get((struct net_device *) dev);
601ba7d49b1SJiri Pirko 	if (!master_dev)
602ba7d49b1SJiri Pirko 		return 0;
603ba7d49b1SJiri Pirko 	ops = master_dev->rtnl_link_ops;
604ba7d49b1SJiri Pirko 	if (!ops)
605ba7d49b1SJiri Pirko 		return 0;
606ba7d49b1SJiri Pirko 	if (nla_put_string(skb, IFLA_INFO_SLAVE_KIND, ops->kind) < 0)
607ba7d49b1SJiri Pirko 		return -EMSGSIZE;
608ba7d49b1SJiri Pirko 	if (ops->fill_slave_info) {
609ba7d49b1SJiri Pirko 		slave_data = nla_nest_start(skb, IFLA_INFO_SLAVE_DATA);
610ba7d49b1SJiri Pirko 		if (!slave_data)
611ba7d49b1SJiri Pirko 			return -EMSGSIZE;
612ba7d49b1SJiri Pirko 		err = ops->fill_slave_info(skb, master_dev, dev);
613ba7d49b1SJiri Pirko 		if (err < 0)
614ba7d49b1SJiri Pirko 			goto err_cancel_slave_data;
615ba7d49b1SJiri Pirko 		nla_nest_end(skb, slave_data);
616ba7d49b1SJiri Pirko 	}
617ba7d49b1SJiri Pirko 	return 0;
618ba7d49b1SJiri Pirko 
619ba7d49b1SJiri Pirko err_cancel_slave_data:
620ba7d49b1SJiri Pirko 	nla_nest_cancel(skb, slave_data);
621ba7d49b1SJiri Pirko 	return err;
622ba7d49b1SJiri Pirko }
623ba7d49b1SJiri Pirko 
624ba7d49b1SJiri Pirko static int rtnl_link_info_fill(struct sk_buff *skb,
625ba7d49b1SJiri Pirko 			       const struct net_device *dev)
62638f7b870SPatrick McHardy {
62738f7b870SPatrick McHardy 	const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
628ba7d49b1SJiri Pirko 	struct nlattr *data;
629ba7d49b1SJiri Pirko 	int err;
630ba7d49b1SJiri Pirko 
631ba7d49b1SJiri Pirko 	if (!ops)
632ba7d49b1SJiri Pirko 		return 0;
633ba7d49b1SJiri Pirko 	if (nla_put_string(skb, IFLA_INFO_KIND, ops->kind) < 0)
634ba7d49b1SJiri Pirko 		return -EMSGSIZE;
635ba7d49b1SJiri Pirko 	if (ops->fill_xstats) {
636ba7d49b1SJiri Pirko 		err = ops->fill_xstats(skb, dev);
637ba7d49b1SJiri Pirko 		if (err < 0)
638ba7d49b1SJiri Pirko 			return err;
639ba7d49b1SJiri Pirko 	}
640ba7d49b1SJiri Pirko 	if (ops->fill_info) {
641ba7d49b1SJiri Pirko 		data = nla_nest_start(skb, IFLA_INFO_DATA);
642ba7d49b1SJiri Pirko 		if (data == NULL)
643ba7d49b1SJiri Pirko 			return -EMSGSIZE;
644ba7d49b1SJiri Pirko 		err = ops->fill_info(skb, dev);
645ba7d49b1SJiri Pirko 		if (err < 0)
646ba7d49b1SJiri Pirko 			goto err_cancel_data;
647ba7d49b1SJiri Pirko 		nla_nest_end(skb, data);
648ba7d49b1SJiri Pirko 	}
649ba7d49b1SJiri Pirko 	return 0;
650ba7d49b1SJiri Pirko 
651ba7d49b1SJiri Pirko err_cancel_data:
652ba7d49b1SJiri Pirko 	nla_nest_cancel(skb, data);
653ba7d49b1SJiri Pirko 	return err;
654ba7d49b1SJiri Pirko }
655ba7d49b1SJiri Pirko 
656ba7d49b1SJiri Pirko static int rtnl_link_fill(struct sk_buff *skb, const struct net_device *dev)
657ba7d49b1SJiri Pirko {
658ba7d49b1SJiri Pirko 	struct nlattr *linkinfo;
65938f7b870SPatrick McHardy 	int err = -EMSGSIZE;
66038f7b870SPatrick McHardy 
66138f7b870SPatrick McHardy 	linkinfo = nla_nest_start(skb, IFLA_LINKINFO);
66238f7b870SPatrick McHardy 	if (linkinfo == NULL)
66338f7b870SPatrick McHardy 		goto out;
66438f7b870SPatrick McHardy 
665ba7d49b1SJiri Pirko 	err = rtnl_link_info_fill(skb, dev);
66638f7b870SPatrick McHardy 	if (err < 0)
66738f7b870SPatrick McHardy 		goto err_cancel_link;
668ba7d49b1SJiri Pirko 
669ba7d49b1SJiri Pirko 	err = rtnl_link_slave_info_fill(skb, dev);
67038f7b870SPatrick McHardy 	if (err < 0)
671ba7d49b1SJiri Pirko 		goto err_cancel_link;
67238f7b870SPatrick McHardy 
67338f7b870SPatrick McHardy 	nla_nest_end(skb, linkinfo);
67438f7b870SPatrick McHardy 	return 0;
67538f7b870SPatrick McHardy 
67638f7b870SPatrick McHardy err_cancel_link:
67738f7b870SPatrick McHardy 	nla_nest_cancel(skb, linkinfo);
67838f7b870SPatrick McHardy out:
67938f7b870SPatrick McHardy 	return err;
68038f7b870SPatrick McHardy }
68138f7b870SPatrick McHardy 
68295c96174SEric Dumazet int rtnetlink_send(struct sk_buff *skb, struct net *net, u32 pid, unsigned int group, int echo)
6831da177e4SLinus Torvalds {
68497c53cacSDenis V. Lunev 	struct sock *rtnl = net->rtnl;
6851da177e4SLinus Torvalds 	int err = 0;
6861da177e4SLinus Torvalds 
687ac6d439dSPatrick McHardy 	NETLINK_CB(skb).dst_group = group;
6881da177e4SLinus Torvalds 	if (echo)
68963354797SReshetova, Elena 		refcount_inc(&skb->users);
6901da177e4SLinus Torvalds 	netlink_broadcast(rtnl, skb, pid, group, GFP_KERNEL);
6911da177e4SLinus Torvalds 	if (echo)
6921da177e4SLinus Torvalds 		err = netlink_unicast(rtnl, skb, pid, MSG_DONTWAIT);
6931da177e4SLinus Torvalds 	return err;
6941da177e4SLinus Torvalds }
6951da177e4SLinus Torvalds 
69697c53cacSDenis V. Lunev int rtnl_unicast(struct sk_buff *skb, struct net *net, u32 pid)
6972942e900SThomas Graf {
69897c53cacSDenis V. Lunev 	struct sock *rtnl = net->rtnl;
69997c53cacSDenis V. Lunev 
7002942e900SThomas Graf 	return nlmsg_unicast(rtnl, skb, pid);
7012942e900SThomas Graf }
702e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_unicast);
7032942e900SThomas Graf 
7041ce85fe4SPablo Neira Ayuso void rtnl_notify(struct sk_buff *skb, struct net *net, u32 pid, u32 group,
70597676b6bSThomas Graf 		 struct nlmsghdr *nlh, gfp_t flags)
70697676b6bSThomas Graf {
70797c53cacSDenis V. Lunev 	struct sock *rtnl = net->rtnl;
70897676b6bSThomas Graf 	int report = 0;
70997676b6bSThomas Graf 
71097676b6bSThomas Graf 	if (nlh)
71197676b6bSThomas Graf 		report = nlmsg_report(nlh);
71297676b6bSThomas Graf 
7131ce85fe4SPablo Neira Ayuso 	nlmsg_notify(rtnl, skb, pid, group, report, flags);
71497676b6bSThomas Graf }
715e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_notify);
71697676b6bSThomas Graf 
71797c53cacSDenis V. Lunev void rtnl_set_sk_err(struct net *net, u32 group, int error)
71897676b6bSThomas Graf {
71997c53cacSDenis V. Lunev 	struct sock *rtnl = net->rtnl;
72097c53cacSDenis V. Lunev 
72197676b6bSThomas Graf 	netlink_set_err(rtnl, 0, group, error);
72297676b6bSThomas Graf }
723e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_set_sk_err);
72497676b6bSThomas Graf 
7251da177e4SLinus Torvalds int rtnetlink_put_metrics(struct sk_buff *skb, u32 *metrics)
7261da177e4SLinus Torvalds {
7272d7202bfSThomas Graf 	struct nlattr *mx;
7282d7202bfSThomas Graf 	int i, valid = 0;
7291da177e4SLinus Torvalds 
7302d7202bfSThomas Graf 	mx = nla_nest_start(skb, RTA_METRICS);
7312d7202bfSThomas Graf 	if (mx == NULL)
7322d7202bfSThomas Graf 		return -ENOBUFS;
7332d7202bfSThomas Graf 
7341da177e4SLinus Torvalds 	for (i = 0; i < RTAX_MAX; i++) {
7352d7202bfSThomas Graf 		if (metrics[i]) {
736ea697639SDaniel Borkmann 			if (i == RTAX_CC_ALGO - 1) {
737ea697639SDaniel Borkmann 				char tmp[TCP_CA_NAME_MAX], *name;
738ea697639SDaniel Borkmann 
739ea697639SDaniel Borkmann 				name = tcp_ca_get_name_by_key(metrics[i], tmp);
740ea697639SDaniel Borkmann 				if (!name)
741ea697639SDaniel Borkmann 					continue;
742ea697639SDaniel Borkmann 				if (nla_put_string(skb, i + 1, name))
743ea697639SDaniel Borkmann 					goto nla_put_failure;
744c3a8d947SDaniel Borkmann 			} else if (i == RTAX_FEATURES - 1) {
745c3a8d947SDaniel Borkmann 				u32 user_features = metrics[i] & RTAX_FEATURE_MASK;
746c3a8d947SDaniel Borkmann 
747f8edcd12SPhil Sutter 				if (!user_features)
748f8edcd12SPhil Sutter 					continue;
749c3a8d947SDaniel Borkmann 				BUILD_BUG_ON(RTAX_FEATURE_MASK & DST_FEATURE_MASK);
750c3a8d947SDaniel Borkmann 				if (nla_put_u32(skb, i + 1, user_features))
751c3a8d947SDaniel Borkmann 					goto nla_put_failure;
752ea697639SDaniel Borkmann 			} else {
753a6574349SDavid S. Miller 				if (nla_put_u32(skb, i + 1, metrics[i]))
754a6574349SDavid S. Miller 					goto nla_put_failure;
7551da177e4SLinus Torvalds 			}
756ea697639SDaniel Borkmann 			valid++;
757ea697639SDaniel Borkmann 		}
7582d7202bfSThomas Graf 	}
7591da177e4SLinus Torvalds 
760a57d27fcSDavid S. Miller 	if (!valid) {
761a57d27fcSDavid S. Miller 		nla_nest_cancel(skb, mx);
762a57d27fcSDavid S. Miller 		return 0;
763a57d27fcSDavid S. Miller 	}
7642d7202bfSThomas Graf 
7652d7202bfSThomas Graf 	return nla_nest_end(skb, mx);
7662d7202bfSThomas Graf 
7672d7202bfSThomas Graf nla_put_failure:
768bc3ed28cSThomas Graf 	nla_nest_cancel(skb, mx);
769bc3ed28cSThomas Graf 	return -EMSGSIZE;
7701da177e4SLinus Torvalds }
771e0d087afSEric Dumazet EXPORT_SYMBOL(rtnetlink_put_metrics);
7721da177e4SLinus Torvalds 
773e3703b3dSThomas Graf int rtnl_put_cacheinfo(struct sk_buff *skb, struct dst_entry *dst, u32 id,
77487a50699SDavid S. Miller 		       long expires, u32 error)
775e3703b3dSThomas Graf {
776e3703b3dSThomas Graf 	struct rta_cacheinfo ci = {
777a399a805SEric Dumazet 		.rta_lastuse = jiffies_delta_to_clock_t(jiffies - dst->lastuse),
778e3703b3dSThomas Graf 		.rta_used = dst->__use,
779e3703b3dSThomas Graf 		.rta_clntref = atomic_read(&(dst->__refcnt)),
780e3703b3dSThomas Graf 		.rta_error = error,
781e3703b3dSThomas Graf 		.rta_id =  id,
782e3703b3dSThomas Graf 	};
783e3703b3dSThomas Graf 
7848253947eSLi Wei 	if (expires) {
7858253947eSLi Wei 		unsigned long clock;
786e3703b3dSThomas Graf 
7878253947eSLi Wei 		clock = jiffies_to_clock_t(abs(expires));
7888253947eSLi Wei 		clock = min_t(unsigned long, clock, INT_MAX);
7898253947eSLi Wei 		ci.rta_expires = (expires > 0) ? clock : -clock;
7908253947eSLi Wei 	}
791e3703b3dSThomas Graf 	return nla_put(skb, RTA_CACHEINFO, sizeof(ci), &ci);
792e3703b3dSThomas Graf }
793e3703b3dSThomas Graf EXPORT_SYMBOL_GPL(rtnl_put_cacheinfo);
7941da177e4SLinus Torvalds 
79593b2d4a2SDavid S. Miller static void set_operstate(struct net_device *dev, unsigned char transition)
796b00055aaSStefan Rompf {
797b00055aaSStefan Rompf 	unsigned char operstate = dev->operstate;
798b00055aaSStefan Rompf 
799b00055aaSStefan Rompf 	switch (transition) {
800b00055aaSStefan Rompf 	case IF_OPER_UP:
801b00055aaSStefan Rompf 		if ((operstate == IF_OPER_DORMANT ||
802b00055aaSStefan Rompf 		     operstate == IF_OPER_UNKNOWN) &&
803b00055aaSStefan Rompf 		    !netif_dormant(dev))
804b00055aaSStefan Rompf 			operstate = IF_OPER_UP;
805b00055aaSStefan Rompf 		break;
806b00055aaSStefan Rompf 
807b00055aaSStefan Rompf 	case IF_OPER_DORMANT:
808b00055aaSStefan Rompf 		if (operstate == IF_OPER_UP ||
809b00055aaSStefan Rompf 		    operstate == IF_OPER_UNKNOWN)
810b00055aaSStefan Rompf 			operstate = IF_OPER_DORMANT;
811b00055aaSStefan Rompf 		break;
8123ff50b79SStephen Hemminger 	}
813b00055aaSStefan Rompf 
814b00055aaSStefan Rompf 	if (dev->operstate != operstate) {
815b00055aaSStefan Rompf 		write_lock_bh(&dev_base_lock);
816b00055aaSStefan Rompf 		dev->operstate = operstate;
817b00055aaSStefan Rompf 		write_unlock_bh(&dev_base_lock);
818b00055aaSStefan Rompf 		netdev_state_change(dev);
81993b2d4a2SDavid S. Miller 	}
820b00055aaSStefan Rompf }
821b00055aaSStefan Rompf 
822b1beb681SJiri Benc static unsigned int rtnl_dev_get_flags(const struct net_device *dev)
823b1beb681SJiri Benc {
824b1beb681SJiri Benc 	return (dev->flags & ~(IFF_PROMISC | IFF_ALLMULTI)) |
825b1beb681SJiri Benc 	       (dev->gflags & (IFF_PROMISC | IFF_ALLMULTI));
826b1beb681SJiri Benc }
827b1beb681SJiri Benc 
8283729d502SPatrick McHardy static unsigned int rtnl_dev_combine_flags(const struct net_device *dev,
8293729d502SPatrick McHardy 					   const struct ifinfomsg *ifm)
8303729d502SPatrick McHardy {
8313729d502SPatrick McHardy 	unsigned int flags = ifm->ifi_flags;
8323729d502SPatrick McHardy 
8333729d502SPatrick McHardy 	/* bugwards compatibility: ifi_change == 0 is treated as ~0 */
8343729d502SPatrick McHardy 	if (ifm->ifi_change)
8353729d502SPatrick McHardy 		flags = (flags & ifm->ifi_change) |
836b1beb681SJiri Benc 			(rtnl_dev_get_flags(dev) & ~ifm->ifi_change);
8373729d502SPatrick McHardy 
8383729d502SPatrick McHardy 	return flags;
8393729d502SPatrick McHardy }
8403729d502SPatrick McHardy 
841b60c5115SThomas Graf static void copy_rtnl_link_stats(struct rtnl_link_stats *a,
842be1f3c2cSBen Hutchings 				 const struct rtnl_link_stats64 *b)
8431da177e4SLinus Torvalds {
844b60c5115SThomas Graf 	a->rx_packets = b->rx_packets;
845b60c5115SThomas Graf 	a->tx_packets = b->tx_packets;
846b60c5115SThomas Graf 	a->rx_bytes = b->rx_bytes;
847b60c5115SThomas Graf 	a->tx_bytes = b->tx_bytes;
848b60c5115SThomas Graf 	a->rx_errors = b->rx_errors;
849b60c5115SThomas Graf 	a->tx_errors = b->tx_errors;
850b60c5115SThomas Graf 	a->rx_dropped = b->rx_dropped;
851b60c5115SThomas Graf 	a->tx_dropped = b->tx_dropped;
852b60c5115SThomas Graf 
853b60c5115SThomas Graf 	a->multicast = b->multicast;
854b60c5115SThomas Graf 	a->collisions = b->collisions;
855b60c5115SThomas Graf 
856b60c5115SThomas Graf 	a->rx_length_errors = b->rx_length_errors;
857b60c5115SThomas Graf 	a->rx_over_errors = b->rx_over_errors;
858b60c5115SThomas Graf 	a->rx_crc_errors = b->rx_crc_errors;
859b60c5115SThomas Graf 	a->rx_frame_errors = b->rx_frame_errors;
860b60c5115SThomas Graf 	a->rx_fifo_errors = b->rx_fifo_errors;
861b60c5115SThomas Graf 	a->rx_missed_errors = b->rx_missed_errors;
862b60c5115SThomas Graf 
863b60c5115SThomas Graf 	a->tx_aborted_errors = b->tx_aborted_errors;
864b60c5115SThomas Graf 	a->tx_carrier_errors = b->tx_carrier_errors;
865b60c5115SThomas Graf 	a->tx_fifo_errors = b->tx_fifo_errors;
866b60c5115SThomas Graf 	a->tx_heartbeat_errors = b->tx_heartbeat_errors;
867b60c5115SThomas Graf 	a->tx_window_errors = b->tx_window_errors;
868b60c5115SThomas Graf 
869b60c5115SThomas Graf 	a->rx_compressed = b->rx_compressed;
870b60c5115SThomas Graf 	a->tx_compressed = b->tx_compressed;
8716e7333d3SJarod Wilson 
8726e7333d3SJarod Wilson 	a->rx_nohandler = b->rx_nohandler;
87310708f37SJan Engelhardt }
87410708f37SJan Engelhardt 
875c02db8c6SChris Wright /* All VF info */
876115c9b81SGreg Rose static inline int rtnl_vfinfo_size(const struct net_device *dev,
877115c9b81SGreg Rose 				   u32 ext_filter_mask)
878ebc08a6fSWilliams, Mitch A {
8799af15c38SPhil Sutter 	if (dev->dev.parent && (ext_filter_mask & RTEXT_FILTER_VF)) {
880c02db8c6SChris Wright 		int num_vfs = dev_num_vf(dev->dev.parent);
8817e75f74aSSabrina Dubroca 		size_t size = nla_total_size(0);
882045de01aSScott Feldman 		size += num_vfs *
8837e75f74aSSabrina Dubroca 			(nla_total_size(0) +
8847e75f74aSSabrina Dubroca 			 nla_total_size(sizeof(struct ifla_vf_mac)) +
8857e75f74aSSabrina Dubroca 			 nla_total_size(sizeof(struct ifla_vf_vlan)) +
8867e75f74aSSabrina Dubroca 			 nla_total_size(0) + /* nest IFLA_VF_VLAN_LIST */
88779aab093SMoshe Shemesh 			 nla_total_size(MAX_VLAN_LIST_LEN *
88879aab093SMoshe Shemesh 					sizeof(struct ifla_vf_vlan_info)) +
889ed616689SSucheta Chakraborty 			 nla_total_size(sizeof(struct ifla_vf_spoofchk)) +
8907e75f74aSSabrina Dubroca 			 nla_total_size(sizeof(struct ifla_vf_tx_rate)) +
891945a3676SJiri Benc 			 nla_total_size(sizeof(struct ifla_vf_rate)) +
89201a3d796SVlad Zolotarov 			 nla_total_size(sizeof(struct ifla_vf_link_state)) +
8933b766cd8SEran Ben Elisha 			 nla_total_size(sizeof(struct ifla_vf_rss_query_en)) +
8947e75f74aSSabrina Dubroca 			 nla_total_size(0) + /* nest IFLA_VF_STATS */
8953b766cd8SEran Ben Elisha 			 /* IFLA_VF_STATS_RX_PACKETS */
896343a6d8eSNicolas Dichtel 			 nla_total_size_64bit(sizeof(__u64)) +
8973b766cd8SEran Ben Elisha 			 /* IFLA_VF_STATS_TX_PACKETS */
898343a6d8eSNicolas Dichtel 			 nla_total_size_64bit(sizeof(__u64)) +
8993b766cd8SEran Ben Elisha 			 /* IFLA_VF_STATS_RX_BYTES */
900343a6d8eSNicolas Dichtel 			 nla_total_size_64bit(sizeof(__u64)) +
9013b766cd8SEran Ben Elisha 			 /* IFLA_VF_STATS_TX_BYTES */
902343a6d8eSNicolas Dichtel 			 nla_total_size_64bit(sizeof(__u64)) +
9033b766cd8SEran Ben Elisha 			 /* IFLA_VF_STATS_BROADCAST */
904343a6d8eSNicolas Dichtel 			 nla_total_size_64bit(sizeof(__u64)) +
9053b766cd8SEran Ben Elisha 			 /* IFLA_VF_STATS_MULTICAST */
906343a6d8eSNicolas Dichtel 			 nla_total_size_64bit(sizeof(__u64)) +
907dd461d6aSHiroshi Shimamoto 			 nla_total_size(sizeof(struct ifla_vf_trust)));
908c02db8c6SChris Wright 		return size;
909c02db8c6SChris Wright 	} else
910ebc08a6fSWilliams, Mitch A 		return 0;
911ebc08a6fSWilliams, Mitch A }
912ebc08a6fSWilliams, Mitch A 
913c53864fdSDavid Gibson static size_t rtnl_port_size(const struct net_device *dev,
914c53864fdSDavid Gibson 			     u32 ext_filter_mask)
91557b61080SScott Feldman {
91657b61080SScott Feldman 	size_t port_size = nla_total_size(4)		/* PORT_VF */
91757b61080SScott Feldman 		+ nla_total_size(PORT_PROFILE_MAX)	/* PORT_PROFILE */
91857b61080SScott Feldman 		+ nla_total_size(PORT_UUID_MAX)		/* PORT_INSTANCE_UUID */
91957b61080SScott Feldman 		+ nla_total_size(PORT_UUID_MAX)		/* PORT_HOST_UUID */
92057b61080SScott Feldman 		+ nla_total_size(1)			/* PROT_VDP_REQUEST */
92157b61080SScott Feldman 		+ nla_total_size(2);			/* PORT_VDP_RESPONSE */
92257b61080SScott Feldman 	size_t vf_ports_size = nla_total_size(sizeof(struct nlattr));
92357b61080SScott Feldman 	size_t vf_port_size = nla_total_size(sizeof(struct nlattr))
92457b61080SScott Feldman 		+ port_size;
92557b61080SScott Feldman 	size_t port_self_size = nla_total_size(sizeof(struct nlattr))
92657b61080SScott Feldman 		+ port_size;
92757b61080SScott Feldman 
928c53864fdSDavid Gibson 	if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent ||
929c53864fdSDavid Gibson 	    !(ext_filter_mask & RTEXT_FILTER_VF))
93057b61080SScott Feldman 		return 0;
93157b61080SScott Feldman 	if (dev_num_vf(dev->dev.parent))
93257b61080SScott Feldman 		return port_self_size + vf_ports_size +
93357b61080SScott Feldman 			vf_port_size * dev_num_vf(dev->dev.parent);
93457b61080SScott Feldman 	else
93557b61080SScott Feldman 		return port_self_size;
93657b61080SScott Feldman }
93757b61080SScott Feldman 
938b5cdae32SDavid S. Miller static size_t rtnl_xdp_size(void)
939d1fdd913SBrenden Blanco {
940b3cfaa31SSabrina Dubroca 	size_t xdp_size = nla_total_size(0) +	/* nest IFLA_XDP */
94158038695SMartin KaFai Lau 			  nla_total_size(1) +	/* XDP_ATTACHED */
94258038695SMartin KaFai Lau 			  nla_total_size(4);	/* XDP_PROG_ID */
943d1fdd913SBrenden Blanco 
944d1fdd913SBrenden Blanco 	return xdp_size;
945d1fdd913SBrenden Blanco }
946d1fdd913SBrenden Blanco 
947115c9b81SGreg Rose static noinline size_t if_nlmsg_size(const struct net_device *dev,
948115c9b81SGreg Rose 				     u32 ext_filter_mask)
949339bf98fSThomas Graf {
950339bf98fSThomas Graf 	return NLMSG_ALIGN(sizeof(struct ifinfomsg))
951339bf98fSThomas Graf 	       + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
9520b815a1aSStephen Hemminger 	       + nla_total_size(IFALIASZ) /* IFLA_IFALIAS */
953339bf98fSThomas Graf 	       + nla_total_size(IFNAMSIZ) /* IFLA_QDISC */
954270cb4d0SNicolas Dichtel 	       + nla_total_size_64bit(sizeof(struct rtnl_link_ifmap))
955339bf98fSThomas Graf 	       + nla_total_size(sizeof(struct rtnl_link_stats))
95635c58459SDavid S. Miller 	       + nla_total_size_64bit(sizeof(struct rtnl_link_stats64))
957339bf98fSThomas Graf 	       + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
958339bf98fSThomas Graf 	       + nla_total_size(MAX_ADDR_LEN) /* IFLA_BROADCAST */
959339bf98fSThomas Graf 	       + nla_total_size(4) /* IFLA_TXQLEN */
960339bf98fSThomas Graf 	       + nla_total_size(4) /* IFLA_WEIGHT */
961339bf98fSThomas Graf 	       + nla_total_size(4) /* IFLA_MTU */
962339bf98fSThomas Graf 	       + nla_total_size(4) /* IFLA_LINK */
963339bf98fSThomas Graf 	       + nla_total_size(4) /* IFLA_MASTER */
9649a57247fSJiri Pirko 	       + nla_total_size(1) /* IFLA_CARRIER */
965edbc0bb3SBen Greear 	       + nla_total_size(4) /* IFLA_PROMISCUITY */
96676ff5cc9SJiri Pirko 	       + nla_total_size(4) /* IFLA_NUM_TX_QUEUES */
96776ff5cc9SJiri Pirko 	       + nla_total_size(4) /* IFLA_NUM_RX_QUEUES */
9686919756cSTobias Klauser 	       + nla_total_size(4) /* IFLA_GSO_MAX_SEGS */
9696919756cSTobias Klauser 	       + nla_total_size(4) /* IFLA_GSO_MAX_SIZE */
970339bf98fSThomas Graf 	       + nla_total_size(1) /* IFLA_OPERSTATE */
97138f7b870SPatrick McHardy 	       + nla_total_size(1) /* IFLA_LINKMODE */
9722d3b479dSdavid decotigny 	       + nla_total_size(4) /* IFLA_CARRIER_CHANGES */
973d37512a2SNicolas Dichtel 	       + nla_total_size(4) /* IFLA_LINK_NETNSID */
974db833d40SSerhey Popovych 	       + nla_total_size(4) /* IFLA_GROUP */
975115c9b81SGreg Rose 	       + nla_total_size(ext_filter_mask
976115c9b81SGreg Rose 			        & RTEXT_FILTER_VF ? 4 : 0) /* IFLA_NUM_VF */
977115c9b81SGreg Rose 	       + rtnl_vfinfo_size(dev, ext_filter_mask) /* IFLA_VFINFO_LIST */
978c53864fdSDavid Gibson 	       + rtnl_port_size(dev, ext_filter_mask) /* IFLA_VF_PORTS + IFLA_PORT_SELF */
979f8ff182cSThomas Graf 	       + rtnl_link_get_size(dev) /* IFLA_LINKINFO */
980b1974ed0SArad, Ronen 	       + rtnl_link_get_af_size(dev, ext_filter_mask) /* IFLA_AF_SPEC */
98182f28412SJiri Pirko 	       + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_PORT_ID */
98288d6378bSAnuradha Karuppiah 	       + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_SWITCH_ID */
983c57c7a95SNicolas Dichtel 	       + nla_total_size(IFNAMSIZ) /* IFLA_PHYS_PORT_NAME */
984b5cdae32SDavid S. Miller 	       + rtnl_xdp_size() /* IFLA_XDP */
9853d3ea5afSVlad Yasevich 	       + nla_total_size(4)  /* IFLA_EVENT */
9866621dd29SNicolas Dichtel 	       + nla_total_size(4)  /* IFLA_NEW_NETNSID */
98703ac738dSColin Ian King 	       + nla_total_size(1)  /* IFLA_PROTO_DOWN */
98879e1ad14SJiri Benc 	       + nla_total_size(4)  /* IFLA_IF_NETNSID */
98979e1ad14SJiri Benc 	       + 0;
990339bf98fSThomas Graf }
991339bf98fSThomas Graf 
99257b61080SScott Feldman static int rtnl_vf_ports_fill(struct sk_buff *skb, struct net_device *dev)
99357b61080SScott Feldman {
99457b61080SScott Feldman 	struct nlattr *vf_ports;
99557b61080SScott Feldman 	struct nlattr *vf_port;
99657b61080SScott Feldman 	int vf;
99757b61080SScott Feldman 	int err;
99857b61080SScott Feldman 
99957b61080SScott Feldman 	vf_ports = nla_nest_start(skb, IFLA_VF_PORTS);
100057b61080SScott Feldman 	if (!vf_ports)
100157b61080SScott Feldman 		return -EMSGSIZE;
100257b61080SScott Feldman 
100357b61080SScott Feldman 	for (vf = 0; vf < dev_num_vf(dev->dev.parent); vf++) {
100457b61080SScott Feldman 		vf_port = nla_nest_start(skb, IFLA_VF_PORT);
10058ca94183SScott Feldman 		if (!vf_port)
10068ca94183SScott Feldman 			goto nla_put_failure;
1007a6574349SDavid S. Miller 		if (nla_put_u32(skb, IFLA_PORT_VF, vf))
1008a6574349SDavid S. Miller 			goto nla_put_failure;
100957b61080SScott Feldman 		err = dev->netdev_ops->ndo_get_vf_port(dev, vf, skb);
10108ca94183SScott Feldman 		if (err == -EMSGSIZE)
10118ca94183SScott Feldman 			goto nla_put_failure;
101257b61080SScott Feldman 		if (err) {
101357b61080SScott Feldman 			nla_nest_cancel(skb, vf_port);
101457b61080SScott Feldman 			continue;
101557b61080SScott Feldman 		}
101657b61080SScott Feldman 		nla_nest_end(skb, vf_port);
101757b61080SScott Feldman 	}
101857b61080SScott Feldman 
101957b61080SScott Feldman 	nla_nest_end(skb, vf_ports);
102057b61080SScott Feldman 
102157b61080SScott Feldman 	return 0;
10228ca94183SScott Feldman 
10238ca94183SScott Feldman nla_put_failure:
10248ca94183SScott Feldman 	nla_nest_cancel(skb, vf_ports);
10258ca94183SScott Feldman 	return -EMSGSIZE;
102657b61080SScott Feldman }
102757b61080SScott Feldman 
102857b61080SScott Feldman static int rtnl_port_self_fill(struct sk_buff *skb, struct net_device *dev)
102957b61080SScott Feldman {
103057b61080SScott Feldman 	struct nlattr *port_self;
103157b61080SScott Feldman 	int err;
103257b61080SScott Feldman 
103357b61080SScott Feldman 	port_self = nla_nest_start(skb, IFLA_PORT_SELF);
103457b61080SScott Feldman 	if (!port_self)
103557b61080SScott Feldman 		return -EMSGSIZE;
103657b61080SScott Feldman 
103757b61080SScott Feldman 	err = dev->netdev_ops->ndo_get_vf_port(dev, PORT_SELF_VF, skb);
103857b61080SScott Feldman 	if (err) {
103957b61080SScott Feldman 		nla_nest_cancel(skb, port_self);
10408ca94183SScott Feldman 		return (err == -EMSGSIZE) ? err : 0;
104157b61080SScott Feldman 	}
104257b61080SScott Feldman 
104357b61080SScott Feldman 	nla_nest_end(skb, port_self);
104457b61080SScott Feldman 
104557b61080SScott Feldman 	return 0;
104657b61080SScott Feldman }
104757b61080SScott Feldman 
1048c53864fdSDavid Gibson static int rtnl_port_fill(struct sk_buff *skb, struct net_device *dev,
1049c53864fdSDavid Gibson 			  u32 ext_filter_mask)
105057b61080SScott Feldman {
105157b61080SScott Feldman 	int err;
105257b61080SScott Feldman 
1053c53864fdSDavid Gibson 	if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent ||
1054c53864fdSDavid Gibson 	    !(ext_filter_mask & RTEXT_FILTER_VF))
105557b61080SScott Feldman 		return 0;
105657b61080SScott Feldman 
105757b61080SScott Feldman 	err = rtnl_port_self_fill(skb, dev);
105857b61080SScott Feldman 	if (err)
105957b61080SScott Feldman 		return err;
106057b61080SScott Feldman 
106157b61080SScott Feldman 	if (dev_num_vf(dev->dev.parent)) {
106257b61080SScott Feldman 		err = rtnl_vf_ports_fill(skb, dev);
106357b61080SScott Feldman 		if (err)
106457b61080SScott Feldman 			return err;
106557b61080SScott Feldman 	}
106657b61080SScott Feldman 
106757b61080SScott Feldman 	return 0;
106857b61080SScott Feldman }
106957b61080SScott Feldman 
107066cae9edSJiri Pirko static int rtnl_phys_port_id_fill(struct sk_buff *skb, struct net_device *dev)
107166cae9edSJiri Pirko {
107266cae9edSJiri Pirko 	int err;
107302637fceSJiri Pirko 	struct netdev_phys_item_id ppid;
107466cae9edSJiri Pirko 
107566cae9edSJiri Pirko 	err = dev_get_phys_port_id(dev, &ppid);
107666cae9edSJiri Pirko 	if (err) {
107766cae9edSJiri Pirko 		if (err == -EOPNOTSUPP)
107866cae9edSJiri Pirko 			return 0;
107966cae9edSJiri Pirko 		return err;
108066cae9edSJiri Pirko 	}
108166cae9edSJiri Pirko 
108266cae9edSJiri Pirko 	if (nla_put(skb, IFLA_PHYS_PORT_ID, ppid.id_len, ppid.id))
108366cae9edSJiri Pirko 		return -EMSGSIZE;
108466cae9edSJiri Pirko 
108566cae9edSJiri Pirko 	return 0;
108666cae9edSJiri Pirko }
108766cae9edSJiri Pirko 
1088db24a904SDavid Ahern static int rtnl_phys_port_name_fill(struct sk_buff *skb, struct net_device *dev)
1089db24a904SDavid Ahern {
1090db24a904SDavid Ahern 	char name[IFNAMSIZ];
1091db24a904SDavid Ahern 	int err;
1092db24a904SDavid Ahern 
1093db24a904SDavid Ahern 	err = dev_get_phys_port_name(dev, name, sizeof(name));
1094db24a904SDavid Ahern 	if (err) {
1095db24a904SDavid Ahern 		if (err == -EOPNOTSUPP)
1096db24a904SDavid Ahern 			return 0;
1097db24a904SDavid Ahern 		return err;
1098db24a904SDavid Ahern 	}
1099db24a904SDavid Ahern 
110077ef033bSMichal Schmidt 	if (nla_put_string(skb, IFLA_PHYS_PORT_NAME, name))
1101db24a904SDavid Ahern 		return -EMSGSIZE;
1102db24a904SDavid Ahern 
1103db24a904SDavid Ahern 	return 0;
1104db24a904SDavid Ahern }
1105db24a904SDavid Ahern 
110682f28412SJiri Pirko static int rtnl_phys_switch_id_fill(struct sk_buff *skb, struct net_device *dev)
110782f28412SJiri Pirko {
110882f28412SJiri Pirko 	int err;
1109f8e20a9fSScott Feldman 	struct switchdev_attr attr = {
11106ff64f6fSIdo Schimmel 		.orig_dev = dev,
11111f868398SJiri Pirko 		.id = SWITCHDEV_ATTR_ID_PORT_PARENT_ID,
1112f8e20a9fSScott Feldman 		.flags = SWITCHDEV_F_NO_RECURSE,
1113f8e20a9fSScott Feldman 	};
111482f28412SJiri Pirko 
1115f8e20a9fSScott Feldman 	err = switchdev_port_attr_get(dev, &attr);
111682f28412SJiri Pirko 	if (err) {
111782f28412SJiri Pirko 		if (err == -EOPNOTSUPP)
111882f28412SJiri Pirko 			return 0;
111982f28412SJiri Pirko 		return err;
112082f28412SJiri Pirko 	}
112182f28412SJiri Pirko 
112242275bd8SScott Feldman 	if (nla_put(skb, IFLA_PHYS_SWITCH_ID, attr.u.ppid.id_len,
112342275bd8SScott Feldman 		    attr.u.ppid.id))
112482f28412SJiri Pirko 		return -EMSGSIZE;
112582f28412SJiri Pirko 
112682f28412SJiri Pirko 	return 0;
112782f28412SJiri Pirko }
112882f28412SJiri Pirko 
1129b22b941bSHannes Frederic Sowa static noinline_for_stack int rtnl_fill_stats(struct sk_buff *skb,
1130b22b941bSHannes Frederic Sowa 					      struct net_device *dev)
1131b22b941bSHannes Frederic Sowa {
1132550bce59SRoopa Prabhu 	struct rtnl_link_stats64 *sp;
1133b22b941bSHannes Frederic Sowa 	struct nlattr *attr;
1134b22b941bSHannes Frederic Sowa 
113558414d32SNicolas Dichtel 	attr = nla_reserve_64bit(skb, IFLA_STATS64,
113658414d32SNicolas Dichtel 				 sizeof(struct rtnl_link_stats64), IFLA_PAD);
1137b22b941bSHannes Frederic Sowa 	if (!attr)
1138b22b941bSHannes Frederic Sowa 		return -EMSGSIZE;
1139b22b941bSHannes Frederic Sowa 
1140550bce59SRoopa Prabhu 	sp = nla_data(attr);
1141550bce59SRoopa Prabhu 	dev_get_stats(dev, sp);
1142550bce59SRoopa Prabhu 
1143550bce59SRoopa Prabhu 	attr = nla_reserve(skb, IFLA_STATS,
1144550bce59SRoopa Prabhu 			   sizeof(struct rtnl_link_stats));
1145550bce59SRoopa Prabhu 	if (!attr)
1146550bce59SRoopa Prabhu 		return -EMSGSIZE;
1147550bce59SRoopa Prabhu 
1148550bce59SRoopa Prabhu 	copy_rtnl_link_stats(nla_data(attr), sp);
1149b22b941bSHannes Frederic Sowa 
1150b22b941bSHannes Frederic Sowa 	return 0;
1151b22b941bSHannes Frederic Sowa }
1152b22b941bSHannes Frederic Sowa 
1153b22b941bSHannes Frederic Sowa static noinline_for_stack int rtnl_fill_vfinfo(struct sk_buff *skb,
1154b22b941bSHannes Frederic Sowa 					       struct net_device *dev,
1155b22b941bSHannes Frederic Sowa 					       int vfs_num,
1156b22b941bSHannes Frederic Sowa 					       struct nlattr *vfinfo)
1157b22b941bSHannes Frederic Sowa {
1158b22b941bSHannes Frederic Sowa 	struct ifla_vf_rss_query_en vf_rss_query_en;
115979aab093SMoshe Shemesh 	struct nlattr *vf, *vfstats, *vfvlanlist;
1160b22b941bSHannes Frederic Sowa 	struct ifla_vf_link_state vf_linkstate;
116179aab093SMoshe Shemesh 	struct ifla_vf_vlan_info vf_vlan_info;
1162b22b941bSHannes Frederic Sowa 	struct ifla_vf_spoofchk vf_spoofchk;
1163b22b941bSHannes Frederic Sowa 	struct ifla_vf_tx_rate vf_tx_rate;
1164b22b941bSHannes Frederic Sowa 	struct ifla_vf_stats vf_stats;
1165b22b941bSHannes Frederic Sowa 	struct ifla_vf_trust vf_trust;
1166b22b941bSHannes Frederic Sowa 	struct ifla_vf_vlan vf_vlan;
1167b22b941bSHannes Frederic Sowa 	struct ifla_vf_rate vf_rate;
1168b22b941bSHannes Frederic Sowa 	struct ifla_vf_mac vf_mac;
1169b22b941bSHannes Frederic Sowa 	struct ifla_vf_info ivi;
1170b22b941bSHannes Frederic Sowa 
11710eed9cf5SMintz, Yuval 	memset(&ivi, 0, sizeof(ivi));
11720eed9cf5SMintz, Yuval 
1173b22b941bSHannes Frederic Sowa 	/* Not all SR-IOV capable drivers support the
1174b22b941bSHannes Frederic Sowa 	 * spoofcheck and "RSS query enable" query.  Preset to
1175b22b941bSHannes Frederic Sowa 	 * -1 so the user space tool can detect that the driver
1176b22b941bSHannes Frederic Sowa 	 * didn't report anything.
1177b22b941bSHannes Frederic Sowa 	 */
1178b22b941bSHannes Frederic Sowa 	ivi.spoofchk = -1;
1179b22b941bSHannes Frederic Sowa 	ivi.rss_query_en = -1;
1180b22b941bSHannes Frederic Sowa 	ivi.trusted = -1;
1181b22b941bSHannes Frederic Sowa 	/* The default value for VF link state is "auto"
1182b22b941bSHannes Frederic Sowa 	 * IFLA_VF_LINK_STATE_AUTO which equals zero
1183b22b941bSHannes Frederic Sowa 	 */
1184b22b941bSHannes Frederic Sowa 	ivi.linkstate = 0;
118579aab093SMoshe Shemesh 	/* VLAN Protocol by default is 802.1Q */
118679aab093SMoshe Shemesh 	ivi.vlan_proto = htons(ETH_P_8021Q);
1187b22b941bSHannes Frederic Sowa 	if (dev->netdev_ops->ndo_get_vf_config(dev, vfs_num, &ivi))
1188b22b941bSHannes Frederic Sowa 		return 0;
1189b22b941bSHannes Frederic Sowa 
1190775f4f05SDan Carpenter 	memset(&vf_vlan_info, 0, sizeof(vf_vlan_info));
1191775f4f05SDan Carpenter 
1192b22b941bSHannes Frederic Sowa 	vf_mac.vf =
1193b22b941bSHannes Frederic Sowa 		vf_vlan.vf =
119479aab093SMoshe Shemesh 		vf_vlan_info.vf =
1195b22b941bSHannes Frederic Sowa 		vf_rate.vf =
1196b22b941bSHannes Frederic Sowa 		vf_tx_rate.vf =
1197b22b941bSHannes Frederic Sowa 		vf_spoofchk.vf =
1198b22b941bSHannes Frederic Sowa 		vf_linkstate.vf =
1199b22b941bSHannes Frederic Sowa 		vf_rss_query_en.vf =
1200b22b941bSHannes Frederic Sowa 		vf_trust.vf = ivi.vf;
1201b22b941bSHannes Frederic Sowa 
1202b22b941bSHannes Frederic Sowa 	memcpy(vf_mac.mac, ivi.mac, sizeof(ivi.mac));
1203b22b941bSHannes Frederic Sowa 	vf_vlan.vlan = ivi.vlan;
1204b22b941bSHannes Frederic Sowa 	vf_vlan.qos = ivi.qos;
120579aab093SMoshe Shemesh 	vf_vlan_info.vlan = ivi.vlan;
120679aab093SMoshe Shemesh 	vf_vlan_info.qos = ivi.qos;
120779aab093SMoshe Shemesh 	vf_vlan_info.vlan_proto = ivi.vlan_proto;
1208b22b941bSHannes Frederic Sowa 	vf_tx_rate.rate = ivi.max_tx_rate;
1209b22b941bSHannes Frederic Sowa 	vf_rate.min_tx_rate = ivi.min_tx_rate;
1210b22b941bSHannes Frederic Sowa 	vf_rate.max_tx_rate = ivi.max_tx_rate;
1211b22b941bSHannes Frederic Sowa 	vf_spoofchk.setting = ivi.spoofchk;
1212b22b941bSHannes Frederic Sowa 	vf_linkstate.link_state = ivi.linkstate;
1213b22b941bSHannes Frederic Sowa 	vf_rss_query_en.setting = ivi.rss_query_en;
1214b22b941bSHannes Frederic Sowa 	vf_trust.setting = ivi.trusted;
1215b22b941bSHannes Frederic Sowa 	vf = nla_nest_start(skb, IFLA_VF_INFO);
121679aab093SMoshe Shemesh 	if (!vf)
121779aab093SMoshe Shemesh 		goto nla_put_vfinfo_failure;
1218b22b941bSHannes Frederic Sowa 	if (nla_put(skb, IFLA_VF_MAC, sizeof(vf_mac), &vf_mac) ||
1219b22b941bSHannes Frederic Sowa 	    nla_put(skb, IFLA_VF_VLAN, sizeof(vf_vlan), &vf_vlan) ||
1220b22b941bSHannes Frederic Sowa 	    nla_put(skb, IFLA_VF_RATE, sizeof(vf_rate),
1221b22b941bSHannes Frederic Sowa 		    &vf_rate) ||
1222b22b941bSHannes Frederic Sowa 	    nla_put(skb, IFLA_VF_TX_RATE, sizeof(vf_tx_rate),
1223b22b941bSHannes Frederic Sowa 		    &vf_tx_rate) ||
1224b22b941bSHannes Frederic Sowa 	    nla_put(skb, IFLA_VF_SPOOFCHK, sizeof(vf_spoofchk),
1225b22b941bSHannes Frederic Sowa 		    &vf_spoofchk) ||
1226b22b941bSHannes Frederic Sowa 	    nla_put(skb, IFLA_VF_LINK_STATE, sizeof(vf_linkstate),
1227b22b941bSHannes Frederic Sowa 		    &vf_linkstate) ||
1228b22b941bSHannes Frederic Sowa 	    nla_put(skb, IFLA_VF_RSS_QUERY_EN,
1229b22b941bSHannes Frederic Sowa 		    sizeof(vf_rss_query_en),
1230b22b941bSHannes Frederic Sowa 		    &vf_rss_query_en) ||
1231b22b941bSHannes Frederic Sowa 	    nla_put(skb, IFLA_VF_TRUST,
1232b22b941bSHannes Frederic Sowa 		    sizeof(vf_trust), &vf_trust))
123379aab093SMoshe Shemesh 		goto nla_put_vf_failure;
123479aab093SMoshe Shemesh 	vfvlanlist = nla_nest_start(skb, IFLA_VF_VLAN_LIST);
123579aab093SMoshe Shemesh 	if (!vfvlanlist)
123679aab093SMoshe Shemesh 		goto nla_put_vf_failure;
123779aab093SMoshe Shemesh 	if (nla_put(skb, IFLA_VF_VLAN_INFO, sizeof(vf_vlan_info),
123879aab093SMoshe Shemesh 		    &vf_vlan_info)) {
123979aab093SMoshe Shemesh 		nla_nest_cancel(skb, vfvlanlist);
124079aab093SMoshe Shemesh 		goto nla_put_vf_failure;
124179aab093SMoshe Shemesh 	}
124279aab093SMoshe Shemesh 	nla_nest_end(skb, vfvlanlist);
1243b22b941bSHannes Frederic Sowa 	memset(&vf_stats, 0, sizeof(vf_stats));
1244b22b941bSHannes Frederic Sowa 	if (dev->netdev_ops->ndo_get_vf_stats)
1245b22b941bSHannes Frederic Sowa 		dev->netdev_ops->ndo_get_vf_stats(dev, vfs_num,
1246b22b941bSHannes Frederic Sowa 						&vf_stats);
1247b22b941bSHannes Frederic Sowa 	vfstats = nla_nest_start(skb, IFLA_VF_STATS);
124879aab093SMoshe Shemesh 	if (!vfstats)
124979aab093SMoshe Shemesh 		goto nla_put_vf_failure;
1250343a6d8eSNicolas Dichtel 	if (nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_PACKETS,
1251343a6d8eSNicolas Dichtel 			      vf_stats.rx_packets, IFLA_VF_STATS_PAD) ||
1252343a6d8eSNicolas Dichtel 	    nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_PACKETS,
1253343a6d8eSNicolas Dichtel 			      vf_stats.tx_packets, IFLA_VF_STATS_PAD) ||
1254343a6d8eSNicolas Dichtel 	    nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_BYTES,
1255343a6d8eSNicolas Dichtel 			      vf_stats.rx_bytes, IFLA_VF_STATS_PAD) ||
1256343a6d8eSNicolas Dichtel 	    nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_BYTES,
1257343a6d8eSNicolas Dichtel 			      vf_stats.tx_bytes, IFLA_VF_STATS_PAD) ||
1258343a6d8eSNicolas Dichtel 	    nla_put_u64_64bit(skb, IFLA_VF_STATS_BROADCAST,
1259343a6d8eSNicolas Dichtel 			      vf_stats.broadcast, IFLA_VF_STATS_PAD) ||
1260343a6d8eSNicolas Dichtel 	    nla_put_u64_64bit(skb, IFLA_VF_STATS_MULTICAST,
126179aab093SMoshe Shemesh 			      vf_stats.multicast, IFLA_VF_STATS_PAD)) {
126279aab093SMoshe Shemesh 		nla_nest_cancel(skb, vfstats);
126379aab093SMoshe Shemesh 		goto nla_put_vf_failure;
126479aab093SMoshe Shemesh 	}
1265b22b941bSHannes Frederic Sowa 	nla_nest_end(skb, vfstats);
1266b22b941bSHannes Frederic Sowa 	nla_nest_end(skb, vf);
1267b22b941bSHannes Frederic Sowa 	return 0;
126879aab093SMoshe Shemesh 
126979aab093SMoshe Shemesh nla_put_vf_failure:
127079aab093SMoshe Shemesh 	nla_nest_cancel(skb, vf);
127179aab093SMoshe Shemesh nla_put_vfinfo_failure:
127279aab093SMoshe Shemesh 	nla_nest_cancel(skb, vfinfo);
127379aab093SMoshe Shemesh 	return -EMSGSIZE;
1274b22b941bSHannes Frederic Sowa }
1275b22b941bSHannes Frederic Sowa 
1276250fc3dfSFlorian Westphal static noinline_for_stack int rtnl_fill_vf(struct sk_buff *skb,
1277250fc3dfSFlorian Westphal 					   struct net_device *dev,
1278250fc3dfSFlorian Westphal 					   u32 ext_filter_mask)
1279250fc3dfSFlorian Westphal {
1280250fc3dfSFlorian Westphal 	struct nlattr *vfinfo;
1281250fc3dfSFlorian Westphal 	int i, num_vfs;
1282250fc3dfSFlorian Westphal 
1283250fc3dfSFlorian Westphal 	if (!dev->dev.parent || ((ext_filter_mask & RTEXT_FILTER_VF) == 0))
1284250fc3dfSFlorian Westphal 		return 0;
1285250fc3dfSFlorian Westphal 
1286250fc3dfSFlorian Westphal 	num_vfs = dev_num_vf(dev->dev.parent);
1287250fc3dfSFlorian Westphal 	if (nla_put_u32(skb, IFLA_NUM_VF, num_vfs))
1288250fc3dfSFlorian Westphal 		return -EMSGSIZE;
1289250fc3dfSFlorian Westphal 
1290250fc3dfSFlorian Westphal 	if (!dev->netdev_ops->ndo_get_vf_config)
1291250fc3dfSFlorian Westphal 		return 0;
1292250fc3dfSFlorian Westphal 
1293250fc3dfSFlorian Westphal 	vfinfo = nla_nest_start(skb, IFLA_VFINFO_LIST);
1294250fc3dfSFlorian Westphal 	if (!vfinfo)
1295250fc3dfSFlorian Westphal 		return -EMSGSIZE;
1296250fc3dfSFlorian Westphal 
1297250fc3dfSFlorian Westphal 	for (i = 0; i < num_vfs; i++) {
1298250fc3dfSFlorian Westphal 		if (rtnl_fill_vfinfo(skb, dev, i, vfinfo))
1299250fc3dfSFlorian Westphal 			return -EMSGSIZE;
1300250fc3dfSFlorian Westphal 	}
1301250fc3dfSFlorian Westphal 
1302250fc3dfSFlorian Westphal 	nla_nest_end(skb, vfinfo);
1303250fc3dfSFlorian Westphal 	return 0;
1304250fc3dfSFlorian Westphal }
1305250fc3dfSFlorian Westphal 
1306b22b941bSHannes Frederic Sowa static int rtnl_fill_link_ifmap(struct sk_buff *skb, struct net_device *dev)
1307b22b941bSHannes Frederic Sowa {
13085f8e4474SKangjie Lu 	struct rtnl_link_ifmap map;
13095f8e4474SKangjie Lu 
13105f8e4474SKangjie Lu 	memset(&map, 0, sizeof(map));
13115f8e4474SKangjie Lu 	map.mem_start   = dev->mem_start;
13125f8e4474SKangjie Lu 	map.mem_end     = dev->mem_end;
13135f8e4474SKangjie Lu 	map.base_addr   = dev->base_addr;
13145f8e4474SKangjie Lu 	map.irq         = dev->irq;
13155f8e4474SKangjie Lu 	map.dma         = dev->dma;
13165f8e4474SKangjie Lu 	map.port        = dev->if_port;
13175f8e4474SKangjie Lu 
1318270cb4d0SNicolas Dichtel 	if (nla_put_64bit(skb, IFLA_MAP, sizeof(map), &map, IFLA_PAD))
1319b22b941bSHannes Frederic Sowa 		return -EMSGSIZE;
1320b22b941bSHannes Frederic Sowa 
1321b22b941bSHannes Frederic Sowa 	return 0;
1322b22b941bSHannes Frederic Sowa }
1323b22b941bSHannes Frederic Sowa 
132458038695SMartin KaFai Lau static u8 rtnl_xdp_attached_mode(struct net_device *dev, u32 *prog_id)
1325d67b9cd2SDaniel Borkmann {
1326d67b9cd2SDaniel Borkmann 	const struct net_device_ops *ops = dev->netdev_ops;
132758038695SMartin KaFai Lau 	const struct bpf_prog *generic_xdp_prog;
1328118b4aa2SJakub Kicinski 	struct netdev_bpf xdp;
1329d67b9cd2SDaniel Borkmann 
1330d67b9cd2SDaniel Borkmann 	ASSERT_RTNL();
1331d67b9cd2SDaniel Borkmann 
133258038695SMartin KaFai Lau 	*prog_id = 0;
133358038695SMartin KaFai Lau 	generic_xdp_prog = rtnl_dereference(dev->xdp_prog);
133458038695SMartin KaFai Lau 	if (generic_xdp_prog) {
133558038695SMartin KaFai Lau 		*prog_id = generic_xdp_prog->aux->id;
1336d67b9cd2SDaniel Borkmann 		return XDP_ATTACHED_SKB;
133758038695SMartin KaFai Lau 	}
1338f4e63525SJakub Kicinski 	if (!ops->ndo_bpf)
1339d67b9cd2SDaniel Borkmann 		return XDP_ATTACHED_NONE;
1340ce158e58SJakub Kicinski 
1341118b4aa2SJakub Kicinski 	__dev_xdp_query(dev, ops->ndo_bpf, &xdp);
1342118b4aa2SJakub Kicinski 	*prog_id = xdp.prog_id;
1343118b4aa2SJakub Kicinski 
1344118b4aa2SJakub Kicinski 	return xdp.prog_attached;
1345d67b9cd2SDaniel Borkmann }
1346d67b9cd2SDaniel Borkmann 
1347d1fdd913SBrenden Blanco static int rtnl_xdp_fill(struct sk_buff *skb, struct net_device *dev)
1348d1fdd913SBrenden Blanco {
1349d1fdd913SBrenden Blanco 	struct nlattr *xdp;
135058038695SMartin KaFai Lau 	u32 prog_id;
1351d1fdd913SBrenden Blanco 	int err;
1352d1fdd913SBrenden Blanco 
1353d1fdd913SBrenden Blanco 	xdp = nla_nest_start(skb, IFLA_XDP);
1354d1fdd913SBrenden Blanco 	if (!xdp)
1355d1fdd913SBrenden Blanco 		return -EMSGSIZE;
1356b5cdae32SDavid S. Miller 
1357d67b9cd2SDaniel Borkmann 	err = nla_put_u8(skb, IFLA_XDP_ATTACHED,
135858038695SMartin KaFai Lau 			 rtnl_xdp_attached_mode(dev, &prog_id));
1359d1fdd913SBrenden Blanco 	if (err)
1360d1fdd913SBrenden Blanco 		goto err_cancel;
1361d1fdd913SBrenden Blanco 
136258038695SMartin KaFai Lau 	if (prog_id) {
136358038695SMartin KaFai Lau 		err = nla_put_u32(skb, IFLA_XDP_PROG_ID, prog_id);
136458038695SMartin KaFai Lau 		if (err)
136558038695SMartin KaFai Lau 			goto err_cancel;
136658038695SMartin KaFai Lau 	}
136758038695SMartin KaFai Lau 
1368d1fdd913SBrenden Blanco 	nla_nest_end(skb, xdp);
1369d1fdd913SBrenden Blanco 	return 0;
1370d1fdd913SBrenden Blanco 
1371d1fdd913SBrenden Blanco err_cancel:
1372d1fdd913SBrenden Blanco 	nla_nest_cancel(skb, xdp);
1373d1fdd913SBrenden Blanco 	return err;
1374d1fdd913SBrenden Blanco }
1375d1fdd913SBrenden Blanco 
13763d3ea5afSVlad Yasevich static u32 rtnl_get_event(unsigned long event)
13773d3ea5afSVlad Yasevich {
13783d3ea5afSVlad Yasevich 	u32 rtnl_event_type = IFLA_EVENT_NONE;
13793d3ea5afSVlad Yasevich 
13803d3ea5afSVlad Yasevich 	switch (event) {
13813d3ea5afSVlad Yasevich 	case NETDEV_REBOOT:
13823d3ea5afSVlad Yasevich 		rtnl_event_type = IFLA_EVENT_REBOOT;
13833d3ea5afSVlad Yasevich 		break;
13843d3ea5afSVlad Yasevich 	case NETDEV_FEAT_CHANGE:
13853d3ea5afSVlad Yasevich 		rtnl_event_type = IFLA_EVENT_FEATURES;
13863d3ea5afSVlad Yasevich 		break;
13873d3ea5afSVlad Yasevich 	case NETDEV_BONDING_FAILOVER:
13883d3ea5afSVlad Yasevich 		rtnl_event_type = IFLA_EVENT_BONDING_FAILOVER;
13893d3ea5afSVlad Yasevich 		break;
13903d3ea5afSVlad Yasevich 	case NETDEV_NOTIFY_PEERS:
13913d3ea5afSVlad Yasevich 		rtnl_event_type = IFLA_EVENT_NOTIFY_PEERS;
13923d3ea5afSVlad Yasevich 		break;
13933d3ea5afSVlad Yasevich 	case NETDEV_RESEND_IGMP:
13943d3ea5afSVlad Yasevich 		rtnl_event_type = IFLA_EVENT_IGMP_RESEND;
13953d3ea5afSVlad Yasevich 		break;
13963d3ea5afSVlad Yasevich 	case NETDEV_CHANGEINFODATA:
13973d3ea5afSVlad Yasevich 		rtnl_event_type = IFLA_EVENT_BONDING_OPTIONS;
13983d3ea5afSVlad Yasevich 		break;
13993d3ea5afSVlad Yasevich 	default:
14003d3ea5afSVlad Yasevich 		break;
14013d3ea5afSVlad Yasevich 	}
14023d3ea5afSVlad Yasevich 
14033d3ea5afSVlad Yasevich 	return rtnl_event_type;
14043d3ea5afSVlad Yasevich }
14053d3ea5afSVlad Yasevich 
140679110a04SFlorian Westphal static int put_master_ifindex(struct sk_buff *skb, struct net_device *dev)
140779110a04SFlorian Westphal {
140879110a04SFlorian Westphal 	const struct net_device *upper_dev;
140979110a04SFlorian Westphal 	int ret = 0;
141079110a04SFlorian Westphal 
141179110a04SFlorian Westphal 	rcu_read_lock();
141279110a04SFlorian Westphal 
141379110a04SFlorian Westphal 	upper_dev = netdev_master_upper_dev_get_rcu(dev);
141479110a04SFlorian Westphal 	if (upper_dev)
141579110a04SFlorian Westphal 		ret = nla_put_u32(skb, IFLA_MASTER, upper_dev->ifindex);
141679110a04SFlorian Westphal 
141779110a04SFlorian Westphal 	rcu_read_unlock();
141879110a04SFlorian Westphal 	return ret;
141979110a04SFlorian Westphal }
142079110a04SFlorian Westphal 
142179110a04SFlorian Westphal static int nla_put_iflink(struct sk_buff *skb, const struct net_device *dev)
142279110a04SFlorian Westphal {
142379110a04SFlorian Westphal 	int ifindex = dev_get_iflink(dev);
142479110a04SFlorian Westphal 
142579110a04SFlorian Westphal 	if (dev->ifindex == ifindex)
142679110a04SFlorian Westphal 		return 0;
142779110a04SFlorian Westphal 
142879110a04SFlorian Westphal 	return nla_put_u32(skb, IFLA_LINK, ifindex);
142979110a04SFlorian Westphal }
143079110a04SFlorian Westphal 
14316c557001SFlorian Westphal static noinline_for_stack int nla_put_ifalias(struct sk_buff *skb,
14326c557001SFlorian Westphal 					      struct net_device *dev)
14336c557001SFlorian Westphal {
14346c557001SFlorian Westphal 	char buf[IFALIASZ];
14356c557001SFlorian Westphal 	int ret;
14366c557001SFlorian Westphal 
14376c557001SFlorian Westphal 	ret = dev_get_alias(dev, buf, sizeof(buf));
14386c557001SFlorian Westphal 	return ret > 0 ? nla_put_string(skb, IFLA_IFALIAS, buf) : 0;
14396c557001SFlorian Westphal }
14406c557001SFlorian Westphal 
1441b1e66b9aSFlorian Westphal static int rtnl_fill_link_netnsid(struct sk_buff *skb,
144279e1ad14SJiri Benc 				  const struct net_device *dev,
144379e1ad14SJiri Benc 				  struct net *src_net)
1444b1e66b9aSFlorian Westphal {
1445b1e66b9aSFlorian Westphal 	if (dev->rtnl_link_ops && dev->rtnl_link_ops->get_link_net) {
1446b1e66b9aSFlorian Westphal 		struct net *link_net = dev->rtnl_link_ops->get_link_net(dev);
1447b1e66b9aSFlorian Westphal 
1448b1e66b9aSFlorian Westphal 		if (!net_eq(dev_net(dev), link_net)) {
144979e1ad14SJiri Benc 			int id = peernet2id_alloc(src_net, link_net);
1450b1e66b9aSFlorian Westphal 
1451b1e66b9aSFlorian Westphal 			if (nla_put_s32(skb, IFLA_LINK_NETNSID, id))
1452b1e66b9aSFlorian Westphal 				return -EMSGSIZE;
1453b1e66b9aSFlorian Westphal 		}
1454b1e66b9aSFlorian Westphal 	}
1455b1e66b9aSFlorian Westphal 
1456b1e66b9aSFlorian Westphal 	return 0;
1457b1e66b9aSFlorian Westphal }
1458b1e66b9aSFlorian Westphal 
1459070cbf5bSFlorian Westphal static int rtnl_fill_link_af(struct sk_buff *skb,
1460070cbf5bSFlorian Westphal 			     const struct net_device *dev,
1461070cbf5bSFlorian Westphal 			     u32 ext_filter_mask)
1462070cbf5bSFlorian Westphal {
1463070cbf5bSFlorian Westphal 	const struct rtnl_af_ops *af_ops;
1464070cbf5bSFlorian Westphal 	struct nlattr *af_spec;
1465070cbf5bSFlorian Westphal 
1466070cbf5bSFlorian Westphal 	af_spec = nla_nest_start(skb, IFLA_AF_SPEC);
1467070cbf5bSFlorian Westphal 	if (!af_spec)
1468070cbf5bSFlorian Westphal 		return -EMSGSIZE;
1469070cbf5bSFlorian Westphal 
14705fa85a09SFlorian Westphal 	list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
1471070cbf5bSFlorian Westphal 		struct nlattr *af;
1472070cbf5bSFlorian Westphal 		int err;
1473070cbf5bSFlorian Westphal 
1474070cbf5bSFlorian Westphal 		if (!af_ops->fill_link_af)
1475070cbf5bSFlorian Westphal 			continue;
1476070cbf5bSFlorian Westphal 
1477070cbf5bSFlorian Westphal 		af = nla_nest_start(skb, af_ops->family);
1478070cbf5bSFlorian Westphal 		if (!af)
1479070cbf5bSFlorian Westphal 			return -EMSGSIZE;
1480070cbf5bSFlorian Westphal 
1481070cbf5bSFlorian Westphal 		err = af_ops->fill_link_af(skb, dev, ext_filter_mask);
1482070cbf5bSFlorian Westphal 		/*
1483070cbf5bSFlorian Westphal 		 * Caller may return ENODATA to indicate that there
1484070cbf5bSFlorian Westphal 		 * was no data to be dumped. This is not an error, it
1485070cbf5bSFlorian Westphal 		 * means we should trim the attribute header and
1486070cbf5bSFlorian Westphal 		 * continue.
1487070cbf5bSFlorian Westphal 		 */
1488070cbf5bSFlorian Westphal 		if (err == -ENODATA)
1489070cbf5bSFlorian Westphal 			nla_nest_cancel(skb, af);
1490070cbf5bSFlorian Westphal 		else if (err < 0)
1491070cbf5bSFlorian Westphal 			return -EMSGSIZE;
1492070cbf5bSFlorian Westphal 
1493070cbf5bSFlorian Westphal 		nla_nest_end(skb, af);
1494070cbf5bSFlorian Westphal 	}
1495070cbf5bSFlorian Westphal 
1496070cbf5bSFlorian Westphal 	nla_nest_end(skb, af_spec);
1497070cbf5bSFlorian Westphal 	return 0;
1498070cbf5bSFlorian Westphal }
1499070cbf5bSFlorian Westphal 
150079e1ad14SJiri Benc static int rtnl_fill_ifinfo(struct sk_buff *skb,
150179e1ad14SJiri Benc 			    struct net_device *dev, struct net *src_net,
1502575c3e2aSPatrick McHardy 			    int type, u32 pid, u32 seq, u32 change,
15033d3ea5afSVlad Yasevich 			    unsigned int flags, u32 ext_filter_mask,
150479e1ad14SJiri Benc 			    u32 event, int *new_nsid, int tgt_netnsid)
1505b60c5115SThomas Graf {
1506b60c5115SThomas Graf 	struct ifinfomsg *ifm;
15071da177e4SLinus Torvalds 	struct nlmsghdr *nlh;
15081da177e4SLinus Torvalds 
15092907c35fSEric Dumazet 	ASSERT_RTNL();
1510b60c5115SThomas Graf 	nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifm), flags);
1511b60c5115SThomas Graf 	if (nlh == NULL)
151226932566SPatrick McHardy 		return -EMSGSIZE;
15131da177e4SLinus Torvalds 
1514b60c5115SThomas Graf 	ifm = nlmsg_data(nlh);
1515b60c5115SThomas Graf 	ifm->ifi_family = AF_UNSPEC;
1516b60c5115SThomas Graf 	ifm->__ifi_pad = 0;
1517b60c5115SThomas Graf 	ifm->ifi_type = dev->type;
1518b60c5115SThomas Graf 	ifm->ifi_index = dev->ifindex;
1519b60c5115SThomas Graf 	ifm->ifi_flags = dev_get_flags(dev);
1520b60c5115SThomas Graf 	ifm->ifi_change = change;
15211da177e4SLinus Torvalds 
152279e1ad14SJiri Benc 	if (tgt_netnsid >= 0 && nla_put_s32(skb, IFLA_IF_NETNSID, tgt_netnsid))
152379e1ad14SJiri Benc 		goto nla_put_failure;
152479e1ad14SJiri Benc 
1525a6574349SDavid S. Miller 	if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
1526a6574349SDavid S. Miller 	    nla_put_u32(skb, IFLA_TXQLEN, dev->tx_queue_len) ||
1527a6574349SDavid S. Miller 	    nla_put_u8(skb, IFLA_OPERSTATE,
1528a6574349SDavid S. Miller 		       netif_running(dev) ? dev->operstate : IF_OPER_DOWN) ||
1529a6574349SDavid S. Miller 	    nla_put_u8(skb, IFLA_LINKMODE, dev->link_mode) ||
1530a6574349SDavid S. Miller 	    nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
1531a6574349SDavid S. Miller 	    nla_put_u32(skb, IFLA_GROUP, dev->group) ||
1532edbc0bb3SBen Greear 	    nla_put_u32(skb, IFLA_PROMISCUITY, dev->promiscuity) ||
153376ff5cc9SJiri Pirko 	    nla_put_u32(skb, IFLA_NUM_TX_QUEUES, dev->num_tx_queues) ||
1534c70ce028SEric Dumazet 	    nla_put_u32(skb, IFLA_GSO_MAX_SEGS, dev->gso_max_segs) ||
1535c70ce028SEric Dumazet 	    nla_put_u32(skb, IFLA_GSO_MAX_SIZE, dev->gso_max_size) ||
15361d69c2b3SMark A. Greer #ifdef CONFIG_RPS
153776ff5cc9SJiri Pirko 	    nla_put_u32(skb, IFLA_NUM_RX_QUEUES, dev->num_rx_queues) ||
15381d69c2b3SMark A. Greer #endif
153979110a04SFlorian Westphal 	    nla_put_iflink(skb, dev) ||
154079110a04SFlorian Westphal 	    put_master_ifindex(skb, dev) ||
15419a57247fSJiri Pirko 	    nla_put_u8(skb, IFLA_CARRIER, netif_carrier_ok(dev)) ||
1542a6574349SDavid S. Miller 	    (dev->qdisc &&
1543a6574349SDavid S. Miller 	     nla_put_string(skb, IFLA_QDISC, dev->qdisc->ops->id)) ||
15446c557001SFlorian Westphal 	    nla_put_ifalias(skb, dev) ||
15452d3b479dSdavid decotigny 	    nla_put_u32(skb, IFLA_CARRIER_CHANGES,
154688d6378bSAnuradha Karuppiah 			atomic_read(&dev->carrier_changes)) ||
154788d6378bSAnuradha Karuppiah 	    nla_put_u8(skb, IFLA_PROTO_DOWN, dev->proto_down))
1548a6574349SDavid S. Miller 		goto nla_put_failure;
15490b815a1aSStephen Hemminger 
15503d3ea5afSVlad Yasevich 	if (event != IFLA_EVENT_NONE) {
15513d3ea5afSVlad Yasevich 		if (nla_put_u32(skb, IFLA_EVENT, event))
15523d3ea5afSVlad Yasevich 			goto nla_put_failure;
15533d3ea5afSVlad Yasevich 	}
15543d3ea5afSVlad Yasevich 
1555b22b941bSHannes Frederic Sowa 	if (rtnl_fill_link_ifmap(skb, dev))
1556a6574349SDavid S. Miller 		goto nla_put_failure;
15571da177e4SLinus Torvalds 
15581da177e4SLinus Torvalds 	if (dev->addr_len) {
1559a6574349SDavid S. Miller 		if (nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr) ||
1560a6574349SDavid S. Miller 		    nla_put(skb, IFLA_BROADCAST, dev->addr_len, dev->broadcast))
1561a6574349SDavid S. Miller 			goto nla_put_failure;
15621da177e4SLinus Torvalds 	}
15631da177e4SLinus Torvalds 
156466cae9edSJiri Pirko 	if (rtnl_phys_port_id_fill(skb, dev))
156566cae9edSJiri Pirko 		goto nla_put_failure;
156666cae9edSJiri Pirko 
1567db24a904SDavid Ahern 	if (rtnl_phys_port_name_fill(skb, dev))
1568db24a904SDavid Ahern 		goto nla_put_failure;
1569db24a904SDavid Ahern 
157082f28412SJiri Pirko 	if (rtnl_phys_switch_id_fill(skb, dev))
157182f28412SJiri Pirko 		goto nla_put_failure;
157282f28412SJiri Pirko 
1573b22b941bSHannes Frederic Sowa 	if (rtnl_fill_stats(skb, dev))
1574b60c5115SThomas Graf 		goto nla_put_failure;
1575b60c5115SThomas Graf 
1576250fc3dfSFlorian Westphal 	if (rtnl_fill_vf(skb, dev, ext_filter_mask))
1577a6574349SDavid S. Miller 		goto nla_put_failure;
157857b61080SScott Feldman 
1579c53864fdSDavid Gibson 	if (rtnl_port_fill(skb, dev, ext_filter_mask))
158057b61080SScott Feldman 		goto nla_put_failure;
158157b61080SScott Feldman 
1582d1fdd913SBrenden Blanco 	if (rtnl_xdp_fill(skb, dev))
1583d1fdd913SBrenden Blanco 		goto nla_put_failure;
1584d1fdd913SBrenden Blanco 
1585ba7d49b1SJiri Pirko 	if (dev->rtnl_link_ops || rtnl_have_link_slave_info(dev)) {
158638f7b870SPatrick McHardy 		if (rtnl_link_fill(skb, dev) < 0)
158738f7b870SPatrick McHardy 			goto nla_put_failure;
158838f7b870SPatrick McHardy 	}
158938f7b870SPatrick McHardy 
159079e1ad14SJiri Benc 	if (rtnl_fill_link_netnsid(skb, dev, src_net))
1591d37512a2SNicolas Dichtel 		goto nla_put_failure;
1592d37512a2SNicolas Dichtel 
15936621dd29SNicolas Dichtel 	if (new_nsid &&
15946621dd29SNicolas Dichtel 	    nla_put_s32(skb, IFLA_NEW_NETNSID, *new_nsid) < 0)
15956621dd29SNicolas Dichtel 		goto nla_put_failure;
15966621dd29SNicolas Dichtel 
15975fa85a09SFlorian Westphal 	rcu_read_lock();
1598070cbf5bSFlorian Westphal 	if (rtnl_fill_link_af(skb, dev, ext_filter_mask))
15995fa85a09SFlorian Westphal 		goto nla_put_failure_rcu;
16005fa85a09SFlorian Westphal 	rcu_read_unlock();
1601f8ff182cSThomas Graf 
1602053c095aSJohannes Berg 	nlmsg_end(skb, nlh);
1603053c095aSJohannes Berg 	return 0;
1604b60c5115SThomas Graf 
16055fa85a09SFlorian Westphal nla_put_failure_rcu:
16065fa85a09SFlorian Westphal 	rcu_read_unlock();
1607b60c5115SThomas Graf nla_put_failure:
160826932566SPatrick McHardy 	nlmsg_cancel(skb, nlh);
160926932566SPatrick McHardy 	return -EMSGSIZE;
16101da177e4SLinus Torvalds }
16111da177e4SLinus Torvalds 
1612f7b12606SJiri Pirko static const struct nla_policy ifla_policy[IFLA_MAX+1] = {
1613f7b12606SJiri Pirko 	[IFLA_IFNAME]		= { .type = NLA_STRING, .len = IFNAMSIZ-1 },
1614f7b12606SJiri Pirko 	[IFLA_ADDRESS]		= { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
1615f7b12606SJiri Pirko 	[IFLA_BROADCAST]	= { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
1616f7b12606SJiri Pirko 	[IFLA_MAP]		= { .len = sizeof(struct rtnl_link_ifmap) },
1617f7b12606SJiri Pirko 	[IFLA_MTU]		= { .type = NLA_U32 },
1618f7b12606SJiri Pirko 	[IFLA_LINK]		= { .type = NLA_U32 },
1619f7b12606SJiri Pirko 	[IFLA_MASTER]		= { .type = NLA_U32 },
1620f7b12606SJiri Pirko 	[IFLA_CARRIER]		= { .type = NLA_U8 },
1621f7b12606SJiri Pirko 	[IFLA_TXQLEN]		= { .type = NLA_U32 },
1622f7b12606SJiri Pirko 	[IFLA_WEIGHT]		= { .type = NLA_U32 },
1623f7b12606SJiri Pirko 	[IFLA_OPERSTATE]	= { .type = NLA_U8 },
1624f7b12606SJiri Pirko 	[IFLA_LINKMODE]		= { .type = NLA_U8 },
1625f7b12606SJiri Pirko 	[IFLA_LINKINFO]		= { .type = NLA_NESTED },
1626f7b12606SJiri Pirko 	[IFLA_NET_NS_PID]	= { .type = NLA_U32 },
1627f7b12606SJiri Pirko 	[IFLA_NET_NS_FD]	= { .type = NLA_U32 },
16282459b4c6SNicolas Dichtel 	/* IFLA_IFALIAS is a string, but policy is set to NLA_BINARY to
16292459b4c6SNicolas Dichtel 	 * allow 0-length string (needed to remove an alias).
16302459b4c6SNicolas Dichtel 	 */
16312459b4c6SNicolas Dichtel 	[IFLA_IFALIAS]	        = { .type = NLA_BINARY, .len = IFALIASZ - 1 },
1632f7b12606SJiri Pirko 	[IFLA_VFINFO_LIST]	= {. type = NLA_NESTED },
1633f7b12606SJiri Pirko 	[IFLA_VF_PORTS]		= { .type = NLA_NESTED },
1634f7b12606SJiri Pirko 	[IFLA_PORT_SELF]	= { .type = NLA_NESTED },
1635f7b12606SJiri Pirko 	[IFLA_AF_SPEC]		= { .type = NLA_NESTED },
1636f7b12606SJiri Pirko 	[IFLA_EXT_MASK]		= { .type = NLA_U32 },
1637f7b12606SJiri Pirko 	[IFLA_PROMISCUITY]	= { .type = NLA_U32 },
1638f7b12606SJiri Pirko 	[IFLA_NUM_TX_QUEUES]	= { .type = NLA_U32 },
1639f7b12606SJiri Pirko 	[IFLA_NUM_RX_QUEUES]	= { .type = NLA_U32 },
164002637fceSJiri Pirko 	[IFLA_PHYS_PORT_ID]	= { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN },
16412d3b479dSdavid decotigny 	[IFLA_CARRIER_CHANGES]	= { .type = NLA_U32 },  /* ignored */
164282f28412SJiri Pirko 	[IFLA_PHYS_SWITCH_ID]	= { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN },
1643317f4810SNicolas Dichtel 	[IFLA_LINK_NETNSID]	= { .type = NLA_S32 },
164488d6378bSAnuradha Karuppiah 	[IFLA_PROTO_DOWN]	= { .type = NLA_U8 },
1645d1fdd913SBrenden Blanco 	[IFLA_XDP]		= { .type = NLA_NESTED },
16463d3ea5afSVlad Yasevich 	[IFLA_EVENT]		= { .type = NLA_U32 },
1647db833d40SSerhey Popovych 	[IFLA_GROUP]		= { .type = NLA_U32 },
164879e1ad14SJiri Benc 	[IFLA_IF_NETNSID]	= { .type = NLA_S32 },
1649f7b12606SJiri Pirko };
1650f7b12606SJiri Pirko 
1651f7b12606SJiri Pirko static const struct nla_policy ifla_info_policy[IFLA_INFO_MAX+1] = {
1652f7b12606SJiri Pirko 	[IFLA_INFO_KIND]	= { .type = NLA_STRING },
1653f7b12606SJiri Pirko 	[IFLA_INFO_DATA]	= { .type = NLA_NESTED },
1654f7b12606SJiri Pirko 	[IFLA_INFO_SLAVE_KIND]	= { .type = NLA_STRING },
1655f7b12606SJiri Pirko 	[IFLA_INFO_SLAVE_DATA]	= { .type = NLA_NESTED },
1656f7b12606SJiri Pirko };
1657f7b12606SJiri Pirko 
1658f7b12606SJiri Pirko static const struct nla_policy ifla_vf_policy[IFLA_VF_MAX+1] = {
1659364d5716SDaniel Borkmann 	[IFLA_VF_MAC]		= { .len = sizeof(struct ifla_vf_mac) },
1660364d5716SDaniel Borkmann 	[IFLA_VF_VLAN]		= { .len = sizeof(struct ifla_vf_vlan) },
166179aab093SMoshe Shemesh 	[IFLA_VF_VLAN_LIST]     = { .type = NLA_NESTED },
1662364d5716SDaniel Borkmann 	[IFLA_VF_TX_RATE]	= { .len = sizeof(struct ifla_vf_tx_rate) },
1663364d5716SDaniel Borkmann 	[IFLA_VF_SPOOFCHK]	= { .len = sizeof(struct ifla_vf_spoofchk) },
1664364d5716SDaniel Borkmann 	[IFLA_VF_RATE]		= { .len = sizeof(struct ifla_vf_rate) },
1665364d5716SDaniel Borkmann 	[IFLA_VF_LINK_STATE]	= { .len = sizeof(struct ifla_vf_link_state) },
166601a3d796SVlad Zolotarov 	[IFLA_VF_RSS_QUERY_EN]	= { .len = sizeof(struct ifla_vf_rss_query_en) },
16673b766cd8SEran Ben Elisha 	[IFLA_VF_STATS]		= { .type = NLA_NESTED },
1668dd461d6aSHiroshi Shimamoto 	[IFLA_VF_TRUST]		= { .len = sizeof(struct ifla_vf_trust) },
1669cc8e27ccSEli Cohen 	[IFLA_VF_IB_NODE_GUID]	= { .len = sizeof(struct ifla_vf_guid) },
1670cc8e27ccSEli Cohen 	[IFLA_VF_IB_PORT_GUID]	= { .len = sizeof(struct ifla_vf_guid) },
16713b766cd8SEran Ben Elisha };
16723b766cd8SEran Ben Elisha 
1673f7b12606SJiri Pirko static const struct nla_policy ifla_port_policy[IFLA_PORT_MAX+1] = {
1674f7b12606SJiri Pirko 	[IFLA_PORT_VF]		= { .type = NLA_U32 },
1675f7b12606SJiri Pirko 	[IFLA_PORT_PROFILE]	= { .type = NLA_STRING,
1676f7b12606SJiri Pirko 				    .len = PORT_PROFILE_MAX },
1677f7b12606SJiri Pirko 	[IFLA_PORT_INSTANCE_UUID] = { .type = NLA_BINARY,
1678f7b12606SJiri Pirko 				      .len = PORT_UUID_MAX },
1679f7b12606SJiri Pirko 	[IFLA_PORT_HOST_UUID]	= { .type = NLA_STRING,
1680f7b12606SJiri Pirko 				    .len = PORT_UUID_MAX },
1681f7b12606SJiri Pirko 	[IFLA_PORT_REQUEST]	= { .type = NLA_U8, },
1682f7b12606SJiri Pirko 	[IFLA_PORT_RESPONSE]	= { .type = NLA_U16, },
1683025331dfSDaniel Borkmann 
1684025331dfSDaniel Borkmann 	/* Unused, but we need to keep it here since user space could
1685025331dfSDaniel Borkmann 	 * fill it. It's also broken with regard to NLA_BINARY use in
1686025331dfSDaniel Borkmann 	 * combination with structs.
1687025331dfSDaniel Borkmann 	 */
1688025331dfSDaniel Borkmann 	[IFLA_PORT_VSI_TYPE]	= { .type = NLA_BINARY,
1689025331dfSDaniel Borkmann 				    .len = sizeof(struct ifla_port_vsi) },
1690f7b12606SJiri Pirko };
1691f7b12606SJiri Pirko 
1692d1fdd913SBrenden Blanco static const struct nla_policy ifla_xdp_policy[IFLA_XDP_MAX + 1] = {
1693d1fdd913SBrenden Blanco 	[IFLA_XDP_FD]		= { .type = NLA_S32 },
1694d1fdd913SBrenden Blanco 	[IFLA_XDP_ATTACHED]	= { .type = NLA_U8 },
169585de8576SDaniel Borkmann 	[IFLA_XDP_FLAGS]	= { .type = NLA_U32 },
169658038695SMartin KaFai Lau 	[IFLA_XDP_PROG_ID]	= { .type = NLA_U32 },
1697d1fdd913SBrenden Blanco };
1698d1fdd913SBrenden Blanco 
1699dc599f76SDavid Ahern static const struct rtnl_link_ops *linkinfo_to_kind_ops(const struct nlattr *nla)
1700dc599f76SDavid Ahern {
1701dc599f76SDavid Ahern 	const struct rtnl_link_ops *ops = NULL;
1702dc599f76SDavid Ahern 	struct nlattr *linfo[IFLA_INFO_MAX + 1];
1703dc599f76SDavid Ahern 
1704fceb6435SJohannes Berg 	if (nla_parse_nested(linfo, IFLA_INFO_MAX, nla,
1705fceb6435SJohannes Berg 			     ifla_info_policy, NULL) < 0)
1706dc599f76SDavid Ahern 		return NULL;
1707dc599f76SDavid Ahern 
1708dc599f76SDavid Ahern 	if (linfo[IFLA_INFO_KIND]) {
1709dc599f76SDavid Ahern 		char kind[MODULE_NAME_LEN];
1710dc599f76SDavid Ahern 
1711dc599f76SDavid Ahern 		nla_strlcpy(kind, linfo[IFLA_INFO_KIND], sizeof(kind));
1712dc599f76SDavid Ahern 		ops = rtnl_link_ops_get(kind);
1713dc599f76SDavid Ahern 	}
1714dc599f76SDavid Ahern 
1715dc599f76SDavid Ahern 	return ops;
1716dc599f76SDavid Ahern }
1717dc599f76SDavid Ahern 
1718dc599f76SDavid Ahern static bool link_master_filtered(struct net_device *dev, int master_idx)
1719dc599f76SDavid Ahern {
1720dc599f76SDavid Ahern 	struct net_device *master;
1721dc599f76SDavid Ahern 
1722dc599f76SDavid Ahern 	if (!master_idx)
1723dc599f76SDavid Ahern 		return false;
1724dc599f76SDavid Ahern 
1725dc599f76SDavid Ahern 	master = netdev_master_upper_dev_get(dev);
1726dc599f76SDavid Ahern 	if (!master || master->ifindex != master_idx)
1727dc599f76SDavid Ahern 		return true;
1728dc599f76SDavid Ahern 
1729dc599f76SDavid Ahern 	return false;
1730dc599f76SDavid Ahern }
1731dc599f76SDavid Ahern 
1732dc599f76SDavid Ahern static bool link_kind_filtered(const struct net_device *dev,
1733dc599f76SDavid Ahern 			       const struct rtnl_link_ops *kind_ops)
1734dc599f76SDavid Ahern {
1735dc599f76SDavid Ahern 	if (kind_ops && dev->rtnl_link_ops != kind_ops)
1736dc599f76SDavid Ahern 		return true;
1737dc599f76SDavid Ahern 
1738dc599f76SDavid Ahern 	return false;
1739dc599f76SDavid Ahern }
1740dc599f76SDavid Ahern 
1741dc599f76SDavid Ahern static bool link_dump_filtered(struct net_device *dev,
1742dc599f76SDavid Ahern 			       int master_idx,
1743dc599f76SDavid Ahern 			       const struct rtnl_link_ops *kind_ops)
1744dc599f76SDavid Ahern {
1745dc599f76SDavid Ahern 	if (link_master_filtered(dev, master_idx) ||
1746dc599f76SDavid Ahern 	    link_kind_filtered(dev, kind_ops))
1747dc599f76SDavid Ahern 		return true;
1748dc599f76SDavid Ahern 
1749dc599f76SDavid Ahern 	return false;
1750dc599f76SDavid Ahern }
1751dc599f76SDavid Ahern 
175279e1ad14SJiri Benc static struct net *get_target_net(struct sk_buff *skb, int netnsid)
175379e1ad14SJiri Benc {
175479e1ad14SJiri Benc 	struct net *net;
175579e1ad14SJiri Benc 
175679e1ad14SJiri Benc 	net = get_net_ns_by_id(sock_net(skb->sk), netnsid);
175779e1ad14SJiri Benc 	if (!net)
175879e1ad14SJiri Benc 		return ERR_PTR(-EINVAL);
175979e1ad14SJiri Benc 
176079e1ad14SJiri Benc 	/* For now, the caller is required to have CAP_NET_ADMIN in
176179e1ad14SJiri Benc 	 * the user namespace owning the target net ns.
176279e1ad14SJiri Benc 	 */
176379e1ad14SJiri Benc 	if (!netlink_ns_capable(skb, net->user_ns, CAP_NET_ADMIN)) {
176479e1ad14SJiri Benc 		put_net(net);
176579e1ad14SJiri Benc 		return ERR_PTR(-EACCES);
176679e1ad14SJiri Benc 	}
176779e1ad14SJiri Benc 	return net;
176879e1ad14SJiri Benc }
176979e1ad14SJiri Benc 
1770b60c5115SThomas Graf static int rtnl_dump_ifinfo(struct sk_buff *skb, struct netlink_callback *cb)
17711da177e4SLinus Torvalds {
17723b1e0a65SYOSHIFUJI Hideaki 	struct net *net = sock_net(skb->sk);
177379e1ad14SJiri Benc 	struct net *tgt_net = net;
17747c28bd0bSEric Dumazet 	int h, s_h;
17757c28bd0bSEric Dumazet 	int idx = 0, s_idx;
17761da177e4SLinus Torvalds 	struct net_device *dev;
17777c28bd0bSEric Dumazet 	struct hlist_head *head;
1778115c9b81SGreg Rose 	struct nlattr *tb[IFLA_MAX+1];
1779115c9b81SGreg Rose 	u32 ext_filter_mask = 0;
1780dc599f76SDavid Ahern 	const struct rtnl_link_ops *kind_ops = NULL;
1781dc599f76SDavid Ahern 	unsigned int flags = NLM_F_MULTI;
1782dc599f76SDavid Ahern 	int master_idx = 0;
178379e1ad14SJiri Benc 	int netnsid = -1;
1784973462bbSDavid Gibson 	int err;
1785e5eca6d4SMichal Schmidt 	int hdrlen;
17861da177e4SLinus Torvalds 
17877c28bd0bSEric Dumazet 	s_h = cb->args[0];
17887c28bd0bSEric Dumazet 	s_idx = cb->args[1];
17897c28bd0bSEric Dumazet 
1790e5eca6d4SMichal Schmidt 	/* A hack to preserve kernel<->userspace interface.
1791e5eca6d4SMichal Schmidt 	 * The correct header is ifinfomsg. It is consistent with rtnl_getlink.
1792e5eca6d4SMichal Schmidt 	 * However, before Linux v3.9 the code here assumed rtgenmsg and that's
1793e5eca6d4SMichal Schmidt 	 * what iproute2 < v3.9.0 used.
1794e5eca6d4SMichal Schmidt 	 * We can detect the old iproute2. Even including the IFLA_EXT_MASK
1795e5eca6d4SMichal Schmidt 	 * attribute, its netlink message is shorter than struct ifinfomsg.
1796e5eca6d4SMichal Schmidt 	 */
1797e5eca6d4SMichal Schmidt 	hdrlen = nlmsg_len(cb->nlh) < sizeof(struct ifinfomsg) ?
1798e5eca6d4SMichal Schmidt 		 sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg);
1799e5eca6d4SMichal Schmidt 
1800fceb6435SJohannes Berg 	if (nlmsg_parse(cb->nlh, hdrlen, tb, IFLA_MAX,
1801fceb6435SJohannes Berg 			ifla_policy, NULL) >= 0) {
180279e1ad14SJiri Benc 		if (tb[IFLA_IF_NETNSID]) {
180379e1ad14SJiri Benc 			netnsid = nla_get_s32(tb[IFLA_IF_NETNSID]);
180479e1ad14SJiri Benc 			tgt_net = get_target_net(skb, netnsid);
180579e1ad14SJiri Benc 			if (IS_ERR(tgt_net)) {
180679e1ad14SJiri Benc 				tgt_net = net;
180779e1ad14SJiri Benc 				netnsid = -1;
180879e1ad14SJiri Benc 			}
180979e1ad14SJiri Benc 		}
181079e1ad14SJiri Benc 
1811115c9b81SGreg Rose 		if (tb[IFLA_EXT_MASK])
1812115c9b81SGreg Rose 			ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
1813dc599f76SDavid Ahern 
1814dc599f76SDavid Ahern 		if (tb[IFLA_MASTER])
1815dc599f76SDavid Ahern 			master_idx = nla_get_u32(tb[IFLA_MASTER]);
1816dc599f76SDavid Ahern 
1817dc599f76SDavid Ahern 		if (tb[IFLA_LINKINFO])
1818dc599f76SDavid Ahern 			kind_ops = linkinfo_to_kind_ops(tb[IFLA_LINKINFO]);
1819dc599f76SDavid Ahern 
1820dc599f76SDavid Ahern 		if (master_idx || kind_ops)
1821dc599f76SDavid Ahern 			flags |= NLM_F_DUMP_FILTERED;
1822a4b64fbeSEric Dumazet 	}
1823115c9b81SGreg Rose 
18247c28bd0bSEric Dumazet 	for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
18257562f876SPavel Emelianov 		idx = 0;
182679e1ad14SJiri Benc 		head = &tgt_net->dev_index_head[h];
1827cac5e65eSEric Dumazet 		hlist_for_each_entry(dev, head, index_hlist) {
1828dc599f76SDavid Ahern 			if (link_dump_filtered(dev, master_idx, kind_ops))
18293f0ae05dSZhang Shengju 				goto cont;
18301da177e4SLinus Torvalds 			if (idx < s_idx)
18317562f876SPavel Emelianov 				goto cont;
183279e1ad14SJiri Benc 			err = rtnl_fill_ifinfo(skb, dev, net,
183379e1ad14SJiri Benc 					       RTM_NEWLINK,
183415e47304SEric W. Biederman 					       NETLINK_CB(cb->skb).portid,
18357c28bd0bSEric Dumazet 					       cb->nlh->nlmsg_seq, 0,
1836dc599f76SDavid Ahern 					       flags,
183779e1ad14SJiri Benc 					       ext_filter_mask, 0, NULL,
183879e1ad14SJiri Benc 					       netnsid);
1839973462bbSDavid Gibson 
1840f6c5775fSDavid Ahern 			if (err < 0) {
1841f6c5775fSDavid Ahern 				if (likely(skb->len))
18427c28bd0bSEric Dumazet 					goto out;
18434e985adaSThomas Graf 
1844f6c5775fSDavid Ahern 				goto out_err;
1845f6c5775fSDavid Ahern 			}
18467562f876SPavel Emelianov cont:
18477562f876SPavel Emelianov 			idx++;
18481da177e4SLinus Torvalds 		}
18497c28bd0bSEric Dumazet 	}
18507c28bd0bSEric Dumazet out:
1851f6c5775fSDavid Ahern 	err = skb->len;
1852f6c5775fSDavid Ahern out_err:
18537c28bd0bSEric Dumazet 	cb->args[1] = idx;
18547c28bd0bSEric Dumazet 	cb->args[0] = h;
1855d0225784SJakub Sitnicki 	cb->seq = net->dev_base_seq;
1856d0225784SJakub Sitnicki 	nl_dump_check_consistent(cb, nlmsg_hdr(skb));
185779e1ad14SJiri Benc 	if (netnsid >= 0)
185879e1ad14SJiri Benc 		put_net(tgt_net);
18591da177e4SLinus Torvalds 
1860f6c5775fSDavid Ahern 	return err;
18611da177e4SLinus Torvalds }
18621da177e4SLinus Torvalds 
1863fceb6435SJohannes Berg int rtnl_nla_parse_ifla(struct nlattr **tb, const struct nlattr *head, int len,
1864fceb6435SJohannes Berg 			struct netlink_ext_ack *exterr)
1865f7b12606SJiri Pirko {
1866fceb6435SJohannes Berg 	return nla_parse(tb, IFLA_MAX, head, len, ifla_policy, exterr);
1867f7b12606SJiri Pirko }
1868f7b12606SJiri Pirko EXPORT_SYMBOL(rtnl_nla_parse_ifla);
186957b61080SScott Feldman 
187081adee47SEric W. Biederman struct net *rtnl_link_get_net(struct net *src_net, struct nlattr *tb[])
187181adee47SEric W. Biederman {
187281adee47SEric W. Biederman 	struct net *net;
187381adee47SEric W. Biederman 	/* Examine the link attributes and figure out which
187481adee47SEric W. Biederman 	 * network namespace we are talking about.
187581adee47SEric W. Biederman 	 */
187681adee47SEric W. Biederman 	if (tb[IFLA_NET_NS_PID])
187781adee47SEric W. Biederman 		net = get_net_ns_by_pid(nla_get_u32(tb[IFLA_NET_NS_PID]));
1878f0630529SEric W. Biederman 	else if (tb[IFLA_NET_NS_FD])
1879f0630529SEric W. Biederman 		net = get_net_ns_by_fd(nla_get_u32(tb[IFLA_NET_NS_FD]));
188081adee47SEric W. Biederman 	else
188181adee47SEric W. Biederman 		net = get_net(src_net);
188281adee47SEric W. Biederman 	return net;
188381adee47SEric W. Biederman }
188481adee47SEric W. Biederman EXPORT_SYMBOL(rtnl_link_get_net);
188581adee47SEric W. Biederman 
18861840bb13SThomas Graf static int validate_linkmsg(struct net_device *dev, struct nlattr *tb[])
18871840bb13SThomas Graf {
18881840bb13SThomas Graf 	if (dev) {
18891840bb13SThomas Graf 		if (tb[IFLA_ADDRESS] &&
18901840bb13SThomas Graf 		    nla_len(tb[IFLA_ADDRESS]) < dev->addr_len)
18911840bb13SThomas Graf 			return -EINVAL;
18921840bb13SThomas Graf 
18931840bb13SThomas Graf 		if (tb[IFLA_BROADCAST] &&
18941840bb13SThomas Graf 		    nla_len(tb[IFLA_BROADCAST]) < dev->addr_len)
18951840bb13SThomas Graf 			return -EINVAL;
18961840bb13SThomas Graf 	}
18971840bb13SThomas Graf 
1898cf7afbfeSThomas Graf 	if (tb[IFLA_AF_SPEC]) {
1899cf7afbfeSThomas Graf 		struct nlattr *af;
1900cf7afbfeSThomas Graf 		int rem, err;
1901cf7afbfeSThomas Graf 
1902cf7afbfeSThomas Graf 		nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) {
1903cf7afbfeSThomas Graf 			const struct rtnl_af_ops *af_ops;
1904cf7afbfeSThomas Graf 
19055fa85a09SFlorian Westphal 			rcu_read_lock();
19065fa85a09SFlorian Westphal 			af_ops = rtnl_af_lookup(nla_type(af));
19075fa85a09SFlorian Westphal 			if (!af_ops) {
19085fa85a09SFlorian Westphal 				rcu_read_unlock();
1909cf7afbfeSThomas Graf 				return -EAFNOSUPPORT;
19105fa85a09SFlorian Westphal 			}
1911cf7afbfeSThomas Graf 
19125fa85a09SFlorian Westphal 			if (!af_ops->set_link_af) {
19135fa85a09SFlorian Westphal 				rcu_read_unlock();
1914cf7afbfeSThomas Graf 				return -EOPNOTSUPP;
19155fa85a09SFlorian Westphal 			}
1916cf7afbfeSThomas Graf 
1917cf7afbfeSThomas Graf 			if (af_ops->validate_link_af) {
19186d3a9a68SKurt Van Dijck 				err = af_ops->validate_link_af(dev, af);
19195fa85a09SFlorian Westphal 				if (err < 0) {
19205fa85a09SFlorian Westphal 					rcu_read_unlock();
1921cf7afbfeSThomas Graf 					return err;
1922cf7afbfeSThomas Graf 				}
1923cf7afbfeSThomas Graf 			}
19245fa85a09SFlorian Westphal 
19255fa85a09SFlorian Westphal 			rcu_read_unlock();
19265fa85a09SFlorian Westphal 		}
1927cf7afbfeSThomas Graf 	}
1928cf7afbfeSThomas Graf 
19291840bb13SThomas Graf 	return 0;
19301840bb13SThomas Graf }
19311840bb13SThomas Graf 
1932cc8e27ccSEli Cohen static int handle_infiniband_guid(struct net_device *dev, struct ifla_vf_guid *ivt,
1933cc8e27ccSEli Cohen 				  int guid_type)
1934cc8e27ccSEli Cohen {
1935cc8e27ccSEli Cohen 	const struct net_device_ops *ops = dev->netdev_ops;
1936cc8e27ccSEli Cohen 
1937cc8e27ccSEli Cohen 	return ops->ndo_set_vf_guid(dev, ivt->vf, ivt->guid, guid_type);
1938cc8e27ccSEli Cohen }
1939cc8e27ccSEli Cohen 
1940cc8e27ccSEli Cohen static int handle_vf_guid(struct net_device *dev, struct ifla_vf_guid *ivt, int guid_type)
1941cc8e27ccSEli Cohen {
1942cc8e27ccSEli Cohen 	if (dev->type != ARPHRD_INFINIBAND)
1943cc8e27ccSEli Cohen 		return -EOPNOTSUPP;
1944cc8e27ccSEli Cohen 
1945cc8e27ccSEli Cohen 	return handle_infiniband_guid(dev, ivt, guid_type);
1946cc8e27ccSEli Cohen }
1947cc8e27ccSEli Cohen 
19484f7d2cdfSDaniel Borkmann static int do_setvfinfo(struct net_device *dev, struct nlattr **tb)
1949c02db8c6SChris Wright {
1950c02db8c6SChris Wright 	const struct net_device_ops *ops = dev->netdev_ops;
19514f7d2cdfSDaniel Borkmann 	int err = -EINVAL;
1952c02db8c6SChris Wright 
19534f7d2cdfSDaniel Borkmann 	if (tb[IFLA_VF_MAC]) {
19544f7d2cdfSDaniel Borkmann 		struct ifla_vf_mac *ivm = nla_data(tb[IFLA_VF_MAC]);
19554f7d2cdfSDaniel Borkmann 
1956c02db8c6SChris Wright 		err = -EOPNOTSUPP;
1957c02db8c6SChris Wright 		if (ops->ndo_set_vf_mac)
1958c02db8c6SChris Wright 			err = ops->ndo_set_vf_mac(dev, ivm->vf,
1959c02db8c6SChris Wright 						  ivm->mac);
19604f7d2cdfSDaniel Borkmann 		if (err < 0)
19614f7d2cdfSDaniel Borkmann 			return err;
1962c02db8c6SChris Wright 	}
19634f7d2cdfSDaniel Borkmann 
19644f7d2cdfSDaniel Borkmann 	if (tb[IFLA_VF_VLAN]) {
19654f7d2cdfSDaniel Borkmann 		struct ifla_vf_vlan *ivv = nla_data(tb[IFLA_VF_VLAN]);
19664f7d2cdfSDaniel Borkmann 
1967c02db8c6SChris Wright 		err = -EOPNOTSUPP;
1968c02db8c6SChris Wright 		if (ops->ndo_set_vf_vlan)
19694f7d2cdfSDaniel Borkmann 			err = ops->ndo_set_vf_vlan(dev, ivv->vf, ivv->vlan,
197079aab093SMoshe Shemesh 						   ivv->qos,
197179aab093SMoshe Shemesh 						   htons(ETH_P_8021Q));
197279aab093SMoshe Shemesh 		if (err < 0)
197379aab093SMoshe Shemesh 			return err;
197479aab093SMoshe Shemesh 	}
197579aab093SMoshe Shemesh 
197679aab093SMoshe Shemesh 	if (tb[IFLA_VF_VLAN_LIST]) {
197779aab093SMoshe Shemesh 		struct ifla_vf_vlan_info *ivvl[MAX_VLAN_LIST_LEN];
197879aab093SMoshe Shemesh 		struct nlattr *attr;
197979aab093SMoshe Shemesh 		int rem, len = 0;
198079aab093SMoshe Shemesh 
198179aab093SMoshe Shemesh 		err = -EOPNOTSUPP;
198279aab093SMoshe Shemesh 		if (!ops->ndo_set_vf_vlan)
198379aab093SMoshe Shemesh 			return err;
198479aab093SMoshe Shemesh 
198579aab093SMoshe Shemesh 		nla_for_each_nested(attr, tb[IFLA_VF_VLAN_LIST], rem) {
198679aab093SMoshe Shemesh 			if (nla_type(attr) != IFLA_VF_VLAN_INFO ||
198779aab093SMoshe Shemesh 			    nla_len(attr) < NLA_HDRLEN) {
198879aab093SMoshe Shemesh 				return -EINVAL;
198979aab093SMoshe Shemesh 			}
199079aab093SMoshe Shemesh 			if (len >= MAX_VLAN_LIST_LEN)
199179aab093SMoshe Shemesh 				return -EOPNOTSUPP;
199279aab093SMoshe Shemesh 			ivvl[len] = nla_data(attr);
199379aab093SMoshe Shemesh 
199479aab093SMoshe Shemesh 			len++;
199579aab093SMoshe Shemesh 		}
1996fa34cd94SArnd Bergmann 		if (len == 0)
1997fa34cd94SArnd Bergmann 			return -EINVAL;
1998fa34cd94SArnd Bergmann 
199979aab093SMoshe Shemesh 		err = ops->ndo_set_vf_vlan(dev, ivvl[0]->vf, ivvl[0]->vlan,
200079aab093SMoshe Shemesh 					   ivvl[0]->qos, ivvl[0]->vlan_proto);
20014f7d2cdfSDaniel Borkmann 		if (err < 0)
20024f7d2cdfSDaniel Borkmann 			return err;
2003c02db8c6SChris Wright 	}
20044f7d2cdfSDaniel Borkmann 
20054f7d2cdfSDaniel Borkmann 	if (tb[IFLA_VF_TX_RATE]) {
20064f7d2cdfSDaniel Borkmann 		struct ifla_vf_tx_rate *ivt = nla_data(tb[IFLA_VF_TX_RATE]);
2007ed616689SSucheta Chakraborty 		struct ifla_vf_info ivf;
20084f7d2cdfSDaniel Borkmann 
2009c02db8c6SChris Wright 		err = -EOPNOTSUPP;
2010ed616689SSucheta Chakraborty 		if (ops->ndo_get_vf_config)
20114f7d2cdfSDaniel Borkmann 			err = ops->ndo_get_vf_config(dev, ivt->vf, &ivf);
20124f7d2cdfSDaniel Borkmann 		if (err < 0)
20134f7d2cdfSDaniel Borkmann 			return err;
20144f7d2cdfSDaniel Borkmann 
2015ed616689SSucheta Chakraborty 		err = -EOPNOTSUPP;
2016ed616689SSucheta Chakraborty 		if (ops->ndo_set_vf_rate)
2017ed616689SSucheta Chakraborty 			err = ops->ndo_set_vf_rate(dev, ivt->vf,
2018ed616689SSucheta Chakraborty 						   ivf.min_tx_rate,
2019c02db8c6SChris Wright 						   ivt->rate);
20204f7d2cdfSDaniel Borkmann 		if (err < 0)
20214f7d2cdfSDaniel Borkmann 			return err;
2022c02db8c6SChris Wright 	}
20234f7d2cdfSDaniel Borkmann 
20244f7d2cdfSDaniel Borkmann 	if (tb[IFLA_VF_RATE]) {
20254f7d2cdfSDaniel Borkmann 		struct ifla_vf_rate *ivt = nla_data(tb[IFLA_VF_RATE]);
20264f7d2cdfSDaniel Borkmann 
2027ed616689SSucheta Chakraborty 		err = -EOPNOTSUPP;
2028ed616689SSucheta Chakraborty 		if (ops->ndo_set_vf_rate)
2029ed616689SSucheta Chakraborty 			err = ops->ndo_set_vf_rate(dev, ivt->vf,
2030ed616689SSucheta Chakraborty 						   ivt->min_tx_rate,
2031ed616689SSucheta Chakraborty 						   ivt->max_tx_rate);
20324f7d2cdfSDaniel Borkmann 		if (err < 0)
20334f7d2cdfSDaniel Borkmann 			return err;
2034ed616689SSucheta Chakraborty 	}
20354f7d2cdfSDaniel Borkmann 
20364f7d2cdfSDaniel Borkmann 	if (tb[IFLA_VF_SPOOFCHK]) {
20374f7d2cdfSDaniel Borkmann 		struct ifla_vf_spoofchk *ivs = nla_data(tb[IFLA_VF_SPOOFCHK]);
20384f7d2cdfSDaniel Borkmann 
20395f8444a3SGreg Rose 		err = -EOPNOTSUPP;
20405f8444a3SGreg Rose 		if (ops->ndo_set_vf_spoofchk)
20415f8444a3SGreg Rose 			err = ops->ndo_set_vf_spoofchk(dev, ivs->vf,
20425f8444a3SGreg Rose 						       ivs->setting);
20434f7d2cdfSDaniel Borkmann 		if (err < 0)
20444f7d2cdfSDaniel Borkmann 			return err;
20455f8444a3SGreg Rose 	}
20464f7d2cdfSDaniel Borkmann 
20474f7d2cdfSDaniel Borkmann 	if (tb[IFLA_VF_LINK_STATE]) {
20484f7d2cdfSDaniel Borkmann 		struct ifla_vf_link_state *ivl = nla_data(tb[IFLA_VF_LINK_STATE]);
20494f7d2cdfSDaniel Borkmann 
20501d8faf48SRony Efraim 		err = -EOPNOTSUPP;
20511d8faf48SRony Efraim 		if (ops->ndo_set_vf_link_state)
20521d8faf48SRony Efraim 			err = ops->ndo_set_vf_link_state(dev, ivl->vf,
20531d8faf48SRony Efraim 							 ivl->link_state);
20544f7d2cdfSDaniel Borkmann 		if (err < 0)
20554f7d2cdfSDaniel Borkmann 			return err;
20561d8faf48SRony Efraim 	}
20574f7d2cdfSDaniel Borkmann 
20584f7d2cdfSDaniel Borkmann 	if (tb[IFLA_VF_RSS_QUERY_EN]) {
205901a3d796SVlad Zolotarov 		struct ifla_vf_rss_query_en *ivrssq_en;
206001a3d796SVlad Zolotarov 
206101a3d796SVlad Zolotarov 		err = -EOPNOTSUPP;
20624f7d2cdfSDaniel Borkmann 		ivrssq_en = nla_data(tb[IFLA_VF_RSS_QUERY_EN]);
206301a3d796SVlad Zolotarov 		if (ops->ndo_set_vf_rss_query_en)
20644f7d2cdfSDaniel Borkmann 			err = ops->ndo_set_vf_rss_query_en(dev, ivrssq_en->vf,
206501a3d796SVlad Zolotarov 							   ivrssq_en->setting);
20664f7d2cdfSDaniel Borkmann 		if (err < 0)
20674f7d2cdfSDaniel Borkmann 			return err;
206801a3d796SVlad Zolotarov 	}
20694f7d2cdfSDaniel Borkmann 
2070dd461d6aSHiroshi Shimamoto 	if (tb[IFLA_VF_TRUST]) {
2071dd461d6aSHiroshi Shimamoto 		struct ifla_vf_trust *ivt = nla_data(tb[IFLA_VF_TRUST]);
2072dd461d6aSHiroshi Shimamoto 
2073dd461d6aSHiroshi Shimamoto 		err = -EOPNOTSUPP;
2074dd461d6aSHiroshi Shimamoto 		if (ops->ndo_set_vf_trust)
2075dd461d6aSHiroshi Shimamoto 			err = ops->ndo_set_vf_trust(dev, ivt->vf, ivt->setting);
2076dd461d6aSHiroshi Shimamoto 		if (err < 0)
2077dd461d6aSHiroshi Shimamoto 			return err;
2078dd461d6aSHiroshi Shimamoto 	}
2079dd461d6aSHiroshi Shimamoto 
2080cc8e27ccSEli Cohen 	if (tb[IFLA_VF_IB_NODE_GUID]) {
2081cc8e27ccSEli Cohen 		struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_NODE_GUID]);
2082cc8e27ccSEli Cohen 
2083cc8e27ccSEli Cohen 		if (!ops->ndo_set_vf_guid)
2084cc8e27ccSEli Cohen 			return -EOPNOTSUPP;
2085cc8e27ccSEli Cohen 
2086cc8e27ccSEli Cohen 		return handle_vf_guid(dev, ivt, IFLA_VF_IB_NODE_GUID);
2087cc8e27ccSEli Cohen 	}
2088cc8e27ccSEli Cohen 
2089cc8e27ccSEli Cohen 	if (tb[IFLA_VF_IB_PORT_GUID]) {
2090cc8e27ccSEli Cohen 		struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_PORT_GUID]);
2091cc8e27ccSEli Cohen 
2092cc8e27ccSEli Cohen 		if (!ops->ndo_set_vf_guid)
2093cc8e27ccSEli Cohen 			return -EOPNOTSUPP;
2094cc8e27ccSEli Cohen 
2095cc8e27ccSEli Cohen 		return handle_vf_guid(dev, ivt, IFLA_VF_IB_PORT_GUID);
2096cc8e27ccSEli Cohen 	}
2097cc8e27ccSEli Cohen 
2098c02db8c6SChris Wright 	return err;
2099c02db8c6SChris Wright }
2100c02db8c6SChris Wright 
210133eaf2a6SDavid Ahern static int do_set_master(struct net_device *dev, int ifindex,
210233eaf2a6SDavid Ahern 			 struct netlink_ext_ack *extack)
2103fbaec0eaSJiri Pirko {
2104898e5061SJiri Pirko 	struct net_device *upper_dev = netdev_master_upper_dev_get(dev);
2105fbaec0eaSJiri Pirko 	const struct net_device_ops *ops;
2106fbaec0eaSJiri Pirko 	int err;
2107fbaec0eaSJiri Pirko 
2108898e5061SJiri Pirko 	if (upper_dev) {
2109898e5061SJiri Pirko 		if (upper_dev->ifindex == ifindex)
2110fbaec0eaSJiri Pirko 			return 0;
2111898e5061SJiri Pirko 		ops = upper_dev->netdev_ops;
2112fbaec0eaSJiri Pirko 		if (ops->ndo_del_slave) {
2113898e5061SJiri Pirko 			err = ops->ndo_del_slave(upper_dev, dev);
2114fbaec0eaSJiri Pirko 			if (err)
2115fbaec0eaSJiri Pirko 				return err;
2116fbaec0eaSJiri Pirko 		} else {
2117fbaec0eaSJiri Pirko 			return -EOPNOTSUPP;
2118fbaec0eaSJiri Pirko 		}
2119fbaec0eaSJiri Pirko 	}
2120fbaec0eaSJiri Pirko 
2121fbaec0eaSJiri Pirko 	if (ifindex) {
2122898e5061SJiri Pirko 		upper_dev = __dev_get_by_index(dev_net(dev), ifindex);
2123898e5061SJiri Pirko 		if (!upper_dev)
2124fbaec0eaSJiri Pirko 			return -EINVAL;
2125898e5061SJiri Pirko 		ops = upper_dev->netdev_ops;
2126fbaec0eaSJiri Pirko 		if (ops->ndo_add_slave) {
212733eaf2a6SDavid Ahern 			err = ops->ndo_add_slave(upper_dev, dev, extack);
2128fbaec0eaSJiri Pirko 			if (err)
2129fbaec0eaSJiri Pirko 				return err;
2130fbaec0eaSJiri Pirko 		} else {
2131fbaec0eaSJiri Pirko 			return -EOPNOTSUPP;
2132fbaec0eaSJiri Pirko 		}
2133fbaec0eaSJiri Pirko 	}
2134fbaec0eaSJiri Pirko 	return 0;
2135fbaec0eaSJiri Pirko }
2136fbaec0eaSJiri Pirko 
213790c325e3SNicolas Dichtel #define DO_SETLINK_MODIFIED	0x01
2138ba998906SNicolas Dichtel /* notify flag means notify + modified. */
2139ba998906SNicolas Dichtel #define DO_SETLINK_NOTIFY	0x03
214090f62cf3SEric W. Biederman static int do_setlink(const struct sk_buff *skb,
214190f62cf3SEric W. Biederman 		      struct net_device *dev, struct ifinfomsg *ifm,
2142ddf9f970SJakub Kicinski 		      struct netlink_ext_ack *extack,
214390c325e3SNicolas Dichtel 		      struct nlattr **tb, char *ifname, int status)
21440157f60cSPatrick McHardy {
2145d314774cSStephen Hemminger 	const struct net_device_ops *ops = dev->netdev_ops;
21460157f60cSPatrick McHardy 	int err;
21470157f60cSPatrick McHardy 
2148f0630529SEric W. Biederman 	if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD]) {
214981adee47SEric W. Biederman 		struct net *net = rtnl_link_get_net(dev_net(dev), tb);
2150d8a5ec67SEric W. Biederman 		if (IS_ERR(net)) {
2151d8a5ec67SEric W. Biederman 			err = PTR_ERR(net);
2152d8a5ec67SEric W. Biederman 			goto errout;
2153d8a5ec67SEric W. Biederman 		}
215490f62cf3SEric W. Biederman 		if (!netlink_ns_capable(skb, net->user_ns, CAP_NET_ADMIN)) {
2155e0ebde0eSNicolas Dichtel 			put_net(net);
2156b51642f6SEric W. Biederman 			err = -EPERM;
2157b51642f6SEric W. Biederman 			goto errout;
2158b51642f6SEric W. Biederman 		}
2159d8a5ec67SEric W. Biederman 		err = dev_change_net_namespace(dev, net, ifname);
2160d8a5ec67SEric W. Biederman 		put_net(net);
2161d8a5ec67SEric W. Biederman 		if (err)
2162d8a5ec67SEric W. Biederman 			goto errout;
216390c325e3SNicolas Dichtel 		status |= DO_SETLINK_MODIFIED;
2164d8a5ec67SEric W. Biederman 	}
2165d8a5ec67SEric W. Biederman 
21660157f60cSPatrick McHardy 	if (tb[IFLA_MAP]) {
21670157f60cSPatrick McHardy 		struct rtnl_link_ifmap *u_map;
21680157f60cSPatrick McHardy 		struct ifmap k_map;
21690157f60cSPatrick McHardy 
2170d314774cSStephen Hemminger 		if (!ops->ndo_set_config) {
21710157f60cSPatrick McHardy 			err = -EOPNOTSUPP;
21720157f60cSPatrick McHardy 			goto errout;
21730157f60cSPatrick McHardy 		}
21740157f60cSPatrick McHardy 
21750157f60cSPatrick McHardy 		if (!netif_device_present(dev)) {
21760157f60cSPatrick McHardy 			err = -ENODEV;
21770157f60cSPatrick McHardy 			goto errout;
21780157f60cSPatrick McHardy 		}
21790157f60cSPatrick McHardy 
21800157f60cSPatrick McHardy 		u_map = nla_data(tb[IFLA_MAP]);
21810157f60cSPatrick McHardy 		k_map.mem_start = (unsigned long) u_map->mem_start;
21820157f60cSPatrick McHardy 		k_map.mem_end = (unsigned long) u_map->mem_end;
21830157f60cSPatrick McHardy 		k_map.base_addr = (unsigned short) u_map->base_addr;
21840157f60cSPatrick McHardy 		k_map.irq = (unsigned char) u_map->irq;
21850157f60cSPatrick McHardy 		k_map.dma = (unsigned char) u_map->dma;
21860157f60cSPatrick McHardy 		k_map.port = (unsigned char) u_map->port;
21870157f60cSPatrick McHardy 
2188d314774cSStephen Hemminger 		err = ops->ndo_set_config(dev, &k_map);
21890157f60cSPatrick McHardy 		if (err < 0)
21900157f60cSPatrick McHardy 			goto errout;
21910157f60cSPatrick McHardy 
2192ba998906SNicolas Dichtel 		status |= DO_SETLINK_NOTIFY;
21930157f60cSPatrick McHardy 	}
21940157f60cSPatrick McHardy 
21950157f60cSPatrick McHardy 	if (tb[IFLA_ADDRESS]) {
21960157f60cSPatrick McHardy 		struct sockaddr *sa;
21970157f60cSPatrick McHardy 		int len;
21980157f60cSPatrick McHardy 
2199153711f9SWANG Cong 		len = sizeof(sa_family_t) + max_t(size_t, dev->addr_len,
2200153711f9SWANG Cong 						  sizeof(*sa));
22010157f60cSPatrick McHardy 		sa = kmalloc(len, GFP_KERNEL);
22020157f60cSPatrick McHardy 		if (!sa) {
22030157f60cSPatrick McHardy 			err = -ENOMEM;
22040157f60cSPatrick McHardy 			goto errout;
22050157f60cSPatrick McHardy 		}
22060157f60cSPatrick McHardy 		sa->sa_family = dev->type;
22070157f60cSPatrick McHardy 		memcpy(sa->sa_data, nla_data(tb[IFLA_ADDRESS]),
22080157f60cSPatrick McHardy 		       dev->addr_len);
2209e7c3273eSJiri Pirko 		err = dev_set_mac_address(dev, sa);
22100157f60cSPatrick McHardy 		kfree(sa);
22110157f60cSPatrick McHardy 		if (err)
22120157f60cSPatrick McHardy 			goto errout;
221390c325e3SNicolas Dichtel 		status |= DO_SETLINK_MODIFIED;
22140157f60cSPatrick McHardy 	}
22150157f60cSPatrick McHardy 
22160157f60cSPatrick McHardy 	if (tb[IFLA_MTU]) {
22170157f60cSPatrick McHardy 		err = dev_set_mtu(dev, nla_get_u32(tb[IFLA_MTU]));
22180157f60cSPatrick McHardy 		if (err < 0)
22190157f60cSPatrick McHardy 			goto errout;
222090c325e3SNicolas Dichtel 		status |= DO_SETLINK_MODIFIED;
22210157f60cSPatrick McHardy 	}
22220157f60cSPatrick McHardy 
2223cbda10faSVlad Dogaru 	if (tb[IFLA_GROUP]) {
2224cbda10faSVlad Dogaru 		dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP]));
2225ba998906SNicolas Dichtel 		status |= DO_SETLINK_NOTIFY;
2226cbda10faSVlad Dogaru 	}
2227cbda10faSVlad Dogaru 
22280157f60cSPatrick McHardy 	/*
22290157f60cSPatrick McHardy 	 * Interface selected by interface index but interface
22300157f60cSPatrick McHardy 	 * name provided implies that a name change has been
22310157f60cSPatrick McHardy 	 * requested.
22320157f60cSPatrick McHardy 	 */
22330157f60cSPatrick McHardy 	if (ifm->ifi_index > 0 && ifname[0]) {
22340157f60cSPatrick McHardy 		err = dev_change_name(dev, ifname);
22350157f60cSPatrick McHardy 		if (err < 0)
22360157f60cSPatrick McHardy 			goto errout;
223790c325e3SNicolas Dichtel 		status |= DO_SETLINK_MODIFIED;
22380157f60cSPatrick McHardy 	}
22390157f60cSPatrick McHardy 
22400b815a1aSStephen Hemminger 	if (tb[IFLA_IFALIAS]) {
22410b815a1aSStephen Hemminger 		err = dev_set_alias(dev, nla_data(tb[IFLA_IFALIAS]),
22420b815a1aSStephen Hemminger 				    nla_len(tb[IFLA_IFALIAS]));
22430b815a1aSStephen Hemminger 		if (err < 0)
22440b815a1aSStephen Hemminger 			goto errout;
2245ba998906SNicolas Dichtel 		status |= DO_SETLINK_NOTIFY;
22460b815a1aSStephen Hemminger 	}
22470b815a1aSStephen Hemminger 
22480157f60cSPatrick McHardy 	if (tb[IFLA_BROADCAST]) {
22490157f60cSPatrick McHardy 		nla_memcpy(dev->broadcast, tb[IFLA_BROADCAST], dev->addr_len);
2250e7c3273eSJiri Pirko 		call_netdevice_notifiers(NETDEV_CHANGEADDR, dev);
22510157f60cSPatrick McHardy 	}
22520157f60cSPatrick McHardy 
22530157f60cSPatrick McHardy 	if (ifm->ifi_flags || ifm->ifi_change) {
22543729d502SPatrick McHardy 		err = dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm));
22555f9021cfSJohannes Berg 		if (err < 0)
22565f9021cfSJohannes Berg 			goto errout;
22570157f60cSPatrick McHardy 	}
22580157f60cSPatrick McHardy 
2259fbaec0eaSJiri Pirko 	if (tb[IFLA_MASTER]) {
226033eaf2a6SDavid Ahern 		err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]), extack);
2261fbaec0eaSJiri Pirko 		if (err)
2262fbaec0eaSJiri Pirko 			goto errout;
226390c325e3SNicolas Dichtel 		status |= DO_SETLINK_MODIFIED;
2264fbaec0eaSJiri Pirko 	}
2265fbaec0eaSJiri Pirko 
22669a57247fSJiri Pirko 	if (tb[IFLA_CARRIER]) {
22679a57247fSJiri Pirko 		err = dev_change_carrier(dev, nla_get_u8(tb[IFLA_CARRIER]));
22689a57247fSJiri Pirko 		if (err)
22699a57247fSJiri Pirko 			goto errout;
227090c325e3SNicolas Dichtel 		status |= DO_SETLINK_MODIFIED;
22719a57247fSJiri Pirko 	}
22729a57247fSJiri Pirko 
22735d1180fcSNicolas Dichtel 	if (tb[IFLA_TXQLEN]) {
22740cd29503SAlexey Dobriyan 		unsigned int value = nla_get_u32(tb[IFLA_TXQLEN]);
22750cd29503SAlexey Dobriyan 		unsigned int orig_len = dev->tx_queue_len;
22765d1180fcSNicolas Dichtel 
227708294a26SJason Wang 		if (dev->tx_queue_len ^ value) {
22785d1180fcSNicolas Dichtel 			dev->tx_queue_len = value;
227908294a26SJason Wang 			err = call_netdevice_notifiers(
228008294a26SJason Wang 			      NETDEV_CHANGE_TX_QUEUE_LEN, dev);
228108294a26SJason Wang 			err = notifier_to_errno(err);
228208294a26SJason Wang 			if (err) {
228308294a26SJason Wang 				dev->tx_queue_len = orig_len;
228408294a26SJason Wang 				goto errout;
228508294a26SJason Wang 			}
22862d7f669bSXin Long 			status |= DO_SETLINK_MODIFIED;
228708294a26SJason Wang 		}
22885d1180fcSNicolas Dichtel 	}
22890157f60cSPatrick McHardy 
22900157f60cSPatrick McHardy 	if (tb[IFLA_OPERSTATE])
229193b2d4a2SDavid S. Miller 		set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE]));
22920157f60cSPatrick McHardy 
22930157f60cSPatrick McHardy 	if (tb[IFLA_LINKMODE]) {
22941889b0e7SNicolas Dichtel 		unsigned char value = nla_get_u8(tb[IFLA_LINKMODE]);
22951889b0e7SNicolas Dichtel 
22960157f60cSPatrick McHardy 		write_lock_bh(&dev_base_lock);
22971889b0e7SNicolas Dichtel 		if (dev->link_mode ^ value)
2298ba998906SNicolas Dichtel 			status |= DO_SETLINK_NOTIFY;
22991889b0e7SNicolas Dichtel 		dev->link_mode = value;
230093b2d4a2SDavid S. Miller 		write_unlock_bh(&dev_base_lock);
23010157f60cSPatrick McHardy 	}
23020157f60cSPatrick McHardy 
2303c02db8c6SChris Wright 	if (tb[IFLA_VFINFO_LIST]) {
23044f7d2cdfSDaniel Borkmann 		struct nlattr *vfinfo[IFLA_VF_MAX + 1];
2305c02db8c6SChris Wright 		struct nlattr *attr;
2306c02db8c6SChris Wright 		int rem;
23074f7d2cdfSDaniel Borkmann 
2308c02db8c6SChris Wright 		nla_for_each_nested(attr, tb[IFLA_VFINFO_LIST], rem) {
23094f7d2cdfSDaniel Borkmann 			if (nla_type(attr) != IFLA_VF_INFO ||
23104f7d2cdfSDaniel Borkmann 			    nla_len(attr) < NLA_HDRLEN) {
2311253683bbSDavid Howells 				err = -EINVAL;
2312c02db8c6SChris Wright 				goto errout;
2313253683bbSDavid Howells 			}
23144f7d2cdfSDaniel Borkmann 			err = nla_parse_nested(vfinfo, IFLA_VF_MAX, attr,
2315fceb6435SJohannes Berg 					       ifla_vf_policy, NULL);
23164f7d2cdfSDaniel Borkmann 			if (err < 0)
23174f7d2cdfSDaniel Borkmann 				goto errout;
23184f7d2cdfSDaniel Borkmann 			err = do_setvfinfo(dev, vfinfo);
2319ebc08a6fSWilliams, Mitch A 			if (err < 0)
2320ebc08a6fSWilliams, Mitch A 				goto errout;
2321ba998906SNicolas Dichtel 			status |= DO_SETLINK_NOTIFY;
2322ebc08a6fSWilliams, Mitch A 		}
2323ebc08a6fSWilliams, Mitch A 	}
23240157f60cSPatrick McHardy 	err = 0;
23250157f60cSPatrick McHardy 
232657b61080SScott Feldman 	if (tb[IFLA_VF_PORTS]) {
232757b61080SScott Feldman 		struct nlattr *port[IFLA_PORT_MAX+1];
232857b61080SScott Feldman 		struct nlattr *attr;
232957b61080SScott Feldman 		int vf;
233057b61080SScott Feldman 		int rem;
233157b61080SScott Feldman 
233257b61080SScott Feldman 		err = -EOPNOTSUPP;
233357b61080SScott Feldman 		if (!ops->ndo_set_vf_port)
233457b61080SScott Feldman 			goto errout;
233557b61080SScott Feldman 
233657b61080SScott Feldman 		nla_for_each_nested(attr, tb[IFLA_VF_PORTS], rem) {
2337035d210fSDaniel Borkmann 			if (nla_type(attr) != IFLA_VF_PORT ||
2338035d210fSDaniel Borkmann 			    nla_len(attr) < NLA_HDRLEN) {
2339035d210fSDaniel Borkmann 				err = -EINVAL;
2340035d210fSDaniel Borkmann 				goto errout;
2341035d210fSDaniel Borkmann 			}
2342035d210fSDaniel Borkmann 			err = nla_parse_nested(port, IFLA_PORT_MAX, attr,
2343fceb6435SJohannes Berg 					       ifla_port_policy, NULL);
234457b61080SScott Feldman 			if (err < 0)
234557b61080SScott Feldman 				goto errout;
234657b61080SScott Feldman 			if (!port[IFLA_PORT_VF]) {
234757b61080SScott Feldman 				err = -EOPNOTSUPP;
234857b61080SScott Feldman 				goto errout;
234957b61080SScott Feldman 			}
235057b61080SScott Feldman 			vf = nla_get_u32(port[IFLA_PORT_VF]);
235157b61080SScott Feldman 			err = ops->ndo_set_vf_port(dev, vf, port);
235257b61080SScott Feldman 			if (err < 0)
235357b61080SScott Feldman 				goto errout;
2354ba998906SNicolas Dichtel 			status |= DO_SETLINK_NOTIFY;
235557b61080SScott Feldman 		}
235657b61080SScott Feldman 	}
235757b61080SScott Feldman 	err = 0;
235857b61080SScott Feldman 
235957b61080SScott Feldman 	if (tb[IFLA_PORT_SELF]) {
236057b61080SScott Feldman 		struct nlattr *port[IFLA_PORT_MAX+1];
236157b61080SScott Feldman 
236257b61080SScott Feldman 		err = nla_parse_nested(port, IFLA_PORT_MAX,
2363fceb6435SJohannes Berg 				       tb[IFLA_PORT_SELF], ifla_port_policy,
2364fceb6435SJohannes Berg 				       NULL);
236557b61080SScott Feldman 		if (err < 0)
236657b61080SScott Feldman 			goto errout;
236757b61080SScott Feldman 
236857b61080SScott Feldman 		err = -EOPNOTSUPP;
236957b61080SScott Feldman 		if (ops->ndo_set_vf_port)
237057b61080SScott Feldman 			err = ops->ndo_set_vf_port(dev, PORT_SELF_VF, port);
237157b61080SScott Feldman 		if (err < 0)
237257b61080SScott Feldman 			goto errout;
2373ba998906SNicolas Dichtel 		status |= DO_SETLINK_NOTIFY;
237457b61080SScott Feldman 	}
2375f8ff182cSThomas Graf 
2376f8ff182cSThomas Graf 	if (tb[IFLA_AF_SPEC]) {
2377f8ff182cSThomas Graf 		struct nlattr *af;
2378f8ff182cSThomas Graf 		int rem;
2379f8ff182cSThomas Graf 
2380f8ff182cSThomas Graf 		nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) {
2381f8ff182cSThomas Graf 			const struct rtnl_af_ops *af_ops;
2382f8ff182cSThomas Graf 
23835fa85a09SFlorian Westphal 			rcu_read_lock();
23845fa85a09SFlorian Westphal 
2385058c8d59SGustavo A. R. Silva 			BUG_ON(!(af_ops = rtnl_af_lookup(nla_type(af))));
2386f8ff182cSThomas Graf 
2387cf7afbfeSThomas Graf 			err = af_ops->set_link_af(dev, af);
23885fa85a09SFlorian Westphal 			if (err < 0) {
23895fa85a09SFlorian Westphal 				rcu_read_unlock();
2390f8ff182cSThomas Graf 				goto errout;
23915fa85a09SFlorian Westphal 			}
2392f8ff182cSThomas Graf 
23935fa85a09SFlorian Westphal 			rcu_read_unlock();
2394ba998906SNicolas Dichtel 			status |= DO_SETLINK_NOTIFY;
2395f8ff182cSThomas Graf 		}
2396f8ff182cSThomas Graf 	}
239757b61080SScott Feldman 	err = 0;
239857b61080SScott Feldman 
239988d6378bSAnuradha Karuppiah 	if (tb[IFLA_PROTO_DOWN]) {
240088d6378bSAnuradha Karuppiah 		err = dev_change_proto_down(dev,
240188d6378bSAnuradha Karuppiah 					    nla_get_u8(tb[IFLA_PROTO_DOWN]));
240288d6378bSAnuradha Karuppiah 		if (err)
240388d6378bSAnuradha Karuppiah 			goto errout;
240488d6378bSAnuradha Karuppiah 		status |= DO_SETLINK_NOTIFY;
240588d6378bSAnuradha Karuppiah 	}
240688d6378bSAnuradha Karuppiah 
2407d1fdd913SBrenden Blanco 	if (tb[IFLA_XDP]) {
2408d1fdd913SBrenden Blanco 		struct nlattr *xdp[IFLA_XDP_MAX + 1];
240985de8576SDaniel Borkmann 		u32 xdp_flags = 0;
2410d1fdd913SBrenden Blanco 
2411d1fdd913SBrenden Blanco 		err = nla_parse_nested(xdp, IFLA_XDP_MAX, tb[IFLA_XDP],
2412fceb6435SJohannes Berg 				       ifla_xdp_policy, NULL);
2413d1fdd913SBrenden Blanco 		if (err < 0)
2414d1fdd913SBrenden Blanco 			goto errout;
2415d1fdd913SBrenden Blanco 
241658038695SMartin KaFai Lau 		if (xdp[IFLA_XDP_ATTACHED] || xdp[IFLA_XDP_PROG_ID]) {
2417262d8625SBrenden Blanco 			err = -EINVAL;
2418262d8625SBrenden Blanco 			goto errout;
2419262d8625SBrenden Blanco 		}
242085de8576SDaniel Borkmann 
242185de8576SDaniel Borkmann 		if (xdp[IFLA_XDP_FLAGS]) {
242285de8576SDaniel Borkmann 			xdp_flags = nla_get_u32(xdp[IFLA_XDP_FLAGS]);
242385de8576SDaniel Borkmann 			if (xdp_flags & ~XDP_FLAGS_MASK) {
242485de8576SDaniel Borkmann 				err = -EINVAL;
242585de8576SDaniel Borkmann 				goto errout;
242685de8576SDaniel Borkmann 			}
2427ee5d032fSJakub Kicinski 			if (hweight32(xdp_flags & XDP_FLAGS_MODES) > 1) {
24280489df9aSDaniel Borkmann 				err = -EINVAL;
24290489df9aSDaniel Borkmann 				goto errout;
24300489df9aSDaniel Borkmann 			}
243185de8576SDaniel Borkmann 		}
243285de8576SDaniel Borkmann 
2433d1fdd913SBrenden Blanco 		if (xdp[IFLA_XDP_FD]) {
2434ddf9f970SJakub Kicinski 			err = dev_change_xdp_fd(dev, extack,
243585de8576SDaniel Borkmann 						nla_get_s32(xdp[IFLA_XDP_FD]),
243685de8576SDaniel Borkmann 						xdp_flags);
2437d1fdd913SBrenden Blanco 			if (err)
2438d1fdd913SBrenden Blanco 				goto errout;
2439d1fdd913SBrenden Blanco 			status |= DO_SETLINK_NOTIFY;
2440d1fdd913SBrenden Blanco 		}
2441d1fdd913SBrenden Blanco 	}
2442d1fdd913SBrenden Blanco 
24430157f60cSPatrick McHardy errout:
2444ba998906SNicolas Dichtel 	if (status & DO_SETLINK_MODIFIED) {
244564ff90ccSXin Long 		if ((status & DO_SETLINK_NOTIFY) == DO_SETLINK_NOTIFY)
2446ba998906SNicolas Dichtel 			netdev_state_change(dev);
2447ba998906SNicolas Dichtel 
2448ba998906SNicolas Dichtel 		if (err < 0)
2449e87cc472SJoe Perches 			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",
2450e87cc472SJoe Perches 					     dev->name);
2451ba998906SNicolas Dichtel 	}
24520157f60cSPatrick McHardy 
24530157f60cSPatrick McHardy 	return err;
24540157f60cSPatrick McHardy }
24550157f60cSPatrick McHardy 
2456c21ef3e3SDavid Ahern static int rtnl_setlink(struct sk_buff *skb, struct nlmsghdr *nlh,
2457c21ef3e3SDavid Ahern 			struct netlink_ext_ack *extack)
2458da5e0494SThomas Graf {
24593b1e0a65SYOSHIFUJI Hideaki 	struct net *net = sock_net(skb->sk);
2460da5e0494SThomas Graf 	struct ifinfomsg *ifm;
2461da5e0494SThomas Graf 	struct net_device *dev;
24620157f60cSPatrick McHardy 	int err;
2463da5e0494SThomas Graf 	struct nlattr *tb[IFLA_MAX+1];
24641da177e4SLinus Torvalds 	char ifname[IFNAMSIZ];
24651da177e4SLinus Torvalds 
2466c21ef3e3SDavid Ahern 	err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy,
2467c21ef3e3SDavid Ahern 			  extack);
2468da5e0494SThomas Graf 	if (err < 0)
2469da5e0494SThomas Graf 		goto errout;
24701da177e4SLinus Torvalds 
247179e1ad14SJiri Benc 	if (tb[IFLA_IF_NETNSID])
247279e1ad14SJiri Benc 		return -EOPNOTSUPP;
247379e1ad14SJiri Benc 
24745176f91eSThomas Graf 	if (tb[IFLA_IFNAME])
24755176f91eSThomas Graf 		nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
247678e5b891SPatrick McHardy 	else
247778e5b891SPatrick McHardy 		ifname[0] = '\0';
24781da177e4SLinus Torvalds 
24791da177e4SLinus Torvalds 	err = -EINVAL;
2480da5e0494SThomas Graf 	ifm = nlmsg_data(nlh);
248151055be8SPatrick McHardy 	if (ifm->ifi_index > 0)
2482a3d12891SEric Dumazet 		dev = __dev_get_by_index(net, ifm->ifi_index);
2483da5e0494SThomas Graf 	else if (tb[IFLA_IFNAME])
2484a3d12891SEric Dumazet 		dev = __dev_get_by_name(net, ifname);
2485da5e0494SThomas Graf 	else
2486da5e0494SThomas Graf 		goto errout;
24871da177e4SLinus Torvalds 
2488da5e0494SThomas Graf 	if (dev == NULL) {
2489da5e0494SThomas Graf 		err = -ENODEV;
2490da5e0494SThomas Graf 		goto errout;
2491da5e0494SThomas Graf 	}
24921da177e4SLinus Torvalds 
2493e0d087afSEric Dumazet 	err = validate_linkmsg(dev, tb);
2494e0d087afSEric Dumazet 	if (err < 0)
2495a3d12891SEric Dumazet 		goto errout;
2496da5e0494SThomas Graf 
2497ddf9f970SJakub Kicinski 	err = do_setlink(skb, dev, ifm, extack, tb, ifname, 0);
2498da5e0494SThomas Graf errout:
24991da177e4SLinus Torvalds 	return err;
25001da177e4SLinus Torvalds }
25011da177e4SLinus Torvalds 
250266400d54SWANG Cong static int rtnl_group_dellink(const struct net *net, int group)
250366400d54SWANG Cong {
250466400d54SWANG Cong 	struct net_device *dev, *aux;
250566400d54SWANG Cong 	LIST_HEAD(list_kill);
250666400d54SWANG Cong 	bool found = false;
250766400d54SWANG Cong 
250866400d54SWANG Cong 	if (!group)
250966400d54SWANG Cong 		return -EPERM;
251066400d54SWANG Cong 
251166400d54SWANG Cong 	for_each_netdev(net, dev) {
251266400d54SWANG Cong 		if (dev->group == group) {
251366400d54SWANG Cong 			const struct rtnl_link_ops *ops;
251466400d54SWANG Cong 
251566400d54SWANG Cong 			found = true;
251666400d54SWANG Cong 			ops = dev->rtnl_link_ops;
251766400d54SWANG Cong 			if (!ops || !ops->dellink)
251866400d54SWANG Cong 				return -EOPNOTSUPP;
251966400d54SWANG Cong 		}
252066400d54SWANG Cong 	}
252166400d54SWANG Cong 
252266400d54SWANG Cong 	if (!found)
252366400d54SWANG Cong 		return -ENODEV;
252466400d54SWANG Cong 
252566400d54SWANG Cong 	for_each_netdev_safe(net, dev, aux) {
252666400d54SWANG Cong 		if (dev->group == group) {
252766400d54SWANG Cong 			const struct rtnl_link_ops *ops;
252866400d54SWANG Cong 
252966400d54SWANG Cong 			ops = dev->rtnl_link_ops;
253066400d54SWANG Cong 			ops->dellink(dev, &list_kill);
253166400d54SWANG Cong 		}
253266400d54SWANG Cong 	}
253366400d54SWANG Cong 	unregister_netdevice_many(&list_kill);
253466400d54SWANG Cong 
253566400d54SWANG Cong 	return 0;
253666400d54SWANG Cong }
253766400d54SWANG Cong 
2538614732eaSThomas Graf int rtnl_delete_link(struct net_device *dev)
2539614732eaSThomas Graf {
2540614732eaSThomas Graf 	const struct rtnl_link_ops *ops;
2541614732eaSThomas Graf 	LIST_HEAD(list_kill);
2542614732eaSThomas Graf 
2543614732eaSThomas Graf 	ops = dev->rtnl_link_ops;
2544614732eaSThomas Graf 	if (!ops || !ops->dellink)
2545614732eaSThomas Graf 		return -EOPNOTSUPP;
2546614732eaSThomas Graf 
2547614732eaSThomas Graf 	ops->dellink(dev, &list_kill);
2548614732eaSThomas Graf 	unregister_netdevice_many(&list_kill);
2549614732eaSThomas Graf 
2550614732eaSThomas Graf 	return 0;
2551614732eaSThomas Graf }
2552614732eaSThomas Graf EXPORT_SYMBOL_GPL(rtnl_delete_link);
2553614732eaSThomas Graf 
2554c21ef3e3SDavid Ahern static int rtnl_dellink(struct sk_buff *skb, struct nlmsghdr *nlh,
2555c21ef3e3SDavid Ahern 			struct netlink_ext_ack *extack)
255638f7b870SPatrick McHardy {
25573b1e0a65SYOSHIFUJI Hideaki 	struct net *net = sock_net(skb->sk);
255838f7b870SPatrick McHardy 	struct net_device *dev;
255938f7b870SPatrick McHardy 	struct ifinfomsg *ifm;
256038f7b870SPatrick McHardy 	char ifname[IFNAMSIZ];
256138f7b870SPatrick McHardy 	struct nlattr *tb[IFLA_MAX+1];
256238f7b870SPatrick McHardy 	int err;
256338f7b870SPatrick McHardy 
2564c21ef3e3SDavid Ahern 	err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack);
256538f7b870SPatrick McHardy 	if (err < 0)
256638f7b870SPatrick McHardy 		return err;
256738f7b870SPatrick McHardy 
256879e1ad14SJiri Benc 	if (tb[IFLA_IF_NETNSID])
256979e1ad14SJiri Benc 		return -EOPNOTSUPP;
257079e1ad14SJiri Benc 
257138f7b870SPatrick McHardy 	if (tb[IFLA_IFNAME])
257238f7b870SPatrick McHardy 		nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
257338f7b870SPatrick McHardy 
257438f7b870SPatrick McHardy 	ifm = nlmsg_data(nlh);
257538f7b870SPatrick McHardy 	if (ifm->ifi_index > 0)
2576881d966bSEric W. Biederman 		dev = __dev_get_by_index(net, ifm->ifi_index);
257738f7b870SPatrick McHardy 	else if (tb[IFLA_IFNAME])
2578881d966bSEric W. Biederman 		dev = __dev_get_by_name(net, ifname);
257966400d54SWANG Cong 	else if (tb[IFLA_GROUP])
258066400d54SWANG Cong 		return rtnl_group_dellink(net, nla_get_u32(tb[IFLA_GROUP]));
258138f7b870SPatrick McHardy 	else
258238f7b870SPatrick McHardy 		return -EINVAL;
258338f7b870SPatrick McHardy 
258438f7b870SPatrick McHardy 	if (!dev)
258538f7b870SPatrick McHardy 		return -ENODEV;
258638f7b870SPatrick McHardy 
2587614732eaSThomas Graf 	return rtnl_delete_link(dev);
258838f7b870SPatrick McHardy }
258938f7b870SPatrick McHardy 
25903729d502SPatrick McHardy int rtnl_configure_link(struct net_device *dev, const struct ifinfomsg *ifm)
25913729d502SPatrick McHardy {
25923729d502SPatrick McHardy 	unsigned int old_flags;
25933729d502SPatrick McHardy 	int err;
25943729d502SPatrick McHardy 
25953729d502SPatrick McHardy 	old_flags = dev->flags;
25963729d502SPatrick McHardy 	if (ifm && (ifm->ifi_flags || ifm->ifi_change)) {
25973729d502SPatrick McHardy 		err = __dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm));
25983729d502SPatrick McHardy 		if (err < 0)
25993729d502SPatrick McHardy 			return err;
26003729d502SPatrick McHardy 	}
26013729d502SPatrick McHardy 
26023729d502SPatrick McHardy 	dev->rtnl_link_state = RTNL_LINK_INITIALIZED;
26033729d502SPatrick McHardy 
2604a528c219SNicolas Dichtel 	__dev_notify_flags(dev, old_flags, ~0U);
26053729d502SPatrick McHardy 	return 0;
26063729d502SPatrick McHardy }
26073729d502SPatrick McHardy EXPORT_SYMBOL(rtnl_configure_link);
26083729d502SPatrick McHardy 
2609c0713563SRami Rosen struct net_device *rtnl_create_link(struct net *net,
261078ebb0d0SThomas Graf 	const char *ifname, unsigned char name_assign_type,
26115517750fSTom Gundersen 	const struct rtnl_link_ops *ops, struct nlattr *tb[])
2612e7199288SPavel Emelianov {
2613e7199288SPavel Emelianov 	struct net_device *dev;
2614d40156aaSJiri Pirko 	unsigned int num_tx_queues = 1;
2615d40156aaSJiri Pirko 	unsigned int num_rx_queues = 1;
2616e7199288SPavel Emelianov 
261776ff5cc9SJiri Pirko 	if (tb[IFLA_NUM_TX_QUEUES])
261876ff5cc9SJiri Pirko 		num_tx_queues = nla_get_u32(tb[IFLA_NUM_TX_QUEUES]);
261976ff5cc9SJiri Pirko 	else if (ops->get_num_tx_queues)
2620d40156aaSJiri Pirko 		num_tx_queues = ops->get_num_tx_queues();
262176ff5cc9SJiri Pirko 
262276ff5cc9SJiri Pirko 	if (tb[IFLA_NUM_RX_QUEUES])
262376ff5cc9SJiri Pirko 		num_rx_queues = nla_get_u32(tb[IFLA_NUM_RX_QUEUES]);
262476ff5cc9SJiri Pirko 	else if (ops->get_num_rx_queues)
2625d40156aaSJiri Pirko 		num_rx_queues = ops->get_num_rx_queues();
2626efacb309Sstephen hemminger 
26275517750fSTom Gundersen 	dev = alloc_netdev_mqs(ops->priv_size, ifname, name_assign_type,
2628c835a677STom Gundersen 			       ops->setup, num_tx_queues, num_rx_queues);
2629e7199288SPavel Emelianov 	if (!dev)
2630d1892e4eSTobias Klauser 		return ERR_PTR(-ENOMEM);
2631e7199288SPavel Emelianov 
263281adee47SEric W. Biederman 	dev_net_set(dev, net);
263381adee47SEric W. Biederman 	dev->rtnl_link_ops = ops;
26343729d502SPatrick McHardy 	dev->rtnl_link_state = RTNL_LINK_INITIALIZING;
263581adee47SEric W. Biederman 
2636e7199288SPavel Emelianov 	if (tb[IFLA_MTU])
2637e7199288SPavel Emelianov 		dev->mtu = nla_get_u32(tb[IFLA_MTU]);
26382afb9b53SJiri Pirko 	if (tb[IFLA_ADDRESS]) {
2639e7199288SPavel Emelianov 		memcpy(dev->dev_addr, nla_data(tb[IFLA_ADDRESS]),
2640e7199288SPavel Emelianov 				nla_len(tb[IFLA_ADDRESS]));
26412afb9b53SJiri Pirko 		dev->addr_assign_type = NET_ADDR_SET;
26422afb9b53SJiri Pirko 	}
2643e7199288SPavel Emelianov 	if (tb[IFLA_BROADCAST])
2644e7199288SPavel Emelianov 		memcpy(dev->broadcast, nla_data(tb[IFLA_BROADCAST]),
2645e7199288SPavel Emelianov 				nla_len(tb[IFLA_BROADCAST]));
2646e7199288SPavel Emelianov 	if (tb[IFLA_TXQLEN])
2647e7199288SPavel Emelianov 		dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]);
2648e7199288SPavel Emelianov 	if (tb[IFLA_OPERSTATE])
264993b2d4a2SDavid S. Miller 		set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE]));
2650e7199288SPavel Emelianov 	if (tb[IFLA_LINKMODE])
2651e7199288SPavel Emelianov 		dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]);
2652ffa934f1SPatrick McHardy 	if (tb[IFLA_GROUP])
2653ffa934f1SPatrick McHardy 		dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP]));
2654e7199288SPavel Emelianov 
2655e7199288SPavel Emelianov 	return dev;
2656e7199288SPavel Emelianov }
2657e0d087afSEric Dumazet EXPORT_SYMBOL(rtnl_create_link);
2658e7199288SPavel Emelianov 
265990f62cf3SEric W. Biederman static int rtnl_group_changelink(const struct sk_buff *skb,
266090f62cf3SEric W. Biederman 		struct net *net, int group,
2661e7ed828fSVlad Dogaru 		struct ifinfomsg *ifm,
2662ddf9f970SJakub Kicinski 		struct netlink_ext_ack *extack,
2663e7ed828fSVlad Dogaru 		struct nlattr **tb)
2664e7ed828fSVlad Dogaru {
2665d079535dSWANG Cong 	struct net_device *dev, *aux;
2666e7ed828fSVlad Dogaru 	int err;
2667e7ed828fSVlad Dogaru 
2668d079535dSWANG Cong 	for_each_netdev_safe(net, dev, aux) {
2669e7ed828fSVlad Dogaru 		if (dev->group == group) {
2670ddf9f970SJakub Kicinski 			err = do_setlink(skb, dev, ifm, extack, tb, NULL, 0);
2671e7ed828fSVlad Dogaru 			if (err < 0)
2672e7ed828fSVlad Dogaru 				return err;
2673e7ed828fSVlad Dogaru 		}
2674e7ed828fSVlad Dogaru 	}
2675e7ed828fSVlad Dogaru 
2676e7ed828fSVlad Dogaru 	return 0;
2677e7ed828fSVlad Dogaru }
2678e7ed828fSVlad Dogaru 
2679c21ef3e3SDavid Ahern static int rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh,
2680c21ef3e3SDavid Ahern 			struct netlink_ext_ack *extack)
268138f7b870SPatrick McHardy {
26823b1e0a65SYOSHIFUJI Hideaki 	struct net *net = sock_net(skb->sk);
268338f7b870SPatrick McHardy 	const struct rtnl_link_ops *ops;
2684ba7d49b1SJiri Pirko 	const struct rtnl_link_ops *m_ops = NULL;
268538f7b870SPatrick McHardy 	struct net_device *dev;
2686ba7d49b1SJiri Pirko 	struct net_device *master_dev = NULL;
268738f7b870SPatrick McHardy 	struct ifinfomsg *ifm;
268838f7b870SPatrick McHardy 	char kind[MODULE_NAME_LEN];
268938f7b870SPatrick McHardy 	char ifname[IFNAMSIZ];
269038f7b870SPatrick McHardy 	struct nlattr *tb[IFLA_MAX+1];
269138f7b870SPatrick McHardy 	struct nlattr *linkinfo[IFLA_INFO_MAX+1];
26925517750fSTom Gundersen 	unsigned char name_assign_type = NET_NAME_USER;
269338f7b870SPatrick McHardy 	int err;
269438f7b870SPatrick McHardy 
269595a5afcaSJohannes Berg #ifdef CONFIG_MODULES
269638f7b870SPatrick McHardy replay:
26978072f085SThomas Graf #endif
2698c21ef3e3SDavid Ahern 	err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack);
269938f7b870SPatrick McHardy 	if (err < 0)
270038f7b870SPatrick McHardy 		return err;
270138f7b870SPatrick McHardy 
270279e1ad14SJiri Benc 	if (tb[IFLA_IF_NETNSID])
270379e1ad14SJiri Benc 		return -EOPNOTSUPP;
270479e1ad14SJiri Benc 
270538f7b870SPatrick McHardy 	if (tb[IFLA_IFNAME])
270638f7b870SPatrick McHardy 		nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
270738f7b870SPatrick McHardy 	else
270838f7b870SPatrick McHardy 		ifname[0] = '\0';
270938f7b870SPatrick McHardy 
271038f7b870SPatrick McHardy 	ifm = nlmsg_data(nlh);
271138f7b870SPatrick McHardy 	if (ifm->ifi_index > 0)
2712881d966bSEric W. Biederman 		dev = __dev_get_by_index(net, ifm->ifi_index);
2713e7ed828fSVlad Dogaru 	else {
2714e7ed828fSVlad Dogaru 		if (ifname[0])
2715881d966bSEric W. Biederman 			dev = __dev_get_by_name(net, ifname);
271638f7b870SPatrick McHardy 		else
271738f7b870SPatrick McHardy 			dev = NULL;
2718e7ed828fSVlad Dogaru 	}
271938f7b870SPatrick McHardy 
2720ba7d49b1SJiri Pirko 	if (dev) {
2721ba7d49b1SJiri Pirko 		master_dev = netdev_master_upper_dev_get(dev);
2722ba7d49b1SJiri Pirko 		if (master_dev)
2723ba7d49b1SJiri Pirko 			m_ops = master_dev->rtnl_link_ops;
2724ba7d49b1SJiri Pirko 	}
2725ba7d49b1SJiri Pirko 
2726e0d087afSEric Dumazet 	err = validate_linkmsg(dev, tb);
2727e0d087afSEric Dumazet 	if (err < 0)
27281840bb13SThomas Graf 		return err;
27291840bb13SThomas Graf 
273038f7b870SPatrick McHardy 	if (tb[IFLA_LINKINFO]) {
273138f7b870SPatrick McHardy 		err = nla_parse_nested(linkinfo, IFLA_INFO_MAX,
2732fceb6435SJohannes Berg 				       tb[IFLA_LINKINFO], ifla_info_policy,
2733fceb6435SJohannes Berg 				       NULL);
273438f7b870SPatrick McHardy 		if (err < 0)
273538f7b870SPatrick McHardy 			return err;
273638f7b870SPatrick McHardy 	} else
273738f7b870SPatrick McHardy 		memset(linkinfo, 0, sizeof(linkinfo));
273838f7b870SPatrick McHardy 
273938f7b870SPatrick McHardy 	if (linkinfo[IFLA_INFO_KIND]) {
274038f7b870SPatrick McHardy 		nla_strlcpy(kind, linkinfo[IFLA_INFO_KIND], sizeof(kind));
274138f7b870SPatrick McHardy 		ops = rtnl_link_ops_get(kind);
274238f7b870SPatrick McHardy 	} else {
274338f7b870SPatrick McHardy 		kind[0] = '\0';
274438f7b870SPatrick McHardy 		ops = NULL;
274538f7b870SPatrick McHardy 	}
274638f7b870SPatrick McHardy 
274738f7b870SPatrick McHardy 	if (1) {
27484e10fd5bSSasha Levin 		struct nlattr *attr[ops ? ops->maxtype + 1 : 1];
27494e10fd5bSSasha Levin 		struct nlattr *slave_attr[m_ops ? m_ops->slave_maxtype + 1 : 1];
2750ba7d49b1SJiri Pirko 		struct nlattr **data = NULL;
2751ba7d49b1SJiri Pirko 		struct nlattr **slave_data = NULL;
2752317f4810SNicolas Dichtel 		struct net *dest_net, *link_net = NULL;
275338f7b870SPatrick McHardy 
275438f7b870SPatrick McHardy 		if (ops) {
275538f7b870SPatrick McHardy 			if (ops->maxtype && linkinfo[IFLA_INFO_DATA]) {
275638f7b870SPatrick McHardy 				err = nla_parse_nested(attr, ops->maxtype,
275738f7b870SPatrick McHardy 						       linkinfo[IFLA_INFO_DATA],
2758fceb6435SJohannes Berg 						       ops->policy, NULL);
275938f7b870SPatrick McHardy 				if (err < 0)
276038f7b870SPatrick McHardy 					return err;
276138f7b870SPatrick McHardy 				data = attr;
276238f7b870SPatrick McHardy 			}
276338f7b870SPatrick McHardy 			if (ops->validate) {
2764a8b8a889SMatthias Schiffer 				err = ops->validate(tb, data, extack);
276538f7b870SPatrick McHardy 				if (err < 0)
276638f7b870SPatrick McHardy 					return err;
276738f7b870SPatrick McHardy 			}
276838f7b870SPatrick McHardy 		}
276938f7b870SPatrick McHardy 
2770ba7d49b1SJiri Pirko 		if (m_ops) {
2771ba7d49b1SJiri Pirko 			if (m_ops->slave_maxtype &&
2772ba7d49b1SJiri Pirko 			    linkinfo[IFLA_INFO_SLAVE_DATA]) {
2773ba7d49b1SJiri Pirko 				err = nla_parse_nested(slave_attr,
2774ba7d49b1SJiri Pirko 						       m_ops->slave_maxtype,
2775ba7d49b1SJiri Pirko 						       linkinfo[IFLA_INFO_SLAVE_DATA],
2776fceb6435SJohannes Berg 						       m_ops->slave_policy,
2777fceb6435SJohannes Berg 						       NULL);
2778ba7d49b1SJiri Pirko 				if (err < 0)
2779ba7d49b1SJiri Pirko 					return err;
2780ba7d49b1SJiri Pirko 				slave_data = slave_attr;
2781ba7d49b1SJiri Pirko 			}
2782ba7d49b1SJiri Pirko 		}
2783ba7d49b1SJiri Pirko 
278438f7b870SPatrick McHardy 		if (dev) {
278590c325e3SNicolas Dichtel 			int status = 0;
278638f7b870SPatrick McHardy 
278738f7b870SPatrick McHardy 			if (nlh->nlmsg_flags & NLM_F_EXCL)
278838f7b870SPatrick McHardy 				return -EEXIST;
278938f7b870SPatrick McHardy 			if (nlh->nlmsg_flags & NLM_F_REPLACE)
279038f7b870SPatrick McHardy 				return -EOPNOTSUPP;
279138f7b870SPatrick McHardy 
279238f7b870SPatrick McHardy 			if (linkinfo[IFLA_INFO_DATA]) {
279338f7b870SPatrick McHardy 				if (!ops || ops != dev->rtnl_link_ops ||
279438f7b870SPatrick McHardy 				    !ops->changelink)
279538f7b870SPatrick McHardy 					return -EOPNOTSUPP;
279638f7b870SPatrick McHardy 
2797ad744b22SMatthias Schiffer 				err = ops->changelink(dev, tb, data, extack);
279838f7b870SPatrick McHardy 				if (err < 0)
279938f7b870SPatrick McHardy 					return err;
2800ba998906SNicolas Dichtel 				status |= DO_SETLINK_NOTIFY;
280138f7b870SPatrick McHardy 			}
280238f7b870SPatrick McHardy 
2803ba7d49b1SJiri Pirko 			if (linkinfo[IFLA_INFO_SLAVE_DATA]) {
2804ba7d49b1SJiri Pirko 				if (!m_ops || !m_ops->slave_changelink)
2805ba7d49b1SJiri Pirko 					return -EOPNOTSUPP;
2806ba7d49b1SJiri Pirko 
2807ba7d49b1SJiri Pirko 				err = m_ops->slave_changelink(master_dev, dev,
280817dd0ec4SMatthias Schiffer 							      tb, slave_data,
280917dd0ec4SMatthias Schiffer 							      extack);
2810ba7d49b1SJiri Pirko 				if (err < 0)
2811ba7d49b1SJiri Pirko 					return err;
2812ba998906SNicolas Dichtel 				status |= DO_SETLINK_NOTIFY;
2813ba7d49b1SJiri Pirko 			}
2814ba7d49b1SJiri Pirko 
2815ddf9f970SJakub Kicinski 			return do_setlink(skb, dev, ifm, extack, tb, ifname,
2816ddf9f970SJakub Kicinski 					  status);
281738f7b870SPatrick McHardy 		}
281838f7b870SPatrick McHardy 
2819ffa934f1SPatrick McHardy 		if (!(nlh->nlmsg_flags & NLM_F_CREATE)) {
2820ffa934f1SPatrick McHardy 			if (ifm->ifi_index == 0 && tb[IFLA_GROUP])
282190f62cf3SEric W. Biederman 				return rtnl_group_changelink(skb, net,
2822ffa934f1SPatrick McHardy 						nla_get_u32(tb[IFLA_GROUP]),
2823ddf9f970SJakub Kicinski 						ifm, extack, tb);
282438f7b870SPatrick McHardy 			return -ENODEV;
2825ffa934f1SPatrick McHardy 		}
282638f7b870SPatrick McHardy 
2827160ca014STheuns Verwoerd 		if (tb[IFLA_MAP] || tb[IFLA_PROTINFO])
282838f7b870SPatrick McHardy 			return -EOPNOTSUPP;
282938f7b870SPatrick McHardy 
283038f7b870SPatrick McHardy 		if (!ops) {
283195a5afcaSJohannes Berg #ifdef CONFIG_MODULES
283238f7b870SPatrick McHardy 			if (kind[0]) {
283338f7b870SPatrick McHardy 				__rtnl_unlock();
283438f7b870SPatrick McHardy 				request_module("rtnl-link-%s", kind);
283538f7b870SPatrick McHardy 				rtnl_lock();
283638f7b870SPatrick McHardy 				ops = rtnl_link_ops_get(kind);
283738f7b870SPatrick McHardy 				if (ops)
283838f7b870SPatrick McHardy 					goto replay;
283938f7b870SPatrick McHardy 			}
284038f7b870SPatrick McHardy #endif
284138f7b870SPatrick McHardy 			return -EOPNOTSUPP;
284238f7b870SPatrick McHardy 		}
284338f7b870SPatrick McHardy 
2844b0ab2fabSJiri Pirko 		if (!ops->setup)
2845b0ab2fabSJiri Pirko 			return -EOPNOTSUPP;
2846b0ab2fabSJiri Pirko 
28475517750fSTom Gundersen 		if (!ifname[0]) {
284838f7b870SPatrick McHardy 			snprintf(ifname, IFNAMSIZ, "%s%%d", ops->kind);
28495517750fSTom Gundersen 			name_assign_type = NET_NAME_ENUM;
28505517750fSTom Gundersen 		}
285138f7b870SPatrick McHardy 
285281adee47SEric W. Biederman 		dest_net = rtnl_link_get_net(net, tb);
285313ad1774SEric W. Biederman 		if (IS_ERR(dest_net))
285413ad1774SEric W. Biederman 			return PTR_ERR(dest_net);
285513ad1774SEric W. Biederman 
2856505ce415SEric W. Biederman 		err = -EPERM;
2857505ce415SEric W. Biederman 		if (!netlink_ns_capable(skb, dest_net->user_ns, CAP_NET_ADMIN))
2858505ce415SEric W. Biederman 			goto out;
2859505ce415SEric W. Biederman 
2860317f4810SNicolas Dichtel 		if (tb[IFLA_LINK_NETNSID]) {
2861317f4810SNicolas Dichtel 			int id = nla_get_s32(tb[IFLA_LINK_NETNSID]);
2862317f4810SNicolas Dichtel 
2863317f4810SNicolas Dichtel 			link_net = get_net_ns_by_id(dest_net, id);
2864317f4810SNicolas Dichtel 			if (!link_net) {
2865317f4810SNicolas Dichtel 				err =  -EINVAL;
2866317f4810SNicolas Dichtel 				goto out;
2867317f4810SNicolas Dichtel 			}
286806615bedSEric W. Biederman 			err = -EPERM;
286906615bedSEric W. Biederman 			if (!netlink_ns_capable(skb, link_net->user_ns, CAP_NET_ADMIN))
287006615bedSEric W. Biederman 				goto out;
2871317f4810SNicolas Dichtel 		}
2872317f4810SNicolas Dichtel 
2873317f4810SNicolas Dichtel 		dev = rtnl_create_link(link_net ? : dest_net, ifname,
2874317f4810SNicolas Dichtel 				       name_assign_type, ops, tb);
28759c7dafbfSPavel Emelyanov 		if (IS_ERR(dev)) {
2876e7199288SPavel Emelianov 			err = PTR_ERR(dev);
28779c7dafbfSPavel Emelyanov 			goto out;
28789c7dafbfSPavel Emelyanov 		}
28799c7dafbfSPavel Emelyanov 
28809c7dafbfSPavel Emelyanov 		dev->ifindex = ifm->ifi_index;
28819c7dafbfSPavel Emelyanov 
28820e0eee24SCong Wang 		if (ops->newlink) {
28837a3f4a18SMatthias Schiffer 			err = ops->newlink(link_net ? : net, dev, tb, data,
28847a3f4a18SMatthias Schiffer 					   extack);
28850e0eee24SCong Wang 			/* Drivers should call free_netdev() in ->destructor
2886e51fb152SCong Wang 			 * and unregister it on failure after registration
2887e51fb152SCong Wang 			 * so that device could be finally freed in rtnl_unlock.
28880e0eee24SCong Wang 			 */
2889e51fb152SCong Wang 			if (err < 0) {
2890e51fb152SCong Wang 				/* If device is not registered at all, free it now */
2891e51fb152SCong Wang 				if (dev->reg_state == NETREG_UNINITIALIZED)
2892e51fb152SCong Wang 					free_netdev(dev);
28930e0eee24SCong Wang 				goto out;
2894e51fb152SCong Wang 			}
28950e0eee24SCong Wang 		} else {
28962d85cba2SPatrick McHardy 			err = register_netdevice(dev);
2897fce9b9beSDan Carpenter 			if (err < 0) {
289838f7b870SPatrick McHardy 				free_netdev(dev);
28993729d502SPatrick McHardy 				goto out;
2900fce9b9beSDan Carpenter 			}
29010e0eee24SCong Wang 		}
29023729d502SPatrick McHardy 		err = rtnl_configure_link(dev, ifm);
290343638900SDavid S. Miller 		if (err < 0)
290443638900SDavid S. Miller 			goto out_unregister;
290543638900SDavid S. Miller 		if (link_net) {
290643638900SDavid S. Miller 			err = dev_change_net_namespace(dev, dest_net, ifname);
290743638900SDavid S. Miller 			if (err < 0)
290843638900SDavid S. Miller 				goto out_unregister;
290943638900SDavid S. Miller 		}
2910160ca014STheuns Verwoerd 		if (tb[IFLA_MASTER]) {
291133eaf2a6SDavid Ahern 			err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]),
291233eaf2a6SDavid Ahern 					    extack);
2913160ca014STheuns Verwoerd 			if (err)
2914160ca014STheuns Verwoerd 				goto out_unregister;
2915160ca014STheuns Verwoerd 		}
291643638900SDavid S. Miller out:
291743638900SDavid S. Miller 		if (link_net)
291843638900SDavid S. Miller 			put_net(link_net);
291943638900SDavid S. Miller 		put_net(dest_net);
292043638900SDavid S. Miller 		return err;
292143638900SDavid S. Miller out_unregister:
29227afb8886SWANG Cong 		if (ops->newlink) {
29237afb8886SWANG Cong 			LIST_HEAD(list_kill);
29247afb8886SWANG Cong 
29257afb8886SWANG Cong 			ops->dellink(dev, &list_kill);
29267afb8886SWANG Cong 			unregister_netdevice_many(&list_kill);
29277afb8886SWANG Cong 		} else {
29283729d502SPatrick McHardy 			unregister_netdevice(dev);
29297afb8886SWANG Cong 		}
2930317f4810SNicolas Dichtel 		goto out;
2931317f4810SNicolas Dichtel 	}
293238f7b870SPatrick McHardy }
293338f7b870SPatrick McHardy 
2934c21ef3e3SDavid Ahern static int rtnl_getlink(struct sk_buff *skb, struct nlmsghdr *nlh,
2935c21ef3e3SDavid Ahern 			struct netlink_ext_ack *extack)
2936711e2c33SJean Tourrilhes {
29373b1e0a65SYOSHIFUJI Hideaki 	struct net *net = sock_net(skb->sk);
293879e1ad14SJiri Benc 	struct net *tgt_net = net;
2939b60c5115SThomas Graf 	struct ifinfomsg *ifm;
2940a3d12891SEric Dumazet 	char ifname[IFNAMSIZ];
2941b60c5115SThomas Graf 	struct nlattr *tb[IFLA_MAX+1];
2942b60c5115SThomas Graf 	struct net_device *dev = NULL;
2943b60c5115SThomas Graf 	struct sk_buff *nskb;
294479e1ad14SJiri Benc 	int netnsid = -1;
2945339bf98fSThomas Graf 	int err;
2946115c9b81SGreg Rose 	u32 ext_filter_mask = 0;
2947711e2c33SJean Tourrilhes 
2948c21ef3e3SDavid Ahern 	err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack);
2949b60c5115SThomas Graf 	if (err < 0)
29509918f230SEric Sesterhenn 		return err;
2951b60c5115SThomas Graf 
295279e1ad14SJiri Benc 	if (tb[IFLA_IF_NETNSID]) {
295379e1ad14SJiri Benc 		netnsid = nla_get_s32(tb[IFLA_IF_NETNSID]);
295479e1ad14SJiri Benc 		tgt_net = get_target_net(skb, netnsid);
295579e1ad14SJiri Benc 		if (IS_ERR(tgt_net))
295679e1ad14SJiri Benc 			return PTR_ERR(tgt_net);
295779e1ad14SJiri Benc 	}
295879e1ad14SJiri Benc 
2959a3d12891SEric Dumazet 	if (tb[IFLA_IFNAME])
2960a3d12891SEric Dumazet 		nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
2961a3d12891SEric Dumazet 
2962115c9b81SGreg Rose 	if (tb[IFLA_EXT_MASK])
2963115c9b81SGreg Rose 		ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
2964115c9b81SGreg Rose 
296579e1ad14SJiri Benc 	err = -EINVAL;
2966b60c5115SThomas Graf 	ifm = nlmsg_data(nlh);
2967a3d12891SEric Dumazet 	if (ifm->ifi_index > 0)
296879e1ad14SJiri Benc 		dev = __dev_get_by_index(tgt_net, ifm->ifi_index);
2969a3d12891SEric Dumazet 	else if (tb[IFLA_IFNAME])
297079e1ad14SJiri Benc 		dev = __dev_get_by_name(tgt_net, ifname);
2971a3d12891SEric Dumazet 	else
297279e1ad14SJiri Benc 		goto out;
2973b60c5115SThomas Graf 
297479e1ad14SJiri Benc 	err = -ENODEV;
2975a3d12891SEric Dumazet 	if (dev == NULL)
297679e1ad14SJiri Benc 		goto out;
2977a3d12891SEric Dumazet 
297879e1ad14SJiri Benc 	err = -ENOBUFS;
2979115c9b81SGreg Rose 	nskb = nlmsg_new(if_nlmsg_size(dev, ext_filter_mask), GFP_KERNEL);
2980a3d12891SEric Dumazet 	if (nskb == NULL)
298179e1ad14SJiri Benc 		goto out;
2982711e2c33SJean Tourrilhes 
298379e1ad14SJiri Benc 	err = rtnl_fill_ifinfo(nskb, dev, net,
298479e1ad14SJiri Benc 			       RTM_NEWLINK, NETLINK_CB(skb).portid,
298579e1ad14SJiri Benc 			       nlh->nlmsg_seq, 0, 0, ext_filter_mask,
298679e1ad14SJiri Benc 			       0, NULL, netnsid);
298726932566SPatrick McHardy 	if (err < 0) {
298826932566SPatrick McHardy 		/* -EMSGSIZE implies BUG in if_nlmsg_size */
298926932566SPatrick McHardy 		WARN_ON(err == -EMSGSIZE);
299026932566SPatrick McHardy 		kfree_skb(nskb);
2991a3d12891SEric Dumazet 	} else
299215e47304SEric W. Biederman 		err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid);
299379e1ad14SJiri Benc out:
299479e1ad14SJiri Benc 	if (netnsid >= 0)
299579e1ad14SJiri Benc 		put_net(tgt_net);
2996b60c5115SThomas Graf 
2997711e2c33SJean Tourrilhes 	return err;
2998711e2c33SJean Tourrilhes }
2999711e2c33SJean Tourrilhes 
3000115c9b81SGreg Rose static u16 rtnl_calcit(struct sk_buff *skb, struct nlmsghdr *nlh)
3001c7ac8679SGreg Rose {
3002115c9b81SGreg Rose 	struct net *net = sock_net(skb->sk);
3003115c9b81SGreg Rose 	struct net_device *dev;
3004115c9b81SGreg Rose 	struct nlattr *tb[IFLA_MAX+1];
3005115c9b81SGreg Rose 	u32 ext_filter_mask = 0;
3006115c9b81SGreg Rose 	u16 min_ifinfo_dump_size = 0;
3007e5eca6d4SMichal Schmidt 	int hdrlen;
3008115c9b81SGreg Rose 
3009e5eca6d4SMichal Schmidt 	/* Same kernel<->userspace interface hack as in rtnl_dump_ifinfo. */
3010e5eca6d4SMichal Schmidt 	hdrlen = nlmsg_len(nlh) < sizeof(struct ifinfomsg) ?
3011e5eca6d4SMichal Schmidt 		 sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg);
3012e5eca6d4SMichal Schmidt 
3013fceb6435SJohannes Berg 	if (nlmsg_parse(nlh, hdrlen, tb, IFLA_MAX, ifla_policy, NULL) >= 0) {
3014115c9b81SGreg Rose 		if (tb[IFLA_EXT_MASK])
3015115c9b81SGreg Rose 			ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
3016a4b64fbeSEric Dumazet 	}
3017115c9b81SGreg Rose 
3018115c9b81SGreg Rose 	if (!ext_filter_mask)
3019115c9b81SGreg Rose 		return NLMSG_GOODSIZE;
3020115c9b81SGreg Rose 	/*
3021115c9b81SGreg Rose 	 * traverse the list of net devices and compute the minimum
3022115c9b81SGreg Rose 	 * buffer size based upon the filter mask.
3023115c9b81SGreg Rose 	 */
30246853dd48SFlorian Westphal 	rcu_read_lock();
30256853dd48SFlorian Westphal 	for_each_netdev_rcu(net, dev) {
3026115c9b81SGreg Rose 		min_ifinfo_dump_size = max_t(u16, min_ifinfo_dump_size,
3027115c9b81SGreg Rose 					     if_nlmsg_size(dev,
3028115c9b81SGreg Rose 						           ext_filter_mask));
3029115c9b81SGreg Rose 	}
30306853dd48SFlorian Westphal 	rcu_read_unlock();
3031115c9b81SGreg Rose 
303293af2056SZhang Shengju 	return nlmsg_total_size(min_ifinfo_dump_size);
3033c7ac8679SGreg Rose }
3034c7ac8679SGreg Rose 
303542bad1daSAdrian Bunk static int rtnl_dump_all(struct sk_buff *skb, struct netlink_callback *cb)
30361da177e4SLinus Torvalds {
30371da177e4SLinus Torvalds 	int idx;
30381da177e4SLinus Torvalds 	int s_idx = cb->family;
30391da177e4SLinus Torvalds 
30401da177e4SLinus Torvalds 	if (s_idx == 0)
30411da177e4SLinus Torvalds 		s_idx = 1;
30426853dd48SFlorian Westphal 
304325239ceeSPatrick McHardy 	for (idx = 1; idx <= RTNL_FAMILY_MAX; idx++) {
3044addf9b90SFlorian Westphal 		struct rtnl_link **tab;
30451da177e4SLinus Torvalds 		int type = cb->nlh->nlmsg_type-RTM_BASE;
3046addf9b90SFlorian Westphal 		struct rtnl_link *link;
30476853dd48SFlorian Westphal 		rtnl_dumpit_func dumpit;
30486853dd48SFlorian Westphal 
30491da177e4SLinus Torvalds 		if (idx < s_idx || idx == PF_PACKET)
30501da177e4SLinus Torvalds 			continue;
30516853dd48SFlorian Westphal 
3052addf9b90SFlorian Westphal 		if (type < 0 || type >= RTM_NR_MSGTYPES)
30531da177e4SLinus Torvalds 			continue;
30546853dd48SFlorian Westphal 
3055addf9b90SFlorian Westphal 		tab = rcu_dereference_rtnl(rtnl_msg_handlers[idx]);
3056addf9b90SFlorian Westphal 		if (!tab)
3057addf9b90SFlorian Westphal 			continue;
3058addf9b90SFlorian Westphal 
3059addf9b90SFlorian Westphal 		link = tab[type];
3060addf9b90SFlorian Westphal 		if (!link)
3061addf9b90SFlorian Westphal 			continue;
3062addf9b90SFlorian Westphal 
3063addf9b90SFlorian Westphal 		dumpit = link->dumpit;
30646853dd48SFlorian Westphal 		if (!dumpit)
30656853dd48SFlorian Westphal 			continue;
30666853dd48SFlorian Westphal 
30670465277fSNicolas Dichtel 		if (idx > s_idx) {
30681da177e4SLinus Torvalds 			memset(&cb->args[0], 0, sizeof(cb->args));
30690465277fSNicolas Dichtel 			cb->prev_seq = 0;
30700465277fSNicolas Dichtel 			cb->seq = 0;
30710465277fSNicolas Dichtel 		}
30726853dd48SFlorian Westphal 		if (dumpit(skb, cb))
30731da177e4SLinus Torvalds 			break;
30741da177e4SLinus Torvalds 	}
30751da177e4SLinus Torvalds 	cb->family = idx;
30761da177e4SLinus Torvalds 
30771da177e4SLinus Torvalds 	return skb->len;
30781da177e4SLinus Torvalds }
30791da177e4SLinus Torvalds 
3080395eea6cSMahesh Bandewar struct sk_buff *rtmsg_ifinfo_build_skb(int type, struct net_device *dev,
30813d3ea5afSVlad Yasevich 				       unsigned int change,
30826621dd29SNicolas Dichtel 				       u32 event, gfp_t flags, int *new_nsid)
30831da177e4SLinus Torvalds {
3084c346dca1SYOSHIFUJI Hideaki 	struct net *net = dev_net(dev);
30851da177e4SLinus Torvalds 	struct sk_buff *skb;
30860ec6d3f4SThomas Graf 	int err = -ENOBUFS;
3087c7ac8679SGreg Rose 	size_t if_info_size;
30881da177e4SLinus Torvalds 
30897f294054SAlexei Starovoitov 	skb = nlmsg_new((if_info_size = if_nlmsg_size(dev, 0)), flags);
30900ec6d3f4SThomas Graf 	if (skb == NULL)
30910ec6d3f4SThomas Graf 		goto errout;
30921da177e4SLinus Torvalds 
309379e1ad14SJiri Benc 	err = rtnl_fill_ifinfo(skb, dev, dev_net(dev),
309479e1ad14SJiri Benc 			       type, 0, 0, change, 0, 0, event,
309579e1ad14SJiri Benc 			       new_nsid, -1);
309626932566SPatrick McHardy 	if (err < 0) {
309726932566SPatrick McHardy 		/* -EMSGSIZE implies BUG in if_nlmsg_size() */
309826932566SPatrick McHardy 		WARN_ON(err == -EMSGSIZE);
309926932566SPatrick McHardy 		kfree_skb(skb);
310026932566SPatrick McHardy 		goto errout;
310126932566SPatrick McHardy 	}
3102395eea6cSMahesh Bandewar 	return skb;
31030ec6d3f4SThomas Graf errout:
31040ec6d3f4SThomas Graf 	if (err < 0)
31054b3da706SEric W. Biederman 		rtnl_set_sk_err(net, RTNLGRP_LINK, err);
3106395eea6cSMahesh Bandewar 	return NULL;
3107395eea6cSMahesh Bandewar }
3108395eea6cSMahesh Bandewar 
3109395eea6cSMahesh Bandewar void rtmsg_ifinfo_send(struct sk_buff *skb, struct net_device *dev, gfp_t flags)
3110395eea6cSMahesh Bandewar {
3111395eea6cSMahesh Bandewar 	struct net *net = dev_net(dev);
3112395eea6cSMahesh Bandewar 
3113395eea6cSMahesh Bandewar 	rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, flags);
3114395eea6cSMahesh Bandewar }
3115395eea6cSMahesh Bandewar 
31163d3ea5afSVlad Yasevich static void rtmsg_ifinfo_event(int type, struct net_device *dev,
31173d3ea5afSVlad Yasevich 			       unsigned int change, u32 event,
31186621dd29SNicolas Dichtel 			       gfp_t flags, int *new_nsid)
3119395eea6cSMahesh Bandewar {
3120395eea6cSMahesh Bandewar 	struct sk_buff *skb;
3121395eea6cSMahesh Bandewar 
3122ed2a80abSNicolas Dichtel 	if (dev->reg_state != NETREG_REGISTERED)
3123ed2a80abSNicolas Dichtel 		return;
3124ed2a80abSNicolas Dichtel 
31256621dd29SNicolas Dichtel 	skb = rtmsg_ifinfo_build_skb(type, dev, change, event, flags, new_nsid);
3126395eea6cSMahesh Bandewar 	if (skb)
3127395eea6cSMahesh Bandewar 		rtmsg_ifinfo_send(skb, dev, flags);
31281da177e4SLinus Torvalds }
31293d3ea5afSVlad Yasevich 
31303d3ea5afSVlad Yasevich void rtmsg_ifinfo(int type, struct net_device *dev, unsigned int change,
31313d3ea5afSVlad Yasevich 		  gfp_t flags)
31323d3ea5afSVlad Yasevich {
31336621dd29SNicolas Dichtel 	rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags, NULL);
31343d3ea5afSVlad Yasevich }
31351da177e4SLinus Torvalds 
31366621dd29SNicolas Dichtel void rtmsg_ifinfo_newnet(int type, struct net_device *dev, unsigned int change,
31376621dd29SNicolas Dichtel 			 gfp_t flags, int *new_nsid)
31386621dd29SNicolas Dichtel {
31396621dd29SNicolas Dichtel 	rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags,
31406621dd29SNicolas Dichtel 			   new_nsid);
31416621dd29SNicolas Dichtel }
31426621dd29SNicolas Dichtel 
3143d83b0603SJohn Fastabend static int nlmsg_populate_fdb_fill(struct sk_buff *skb,
3144d83b0603SJohn Fastabend 				   struct net_device *dev,
31451e53d5bbSHubert Sokolowski 				   u8 *addr, u16 vid, u32 pid, u32 seq,
31461c104a6bSNicolas Dichtel 				   int type, unsigned int flags,
3147b3379041SHubert Sokolowski 				   int nlflags, u16 ndm_state)
3148d83b0603SJohn Fastabend {
3149d83b0603SJohn Fastabend 	struct nlmsghdr *nlh;
3150d83b0603SJohn Fastabend 	struct ndmsg *ndm;
3151d83b0603SJohn Fastabend 
31521c104a6bSNicolas Dichtel 	nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ndm), nlflags);
3153d83b0603SJohn Fastabend 	if (!nlh)
3154d83b0603SJohn Fastabend 		return -EMSGSIZE;
3155d83b0603SJohn Fastabend 
3156d83b0603SJohn Fastabend 	ndm = nlmsg_data(nlh);
3157d83b0603SJohn Fastabend 	ndm->ndm_family  = AF_BRIDGE;
3158d83b0603SJohn Fastabend 	ndm->ndm_pad1	 = 0;
3159d83b0603SJohn Fastabend 	ndm->ndm_pad2    = 0;
3160d83b0603SJohn Fastabend 	ndm->ndm_flags	 = flags;
3161d83b0603SJohn Fastabend 	ndm->ndm_type	 = 0;
3162d83b0603SJohn Fastabend 	ndm->ndm_ifindex = dev->ifindex;
3163b3379041SHubert Sokolowski 	ndm->ndm_state   = ndm_state;
3164d83b0603SJohn Fastabend 
3165d83b0603SJohn Fastabend 	if (nla_put(skb, NDA_LLADDR, ETH_ALEN, addr))
3166d83b0603SJohn Fastabend 		goto nla_put_failure;
31671e53d5bbSHubert Sokolowski 	if (vid)
31681e53d5bbSHubert Sokolowski 		if (nla_put(skb, NDA_VLAN, sizeof(u16), &vid))
31691e53d5bbSHubert Sokolowski 			goto nla_put_failure;
3170d83b0603SJohn Fastabend 
3171053c095aSJohannes Berg 	nlmsg_end(skb, nlh);
3172053c095aSJohannes Berg 	return 0;
3173d83b0603SJohn Fastabend 
3174d83b0603SJohn Fastabend nla_put_failure:
3175d83b0603SJohn Fastabend 	nlmsg_cancel(skb, nlh);
3176d83b0603SJohn Fastabend 	return -EMSGSIZE;
3177d83b0603SJohn Fastabend }
3178d83b0603SJohn Fastabend 
31793ff661c3SJohn Fastabend static inline size_t rtnl_fdb_nlmsg_size(void)
31803ff661c3SJohn Fastabend {
3181f82ef3e1SSabrina Dubroca 	return NLMSG_ALIGN(sizeof(struct ndmsg)) +
3182f82ef3e1SSabrina Dubroca 	       nla_total_size(ETH_ALEN) +	/* NDA_LLADDR */
3183f82ef3e1SSabrina Dubroca 	       nla_total_size(sizeof(u16)) +	/* NDA_VLAN */
3184f82ef3e1SSabrina Dubroca 	       0;
31853ff661c3SJohn Fastabend }
31863ff661c3SJohn Fastabend 
3187b3379041SHubert Sokolowski static void rtnl_fdb_notify(struct net_device *dev, u8 *addr, u16 vid, int type,
3188b3379041SHubert Sokolowski 			    u16 ndm_state)
31893ff661c3SJohn Fastabend {
31903ff661c3SJohn Fastabend 	struct net *net = dev_net(dev);
31913ff661c3SJohn Fastabend 	struct sk_buff *skb;
31923ff661c3SJohn Fastabend 	int err = -ENOBUFS;
31933ff661c3SJohn Fastabend 
31943ff661c3SJohn Fastabend 	skb = nlmsg_new(rtnl_fdb_nlmsg_size(), GFP_ATOMIC);
31953ff661c3SJohn Fastabend 	if (!skb)
31963ff661c3SJohn Fastabend 		goto errout;
31973ff661c3SJohn Fastabend 
31981e53d5bbSHubert Sokolowski 	err = nlmsg_populate_fdb_fill(skb, dev, addr, vid,
3199b3379041SHubert Sokolowski 				      0, 0, type, NTF_SELF, 0, ndm_state);
32003ff661c3SJohn Fastabend 	if (err < 0) {
32013ff661c3SJohn Fastabend 		kfree_skb(skb);
32023ff661c3SJohn Fastabend 		goto errout;
32033ff661c3SJohn Fastabend 	}
32043ff661c3SJohn Fastabend 
32053ff661c3SJohn Fastabend 	rtnl_notify(skb, net, 0, RTNLGRP_NEIGH, NULL, GFP_ATOMIC);
32063ff661c3SJohn Fastabend 	return;
32073ff661c3SJohn Fastabend errout:
32083ff661c3SJohn Fastabend 	rtnl_set_sk_err(net, RTNLGRP_NEIGH, err);
32093ff661c3SJohn Fastabend }
32103ff661c3SJohn Fastabend 
3211090096bfSVlad Yasevich /**
3212090096bfSVlad Yasevich  * ndo_dflt_fdb_add - default netdevice operation to add an FDB entry
3213090096bfSVlad Yasevich  */
3214090096bfSVlad Yasevich int ndo_dflt_fdb_add(struct ndmsg *ndm,
3215090096bfSVlad Yasevich 		     struct nlattr *tb[],
3216090096bfSVlad Yasevich 		     struct net_device *dev,
3217f6f6424bSJiri Pirko 		     const unsigned char *addr, u16 vid,
3218090096bfSVlad Yasevich 		     u16 flags)
3219090096bfSVlad Yasevich {
3220090096bfSVlad Yasevich 	int err = -EINVAL;
3221090096bfSVlad Yasevich 
3222090096bfSVlad Yasevich 	/* If aging addresses are supported device will need to
3223090096bfSVlad Yasevich 	 * implement its own handler for this.
3224090096bfSVlad Yasevich 	 */
3225090096bfSVlad Yasevich 	if (ndm->ndm_state && !(ndm->ndm_state & NUD_PERMANENT)) {
3226090096bfSVlad Yasevich 		pr_info("%s: FDB only supports static addresses\n", dev->name);
3227090096bfSVlad Yasevich 		return err;
3228090096bfSVlad Yasevich 	}
3229090096bfSVlad Yasevich 
323065891feaSOr Gerlitz 	if (vid) {
323165891feaSOr Gerlitz 		pr_info("%s: vlans aren't supported yet for dev_uc|mc_add()\n", dev->name);
323265891feaSOr Gerlitz 		return err;
323365891feaSOr Gerlitz 	}
323465891feaSOr Gerlitz 
3235090096bfSVlad Yasevich 	if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr))
3236090096bfSVlad Yasevich 		err = dev_uc_add_excl(dev, addr);
3237090096bfSVlad Yasevich 	else if (is_multicast_ether_addr(addr))
3238090096bfSVlad Yasevich 		err = dev_mc_add_excl(dev, addr);
3239090096bfSVlad Yasevich 
3240090096bfSVlad Yasevich 	/* Only return duplicate errors if NLM_F_EXCL is set */
3241090096bfSVlad Yasevich 	if (err == -EEXIST && !(flags & NLM_F_EXCL))
3242090096bfSVlad Yasevich 		err = 0;
3243090096bfSVlad Yasevich 
3244090096bfSVlad Yasevich 	return err;
3245090096bfSVlad Yasevich }
3246090096bfSVlad Yasevich EXPORT_SYMBOL(ndo_dflt_fdb_add);
3247090096bfSVlad Yasevich 
3248b88d12e4SFlorian Westphal static int fdb_vid_parse(struct nlattr *vlan_attr, u16 *p_vid,
3249b88d12e4SFlorian Westphal 			 struct netlink_ext_ack *extack)
3250f6f6424bSJiri Pirko {
3251f6f6424bSJiri Pirko 	u16 vid = 0;
3252f6f6424bSJiri Pirko 
3253f6f6424bSJiri Pirko 	if (vlan_attr) {
3254f6f6424bSJiri Pirko 		if (nla_len(vlan_attr) != sizeof(u16)) {
3255b88d12e4SFlorian Westphal 			NL_SET_ERR_MSG(extack, "invalid vlan attribute size");
3256f6f6424bSJiri Pirko 			return -EINVAL;
3257f6f6424bSJiri Pirko 		}
3258f6f6424bSJiri Pirko 
3259f6f6424bSJiri Pirko 		vid = nla_get_u16(vlan_attr);
3260f6f6424bSJiri Pirko 
3261f6f6424bSJiri Pirko 		if (!vid || vid >= VLAN_VID_MASK) {
3262b88d12e4SFlorian Westphal 			NL_SET_ERR_MSG(extack, "invalid vlan id");
3263f6f6424bSJiri Pirko 			return -EINVAL;
3264f6f6424bSJiri Pirko 		}
3265f6f6424bSJiri Pirko 	}
3266f6f6424bSJiri Pirko 	*p_vid = vid;
3267f6f6424bSJiri Pirko 	return 0;
3268f6f6424bSJiri Pirko }
3269f6f6424bSJiri Pirko 
3270c21ef3e3SDavid Ahern static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh,
3271c21ef3e3SDavid Ahern 			struct netlink_ext_ack *extack)
327277162022SJohn Fastabend {
327377162022SJohn Fastabend 	struct net *net = sock_net(skb->sk);
327477162022SJohn Fastabend 	struct ndmsg *ndm;
327577162022SJohn Fastabend 	struct nlattr *tb[NDA_MAX+1];
327677162022SJohn Fastabend 	struct net_device *dev;
327777162022SJohn Fastabend 	u8 *addr;
3278f6f6424bSJiri Pirko 	u16 vid;
327977162022SJohn Fastabend 	int err;
328077162022SJohn Fastabend 
3281c21ef3e3SDavid Ahern 	err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack);
328277162022SJohn Fastabend 	if (err < 0)
328377162022SJohn Fastabend 		return err;
328477162022SJohn Fastabend 
328577162022SJohn Fastabend 	ndm = nlmsg_data(nlh);
328677162022SJohn Fastabend 	if (ndm->ndm_ifindex == 0) {
3287b88d12e4SFlorian Westphal 		NL_SET_ERR_MSG(extack, "invalid ifindex");
328877162022SJohn Fastabend 		return -EINVAL;
328977162022SJohn Fastabend 	}
329077162022SJohn Fastabend 
329177162022SJohn Fastabend 	dev = __dev_get_by_index(net, ndm->ndm_ifindex);
329277162022SJohn Fastabend 	if (dev == NULL) {
3293b88d12e4SFlorian Westphal 		NL_SET_ERR_MSG(extack, "unknown ifindex");
329477162022SJohn Fastabend 		return -ENODEV;
329577162022SJohn Fastabend 	}
329677162022SJohn Fastabend 
329777162022SJohn Fastabend 	if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) {
3298b88d12e4SFlorian Westphal 		NL_SET_ERR_MSG(extack, "invalid address");
329977162022SJohn Fastabend 		return -EINVAL;
330077162022SJohn Fastabend 	}
330177162022SJohn Fastabend 
330277162022SJohn Fastabend 	addr = nla_data(tb[NDA_LLADDR]);
330377162022SJohn Fastabend 
3304b88d12e4SFlorian Westphal 	err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack);
3305f6f6424bSJiri Pirko 	if (err)
3306f6f6424bSJiri Pirko 		return err;
3307f6f6424bSJiri Pirko 
330877162022SJohn Fastabend 	err = -EOPNOTSUPP;
330977162022SJohn Fastabend 
331077162022SJohn Fastabend 	/* Support fdb on master device the net/bridge default case */
331177162022SJohn Fastabend 	if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) &&
331277162022SJohn Fastabend 	    (dev->priv_flags & IFF_BRIDGE_PORT)) {
3313898e5061SJiri Pirko 		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
3314898e5061SJiri Pirko 		const struct net_device_ops *ops = br_dev->netdev_ops;
3315898e5061SJiri Pirko 
3316f6f6424bSJiri Pirko 		err = ops->ndo_fdb_add(ndm, tb, dev, addr, vid,
3317f6f6424bSJiri Pirko 				       nlh->nlmsg_flags);
331877162022SJohn Fastabend 		if (err)
331977162022SJohn Fastabend 			goto out;
332077162022SJohn Fastabend 		else
332177162022SJohn Fastabend 			ndm->ndm_flags &= ~NTF_MASTER;
332277162022SJohn Fastabend 	}
332377162022SJohn Fastabend 
332477162022SJohn Fastabend 	/* Embedded bridge, macvlan, and any other device support */
3325090096bfSVlad Yasevich 	if ((ndm->ndm_flags & NTF_SELF)) {
3326090096bfSVlad Yasevich 		if (dev->netdev_ops->ndo_fdb_add)
3327090096bfSVlad Yasevich 			err = dev->netdev_ops->ndo_fdb_add(ndm, tb, dev, addr,
3328f6f6424bSJiri Pirko 							   vid,
3329090096bfSVlad Yasevich 							   nlh->nlmsg_flags);
3330090096bfSVlad Yasevich 		else
3331f6f6424bSJiri Pirko 			err = ndo_dflt_fdb_add(ndm, tb, dev, addr, vid,
333277162022SJohn Fastabend 					       nlh->nlmsg_flags);
333377162022SJohn Fastabend 
33343ff661c3SJohn Fastabend 		if (!err) {
3335b3379041SHubert Sokolowski 			rtnl_fdb_notify(dev, addr, vid, RTM_NEWNEIGH,
3336b3379041SHubert Sokolowski 					ndm->ndm_state);
333777162022SJohn Fastabend 			ndm->ndm_flags &= ~NTF_SELF;
333877162022SJohn Fastabend 		}
33393ff661c3SJohn Fastabend 	}
334077162022SJohn Fastabend out:
334177162022SJohn Fastabend 	return err;
334277162022SJohn Fastabend }
334377162022SJohn Fastabend 
3344090096bfSVlad Yasevich /**
3345090096bfSVlad Yasevich  * ndo_dflt_fdb_del - default netdevice operation to delete an FDB entry
3346090096bfSVlad Yasevich  */
3347090096bfSVlad Yasevich int ndo_dflt_fdb_del(struct ndmsg *ndm,
3348090096bfSVlad Yasevich 		     struct nlattr *tb[],
3349090096bfSVlad Yasevich 		     struct net_device *dev,
3350f6f6424bSJiri Pirko 		     const unsigned char *addr, u16 vid)
3351090096bfSVlad Yasevich {
3352c8a89c4aSAlexander Duyck 	int err = -EINVAL;
3353090096bfSVlad Yasevich 
3354090096bfSVlad Yasevich 	/* If aging addresses are supported device will need to
3355090096bfSVlad Yasevich 	 * implement its own handler for this.
3356090096bfSVlad Yasevich 	 */
335764535993SSridhar Samudrala 	if (!(ndm->ndm_state & NUD_PERMANENT)) {
3358090096bfSVlad Yasevich 		pr_info("%s: FDB only supports static addresses\n", dev->name);
3359c8a89c4aSAlexander Duyck 		return err;
3360090096bfSVlad Yasevich 	}
3361090096bfSVlad Yasevich 
3362090096bfSVlad Yasevich 	if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr))
3363090096bfSVlad Yasevich 		err = dev_uc_del(dev, addr);
3364090096bfSVlad Yasevich 	else if (is_multicast_ether_addr(addr))
3365090096bfSVlad Yasevich 		err = dev_mc_del(dev, addr);
3366090096bfSVlad Yasevich 
3367090096bfSVlad Yasevich 	return err;
3368090096bfSVlad Yasevich }
3369090096bfSVlad Yasevich EXPORT_SYMBOL(ndo_dflt_fdb_del);
3370090096bfSVlad Yasevich 
3371c21ef3e3SDavid Ahern static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh,
3372c21ef3e3SDavid Ahern 			struct netlink_ext_ack *extack)
337377162022SJohn Fastabend {
337477162022SJohn Fastabend 	struct net *net = sock_net(skb->sk);
337577162022SJohn Fastabend 	struct ndmsg *ndm;
33761690be63SVlad Yasevich 	struct nlattr *tb[NDA_MAX+1];
337777162022SJohn Fastabend 	struct net_device *dev;
337877162022SJohn Fastabend 	int err = -EINVAL;
337977162022SJohn Fastabend 	__u8 *addr;
3380f6f6424bSJiri Pirko 	u16 vid;
338177162022SJohn Fastabend 
338290f62cf3SEric W. Biederman 	if (!netlink_capable(skb, CAP_NET_ADMIN))
33831690be63SVlad Yasevich 		return -EPERM;
33841690be63SVlad Yasevich 
3385c21ef3e3SDavid Ahern 	err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack);
33861690be63SVlad Yasevich 	if (err < 0)
33871690be63SVlad Yasevich 		return err;
338877162022SJohn Fastabend 
338977162022SJohn Fastabend 	ndm = nlmsg_data(nlh);
339077162022SJohn Fastabend 	if (ndm->ndm_ifindex == 0) {
3391b88d12e4SFlorian Westphal 		NL_SET_ERR_MSG(extack, "invalid ifindex");
339277162022SJohn Fastabend 		return -EINVAL;
339377162022SJohn Fastabend 	}
339477162022SJohn Fastabend 
339577162022SJohn Fastabend 	dev = __dev_get_by_index(net, ndm->ndm_ifindex);
339677162022SJohn Fastabend 	if (dev == NULL) {
3397b88d12e4SFlorian Westphal 		NL_SET_ERR_MSG(extack, "unknown ifindex");
339877162022SJohn Fastabend 		return -ENODEV;
339977162022SJohn Fastabend 	}
340077162022SJohn Fastabend 
34011690be63SVlad Yasevich 	if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) {
3402b88d12e4SFlorian Westphal 		NL_SET_ERR_MSG(extack, "invalid address");
340377162022SJohn Fastabend 		return -EINVAL;
340477162022SJohn Fastabend 	}
340577162022SJohn Fastabend 
34061690be63SVlad Yasevich 	addr = nla_data(tb[NDA_LLADDR]);
34071690be63SVlad Yasevich 
3408b88d12e4SFlorian Westphal 	err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack);
3409f6f6424bSJiri Pirko 	if (err)
3410f6f6424bSJiri Pirko 		return err;
3411f6f6424bSJiri Pirko 
341277162022SJohn Fastabend 	err = -EOPNOTSUPP;
341377162022SJohn Fastabend 
341477162022SJohn Fastabend 	/* Support fdb on master device the net/bridge default case */
341577162022SJohn Fastabend 	if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) &&
341677162022SJohn Fastabend 	    (dev->priv_flags & IFF_BRIDGE_PORT)) {
3417898e5061SJiri Pirko 		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
3418898e5061SJiri Pirko 		const struct net_device_ops *ops = br_dev->netdev_ops;
341977162022SJohn Fastabend 
3420898e5061SJiri Pirko 		if (ops->ndo_fdb_del)
3421f6f6424bSJiri Pirko 			err = ops->ndo_fdb_del(ndm, tb, dev, addr, vid);
342277162022SJohn Fastabend 
342377162022SJohn Fastabend 		if (err)
342477162022SJohn Fastabend 			goto out;
342577162022SJohn Fastabend 		else
342677162022SJohn Fastabend 			ndm->ndm_flags &= ~NTF_MASTER;
342777162022SJohn Fastabend 	}
342877162022SJohn Fastabend 
342977162022SJohn Fastabend 	/* Embedded bridge, macvlan, and any other device support */
3430090096bfSVlad Yasevich 	if (ndm->ndm_flags & NTF_SELF) {
3431090096bfSVlad Yasevich 		if (dev->netdev_ops->ndo_fdb_del)
3432f6f6424bSJiri Pirko 			err = dev->netdev_ops->ndo_fdb_del(ndm, tb, dev, addr,
3433f6f6424bSJiri Pirko 							   vid);
3434090096bfSVlad Yasevich 		else
3435f6f6424bSJiri Pirko 			err = ndo_dflt_fdb_del(ndm, tb, dev, addr, vid);
343677162022SJohn Fastabend 
34373ff661c3SJohn Fastabend 		if (!err) {
3438b3379041SHubert Sokolowski 			rtnl_fdb_notify(dev, addr, vid, RTM_DELNEIGH,
3439b3379041SHubert Sokolowski 					ndm->ndm_state);
344077162022SJohn Fastabend 			ndm->ndm_flags &= ~NTF_SELF;
344177162022SJohn Fastabend 		}
34423ff661c3SJohn Fastabend 	}
344377162022SJohn Fastabend out:
344477162022SJohn Fastabend 	return err;
344577162022SJohn Fastabend }
344677162022SJohn Fastabend 
3447d83b0603SJohn Fastabend static int nlmsg_populate_fdb(struct sk_buff *skb,
3448d83b0603SJohn Fastabend 			      struct netlink_callback *cb,
3449d83b0603SJohn Fastabend 			      struct net_device *dev,
3450d83b0603SJohn Fastabend 			      int *idx,
3451d83b0603SJohn Fastabend 			      struct netdev_hw_addr_list *list)
3452d83b0603SJohn Fastabend {
3453d83b0603SJohn Fastabend 	struct netdev_hw_addr *ha;
3454d83b0603SJohn Fastabend 	int err;
345515e47304SEric W. Biederman 	u32 portid, seq;
3456d83b0603SJohn Fastabend 
345715e47304SEric W. Biederman 	portid = NETLINK_CB(cb->skb).portid;
3458d83b0603SJohn Fastabend 	seq = cb->nlh->nlmsg_seq;
3459d83b0603SJohn Fastabend 
3460d83b0603SJohn Fastabend 	list_for_each_entry(ha, &list->list, list) {
3461d297653dSRoopa Prabhu 		if (*idx < cb->args[2])
3462d83b0603SJohn Fastabend 			goto skip;
3463d83b0603SJohn Fastabend 
34641e53d5bbSHubert Sokolowski 		err = nlmsg_populate_fdb_fill(skb, dev, ha->addr, 0,
3465a7a558feSJohn Fastabend 					      portid, seq,
34661c104a6bSNicolas Dichtel 					      RTM_NEWNEIGH, NTF_SELF,
3467b3379041SHubert Sokolowski 					      NLM_F_MULTI, NUD_PERMANENT);
3468d83b0603SJohn Fastabend 		if (err < 0)
3469d83b0603SJohn Fastabend 			return err;
3470d83b0603SJohn Fastabend skip:
3471d83b0603SJohn Fastabend 		*idx += 1;
3472d83b0603SJohn Fastabend 	}
3473d83b0603SJohn Fastabend 	return 0;
3474d83b0603SJohn Fastabend }
3475d83b0603SJohn Fastabend 
3476d83b0603SJohn Fastabend /**
34772c53040fSBen Hutchings  * ndo_dflt_fdb_dump - default netdevice operation to dump an FDB table.
3478d83b0603SJohn Fastabend  * @nlh: netlink message header
3479d83b0603SJohn Fastabend  * @dev: netdevice
3480d83b0603SJohn Fastabend  *
3481d83b0603SJohn Fastabend  * Default netdevice operation to dump the existing unicast address list.
348291f3e7b1SJohn Fastabend  * Returns number of addresses from list put in skb.
3483d83b0603SJohn Fastabend  */
3484d83b0603SJohn Fastabend int ndo_dflt_fdb_dump(struct sk_buff *skb,
3485d83b0603SJohn Fastabend 		      struct netlink_callback *cb,
3486d83b0603SJohn Fastabend 		      struct net_device *dev,
34875d5eacb3SJamal Hadi Salim 		      struct net_device *filter_dev,
3488d297653dSRoopa Prabhu 		      int *idx)
3489d83b0603SJohn Fastabend {
3490d83b0603SJohn Fastabend 	int err;
3491d83b0603SJohn Fastabend 
3492d83b0603SJohn Fastabend 	netif_addr_lock_bh(dev);
3493d297653dSRoopa Prabhu 	err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->uc);
3494d83b0603SJohn Fastabend 	if (err)
3495d83b0603SJohn Fastabend 		goto out;
34962934c9dbSZhang Shengju 	err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->mc);
3497d83b0603SJohn Fastabend out:
3498d83b0603SJohn Fastabend 	netif_addr_unlock_bh(dev);
3499d297653dSRoopa Prabhu 	return err;
3500d83b0603SJohn Fastabend }
3501d83b0603SJohn Fastabend EXPORT_SYMBOL(ndo_dflt_fdb_dump);
3502d83b0603SJohn Fastabend 
350377162022SJohn Fastabend static int rtnl_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb)
350477162022SJohn Fastabend {
350577162022SJohn Fastabend 	struct net_device *dev;
35065e6d2435SJamal Hadi Salim 	struct nlattr *tb[IFLA_MAX+1];
35075e6d2435SJamal Hadi Salim 	struct net_device *br_dev = NULL;
35085e6d2435SJamal Hadi Salim 	const struct net_device_ops *ops = NULL;
35095e6d2435SJamal Hadi Salim 	const struct net_device_ops *cops = NULL;
35105e6d2435SJamal Hadi Salim 	struct ifinfomsg *ifm = nlmsg_data(cb->nlh);
35115e6d2435SJamal Hadi Salim 	struct net *net = sock_net(skb->sk);
3512d297653dSRoopa Prabhu 	struct hlist_head *head;
35135e6d2435SJamal Hadi Salim 	int brport_idx = 0;
35145e6d2435SJamal Hadi Salim 	int br_idx = 0;
3515d297653dSRoopa Prabhu 	int h, s_h;
3516d297653dSRoopa Prabhu 	int idx = 0, s_idx;
3517d297653dSRoopa Prabhu 	int err = 0;
3518d297653dSRoopa Prabhu 	int fidx = 0;
351977162022SJohn Fastabend 
35200ff50e83SAlexander Potapenko 	err = nlmsg_parse(cb->nlh, sizeof(struct ifinfomsg), tb,
35210ff50e83SAlexander Potapenko 			  IFLA_MAX, ifla_policy, NULL);
35220ff50e83SAlexander Potapenko 	if (err < 0) {
35230ff50e83SAlexander Potapenko 		return -EINVAL;
35240ff50e83SAlexander Potapenko 	} else if (err == 0) {
35255e6d2435SJamal Hadi Salim 		if (tb[IFLA_MASTER])
35265e6d2435SJamal Hadi Salim 			br_idx = nla_get_u32(tb[IFLA_MASTER]);
35275e6d2435SJamal Hadi Salim 	}
352877162022SJohn Fastabend 
35295e6d2435SJamal Hadi Salim 	brport_idx = ifm->ifi_index;
35305e6d2435SJamal Hadi Salim 
35315e6d2435SJamal Hadi Salim 	if (br_idx) {
35325e6d2435SJamal Hadi Salim 		br_dev = __dev_get_by_index(net, br_idx);
35335e6d2435SJamal Hadi Salim 		if (!br_dev)
35345e6d2435SJamal Hadi Salim 			return -ENODEV;
35355e6d2435SJamal Hadi Salim 
3536898e5061SJiri Pirko 		ops = br_dev->netdev_ops;
35375e6d2435SJamal Hadi Salim 	}
35385e6d2435SJamal Hadi Salim 
3539d297653dSRoopa Prabhu 	s_h = cb->args[0];
3540d297653dSRoopa Prabhu 	s_idx = cb->args[1];
3541d297653dSRoopa Prabhu 
3542d297653dSRoopa Prabhu 	for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
3543d297653dSRoopa Prabhu 		idx = 0;
3544d297653dSRoopa Prabhu 		head = &net->dev_index_head[h];
3545d297653dSRoopa Prabhu 		hlist_for_each_entry(dev, head, index_hlist) {
3546d297653dSRoopa Prabhu 
35475e6d2435SJamal Hadi Salim 			if (brport_idx && (dev->ifindex != brport_idx))
35485e6d2435SJamal Hadi Salim 				continue;
35495e6d2435SJamal Hadi Salim 
35505e6d2435SJamal Hadi Salim 			if (!br_idx) { /* user did not specify a specific bridge */
35515e6d2435SJamal Hadi Salim 				if (dev->priv_flags & IFF_BRIDGE_PORT) {
35525e6d2435SJamal Hadi Salim 					br_dev = netdev_master_upper_dev_get(dev);
35535e6d2435SJamal Hadi Salim 					cops = br_dev->netdev_ops;
35545e6d2435SJamal Hadi Salim 				}
35555e6d2435SJamal Hadi Salim 			} else {
35565e6d2435SJamal Hadi Salim 				if (dev != br_dev &&
35575e6d2435SJamal Hadi Salim 				    !(dev->priv_flags & IFF_BRIDGE_PORT))
35585e6d2435SJamal Hadi Salim 					continue;
35595e6d2435SJamal Hadi Salim 
35605e6d2435SJamal Hadi Salim 				if (br_dev != netdev_master_upper_dev_get(dev) &&
35615e6d2435SJamal Hadi Salim 				    !(dev->priv_flags & IFF_EBRIDGE))
35625e6d2435SJamal Hadi Salim 					continue;
35635e6d2435SJamal Hadi Salim 				cops = ops;
35645e6d2435SJamal Hadi Salim 			}
35655e6d2435SJamal Hadi Salim 
3566d297653dSRoopa Prabhu 			if (idx < s_idx)
3567d297653dSRoopa Prabhu 				goto cont;
3568d297653dSRoopa Prabhu 
35695e6d2435SJamal Hadi Salim 			if (dev->priv_flags & IFF_BRIDGE_PORT) {
3570d297653dSRoopa Prabhu 				if (cops && cops->ndo_fdb_dump) {
3571d297653dSRoopa Prabhu 					err = cops->ndo_fdb_dump(skb, cb,
3572d297653dSRoopa Prabhu 								br_dev, dev,
3573d297653dSRoopa Prabhu 								&fidx);
3574d297653dSRoopa Prabhu 					if (err == -EMSGSIZE)
3575d297653dSRoopa Prabhu 						goto out;
357677162022SJohn Fastabend 				}
3577d297653dSRoopa Prabhu 			}
357877162022SJohn Fastabend 
35795e6d2435SJamal Hadi Salim 			if (dev->netdev_ops->ndo_fdb_dump)
3580d297653dSRoopa Prabhu 				err = dev->netdev_ops->ndo_fdb_dump(skb, cb,
3581d297653dSRoopa Prabhu 								    dev, NULL,
3582d297653dSRoopa Prabhu 								    &fidx);
35836cb69742SHubert Sokolowski 			else
3584d297653dSRoopa Prabhu 				err = ndo_dflt_fdb_dump(skb, cb, dev, NULL,
3585d297653dSRoopa Prabhu 							&fidx);
3586d297653dSRoopa Prabhu 			if (err == -EMSGSIZE)
3587d297653dSRoopa Prabhu 				goto out;
35885e6d2435SJamal Hadi Salim 
35895e6d2435SJamal Hadi Salim 			cops = NULL;
3590d297653dSRoopa Prabhu 
3591d297653dSRoopa Prabhu 			/* reset fdb offset to 0 for rest of the interfaces */
3592d297653dSRoopa Prabhu 			cb->args[2] = 0;
3593d297653dSRoopa Prabhu 			fidx = 0;
3594d297653dSRoopa Prabhu cont:
3595d297653dSRoopa Prabhu 			idx++;
3596d297653dSRoopa Prabhu 		}
359777162022SJohn Fastabend 	}
359877162022SJohn Fastabend 
3599d297653dSRoopa Prabhu out:
3600d297653dSRoopa Prabhu 	cb->args[0] = h;
3601d297653dSRoopa Prabhu 	cb->args[1] = idx;
3602d297653dSRoopa Prabhu 	cb->args[2] = fidx;
3603d297653dSRoopa Prabhu 
360477162022SJohn Fastabend 	return skb->len;
360577162022SJohn Fastabend }
360677162022SJohn Fastabend 
36072c3c031cSScott Feldman static int brport_nla_put_flag(struct sk_buff *skb, u32 flags, u32 mask,
36082c3c031cSScott Feldman 			       unsigned int attrnum, unsigned int flag)
36092c3c031cSScott Feldman {
36102c3c031cSScott Feldman 	if (mask & flag)
36112c3c031cSScott Feldman 		return nla_put_u8(skb, attrnum, !!(flags & flag));
36122c3c031cSScott Feldman 	return 0;
36132c3c031cSScott Feldman }
36142c3c031cSScott Feldman 
3615815cccbfSJohn Fastabend int ndo_dflt_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq,
36162c3c031cSScott Feldman 			    struct net_device *dev, u16 mode,
36177d4f8d87SScott Feldman 			    u32 flags, u32 mask, int nlflags,
36187d4f8d87SScott Feldman 			    u32 filter_mask,
36197d4f8d87SScott Feldman 			    int (*vlan_fill)(struct sk_buff *skb,
36207d4f8d87SScott Feldman 					     struct net_device *dev,
36217d4f8d87SScott Feldman 					     u32 filter_mask))
3622815cccbfSJohn Fastabend {
3623815cccbfSJohn Fastabend 	struct nlmsghdr *nlh;
3624815cccbfSJohn Fastabend 	struct ifinfomsg *ifm;
3625815cccbfSJohn Fastabend 	struct nlattr *br_afspec;
36262c3c031cSScott Feldman 	struct nlattr *protinfo;
3627815cccbfSJohn Fastabend 	u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN;
3628898e5061SJiri Pirko 	struct net_device *br_dev = netdev_master_upper_dev_get(dev);
36297d4f8d87SScott Feldman 	int err = 0;
3630815cccbfSJohn Fastabend 
363146c264daSNicolas Dichtel 	nlh = nlmsg_put(skb, pid, seq, RTM_NEWLINK, sizeof(*ifm), nlflags);
3632815cccbfSJohn Fastabend 	if (nlh == NULL)
3633815cccbfSJohn Fastabend 		return -EMSGSIZE;
3634815cccbfSJohn Fastabend 
3635815cccbfSJohn Fastabend 	ifm = nlmsg_data(nlh);
3636815cccbfSJohn Fastabend 	ifm->ifi_family = AF_BRIDGE;
3637815cccbfSJohn Fastabend 	ifm->__ifi_pad = 0;
3638815cccbfSJohn Fastabend 	ifm->ifi_type = dev->type;
3639815cccbfSJohn Fastabend 	ifm->ifi_index = dev->ifindex;
3640815cccbfSJohn Fastabend 	ifm->ifi_flags = dev_get_flags(dev);
3641815cccbfSJohn Fastabend 	ifm->ifi_change = 0;
3642815cccbfSJohn Fastabend 
3643815cccbfSJohn Fastabend 
3644815cccbfSJohn Fastabend 	if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
3645815cccbfSJohn Fastabend 	    nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
3646815cccbfSJohn Fastabend 	    nla_put_u8(skb, IFLA_OPERSTATE, operstate) ||
3647898e5061SJiri Pirko 	    (br_dev &&
3648898e5061SJiri Pirko 	     nla_put_u32(skb, IFLA_MASTER, br_dev->ifindex)) ||
3649815cccbfSJohn Fastabend 	    (dev->addr_len &&
3650815cccbfSJohn Fastabend 	     nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) ||
3651a54acb3aSNicolas Dichtel 	    (dev->ifindex != dev_get_iflink(dev) &&
3652a54acb3aSNicolas Dichtel 	     nla_put_u32(skb, IFLA_LINK, dev_get_iflink(dev))))
3653815cccbfSJohn Fastabend 		goto nla_put_failure;
3654815cccbfSJohn Fastabend 
3655815cccbfSJohn Fastabend 	br_afspec = nla_nest_start(skb, IFLA_AF_SPEC);
3656815cccbfSJohn Fastabend 	if (!br_afspec)
3657815cccbfSJohn Fastabend 		goto nla_put_failure;
3658815cccbfSJohn Fastabend 
36591d460b98SRoopa Prabhu 	if (nla_put_u16(skb, IFLA_BRIDGE_FLAGS, BRIDGE_FLAGS_SELF)) {
3660815cccbfSJohn Fastabend 		nla_nest_cancel(skb, br_afspec);
3661815cccbfSJohn Fastabend 		goto nla_put_failure;
3662815cccbfSJohn Fastabend 	}
36631d460b98SRoopa Prabhu 
36641d460b98SRoopa Prabhu 	if (mode != BRIDGE_MODE_UNDEF) {
36651d460b98SRoopa Prabhu 		if (nla_put_u16(skb, IFLA_BRIDGE_MODE, mode)) {
36661d460b98SRoopa Prabhu 			nla_nest_cancel(skb, br_afspec);
36671d460b98SRoopa Prabhu 			goto nla_put_failure;
36681d460b98SRoopa Prabhu 		}
36691d460b98SRoopa Prabhu 	}
36707d4f8d87SScott Feldman 	if (vlan_fill) {
36717d4f8d87SScott Feldman 		err = vlan_fill(skb, dev, filter_mask);
36727d4f8d87SScott Feldman 		if (err) {
36737d4f8d87SScott Feldman 			nla_nest_cancel(skb, br_afspec);
36747d4f8d87SScott Feldman 			goto nla_put_failure;
36757d4f8d87SScott Feldman 		}
36767d4f8d87SScott Feldman 	}
3677815cccbfSJohn Fastabend 	nla_nest_end(skb, br_afspec);
3678815cccbfSJohn Fastabend 
36792c3c031cSScott Feldman 	protinfo = nla_nest_start(skb, IFLA_PROTINFO | NLA_F_NESTED);
36802c3c031cSScott Feldman 	if (!protinfo)
36812c3c031cSScott Feldman 		goto nla_put_failure;
36822c3c031cSScott Feldman 
36832c3c031cSScott Feldman 	if (brport_nla_put_flag(skb, flags, mask,
36842c3c031cSScott Feldman 				IFLA_BRPORT_MODE, BR_HAIRPIN_MODE) ||
36852c3c031cSScott Feldman 	    brport_nla_put_flag(skb, flags, mask,
36862c3c031cSScott Feldman 				IFLA_BRPORT_GUARD, BR_BPDU_GUARD) ||
36872c3c031cSScott Feldman 	    brport_nla_put_flag(skb, flags, mask,
36882c3c031cSScott Feldman 				IFLA_BRPORT_FAST_LEAVE,
36892c3c031cSScott Feldman 				BR_MULTICAST_FAST_LEAVE) ||
36902c3c031cSScott Feldman 	    brport_nla_put_flag(skb, flags, mask,
36912c3c031cSScott Feldman 				IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK) ||
36922c3c031cSScott Feldman 	    brport_nla_put_flag(skb, flags, mask,
36932c3c031cSScott Feldman 				IFLA_BRPORT_LEARNING, BR_LEARNING) ||
36942c3c031cSScott Feldman 	    brport_nla_put_flag(skb, flags, mask,
36952c3c031cSScott Feldman 				IFLA_BRPORT_LEARNING_SYNC, BR_LEARNING_SYNC) ||
36962c3c031cSScott Feldman 	    brport_nla_put_flag(skb, flags, mask,
36972c3c031cSScott Feldman 				IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD) ||
36982c3c031cSScott Feldman 	    brport_nla_put_flag(skb, flags, mask,
36992c3c031cSScott Feldman 				IFLA_BRPORT_PROXYARP, BR_PROXYARP)) {
37002c3c031cSScott Feldman 		nla_nest_cancel(skb, protinfo);
37012c3c031cSScott Feldman 		goto nla_put_failure;
37022c3c031cSScott Feldman 	}
37032c3c031cSScott Feldman 
37042c3c031cSScott Feldman 	nla_nest_end(skb, protinfo);
37052c3c031cSScott Feldman 
3706053c095aSJohannes Berg 	nlmsg_end(skb, nlh);
3707053c095aSJohannes Berg 	return 0;
3708815cccbfSJohn Fastabend nla_put_failure:
3709815cccbfSJohn Fastabend 	nlmsg_cancel(skb, nlh);
37107d4f8d87SScott Feldman 	return err ? err : -EMSGSIZE;
3711815cccbfSJohn Fastabend }
37127d4f8d87SScott Feldman EXPORT_SYMBOL_GPL(ndo_dflt_bridge_getlink);
3713815cccbfSJohn Fastabend 
3714e5a55a89SJohn Fastabend static int rtnl_bridge_getlink(struct sk_buff *skb, struct netlink_callback *cb)
3715e5a55a89SJohn Fastabend {
3716e5a55a89SJohn Fastabend 	struct net *net = sock_net(skb->sk);
3717e5a55a89SJohn Fastabend 	struct net_device *dev;
3718e5a55a89SJohn Fastabend 	int idx = 0;
3719e5a55a89SJohn Fastabend 	u32 portid = NETLINK_CB(cb->skb).portid;
3720e5a55a89SJohn Fastabend 	u32 seq = cb->nlh->nlmsg_seq;
37216cbdceebSVlad Yasevich 	u32 filter_mask = 0;
3722d64f69b0SRoopa Prabhu 	int err;
37236cbdceebSVlad Yasevich 
3724aa68c20fSThomas Graf 	if (nlmsg_len(cb->nlh) > sizeof(struct ifinfomsg)) {
3725aa68c20fSThomas Graf 		struct nlattr *extfilt;
3726aa68c20fSThomas Graf 
37273e805ad2SAsbjoern Sloth Toennesen 		extfilt = nlmsg_find_attr(cb->nlh, sizeof(struct ifinfomsg),
37286cbdceebSVlad Yasevich 					  IFLA_EXT_MASK);
3729aa68c20fSThomas Graf 		if (extfilt) {
3730aa68c20fSThomas Graf 			if (nla_len(extfilt) < sizeof(filter_mask))
3731aa68c20fSThomas Graf 				return -EINVAL;
3732aa68c20fSThomas Graf 
37336cbdceebSVlad Yasevich 			filter_mask = nla_get_u32(extfilt);
3734aa68c20fSThomas Graf 		}
3735aa68c20fSThomas Graf 	}
3736e5a55a89SJohn Fastabend 
3737e5a55a89SJohn Fastabend 	rcu_read_lock();
3738e5a55a89SJohn Fastabend 	for_each_netdev_rcu(net, dev) {
3739e5a55a89SJohn Fastabend 		const struct net_device_ops *ops = dev->netdev_ops;
3740898e5061SJiri Pirko 		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
3741e5a55a89SJohn Fastabend 
3742898e5061SJiri Pirko 		if (br_dev && br_dev->netdev_ops->ndo_bridge_getlink) {
3743d64f69b0SRoopa Prabhu 			if (idx >= cb->args[0]) {
3744d64f69b0SRoopa Prabhu 				err = br_dev->netdev_ops->ndo_bridge_getlink(
3745d64f69b0SRoopa Prabhu 						skb, portid, seq, dev,
3746d64f69b0SRoopa Prabhu 						filter_mask, NLM_F_MULTI);
3747f6c5775fSDavid Ahern 				if (err < 0 && err != -EOPNOTSUPP) {
3748f6c5775fSDavid Ahern 					if (likely(skb->len))
3749e5a55a89SJohn Fastabend 						break;
3750f6c5775fSDavid Ahern 
3751f6c5775fSDavid Ahern 					goto out_err;
3752f6c5775fSDavid Ahern 				}
3753d64f69b0SRoopa Prabhu 			}
3754e5a55a89SJohn Fastabend 			idx++;
3755e5a55a89SJohn Fastabend 		}
3756e5a55a89SJohn Fastabend 
3757e5a55a89SJohn Fastabend 		if (ops->ndo_bridge_getlink) {
3758d64f69b0SRoopa Prabhu 			if (idx >= cb->args[0]) {
3759d64f69b0SRoopa Prabhu 				err = ops->ndo_bridge_getlink(skb, portid,
3760d64f69b0SRoopa Prabhu 							      seq, dev,
376146c264daSNicolas Dichtel 							      filter_mask,
3762d64f69b0SRoopa Prabhu 							      NLM_F_MULTI);
3763f6c5775fSDavid Ahern 				if (err < 0 && err != -EOPNOTSUPP) {
3764f6c5775fSDavid Ahern 					if (likely(skb->len))
3765e5a55a89SJohn Fastabend 						break;
3766f6c5775fSDavid Ahern 
3767f6c5775fSDavid Ahern 					goto out_err;
3768f6c5775fSDavid Ahern 				}
3769d64f69b0SRoopa Prabhu 			}
3770e5a55a89SJohn Fastabend 			idx++;
3771e5a55a89SJohn Fastabend 		}
3772e5a55a89SJohn Fastabend 	}
3773f6c5775fSDavid Ahern 	err = skb->len;
3774f6c5775fSDavid Ahern out_err:
3775e5a55a89SJohn Fastabend 	rcu_read_unlock();
3776e5a55a89SJohn Fastabend 	cb->args[0] = idx;
3777e5a55a89SJohn Fastabend 
3778f6c5775fSDavid Ahern 	return err;
3779e5a55a89SJohn Fastabend }
3780e5a55a89SJohn Fastabend 
37812469ffd7SJohn Fastabend static inline size_t bridge_nlmsg_size(void)
37822469ffd7SJohn Fastabend {
37832469ffd7SJohn Fastabend 	return NLMSG_ALIGN(sizeof(struct ifinfomsg))
37842469ffd7SJohn Fastabend 		+ nla_total_size(IFNAMSIZ)	/* IFLA_IFNAME */
37852469ffd7SJohn Fastabend 		+ nla_total_size(MAX_ADDR_LEN)	/* IFLA_ADDRESS */
37862469ffd7SJohn Fastabend 		+ nla_total_size(sizeof(u32))	/* IFLA_MASTER */
37872469ffd7SJohn Fastabend 		+ nla_total_size(sizeof(u32))	/* IFLA_MTU */
37882469ffd7SJohn Fastabend 		+ nla_total_size(sizeof(u32))	/* IFLA_LINK */
37892469ffd7SJohn Fastabend 		+ nla_total_size(sizeof(u32))	/* IFLA_OPERSTATE */
37902469ffd7SJohn Fastabend 		+ nla_total_size(sizeof(u8))	/* IFLA_PROTINFO */
37912469ffd7SJohn Fastabend 		+ nla_total_size(sizeof(struct nlattr))	/* IFLA_AF_SPEC */
37922469ffd7SJohn Fastabend 		+ nla_total_size(sizeof(u16))	/* IFLA_BRIDGE_FLAGS */
37932469ffd7SJohn Fastabend 		+ nla_total_size(sizeof(u16));	/* IFLA_BRIDGE_MODE */
37942469ffd7SJohn Fastabend }
37952469ffd7SJohn Fastabend 
379602dba438SRoopa Prabhu static int rtnl_bridge_notify(struct net_device *dev)
37972469ffd7SJohn Fastabend {
37982469ffd7SJohn Fastabend 	struct net *net = dev_net(dev);
37992469ffd7SJohn Fastabend 	struct sk_buff *skb;
38002469ffd7SJohn Fastabend 	int err = -EOPNOTSUPP;
38012469ffd7SJohn Fastabend 
380202dba438SRoopa Prabhu 	if (!dev->netdev_ops->ndo_bridge_getlink)
380302dba438SRoopa Prabhu 		return 0;
380402dba438SRoopa Prabhu 
38052469ffd7SJohn Fastabend 	skb = nlmsg_new(bridge_nlmsg_size(), GFP_ATOMIC);
38062469ffd7SJohn Fastabend 	if (!skb) {
38072469ffd7SJohn Fastabend 		err = -ENOMEM;
38082469ffd7SJohn Fastabend 		goto errout;
38092469ffd7SJohn Fastabend 	}
38102469ffd7SJohn Fastabend 
381146c264daSNicolas Dichtel 	err = dev->netdev_ops->ndo_bridge_getlink(skb, 0, 0, dev, 0, 0);
3812c38e01b8SJohn Fastabend 	if (err < 0)
3813c38e01b8SJohn Fastabend 		goto errout;
38142469ffd7SJohn Fastabend 
381559ccaaaaSRoopa Prabhu 	if (!skb->len)
381659ccaaaaSRoopa Prabhu 		goto errout;
381759ccaaaaSRoopa Prabhu 
38182469ffd7SJohn Fastabend 	rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC);
38192469ffd7SJohn Fastabend 	return 0;
38202469ffd7SJohn Fastabend errout:
38212469ffd7SJohn Fastabend 	WARN_ON(err == -EMSGSIZE);
38222469ffd7SJohn Fastabend 	kfree_skb(skb);
382359ccaaaaSRoopa Prabhu 	if (err)
38242469ffd7SJohn Fastabend 		rtnl_set_sk_err(net, RTNLGRP_LINK, err);
38252469ffd7SJohn Fastabend 	return err;
38262469ffd7SJohn Fastabend }
38272469ffd7SJohn Fastabend 
3828c21ef3e3SDavid Ahern static int rtnl_bridge_setlink(struct sk_buff *skb, struct nlmsghdr *nlh,
3829c21ef3e3SDavid Ahern 			       struct netlink_ext_ack *extack)
3830e5a55a89SJohn Fastabend {
3831e5a55a89SJohn Fastabend 	struct net *net = sock_net(skb->sk);
3832e5a55a89SJohn Fastabend 	struct ifinfomsg *ifm;
3833e5a55a89SJohn Fastabend 	struct net_device *dev;
38342469ffd7SJohn Fastabend 	struct nlattr *br_spec, *attr = NULL;
38352469ffd7SJohn Fastabend 	int rem, err = -EOPNOTSUPP;
38364de8b413SRosen, Rami 	u16 flags = 0;
3837c38e01b8SJohn Fastabend 	bool have_flags = false;
3838e5a55a89SJohn Fastabend 
3839e5a55a89SJohn Fastabend 	if (nlmsg_len(nlh) < sizeof(*ifm))
3840e5a55a89SJohn Fastabend 		return -EINVAL;
3841e5a55a89SJohn Fastabend 
3842e5a55a89SJohn Fastabend 	ifm = nlmsg_data(nlh);
3843e5a55a89SJohn Fastabend 	if (ifm->ifi_family != AF_BRIDGE)
3844e5a55a89SJohn Fastabend 		return -EPFNOSUPPORT;
3845e5a55a89SJohn Fastabend 
3846e5a55a89SJohn Fastabend 	dev = __dev_get_by_index(net, ifm->ifi_index);
3847e5a55a89SJohn Fastabend 	if (!dev) {
3848b88d12e4SFlorian Westphal 		NL_SET_ERR_MSG(extack, "unknown ifindex");
3849e5a55a89SJohn Fastabend 		return -ENODEV;
3850e5a55a89SJohn Fastabend 	}
3851e5a55a89SJohn Fastabend 
38522469ffd7SJohn Fastabend 	br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
38532469ffd7SJohn Fastabend 	if (br_spec) {
38542469ffd7SJohn Fastabend 		nla_for_each_nested(attr, br_spec, rem) {
38552469ffd7SJohn Fastabend 			if (nla_type(attr) == IFLA_BRIDGE_FLAGS) {
38566e8d1c55SThomas Graf 				if (nla_len(attr) < sizeof(flags))
38576e8d1c55SThomas Graf 					return -EINVAL;
38586e8d1c55SThomas Graf 
3859c38e01b8SJohn Fastabend 				have_flags = true;
38602469ffd7SJohn Fastabend 				flags = nla_get_u16(attr);
38612469ffd7SJohn Fastabend 				break;
38622469ffd7SJohn Fastabend 			}
38632469ffd7SJohn Fastabend 		}
38642469ffd7SJohn Fastabend 	}
38652469ffd7SJohn Fastabend 
38662469ffd7SJohn Fastabend 	if (!flags || (flags & BRIDGE_FLAGS_MASTER)) {
3867898e5061SJiri Pirko 		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
3868898e5061SJiri Pirko 
3869898e5061SJiri Pirko 		if (!br_dev || !br_dev->netdev_ops->ndo_bridge_setlink) {
38702469ffd7SJohn Fastabend 			err = -EOPNOTSUPP;
3871e5a55a89SJohn Fastabend 			goto out;
3872e5a55a89SJohn Fastabend 		}
3873e5a55a89SJohn Fastabend 
3874add511b3SRoopa Prabhu 		err = br_dev->netdev_ops->ndo_bridge_setlink(dev, nlh, flags);
38752469ffd7SJohn Fastabend 		if (err)
38762469ffd7SJohn Fastabend 			goto out;
38772469ffd7SJohn Fastabend 
38782469ffd7SJohn Fastabend 		flags &= ~BRIDGE_FLAGS_MASTER;
38792469ffd7SJohn Fastabend 	}
38802469ffd7SJohn Fastabend 
38812469ffd7SJohn Fastabend 	if ((flags & BRIDGE_FLAGS_SELF)) {
38822469ffd7SJohn Fastabend 		if (!dev->netdev_ops->ndo_bridge_setlink)
38832469ffd7SJohn Fastabend 			err = -EOPNOTSUPP;
38842469ffd7SJohn Fastabend 		else
3885add511b3SRoopa Prabhu 			err = dev->netdev_ops->ndo_bridge_setlink(dev, nlh,
3886add511b3SRoopa Prabhu 								  flags);
388702dba438SRoopa Prabhu 		if (!err) {
38882469ffd7SJohn Fastabend 			flags &= ~BRIDGE_FLAGS_SELF;
388902dba438SRoopa Prabhu 
389002dba438SRoopa Prabhu 			/* Generate event to notify upper layer of bridge
389102dba438SRoopa Prabhu 			 * change
389202dba438SRoopa Prabhu 			 */
389302dba438SRoopa Prabhu 			err = rtnl_bridge_notify(dev);
389402dba438SRoopa Prabhu 		}
38952469ffd7SJohn Fastabend 	}
38962469ffd7SJohn Fastabend 
3897c38e01b8SJohn Fastabend 	if (have_flags)
38982469ffd7SJohn Fastabend 		memcpy(nla_data(attr), &flags, sizeof(flags));
3899e5a55a89SJohn Fastabend out:
3900e5a55a89SJohn Fastabend 	return err;
3901e5a55a89SJohn Fastabend }
3902e5a55a89SJohn Fastabend 
3903c21ef3e3SDavid Ahern static int rtnl_bridge_dellink(struct sk_buff *skb, struct nlmsghdr *nlh,
3904c21ef3e3SDavid Ahern 			       struct netlink_ext_ack *extack)
3905407af329SVlad Yasevich {
3906407af329SVlad Yasevich 	struct net *net = sock_net(skb->sk);
3907407af329SVlad Yasevich 	struct ifinfomsg *ifm;
3908407af329SVlad Yasevich 	struct net_device *dev;
3909407af329SVlad Yasevich 	struct nlattr *br_spec, *attr = NULL;
3910407af329SVlad Yasevich 	int rem, err = -EOPNOTSUPP;
39114de8b413SRosen, Rami 	u16 flags = 0;
3912407af329SVlad Yasevich 	bool have_flags = false;
3913407af329SVlad Yasevich 
3914407af329SVlad Yasevich 	if (nlmsg_len(nlh) < sizeof(*ifm))
3915407af329SVlad Yasevich 		return -EINVAL;
3916407af329SVlad Yasevich 
3917407af329SVlad Yasevich 	ifm = nlmsg_data(nlh);
3918407af329SVlad Yasevich 	if (ifm->ifi_family != AF_BRIDGE)
3919407af329SVlad Yasevich 		return -EPFNOSUPPORT;
3920407af329SVlad Yasevich 
3921407af329SVlad Yasevich 	dev = __dev_get_by_index(net, ifm->ifi_index);
3922407af329SVlad Yasevich 	if (!dev) {
3923b88d12e4SFlorian Westphal 		NL_SET_ERR_MSG(extack, "unknown ifindex");
3924407af329SVlad Yasevich 		return -ENODEV;
3925407af329SVlad Yasevich 	}
3926407af329SVlad Yasevich 
3927407af329SVlad Yasevich 	br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
3928407af329SVlad Yasevich 	if (br_spec) {
3929407af329SVlad Yasevich 		nla_for_each_nested(attr, br_spec, rem) {
3930407af329SVlad Yasevich 			if (nla_type(attr) == IFLA_BRIDGE_FLAGS) {
39316e8d1c55SThomas Graf 				if (nla_len(attr) < sizeof(flags))
39326e8d1c55SThomas Graf 					return -EINVAL;
39336e8d1c55SThomas Graf 
3934407af329SVlad Yasevich 				have_flags = true;
3935407af329SVlad Yasevich 				flags = nla_get_u16(attr);
3936407af329SVlad Yasevich 				break;
3937407af329SVlad Yasevich 			}
3938407af329SVlad Yasevich 		}
3939407af329SVlad Yasevich 	}
3940407af329SVlad Yasevich 
3941407af329SVlad Yasevich 	if (!flags || (flags & BRIDGE_FLAGS_MASTER)) {
3942407af329SVlad Yasevich 		struct net_device *br_dev = netdev_master_upper_dev_get(dev);
3943407af329SVlad Yasevich 
3944407af329SVlad Yasevich 		if (!br_dev || !br_dev->netdev_ops->ndo_bridge_dellink) {
3945407af329SVlad Yasevich 			err = -EOPNOTSUPP;
3946407af329SVlad Yasevich 			goto out;
3947407af329SVlad Yasevich 		}
3948407af329SVlad Yasevich 
3949add511b3SRoopa Prabhu 		err = br_dev->netdev_ops->ndo_bridge_dellink(dev, nlh, flags);
3950407af329SVlad Yasevich 		if (err)
3951407af329SVlad Yasevich 			goto out;
3952407af329SVlad Yasevich 
3953407af329SVlad Yasevich 		flags &= ~BRIDGE_FLAGS_MASTER;
3954407af329SVlad Yasevich 	}
3955407af329SVlad Yasevich 
3956407af329SVlad Yasevich 	if ((flags & BRIDGE_FLAGS_SELF)) {
3957407af329SVlad Yasevich 		if (!dev->netdev_ops->ndo_bridge_dellink)
3958407af329SVlad Yasevich 			err = -EOPNOTSUPP;
3959407af329SVlad Yasevich 		else
3960add511b3SRoopa Prabhu 			err = dev->netdev_ops->ndo_bridge_dellink(dev, nlh,
3961add511b3SRoopa Prabhu 								  flags);
3962407af329SVlad Yasevich 
396302dba438SRoopa Prabhu 		if (!err) {
3964407af329SVlad Yasevich 			flags &= ~BRIDGE_FLAGS_SELF;
396502dba438SRoopa Prabhu 
396602dba438SRoopa Prabhu 			/* Generate event to notify upper layer of bridge
396702dba438SRoopa Prabhu 			 * change
396802dba438SRoopa Prabhu 			 */
396902dba438SRoopa Prabhu 			err = rtnl_bridge_notify(dev);
397002dba438SRoopa Prabhu 		}
3971407af329SVlad Yasevich 	}
3972407af329SVlad Yasevich 
3973407af329SVlad Yasevich 	if (have_flags)
3974407af329SVlad Yasevich 		memcpy(nla_data(attr), &flags, sizeof(flags));
3975407af329SVlad Yasevich out:
3976407af329SVlad Yasevich 	return err;
3977407af329SVlad Yasevich }
3978407af329SVlad Yasevich 
3979e8872a25SNikolay Aleksandrov static bool stats_attr_valid(unsigned int mask, int attrid, int idxattr)
3980e8872a25SNikolay Aleksandrov {
3981e8872a25SNikolay Aleksandrov 	return (mask & IFLA_STATS_FILTER_BIT(attrid)) &&
3982e8872a25SNikolay Aleksandrov 	       (!idxattr || idxattr == attrid);
3983e8872a25SNikolay Aleksandrov }
3984e8872a25SNikolay Aleksandrov 
398569ae6ad2SNogah Frankel #define IFLA_OFFLOAD_XSTATS_FIRST (IFLA_OFFLOAD_XSTATS_UNSPEC + 1)
398669ae6ad2SNogah Frankel static int rtnl_get_offload_stats_attr_size(int attr_id)
398769ae6ad2SNogah Frankel {
398869ae6ad2SNogah Frankel 	switch (attr_id) {
398969ae6ad2SNogah Frankel 	case IFLA_OFFLOAD_XSTATS_CPU_HIT:
399069ae6ad2SNogah Frankel 		return sizeof(struct rtnl_link_stats64);
399169ae6ad2SNogah Frankel 	}
399269ae6ad2SNogah Frankel 
399369ae6ad2SNogah Frankel 	return 0;
399469ae6ad2SNogah Frankel }
399569ae6ad2SNogah Frankel 
399669ae6ad2SNogah Frankel static int rtnl_get_offload_stats(struct sk_buff *skb, struct net_device *dev,
399769ae6ad2SNogah Frankel 				  int *prividx)
399869ae6ad2SNogah Frankel {
399969ae6ad2SNogah Frankel 	struct nlattr *attr = NULL;
400069ae6ad2SNogah Frankel 	int attr_id, size;
400169ae6ad2SNogah Frankel 	void *attr_data;
400269ae6ad2SNogah Frankel 	int err;
400369ae6ad2SNogah Frankel 
400469ae6ad2SNogah Frankel 	if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats &&
400569ae6ad2SNogah Frankel 	      dev->netdev_ops->ndo_get_offload_stats))
400669ae6ad2SNogah Frankel 		return -ENODATA;
400769ae6ad2SNogah Frankel 
400869ae6ad2SNogah Frankel 	for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST;
400969ae6ad2SNogah Frankel 	     attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) {
401069ae6ad2SNogah Frankel 		if (attr_id < *prividx)
401169ae6ad2SNogah Frankel 			continue;
401269ae6ad2SNogah Frankel 
401369ae6ad2SNogah Frankel 		size = rtnl_get_offload_stats_attr_size(attr_id);
401469ae6ad2SNogah Frankel 		if (!size)
401569ae6ad2SNogah Frankel 			continue;
401669ae6ad2SNogah Frankel 
40173df5b3c6SOr Gerlitz 		if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id))
401869ae6ad2SNogah Frankel 			continue;
401969ae6ad2SNogah Frankel 
402069ae6ad2SNogah Frankel 		attr = nla_reserve_64bit(skb, attr_id, size,
402169ae6ad2SNogah Frankel 					 IFLA_OFFLOAD_XSTATS_UNSPEC);
402269ae6ad2SNogah Frankel 		if (!attr)
402369ae6ad2SNogah Frankel 			goto nla_put_failure;
402469ae6ad2SNogah Frankel 
402569ae6ad2SNogah Frankel 		attr_data = nla_data(attr);
402669ae6ad2SNogah Frankel 		memset(attr_data, 0, size);
402769ae6ad2SNogah Frankel 		err = dev->netdev_ops->ndo_get_offload_stats(attr_id, dev,
402869ae6ad2SNogah Frankel 							     attr_data);
402969ae6ad2SNogah Frankel 		if (err)
403069ae6ad2SNogah Frankel 			goto get_offload_stats_failure;
403169ae6ad2SNogah Frankel 	}
403269ae6ad2SNogah Frankel 
403369ae6ad2SNogah Frankel 	if (!attr)
403469ae6ad2SNogah Frankel 		return -ENODATA;
403569ae6ad2SNogah Frankel 
403669ae6ad2SNogah Frankel 	*prividx = 0;
403769ae6ad2SNogah Frankel 	return 0;
403869ae6ad2SNogah Frankel 
403969ae6ad2SNogah Frankel nla_put_failure:
404069ae6ad2SNogah Frankel 	err = -EMSGSIZE;
404169ae6ad2SNogah Frankel get_offload_stats_failure:
404269ae6ad2SNogah Frankel 	*prividx = attr_id;
404369ae6ad2SNogah Frankel 	return err;
404469ae6ad2SNogah Frankel }
404569ae6ad2SNogah Frankel 
404669ae6ad2SNogah Frankel static int rtnl_get_offload_stats_size(const struct net_device *dev)
404769ae6ad2SNogah Frankel {
404869ae6ad2SNogah Frankel 	int nla_size = 0;
404969ae6ad2SNogah Frankel 	int attr_id;
405069ae6ad2SNogah Frankel 	int size;
405169ae6ad2SNogah Frankel 
405269ae6ad2SNogah Frankel 	if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats &&
405369ae6ad2SNogah Frankel 	      dev->netdev_ops->ndo_get_offload_stats))
405469ae6ad2SNogah Frankel 		return 0;
405569ae6ad2SNogah Frankel 
405669ae6ad2SNogah Frankel 	for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST;
405769ae6ad2SNogah Frankel 	     attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) {
40583df5b3c6SOr Gerlitz 		if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id))
405969ae6ad2SNogah Frankel 			continue;
406069ae6ad2SNogah Frankel 		size = rtnl_get_offload_stats_attr_size(attr_id);
406169ae6ad2SNogah Frankel 		nla_size += nla_total_size_64bit(size);
406269ae6ad2SNogah Frankel 	}
406369ae6ad2SNogah Frankel 
406469ae6ad2SNogah Frankel 	if (nla_size != 0)
406569ae6ad2SNogah Frankel 		nla_size += nla_total_size(0);
406669ae6ad2SNogah Frankel 
406769ae6ad2SNogah Frankel 	return nla_size;
406869ae6ad2SNogah Frankel }
406969ae6ad2SNogah Frankel 
407010c9ead9SRoopa Prabhu static int rtnl_fill_statsinfo(struct sk_buff *skb, struct net_device *dev,
407110c9ead9SRoopa Prabhu 			       int type, u32 pid, u32 seq, u32 change,
4072e8872a25SNikolay Aleksandrov 			       unsigned int flags, unsigned int filter_mask,
4073e8872a25SNikolay Aleksandrov 			       int *idxattr, int *prividx)
407410c9ead9SRoopa Prabhu {
407510c9ead9SRoopa Prabhu 	struct if_stats_msg *ifsm;
407610c9ead9SRoopa Prabhu 	struct nlmsghdr *nlh;
407710c9ead9SRoopa Prabhu 	struct nlattr *attr;
4078e8872a25SNikolay Aleksandrov 	int s_prividx = *prividx;
407969ae6ad2SNogah Frankel 	int err;
408010c9ead9SRoopa Prabhu 
408110c9ead9SRoopa Prabhu 	ASSERT_RTNL();
408210c9ead9SRoopa Prabhu 
408310c9ead9SRoopa Prabhu 	nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifsm), flags);
408410c9ead9SRoopa Prabhu 	if (!nlh)
408510c9ead9SRoopa Prabhu 		return -EMSGSIZE;
408610c9ead9SRoopa Prabhu 
408710c9ead9SRoopa Prabhu 	ifsm = nlmsg_data(nlh);
4088ce024f42SNikolay Aleksandrov 	ifsm->family = PF_UNSPEC;
4089ce024f42SNikolay Aleksandrov 	ifsm->pad1 = 0;
4090ce024f42SNikolay Aleksandrov 	ifsm->pad2 = 0;
409110c9ead9SRoopa Prabhu 	ifsm->ifindex = dev->ifindex;
409210c9ead9SRoopa Prabhu 	ifsm->filter_mask = filter_mask;
409310c9ead9SRoopa Prabhu 
4094e8872a25SNikolay Aleksandrov 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, *idxattr)) {
409510c9ead9SRoopa Prabhu 		struct rtnl_link_stats64 *sp;
409610c9ead9SRoopa Prabhu 
409758414d32SNicolas Dichtel 		attr = nla_reserve_64bit(skb, IFLA_STATS_LINK_64,
409858414d32SNicolas Dichtel 					 sizeof(struct rtnl_link_stats64),
409958414d32SNicolas Dichtel 					 IFLA_STATS_UNSPEC);
410010c9ead9SRoopa Prabhu 		if (!attr)
410110c9ead9SRoopa Prabhu 			goto nla_put_failure;
410210c9ead9SRoopa Prabhu 
410310c9ead9SRoopa Prabhu 		sp = nla_data(attr);
410410c9ead9SRoopa Prabhu 		dev_get_stats(dev, sp);
410510c9ead9SRoopa Prabhu 	}
410610c9ead9SRoopa Prabhu 
410797a47facSNikolay Aleksandrov 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, *idxattr)) {
410897a47facSNikolay Aleksandrov 		const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
410997a47facSNikolay Aleksandrov 
411097a47facSNikolay Aleksandrov 		if (ops && ops->fill_linkxstats) {
411197a47facSNikolay Aleksandrov 			*idxattr = IFLA_STATS_LINK_XSTATS;
411297a47facSNikolay Aleksandrov 			attr = nla_nest_start(skb,
411397a47facSNikolay Aleksandrov 					      IFLA_STATS_LINK_XSTATS);
411497a47facSNikolay Aleksandrov 			if (!attr)
411597a47facSNikolay Aleksandrov 				goto nla_put_failure;
411697a47facSNikolay Aleksandrov 
411780e73cc5SNikolay Aleksandrov 			err = ops->fill_linkxstats(skb, dev, prividx, *idxattr);
411880e73cc5SNikolay Aleksandrov 			nla_nest_end(skb, attr);
411980e73cc5SNikolay Aleksandrov 			if (err)
412080e73cc5SNikolay Aleksandrov 				goto nla_put_failure;
412180e73cc5SNikolay Aleksandrov 			*idxattr = 0;
412280e73cc5SNikolay Aleksandrov 		}
412380e73cc5SNikolay Aleksandrov 	}
412480e73cc5SNikolay Aleksandrov 
412580e73cc5SNikolay Aleksandrov 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE,
412680e73cc5SNikolay Aleksandrov 			     *idxattr)) {
412780e73cc5SNikolay Aleksandrov 		const struct rtnl_link_ops *ops = NULL;
412880e73cc5SNikolay Aleksandrov 		const struct net_device *master;
412980e73cc5SNikolay Aleksandrov 
413080e73cc5SNikolay Aleksandrov 		master = netdev_master_upper_dev_get(dev);
413180e73cc5SNikolay Aleksandrov 		if (master)
413280e73cc5SNikolay Aleksandrov 			ops = master->rtnl_link_ops;
413380e73cc5SNikolay Aleksandrov 		if (ops && ops->fill_linkxstats) {
413480e73cc5SNikolay Aleksandrov 			*idxattr = IFLA_STATS_LINK_XSTATS_SLAVE;
413580e73cc5SNikolay Aleksandrov 			attr = nla_nest_start(skb,
413680e73cc5SNikolay Aleksandrov 					      IFLA_STATS_LINK_XSTATS_SLAVE);
413780e73cc5SNikolay Aleksandrov 			if (!attr)
413880e73cc5SNikolay Aleksandrov 				goto nla_put_failure;
413980e73cc5SNikolay Aleksandrov 
414080e73cc5SNikolay Aleksandrov 			err = ops->fill_linkxstats(skb, dev, prividx, *idxattr);
414197a47facSNikolay Aleksandrov 			nla_nest_end(skb, attr);
414297a47facSNikolay Aleksandrov 			if (err)
414397a47facSNikolay Aleksandrov 				goto nla_put_failure;
414497a47facSNikolay Aleksandrov 			*idxattr = 0;
414597a47facSNikolay Aleksandrov 		}
414697a47facSNikolay Aleksandrov 	}
414797a47facSNikolay Aleksandrov 
414869ae6ad2SNogah Frankel 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS,
414969ae6ad2SNogah Frankel 			     *idxattr)) {
415069ae6ad2SNogah Frankel 		*idxattr = IFLA_STATS_LINK_OFFLOAD_XSTATS;
415169ae6ad2SNogah Frankel 		attr = nla_nest_start(skb, IFLA_STATS_LINK_OFFLOAD_XSTATS);
415269ae6ad2SNogah Frankel 		if (!attr)
415369ae6ad2SNogah Frankel 			goto nla_put_failure;
415469ae6ad2SNogah Frankel 
415569ae6ad2SNogah Frankel 		err = rtnl_get_offload_stats(skb, dev, prividx);
415669ae6ad2SNogah Frankel 		if (err == -ENODATA)
415769ae6ad2SNogah Frankel 			nla_nest_cancel(skb, attr);
415869ae6ad2SNogah Frankel 		else
415969ae6ad2SNogah Frankel 			nla_nest_end(skb, attr);
416069ae6ad2SNogah Frankel 
416169ae6ad2SNogah Frankel 		if (err && err != -ENODATA)
416269ae6ad2SNogah Frankel 			goto nla_put_failure;
416369ae6ad2SNogah Frankel 		*idxattr = 0;
416469ae6ad2SNogah Frankel 	}
416569ae6ad2SNogah Frankel 
4166aefb4d4aSRobert Shearman 	if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, *idxattr)) {
4167aefb4d4aSRobert Shearman 		struct rtnl_af_ops *af_ops;
4168aefb4d4aSRobert Shearman 
4169aefb4d4aSRobert Shearman 		*idxattr = IFLA_STATS_AF_SPEC;
4170aefb4d4aSRobert Shearman 		attr = nla_nest_start(skb, IFLA_STATS_AF_SPEC);
4171aefb4d4aSRobert Shearman 		if (!attr)
4172aefb4d4aSRobert Shearman 			goto nla_put_failure;
4173aefb4d4aSRobert Shearman 
41745fa85a09SFlorian Westphal 		rcu_read_lock();
41755fa85a09SFlorian Westphal 		list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
4176aefb4d4aSRobert Shearman 			if (af_ops->fill_stats_af) {
4177aefb4d4aSRobert Shearman 				struct nlattr *af;
4178aefb4d4aSRobert Shearman 				int err;
4179aefb4d4aSRobert Shearman 
4180aefb4d4aSRobert Shearman 				af = nla_nest_start(skb, af_ops->family);
41815fa85a09SFlorian Westphal 				if (!af) {
41825fa85a09SFlorian Westphal 					rcu_read_unlock();
4183aefb4d4aSRobert Shearman 					goto nla_put_failure;
41845fa85a09SFlorian Westphal 				}
4185aefb4d4aSRobert Shearman 				err = af_ops->fill_stats_af(skb, dev);
4186aefb4d4aSRobert Shearman 
41875fa85a09SFlorian Westphal 				if (err == -ENODATA) {
4188aefb4d4aSRobert Shearman 					nla_nest_cancel(skb, af);
41895fa85a09SFlorian Westphal 				} else if (err < 0) {
41905fa85a09SFlorian Westphal 					rcu_read_unlock();
4191aefb4d4aSRobert Shearman 					goto nla_put_failure;
41925fa85a09SFlorian Westphal 				}
4193aefb4d4aSRobert Shearman 
4194aefb4d4aSRobert Shearman 				nla_nest_end(skb, af);
4195aefb4d4aSRobert Shearman 			}
4196aefb4d4aSRobert Shearman 		}
41975fa85a09SFlorian Westphal 		rcu_read_unlock();
4198aefb4d4aSRobert Shearman 
4199aefb4d4aSRobert Shearman 		nla_nest_end(skb, attr);
4200aefb4d4aSRobert Shearman 
4201aefb4d4aSRobert Shearman 		*idxattr = 0;
4202aefb4d4aSRobert Shearman 	}
4203aefb4d4aSRobert Shearman 
420410c9ead9SRoopa Prabhu 	nlmsg_end(skb, nlh);
420510c9ead9SRoopa Prabhu 
420610c9ead9SRoopa Prabhu 	return 0;
420710c9ead9SRoopa Prabhu 
420810c9ead9SRoopa Prabhu nla_put_failure:
4209e8872a25SNikolay Aleksandrov 	/* not a multi message or no progress mean a real error */
4210e8872a25SNikolay Aleksandrov 	if (!(flags & NLM_F_MULTI) || s_prividx == *prividx)
421110c9ead9SRoopa Prabhu 		nlmsg_cancel(skb, nlh);
4212e8872a25SNikolay Aleksandrov 	else
4213e8872a25SNikolay Aleksandrov 		nlmsg_end(skb, nlh);
421410c9ead9SRoopa Prabhu 
421510c9ead9SRoopa Prabhu 	return -EMSGSIZE;
421610c9ead9SRoopa Prabhu }
421710c9ead9SRoopa Prabhu 
421810c9ead9SRoopa Prabhu static size_t if_nlmsg_stats_size(const struct net_device *dev,
421910c9ead9SRoopa Prabhu 				  u32 filter_mask)
422010c9ead9SRoopa Prabhu {
422110c9ead9SRoopa Prabhu 	size_t size = 0;
422210c9ead9SRoopa Prabhu 
4223e8872a25SNikolay Aleksandrov 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, 0))
422410c9ead9SRoopa Prabhu 		size += nla_total_size_64bit(sizeof(struct rtnl_link_stats64));
422510c9ead9SRoopa Prabhu 
422697a47facSNikolay Aleksandrov 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, 0)) {
422797a47facSNikolay Aleksandrov 		const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
422880e73cc5SNikolay Aleksandrov 		int attr = IFLA_STATS_LINK_XSTATS;
422997a47facSNikolay Aleksandrov 
423097a47facSNikolay Aleksandrov 		if (ops && ops->get_linkxstats_size) {
423180e73cc5SNikolay Aleksandrov 			size += nla_total_size(ops->get_linkxstats_size(dev,
423280e73cc5SNikolay Aleksandrov 									attr));
423397a47facSNikolay Aleksandrov 			/* for IFLA_STATS_LINK_XSTATS */
423497a47facSNikolay Aleksandrov 			size += nla_total_size(0);
423597a47facSNikolay Aleksandrov 		}
423697a47facSNikolay Aleksandrov 	}
423797a47facSNikolay Aleksandrov 
423880e73cc5SNikolay Aleksandrov 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 0)) {
423980e73cc5SNikolay Aleksandrov 		struct net_device *_dev = (struct net_device *)dev;
424080e73cc5SNikolay Aleksandrov 		const struct rtnl_link_ops *ops = NULL;
424180e73cc5SNikolay Aleksandrov 		const struct net_device *master;
424280e73cc5SNikolay Aleksandrov 
424380e73cc5SNikolay Aleksandrov 		/* netdev_master_upper_dev_get can't take const */
424480e73cc5SNikolay Aleksandrov 		master = netdev_master_upper_dev_get(_dev);
424580e73cc5SNikolay Aleksandrov 		if (master)
424680e73cc5SNikolay Aleksandrov 			ops = master->rtnl_link_ops;
424780e73cc5SNikolay Aleksandrov 		if (ops && ops->get_linkxstats_size) {
424880e73cc5SNikolay Aleksandrov 			int attr = IFLA_STATS_LINK_XSTATS_SLAVE;
424980e73cc5SNikolay Aleksandrov 
425080e73cc5SNikolay Aleksandrov 			size += nla_total_size(ops->get_linkxstats_size(dev,
425180e73cc5SNikolay Aleksandrov 									attr));
425280e73cc5SNikolay Aleksandrov 			/* for IFLA_STATS_LINK_XSTATS_SLAVE */
425380e73cc5SNikolay Aleksandrov 			size += nla_total_size(0);
425480e73cc5SNikolay Aleksandrov 		}
425580e73cc5SNikolay Aleksandrov 	}
425680e73cc5SNikolay Aleksandrov 
425769ae6ad2SNogah Frankel 	if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 0))
425869ae6ad2SNogah Frankel 		size += rtnl_get_offload_stats_size(dev);
425969ae6ad2SNogah Frankel 
4260aefb4d4aSRobert Shearman 	if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, 0)) {
4261aefb4d4aSRobert Shearman 		struct rtnl_af_ops *af_ops;
4262aefb4d4aSRobert Shearman 
4263aefb4d4aSRobert Shearman 		/* for IFLA_STATS_AF_SPEC */
4264aefb4d4aSRobert Shearman 		size += nla_total_size(0);
4265aefb4d4aSRobert Shearman 
42665fa85a09SFlorian Westphal 		rcu_read_lock();
42675fa85a09SFlorian Westphal 		list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
4268aefb4d4aSRobert Shearman 			if (af_ops->get_stats_af_size) {
4269aefb4d4aSRobert Shearman 				size += nla_total_size(
4270aefb4d4aSRobert Shearman 					af_ops->get_stats_af_size(dev));
4271aefb4d4aSRobert Shearman 
4272aefb4d4aSRobert Shearman 				/* for AF_* */
4273aefb4d4aSRobert Shearman 				size += nla_total_size(0);
4274aefb4d4aSRobert Shearman 			}
4275aefb4d4aSRobert Shearman 		}
42765fa85a09SFlorian Westphal 		rcu_read_unlock();
4277aefb4d4aSRobert Shearman 	}
4278aefb4d4aSRobert Shearman 
427910c9ead9SRoopa Prabhu 	return size;
428010c9ead9SRoopa Prabhu }
428110c9ead9SRoopa Prabhu 
4282c21ef3e3SDavid Ahern static int rtnl_stats_get(struct sk_buff *skb, struct nlmsghdr *nlh,
4283c21ef3e3SDavid Ahern 			  struct netlink_ext_ack *extack)
428410c9ead9SRoopa Prabhu {
428510c9ead9SRoopa Prabhu 	struct net *net = sock_net(skb->sk);
428610c9ead9SRoopa Prabhu 	struct net_device *dev = NULL;
4287e8872a25SNikolay Aleksandrov 	int idxattr = 0, prividx = 0;
4288e8872a25SNikolay Aleksandrov 	struct if_stats_msg *ifsm;
428910c9ead9SRoopa Prabhu 	struct sk_buff *nskb;
429010c9ead9SRoopa Prabhu 	u32 filter_mask;
429110c9ead9SRoopa Prabhu 	int err;
429210c9ead9SRoopa Prabhu 
42934775cc1fSMathias Krause 	if (nlmsg_len(nlh) < sizeof(*ifsm))
42944775cc1fSMathias Krause 		return -EINVAL;
42954775cc1fSMathias Krause 
429610c9ead9SRoopa Prabhu 	ifsm = nlmsg_data(nlh);
429710c9ead9SRoopa Prabhu 	if (ifsm->ifindex > 0)
429810c9ead9SRoopa Prabhu 		dev = __dev_get_by_index(net, ifsm->ifindex);
429910c9ead9SRoopa Prabhu 	else
430010c9ead9SRoopa Prabhu 		return -EINVAL;
430110c9ead9SRoopa Prabhu 
430210c9ead9SRoopa Prabhu 	if (!dev)
430310c9ead9SRoopa Prabhu 		return -ENODEV;
430410c9ead9SRoopa Prabhu 
430510c9ead9SRoopa Prabhu 	filter_mask = ifsm->filter_mask;
430610c9ead9SRoopa Prabhu 	if (!filter_mask)
430710c9ead9SRoopa Prabhu 		return -EINVAL;
430810c9ead9SRoopa Prabhu 
430910c9ead9SRoopa Prabhu 	nskb = nlmsg_new(if_nlmsg_stats_size(dev, filter_mask), GFP_KERNEL);
431010c9ead9SRoopa Prabhu 	if (!nskb)
431110c9ead9SRoopa Prabhu 		return -ENOBUFS;
431210c9ead9SRoopa Prabhu 
431310c9ead9SRoopa Prabhu 	err = rtnl_fill_statsinfo(nskb, dev, RTM_NEWSTATS,
431410c9ead9SRoopa Prabhu 				  NETLINK_CB(skb).portid, nlh->nlmsg_seq, 0,
4315e8872a25SNikolay Aleksandrov 				  0, filter_mask, &idxattr, &prividx);
431610c9ead9SRoopa Prabhu 	if (err < 0) {
431710c9ead9SRoopa Prabhu 		/* -EMSGSIZE implies BUG in if_nlmsg_stats_size */
431810c9ead9SRoopa Prabhu 		WARN_ON(err == -EMSGSIZE);
431910c9ead9SRoopa Prabhu 		kfree_skb(nskb);
432010c9ead9SRoopa Prabhu 	} else {
432110c9ead9SRoopa Prabhu 		err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid);
432210c9ead9SRoopa Prabhu 	}
432310c9ead9SRoopa Prabhu 
432410c9ead9SRoopa Prabhu 	return err;
432510c9ead9SRoopa Prabhu }
432610c9ead9SRoopa Prabhu 
432710c9ead9SRoopa Prabhu static int rtnl_stats_dump(struct sk_buff *skb, struct netlink_callback *cb)
432810c9ead9SRoopa Prabhu {
4329e8872a25SNikolay Aleksandrov 	int h, s_h, err, s_idx, s_idxattr, s_prividx;
433010c9ead9SRoopa Prabhu 	struct net *net = sock_net(skb->sk);
433110c9ead9SRoopa Prabhu 	unsigned int flags = NLM_F_MULTI;
4332e8872a25SNikolay Aleksandrov 	struct if_stats_msg *ifsm;
4333e8872a25SNikolay Aleksandrov 	struct hlist_head *head;
4334e8872a25SNikolay Aleksandrov 	struct net_device *dev;
433510c9ead9SRoopa Prabhu 	u32 filter_mask = 0;
4336e8872a25SNikolay Aleksandrov 	int idx = 0;
433710c9ead9SRoopa Prabhu 
433810c9ead9SRoopa Prabhu 	s_h = cb->args[0];
433910c9ead9SRoopa Prabhu 	s_idx = cb->args[1];
4340e8872a25SNikolay Aleksandrov 	s_idxattr = cb->args[2];
4341e8872a25SNikolay Aleksandrov 	s_prividx = cb->args[3];
434210c9ead9SRoopa Prabhu 
434310c9ead9SRoopa Prabhu 	cb->seq = net->dev_base_seq;
434410c9ead9SRoopa Prabhu 
43454775cc1fSMathias Krause 	if (nlmsg_len(cb->nlh) < sizeof(*ifsm))
43464775cc1fSMathias Krause 		return -EINVAL;
43474775cc1fSMathias Krause 
434810c9ead9SRoopa Prabhu 	ifsm = nlmsg_data(cb->nlh);
434910c9ead9SRoopa Prabhu 	filter_mask = ifsm->filter_mask;
435010c9ead9SRoopa Prabhu 	if (!filter_mask)
435110c9ead9SRoopa Prabhu 		return -EINVAL;
435210c9ead9SRoopa Prabhu 
435310c9ead9SRoopa Prabhu 	for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
435410c9ead9SRoopa Prabhu 		idx = 0;
435510c9ead9SRoopa Prabhu 		head = &net->dev_index_head[h];
435610c9ead9SRoopa Prabhu 		hlist_for_each_entry(dev, head, index_hlist) {
435710c9ead9SRoopa Prabhu 			if (idx < s_idx)
435810c9ead9SRoopa Prabhu 				goto cont;
435910c9ead9SRoopa Prabhu 			err = rtnl_fill_statsinfo(skb, dev, RTM_NEWSTATS,
436010c9ead9SRoopa Prabhu 						  NETLINK_CB(cb->skb).portid,
436110c9ead9SRoopa Prabhu 						  cb->nlh->nlmsg_seq, 0,
4362e8872a25SNikolay Aleksandrov 						  flags, filter_mask,
4363e8872a25SNikolay Aleksandrov 						  &s_idxattr, &s_prividx);
436410c9ead9SRoopa Prabhu 			/* If we ran out of room on the first message,
436510c9ead9SRoopa Prabhu 			 * we're in trouble
436610c9ead9SRoopa Prabhu 			 */
436710c9ead9SRoopa Prabhu 			WARN_ON((err == -EMSGSIZE) && (skb->len == 0));
436810c9ead9SRoopa Prabhu 
436910c9ead9SRoopa Prabhu 			if (err < 0)
437010c9ead9SRoopa Prabhu 				goto out;
4371e8872a25SNikolay Aleksandrov 			s_prividx = 0;
4372e8872a25SNikolay Aleksandrov 			s_idxattr = 0;
437310c9ead9SRoopa Prabhu 			nl_dump_check_consistent(cb, nlmsg_hdr(skb));
437410c9ead9SRoopa Prabhu cont:
437510c9ead9SRoopa Prabhu 			idx++;
437610c9ead9SRoopa Prabhu 		}
437710c9ead9SRoopa Prabhu 	}
437810c9ead9SRoopa Prabhu out:
4379e8872a25SNikolay Aleksandrov 	cb->args[3] = s_prividx;
4380e8872a25SNikolay Aleksandrov 	cb->args[2] = s_idxattr;
438110c9ead9SRoopa Prabhu 	cb->args[1] = idx;
438210c9ead9SRoopa Prabhu 	cb->args[0] = h;
438310c9ead9SRoopa Prabhu 
438410c9ead9SRoopa Prabhu 	return skb->len;
438510c9ead9SRoopa Prabhu }
438610c9ead9SRoopa Prabhu 
43871da177e4SLinus Torvalds /* Process one rtnetlink message. */
43881da177e4SLinus Torvalds 
43892d4bc933SJohannes Berg static int rtnetlink_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh,
43902d4bc933SJohannes Berg 			     struct netlink_ext_ack *extack)
43911da177e4SLinus Torvalds {
43923b1e0a65SYOSHIFUJI Hideaki 	struct net *net = sock_net(skb->sk);
4393addf9b90SFlorian Westphal 	struct rtnl_link *link;
4394e4202511SFlorian Westphal 	struct module *owner;
43956853dd48SFlorian Westphal 	int err = -EOPNOTSUPP;
4396e2849863SThomas Graf 	rtnl_doit_func doit;
439762256f98SFlorian Westphal 	unsigned int flags;
4398617cfc75SAlexander Kuleshov 	int kind;
43991da177e4SLinus Torvalds 	int family;
44001da177e4SLinus Torvalds 	int type;
44011da177e4SLinus Torvalds 
44021da177e4SLinus Torvalds 	type = nlh->nlmsg_type;
44031da177e4SLinus Torvalds 	if (type > RTM_MAX)
4404038890feSThomas Graf 		return -EOPNOTSUPP;
44051da177e4SLinus Torvalds 
44061da177e4SLinus Torvalds 	type -= RTM_BASE;
44071da177e4SLinus Torvalds 
44081da177e4SLinus Torvalds 	/* All the messages must have at least 1 byte length */
4409573ce260SHong zhi guo 	if (nlmsg_len(nlh) < sizeof(struct rtgenmsg))
44101da177e4SLinus Torvalds 		return 0;
44111da177e4SLinus Torvalds 
4412573ce260SHong zhi guo 	family = ((struct rtgenmsg *)nlmsg_data(nlh))->rtgen_family;
44131da177e4SLinus Torvalds 	kind = type&3;
44141da177e4SLinus Torvalds 
441590f62cf3SEric W. Biederman 	if (kind != 2 && !netlink_net_capable(skb, CAP_NET_ADMIN))
44161d00a4ebSThomas Graf 		return -EPERM;
44171da177e4SLinus Torvalds 
44186853dd48SFlorian Westphal 	rcu_read_lock();
4419b8f3ab42SDavid S. Miller 	if (kind == 2 && nlh->nlmsg_flags&NLM_F_DUMP) {
442097c53cacSDenis V. Lunev 		struct sock *rtnl;
4421e2849863SThomas Graf 		rtnl_dumpit_func dumpit;
4422c7ac8679SGreg Rose 		u16 min_dump_alloc = 0;
44231da177e4SLinus Torvalds 
4424addf9b90SFlorian Westphal 		link = rtnl_get_link(family, type);
4425addf9b90SFlorian Westphal 		if (!link || !link->dumpit) {
44266853dd48SFlorian Westphal 			family = PF_UNSPEC;
4427addf9b90SFlorian Westphal 			link = rtnl_get_link(family, type);
4428addf9b90SFlorian Westphal 			if (!link || !link->dumpit)
44296853dd48SFlorian Westphal 				goto err_unlock;
44306853dd48SFlorian Westphal 		}
4431e4202511SFlorian Westphal 		owner = link->owner;
4432addf9b90SFlorian Westphal 		dumpit = link->dumpit;
44336853dd48SFlorian Westphal 
44345c2bb9b6SFlorian Westphal 		if (type == RTM_GETLINK - RTM_BASE)
4435e1fa6d21SFlorian Westphal 			min_dump_alloc = rtnl_calcit(skb, nlh);
44361da177e4SLinus Torvalds 
4437e4202511SFlorian Westphal 		err = 0;
4438e4202511SFlorian Westphal 		/* need to do this before rcu_read_unlock() */
4439e4202511SFlorian Westphal 		if (!try_module_get(owner))
4440e4202511SFlorian Westphal 			err = -EPROTONOSUPPORT;
4441e4202511SFlorian Westphal 
44426853dd48SFlorian Westphal 		rcu_read_unlock();
44436853dd48SFlorian Westphal 
444497c53cacSDenis V. Lunev 		rtnl = net->rtnl;
4445e4202511SFlorian Westphal 		if (err == 0) {
444680d326faSPablo Neira Ayuso 			struct netlink_dump_control c = {
444780d326faSPablo Neira Ayuso 				.dump		= dumpit,
444880d326faSPablo Neira Ayuso 				.min_dump_alloc	= min_dump_alloc,
4449e4202511SFlorian Westphal 				.module		= owner,
445080d326faSPablo Neira Ayuso 			};
445180d326faSPablo Neira Ayuso 			err = netlink_dump_start(rtnl, skb, nlh, &c);
4452e4202511SFlorian Westphal 			/* netlink_dump_start() will keep a reference on
4453e4202511SFlorian Westphal 			 * module if dump is still in progress.
4454e4202511SFlorian Westphal 			 */
4455e4202511SFlorian Westphal 			module_put(owner);
445680d326faSPablo Neira Ayuso 		}
44572907c35fSEric Dumazet 		return err;
44581da177e4SLinus Torvalds 	}
44591da177e4SLinus Torvalds 
4460addf9b90SFlorian Westphal 	link = rtnl_get_link(family, type);
4461addf9b90SFlorian Westphal 	if (!link || !link->doit) {
44628caa38b5SFlorian Westphal 		family = PF_UNSPEC;
4463addf9b90SFlorian Westphal 		link = rtnl_get_link(PF_UNSPEC, type);
4464addf9b90SFlorian Westphal 		if (!link || !link->doit)
4465addf9b90SFlorian Westphal 			goto out_unlock;
44668caa38b5SFlorian Westphal 	}
44678caa38b5SFlorian Westphal 
4468e4202511SFlorian Westphal 	owner = link->owner;
4469e4202511SFlorian Westphal 	if (!try_module_get(owner)) {
4470e4202511SFlorian Westphal 		err = -EPROTONOSUPPORT;
4471e4202511SFlorian Westphal 		goto out_unlock;
4472e4202511SFlorian Westphal 	}
4473e4202511SFlorian Westphal 
4474addf9b90SFlorian Westphal 	flags = link->flags;
447562256f98SFlorian Westphal 	if (flags & RTNL_FLAG_DOIT_UNLOCKED) {
4476addf9b90SFlorian Westphal 		doit = link->doit;
447762256f98SFlorian Westphal 		rcu_read_unlock();
447862256f98SFlorian Westphal 		if (doit)
447962256f98SFlorian Westphal 			err = doit(skb, nlh, extack);
4480e4202511SFlorian Westphal 		module_put(owner);
448162256f98SFlorian Westphal 		return err;
448262256f98SFlorian Westphal 	}
44836853dd48SFlorian Westphal 	rcu_read_unlock();
44846853dd48SFlorian Westphal 
44850cc09020SFlorian Westphal 	rtnl_lock();
4486addf9b90SFlorian Westphal 	link = rtnl_get_link(family, type);
4487addf9b90SFlorian Westphal 	if (link && link->doit)
4488addf9b90SFlorian Westphal 		err = link->doit(skb, nlh, extack);
44890cc09020SFlorian Westphal 	rtnl_unlock();
4490addf9b90SFlorian Westphal 
4491e4202511SFlorian Westphal 	module_put(owner);
4492e4202511SFlorian Westphal 
4493addf9b90SFlorian Westphal 	return err;
4494addf9b90SFlorian Westphal 
4495addf9b90SFlorian Westphal out_unlock:
4496addf9b90SFlorian Westphal 	rcu_read_unlock();
44970cc09020SFlorian Westphal 	return err;
44980cc09020SFlorian Westphal 
44990cc09020SFlorian Westphal err_unlock:
45006853dd48SFlorian Westphal 	rcu_read_unlock();
45010cc09020SFlorian Westphal 	return -EOPNOTSUPP;
45021da177e4SLinus Torvalds }
45031da177e4SLinus Torvalds 
4504cd40b7d3SDenis V. Lunev static void rtnetlink_rcv(struct sk_buff *skb)
45051da177e4SLinus Torvalds {
4506cd40b7d3SDenis V. Lunev 	netlink_rcv_skb(skb, &rtnetlink_rcv_msg);
45071da177e4SLinus Torvalds }
45081da177e4SLinus Torvalds 
45095f729eaaSJulien Gomes static int rtnetlink_bind(struct net *net, int group)
45105f729eaaSJulien Gomes {
45115f729eaaSJulien Gomes 	switch (group) {
45125f729eaaSJulien Gomes 	case RTNLGRP_IPV4_MROUTE_R:
45135f729eaaSJulien Gomes 	case RTNLGRP_IPV6_MROUTE_R:
45145f729eaaSJulien Gomes 		if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
45155f729eaaSJulien Gomes 			return -EPERM;
45165f729eaaSJulien Gomes 		break;
45175f729eaaSJulien Gomes 	}
45185f729eaaSJulien Gomes 	return 0;
45195f729eaaSJulien Gomes }
45205f729eaaSJulien Gomes 
45211da177e4SLinus Torvalds static int rtnetlink_event(struct notifier_block *this, unsigned long event, void *ptr)
45221da177e4SLinus Torvalds {
4523351638e7SJiri Pirko 	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
4524e9dc8653SEric W. Biederman 
45251da177e4SLinus Torvalds 	switch (event) {
45265138e86fSVlad Yasevich 	case NETDEV_REBOOT:
45278a212589SXin Long 	case NETDEV_CHANGEMTU:
45283753654eSDavid Ahern 	case NETDEV_CHANGEADDR:
45295138e86fSVlad Yasevich 	case NETDEV_CHANGENAME:
45305138e86fSVlad Yasevich 	case NETDEV_FEAT_CHANGE:
45315138e86fSVlad Yasevich 	case NETDEV_BONDING_FAILOVER:
4532e6e66594SXin Long 	case NETDEV_POST_TYPE_CHANGE:
45335138e86fSVlad Yasevich 	case NETDEV_NOTIFY_PEERS:
4534dc709f37SXin Long 	case NETDEV_CHANGEUPPER:
45355138e86fSVlad Yasevich 	case NETDEV_RESEND_IGMP:
45365138e86fSVlad Yasevich 	case NETDEV_CHANGEINFODATA:
4537eeda3fb9SXin Long 	case NETDEV_CHANGELOWERSTATE:
4538ebdcf045SXin Long 	case NETDEV_CHANGE_TX_QUEUE_LEN:
45393d3ea5afSVlad Yasevich 		rtmsg_ifinfo_event(RTM_NEWLINK, dev, 0, rtnl_get_event(event),
45406621dd29SNicolas Dichtel 				   GFP_KERNEL, NULL);
45411da177e4SLinus Torvalds 		break;
45421da177e4SLinus Torvalds 	default:
45431da177e4SLinus Torvalds 		break;
45441da177e4SLinus Torvalds 	}
45451da177e4SLinus Torvalds 	return NOTIFY_DONE;
45461da177e4SLinus Torvalds }
45471da177e4SLinus Torvalds 
45481da177e4SLinus Torvalds static struct notifier_block rtnetlink_dev_notifier = {
45491da177e4SLinus Torvalds 	.notifier_call	= rtnetlink_event,
45501da177e4SLinus Torvalds };
45511da177e4SLinus Torvalds 
455297c53cacSDenis V. Lunev 
45532c8c1e72SAlexey Dobriyan static int __net_init rtnetlink_net_init(struct net *net)
455497c53cacSDenis V. Lunev {
455597c53cacSDenis V. Lunev 	struct sock *sk;
4556a31f2d17SPablo Neira Ayuso 	struct netlink_kernel_cfg cfg = {
4557a31f2d17SPablo Neira Ayuso 		.groups		= RTNLGRP_MAX,
4558a31f2d17SPablo Neira Ayuso 		.input		= rtnetlink_rcv,
4559a31f2d17SPablo Neira Ayuso 		.cb_mutex	= &rtnl_mutex,
45609785e10aSPablo Neira Ayuso 		.flags		= NL_CFG_F_NONROOT_RECV,
45615f729eaaSJulien Gomes 		.bind		= rtnetlink_bind,
4562a31f2d17SPablo Neira Ayuso 	};
4563a31f2d17SPablo Neira Ayuso 
45649f00d977SPablo Neira Ayuso 	sk = netlink_kernel_create(net, NETLINK_ROUTE, &cfg);
456597c53cacSDenis V. Lunev 	if (!sk)
456697c53cacSDenis V. Lunev 		return -ENOMEM;
456797c53cacSDenis V. Lunev 	net->rtnl = sk;
456897c53cacSDenis V. Lunev 	return 0;
456997c53cacSDenis V. Lunev }
457097c53cacSDenis V. Lunev 
45712c8c1e72SAlexey Dobriyan static void __net_exit rtnetlink_net_exit(struct net *net)
457297c53cacSDenis V. Lunev {
4573b7c6ba6eSDenis V. Lunev 	netlink_kernel_release(net->rtnl);
457497c53cacSDenis V. Lunev 	net->rtnl = NULL;
457597c53cacSDenis V. Lunev }
457697c53cacSDenis V. Lunev 
457797c53cacSDenis V. Lunev static struct pernet_operations rtnetlink_net_ops = {
457897c53cacSDenis V. Lunev 	.init = rtnetlink_net_init,
457997c53cacSDenis V. Lunev 	.exit = rtnetlink_net_exit,
458097c53cacSDenis V. Lunev };
458197c53cacSDenis V. Lunev 
45821da177e4SLinus Torvalds void __init rtnetlink_init(void)
45831da177e4SLinus Torvalds {
458497c53cacSDenis V. Lunev 	if (register_pernet_subsys(&rtnetlink_net_ops))
45851da177e4SLinus Torvalds 		panic("rtnetlink_init: cannot initialize rtnetlink\n");
458697c53cacSDenis V. Lunev 
45871da177e4SLinus Torvalds 	register_netdevice_notifier(&rtnetlink_dev_notifier);
4588340d17fcSThomas Graf 
4589c7ac8679SGreg Rose 	rtnl_register(PF_UNSPEC, RTM_GETLINK, rtnl_getlink,
4590b97bac64SFlorian Westphal 		      rtnl_dump_ifinfo, 0);
4591b97bac64SFlorian Westphal 	rtnl_register(PF_UNSPEC, RTM_SETLINK, rtnl_setlink, NULL, 0);
4592b97bac64SFlorian Westphal 	rtnl_register(PF_UNSPEC, RTM_NEWLINK, rtnl_newlink, NULL, 0);
4593b97bac64SFlorian Westphal 	rtnl_register(PF_UNSPEC, RTM_DELLINK, rtnl_dellink, NULL, 0);
4594687ad8ccSThomas Graf 
4595b97bac64SFlorian Westphal 	rtnl_register(PF_UNSPEC, RTM_GETADDR, NULL, rtnl_dump_all, 0);
4596b97bac64SFlorian Westphal 	rtnl_register(PF_UNSPEC, RTM_GETROUTE, NULL, rtnl_dump_all, 0);
4597b97bac64SFlorian Westphal 	rtnl_register(PF_UNSPEC, RTM_GETNETCONF, NULL, rtnl_dump_all, 0);
459877162022SJohn Fastabend 
4599b97bac64SFlorian Westphal 	rtnl_register(PF_BRIDGE, RTM_NEWNEIGH, rtnl_fdb_add, NULL, 0);
4600b97bac64SFlorian Westphal 	rtnl_register(PF_BRIDGE, RTM_DELNEIGH, rtnl_fdb_del, NULL, 0);
4601b97bac64SFlorian Westphal 	rtnl_register(PF_BRIDGE, RTM_GETNEIGH, NULL, rtnl_fdb_dump, 0);
4602e5a55a89SJohn Fastabend 
4603b97bac64SFlorian Westphal 	rtnl_register(PF_BRIDGE, RTM_GETLINK, NULL, rtnl_bridge_getlink, 0);
4604b97bac64SFlorian Westphal 	rtnl_register(PF_BRIDGE, RTM_DELLINK, rtnl_bridge_dellink, NULL, 0);
4605b97bac64SFlorian Westphal 	rtnl_register(PF_BRIDGE, RTM_SETLINK, rtnl_bridge_setlink, NULL, 0);
460610c9ead9SRoopa Prabhu 
460710c9ead9SRoopa Prabhu 	rtnl_register(PF_UNSPEC, RTM_GETSTATS, rtnl_stats_get, rtnl_stats_dump,
4608b97bac64SFlorian Westphal 		      0);
46091da177e4SLinus Torvalds }
4610