]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - net/core/rtnetlink.c
projects / mirror_ubuntu-bionic-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
dev: always advertise the new nsid when the netns iface changes
[mirror_ubuntu-bionic-kernel.git] / net / core / rtnetlink.c
CommitLineData
1da177e4
LT		 1/*
2 * INET An implementation of the TCP/IP protocol suite for the LINUX
3 * operating system. INET is implemented using the BSD Socket
4 * interface as the means of communication with the user level.
5 *
6 * Routing netlink socket interface: protocol independent part.
7 *
8 * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
9 *
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License
12 * as published by the Free Software Foundation; either version
13 * 2 of the License, or (at your option) any later version.
14 *
15 * Fixes:
16 * Vitaly E. Lavrov RTA_OK arithmetics was wrong.
17 */
18
ee5d032f 19#include <linux/bitops.h>
1da177e4
LT		 20#include <linux/errno.h>
21#include <linux/module.h>
22#include <linux/types.h>
23#include <linux/socket.h>
24#include <linux/kernel.h>
1da177e4
LT		 25#include <linux/timer.h>
26#include <linux/string.h>
27#include <linux/sockios.h>
28#include <linux/net.h>
29#include <linux/fcntl.h>
30#include <linux/mm.h>
31#include <linux/slab.h>
32#include <linux/interrupt.h>
33#include <linux/capability.h>
34#include <linux/skbuff.h>
35#include <linux/init.h>
36#include <linux/security.h>
6756ae4b 37#include <linux/mutex.h>
1823730f 38#include <linux/if_addr.h>
77162022 39#include <linux/if_bridge.h>
f6f6424b 40#include <linux/if_vlan.h>
ebc08a6f 41#include <linux/pci.h>
77162022 42#include <linux/etherdevice.h>
58038695 43#include <linux/bpf.h>
1da177e4 44
7c0f6ba6 45#include <linux/uaccess.h>
1da177e4
LT		 46
47#include <linux/inet.h>
48#include <linux/netdevice.h>
82f28412 49#include <net/switchdev.h>
1da177e4
LT		 50#include <net/ip.h>
51#include <net/protocol.h>
52#include <net/arp.h>
53#include <net/route.h>
54#include <net/udp.h>
ea697639 55#include <net/tcp.h>
1da177e4
LT		 56#include <net/sock.h>
57#include <net/pkt_sched.h>
14c0b97d 58#include <net/fib_rules.h>
e2849863 59#include <net/rtnetlink.h>
30ffee84 60#include <net/net_namespace.h>
1da177e4 61
e0d087af 62struct rtnl_link {
e2849863
TG		 63 rtnl_doit_func doit;
64 rtnl_dumpit_func dumpit;
62256f98 65 unsigned int flags;
e2849863
TG		 66};
67
6756ae4b 68static DEFINE_MUTEX(rtnl_mutex);
1da177e4
LT		 69
70void rtnl_lock(void)
71{
6756ae4b 72 mutex_lock(&rtnl_mutex);
1da177e4 73}
e0d087af 74EXPORT_SYMBOL(rtnl_lock);
1da177e4 75
1b5c5493
ED		 76static struct sk_buff *defer_kfree_skb_list;
77void rtnl_kfree_skbs(struct sk_buff *head, struct sk_buff *tail)
78{
79 if (head && tail) {
80 tail->next = defer_kfree_skb_list;
81 defer_kfree_skb_list = head;
82 }
83}
84EXPORT_SYMBOL(rtnl_kfree_skbs);
85
6756ae4b 86void __rtnl_unlock(void)
1da177e4 87{
1b5c5493
ED		 88 struct sk_buff *head = defer_kfree_skb_list;
89
90 defer_kfree_skb_list = NULL;
91
6756ae4b 92 mutex_unlock(&rtnl_mutex);
1b5c5493
ED		 93
94 while (head) {
95 struct sk_buff *next = head->next;
96
97 kfree_skb(head);
98 cond_resched();
99 head = next;
100 }
1da177e4 101}
6756ae4b 102
1da177e4
LT		 103void rtnl_unlock(void)
104{
58ec3b4d 105 /* This fellow will unlock it for us. */
1da177e4
LT		 106 netdev_run_todo();
107}
e0d087af 108EXPORT_SYMBOL(rtnl_unlock);
1da177e4 109
6756ae4b
SH		 110int rtnl_trylock(void)
111{
112 return mutex_trylock(&rtnl_mutex);
113}
e0d087af 114EXPORT_SYMBOL(rtnl_trylock);
6756ae4b 115
c9c1014b
PM		 116int rtnl_is_locked(void)
117{
118 return mutex_is_locked(&rtnl_mutex);
119}
e0d087af 120EXPORT_SYMBOL(rtnl_is_locked);
c9c1014b 121
a898def2 122#ifdef CONFIG_PROVE_LOCKING
0cbf3343 123bool lockdep_rtnl_is_held(void)
a898def2
PM		 124{
125 return lockdep_is_held(&rtnl_mutex);
126}
127EXPORT_SYMBOL(lockdep_rtnl_is_held);
128#endif /* #ifdef CONFIG_PROVE_LOCKING */
129
6853dd48 130static struct rtnl_link __rcu *rtnl_msg_handlers[RTNL_FAMILY_MAX + 1];
019a3169 131static refcount_t rtnl_msg_handlers_ref[RTNL_FAMILY_MAX + 1];
e2849863
TG		 132
133static inline int rtm_msgindex(int msgtype)
134{
135 int msgindex = msgtype - RTM_BASE;
136
137 /*
138 * msgindex < 0 implies someone tried to register a netlink
139 * control code. msgindex >= RTM_NR_MSGTYPES may indicate that
140 * the message type has not been added to linux/rtnetlink.h
141 */
142 BUG_ON(msgindex < 0 || msgindex >= RTM_NR_MSGTYPES);
143
144 return msgindex;
145}
146
e2849863
TG		 147/**
148 * __rtnl_register - Register a rtnetlink message type
149 * @protocol: Protocol family or PF_UNSPEC
150 * @msgtype: rtnetlink message type
151 * @doit: Function pointer called for each request message
152 * @dumpit: Function pointer called for each dump request (NLM_F_DUMP) message
b97bac64 153 * @flags: rtnl_link_flags to modifiy behaviour of doit/dumpit functions
e2849863
TG		 154 *
155 * Registers the specified function pointers (at least one of them has
156 * to be non-NULL) to be called whenever a request message for the
157 * specified protocol family and message type is received.
158 *
159 * The special protocol family PF_UNSPEC may be used to define fallback
160 * function pointers for the case when no entry for the specific protocol
161 * family exists.
162 *
163 * Returns 0 on success or a negative error code.
164 */
165int __rtnl_register(int protocol, int msgtype,
c7ac8679 166 rtnl_doit_func doit, rtnl_dumpit_func dumpit,
b97bac64 167 unsigned int flags)
e2849863
TG		 168{
169 struct rtnl_link *tab;
170 int msgindex;
171
25239cee 172 BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
e2849863
TG		 173 msgindex = rtm_msgindex(msgtype);
174
377cb248 175 tab = rcu_dereference_raw(rtnl_msg_handlers[protocol]);
e2849863
TG		 176 if (tab == NULL) {
177 tab = kcalloc(RTM_NR_MSGTYPES, sizeof(*tab), GFP_KERNEL);
178 if (tab == NULL)
179 return -ENOBUFS;
180
6853dd48 181 rcu_assign_pointer(rtnl_msg_handlers[protocol], tab);
e2849863
TG		 182 }
183
184 if (doit)
185 tab[msgindex].doit = doit;
e2849863
TG		 186 if (dumpit)
187 tab[msgindex].dumpit = dumpit;
62256f98 188 tab[msgindex].flags |= flags;
e2849863
TG		 189
190 return 0;
191}
e2849863
TG		 192EXPORT_SYMBOL_GPL(__rtnl_register);
193
194/**
195 * rtnl_register - Register a rtnetlink message type
196 *
197 * Identical to __rtnl_register() but panics on failure. This is useful
198 * as failure of this function is very unlikely, it can only happen due
199 * to lack of memory when allocating the chain to store all message
200 * handlers for a protocol. Meant for use in init functions where lack
25985edc 201 * of memory implies no sense in continuing.
e2849863
TG		 202 */
203void rtnl_register(int protocol, int msgtype,
c7ac8679 204 rtnl_doit_func doit, rtnl_dumpit_func dumpit,
b97bac64 205 unsigned int flags)
e2849863 206{
b97bac64 207 if (__rtnl_register(protocol, msgtype, doit, dumpit, flags) < 0)
e2849863
TG		 208 panic("Unable to register rtnetlink message handler, "
209 "protocol = %d, message type = %d\n",
210 protocol, msgtype);
211}
e2849863
TG		 212EXPORT_SYMBOL_GPL(rtnl_register);
213
214/**
215 * rtnl_unregister - Unregister a rtnetlink message type
216 * @protocol: Protocol family or PF_UNSPEC
217 * @msgtype: rtnetlink message type
218 *
219 * Returns 0 on success or a negative error code.
220 */
221int rtnl_unregister(int protocol, int msgtype)
222{
6853dd48 223 struct rtnl_link *handlers;
e2849863
TG		 224 int msgindex;
225
25239cee 226 BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
e2849863
TG		 227 msgindex = rtm_msgindex(msgtype);
228
6853dd48
FW		 229 rtnl_lock();
230 handlers = rtnl_dereference(rtnl_msg_handlers[protocol]);
231 if (!handlers) {
232 rtnl_unlock();
e2849863 233 return -ENOENT;
6853dd48 234 }
e2849863 235
6853dd48
FW		 236 handlers[msgindex].doit = NULL;
237 handlers[msgindex].dumpit = NULL;
62256f98 238 handlers[msgindex].flags = 0;
6853dd48 239 rtnl_unlock();
e2849863
TG		 240
241 return 0;
242}
e2849863
TG		 243EXPORT_SYMBOL_GPL(rtnl_unregister);
244
245/**
246 * rtnl_unregister_all - Unregister all rtnetlink message type of a protocol
247 * @protocol : Protocol family or PF_UNSPEC
248 *
249 * Identical to calling rtnl_unregster() for all registered message types
250 * of a certain protocol family.
251 */
252void rtnl_unregister_all(int protocol)
253{
019a3169
FW		 254 struct rtnl_link *handlers;
255
25239cee 256 BUG_ON(protocol < 0 || protocol > RTNL_FAMILY_MAX);
e2849863 257
019a3169 258 rtnl_lock();
6853dd48
FW		 259 handlers = rtnl_dereference(rtnl_msg_handlers[protocol]);
260 RCU_INIT_POINTER(rtnl_msg_handlers[protocol], NULL);
019a3169
FW		 261 rtnl_unlock();
262
6853dd48
FW		 263 synchronize_net();
264
d38a6512 265 while (refcount_read(&rtnl_msg_handlers_ref[protocol]) > 1)
019a3169
FW		 266 schedule();
267 kfree(handlers);
e2849863 268}
e2849863 269EXPORT_SYMBOL_GPL(rtnl_unregister_all);
1da177e4 270
38f7b870
PM		 271static LIST_HEAD(link_ops);
272
c63044f0
ED		 273static const struct rtnl_link_ops *rtnl_link_ops_get(const char *kind)
274{
275 const struct rtnl_link_ops *ops;
276
277 list_for_each_entry(ops, &link_ops, list) {
278 if (!strcmp(ops->kind, kind))
279 return ops;
280 }
281 return NULL;
282}
283
38f7b870
PM		 284/**
285 * __rtnl_link_register - Register rtnl_link_ops with rtnetlink.
286 * @ops: struct rtnl_link_ops * to register
287 *
288 * The caller must hold the rtnl_mutex. This function should be used
289 * by drivers that create devices during module initialization. It
290 * must be called before registering the devices.
291 *
292 * Returns 0 on success or a negative error code.
293 */
294int __rtnl_link_register(struct rtnl_link_ops *ops)
295{
c63044f0
ED		 296 if (rtnl_link_ops_get(ops->kind))
297 return -EEXIST;
298
b0ab2fab
JP		 299 /* The check for setup is here because if ops
300 * does not have that filled up, it is not possible
301 * to use the ops for creating device. So do not
302 * fill up dellink as well. That disables rtnl_dellink.
303 */
304 if (ops->setup && !ops->dellink)
23289a37 305 ops->dellink = unregister_netdevice_queue;
2d85cba2 306
38f7b870
PM		 307 list_add_tail(&ops->list, &link_ops);
308 return 0;
309}
38f7b870
PM		 310EXPORT_SYMBOL_GPL(__rtnl_link_register);
311
312/**
313 * rtnl_link_register - Register rtnl_link_ops with rtnetlink.
314 * @ops: struct rtnl_link_ops * to register
315 *
316 * Returns 0 on success or a negative error code.
317 */
318int rtnl_link_register(struct rtnl_link_ops *ops)
319{
320 int err;
321
322 rtnl_lock();
323 err = __rtnl_link_register(ops);
324 rtnl_unlock();
325 return err;
326}
38f7b870
PM		 327EXPORT_SYMBOL_GPL(rtnl_link_register);
328
669f87ba
PE		 329static void __rtnl_kill_links(struct net *net, struct rtnl_link_ops *ops)
330{
331 struct net_device *dev;
23289a37
ED		 332 LIST_HEAD(list_kill);
333
669f87ba 334 for_each_netdev(net, dev) {
23289a37
ED		 335 if (dev->rtnl_link_ops == ops)
336 ops->dellink(dev, &list_kill);
669f87ba 337 }
23289a37 338 unregister_netdevice_many(&list_kill);
669f87ba
PE		 339}
340
38f7b870
PM		 341/**
342 * __rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink.
343 * @ops: struct rtnl_link_ops * to unregister
344 *
2d85cba2 345 * The caller must hold the rtnl_mutex.
38f7b870
PM		 346 */
347void __rtnl_link_unregister(struct rtnl_link_ops *ops)
348{
881d966b 349 struct net *net;
2d85cba2 350
881d966b 351 for_each_net(net) {
669f87ba 352 __rtnl_kill_links(net, ops);
2d85cba2 353 }
38f7b870
PM		 354 list_del(&ops->list);
355}
38f7b870
PM		 356EXPORT_SYMBOL_GPL(__rtnl_link_unregister);
357
200b916f
CW		 358/* Return with the rtnl_lock held when there are no network
359 * devices unregistering in any network namespace.
360 */
361static void rtnl_lock_unregistering_all(void)
362{
363 struct net *net;
364 bool unregistering;
ff960a73 365 DEFINE_WAIT_FUNC(wait, woken_wake_function);
200b916f 366
ff960a73 367 add_wait_queue(&netdev_unregistering_wq, &wait);
200b916f 368 for (;;) {
200b916f
CW		 369 unregistering = false;
370 rtnl_lock();
371 for_each_net(net) {
372 if (net->dev_unreg_count > 0) {
373 unregistering = true;
374 break;
375 }
376 }
377 if (!unregistering)
378 break;
379 __rtnl_unlock();
ff960a73
PZ		 380
381 wait_woken(&wait, TASK_UNINTERRUPTIBLE, MAX_SCHEDULE_TIMEOUT);
200b916f 382 }
ff960a73 383 remove_wait_queue(&netdev_unregistering_wq, &wait);
200b916f
CW		 384}
385
38f7b870
PM		 386/**
387 * rtnl_link_unregister - Unregister rtnl_link_ops from rtnetlink.
388 * @ops: struct rtnl_link_ops * to unregister
389 */
390void rtnl_link_unregister(struct rtnl_link_ops *ops)
391{
200b916f
CW		 392 /* Close the race with cleanup_net() */
393 mutex_lock(&net_mutex);
394 rtnl_lock_unregistering_all();
38f7b870
PM		 395 __rtnl_link_unregister(ops);
396 rtnl_unlock();
200b916f 397 mutex_unlock(&net_mutex);
38f7b870 398}
38f7b870
PM		 399EXPORT_SYMBOL_GPL(rtnl_link_unregister);
400
ba7d49b1
JP		 401static size_t rtnl_link_get_slave_info_data_size(const struct net_device *dev)
402{
403 struct net_device *master_dev;
404 const struct rtnl_link_ops *ops;
8515ae38 405 size_t size = 0;
ba7d49b1 406
8515ae38
FW		 407 rcu_read_lock();
408
409 master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev);
ba7d49b1 410 if (!master_dev)
8515ae38
FW		 411 goto out;
412
ba7d49b1 413 ops = master_dev->rtnl_link_ops;
6049f253 414 if (!ops || !ops->get_slave_size)
8515ae38 415 goto out;
ba7d49b1 416 /* IFLA_INFO_SLAVE_DATA + nested data */
8515ae38 417 size = nla_total_size(sizeof(struct nlattr)) +
ba7d49b1 418 ops->get_slave_size(master_dev, dev);
8515ae38
FW		 419
420out:
421 rcu_read_unlock();
422 return size;
ba7d49b1
JP		 423}
424
38f7b870
PM		 425static size_t rtnl_link_get_size(const struct net_device *dev)
426{
427 const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
428 size_t size;
429
430 if (!ops)
431 return 0;
432
369cf77a
TG		 433 size = nla_total_size(sizeof(struct nlattr)) + /* IFLA_LINKINFO */
434 nla_total_size(strlen(ops->kind) + 1); /* IFLA_INFO_KIND */
38f7b870
PM		 435
436 if (ops->get_size)
437 /* IFLA_INFO_DATA + nested data */
369cf77a 438 size += nla_total_size(sizeof(struct nlattr)) +
38f7b870
PM		 439 ops->get_size(dev);
440
441 if (ops->get_xstats_size)
369cf77a
TG		 442 /* IFLA_INFO_XSTATS */
443 size += nla_total_size(ops->get_xstats_size(dev));
38f7b870 444
ba7d49b1
JP		 445 size += rtnl_link_get_slave_info_data_size(dev);
446
38f7b870
PM		 447 return size;
448}
449
f8ff182c
TG		 450static LIST_HEAD(rtnl_af_ops);
451
452static const struct rtnl_af_ops *rtnl_af_lookup(const int family)
453{
454 const struct rtnl_af_ops *ops;
455
5fa85a09 456 list_for_each_entry_rcu(ops, &rtnl_af_ops, list) {
f8ff182c
TG		 457 if (ops->family == family)
458 return ops;
459 }
460
461 return NULL;
462}
463
f8ff182c
TG		 464/**
465 * rtnl_af_register - Register rtnl_af_ops with rtnetlink.
466 * @ops: struct rtnl_af_ops * to register
467 *
468 * Returns 0 on success or a negative error code.
469 */
3678a9d8 470void rtnl_af_register(struct rtnl_af_ops *ops)
f8ff182c 471{
f8ff182c 472 rtnl_lock();
5fa85a09 473 list_add_tail_rcu(&ops->list, &rtnl_af_ops);
f8ff182c 474 rtnl_unlock();
f8ff182c
TG		 475}
476EXPORT_SYMBOL_GPL(rtnl_af_register);
477
f8ff182c
TG		 478/**
479 * rtnl_af_unregister - Unregister rtnl_af_ops from rtnetlink.
480 * @ops: struct rtnl_af_ops * to unregister
481 */
482void rtnl_af_unregister(struct rtnl_af_ops *ops)
483{
484 rtnl_lock();
5fa85a09 485 list_del_rcu(&ops->list);
f8ff182c 486 rtnl_unlock();
5fa85a09
FW		 487
488 synchronize_rcu();
f8ff182c
TG		 489}
490EXPORT_SYMBOL_GPL(rtnl_af_unregister);
491
b1974ed0
AR		 492static size_t rtnl_link_get_af_size(const struct net_device *dev,
493 u32 ext_filter_mask)
f8ff182c
TG		 494{
495 struct rtnl_af_ops *af_ops;
496 size_t size;
497
498 /* IFLA_AF_SPEC */
499 size = nla_total_size(sizeof(struct nlattr));
500
5fa85a09
FW		 501 rcu_read_lock();
502 list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
f8ff182c
TG		 503 if (af_ops->get_link_af_size) {
504 /* AF_* + nested data */
505 size += nla_total_size(sizeof(struct nlattr)) +
b1974ed0 506 af_ops->get_link_af_size(dev, ext_filter_mask);
f8ff182c
TG		 507 }
508 }
5fa85a09 509 rcu_read_unlock();
f8ff182c
TG		 510
511 return size;
512}
513
ba7d49b1 514static bool rtnl_have_link_slave_info(const struct net_device *dev)
38f7b870 515{
ba7d49b1 516 struct net_device *master_dev;
4c82a95e 517 bool ret = false;
38f7b870 518
4c82a95e
FW		 519 rcu_read_lock();
520
521 master_dev = netdev_master_upper_dev_get_rcu((struct net_device *)dev);
813f020c 522 if (master_dev && master_dev->rtnl_link_ops)
4c82a95e
FW		 523 ret = true;
524 rcu_read_unlock();
525 return ret;
ba7d49b1
JP		 526}
527
528static int rtnl_link_slave_info_fill(struct sk_buff *skb,
529 const struct net_device *dev)
530{
531 struct net_device *master_dev;
532 const struct rtnl_link_ops *ops;
533 struct nlattr *slave_data;
534 int err;
38f7b870 535
ba7d49b1
JP		 536 master_dev = netdev_master_upper_dev_get((struct net_device *) dev);
537 if (!master_dev)
538 return 0;
539 ops = master_dev->rtnl_link_ops;
540 if (!ops)
541 return 0;
542 if (nla_put_string(skb, IFLA_INFO_SLAVE_KIND, ops->kind) < 0)
543 return -EMSGSIZE;
544 if (ops->fill_slave_info) {
545 slave_data = nla_nest_start(skb, IFLA_INFO_SLAVE_DATA);
546 if (!slave_data)
547 return -EMSGSIZE;
548 err = ops->fill_slave_info(skb, master_dev, dev);
549 if (err < 0)
550 goto err_cancel_slave_data;
551 nla_nest_end(skb, slave_data);
552 }
553 return 0;
554
555err_cancel_slave_data:
556 nla_nest_cancel(skb, slave_data);
557 return err;
558}
559
560static int rtnl_link_info_fill(struct sk_buff *skb,
561 const struct net_device *dev)
562{
563 const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
564 struct nlattr *data;
565 int err;
566
567 if (!ops)
568 return 0;
38f7b870 569 if (nla_put_string(skb, IFLA_INFO_KIND, ops->kind) < 0)
ba7d49b1 570 return -EMSGSIZE;
38f7b870
PM		 571 if (ops->fill_xstats) {
572 err = ops->fill_xstats(skb, dev);
573 if (err < 0)
ba7d49b1 574 return err;
38f7b870
PM		 575 }
576 if (ops->fill_info) {
577 data = nla_nest_start(skb, IFLA_INFO_DATA);
ba7d49b1
JP		 578 if (data == NULL)
579 return -EMSGSIZE;
38f7b870
PM		 580 err = ops->fill_info(skb, dev);
581 if (err < 0)
582 goto err_cancel_data;
583 nla_nest_end(skb, data);
584 }
38f7b870
PM		 585 return 0;
586
587err_cancel_data:
588 nla_nest_cancel(skb, data);
ba7d49b1
JP		 589 return err;
590}
591
592static int rtnl_link_fill(struct sk_buff *skb, const struct net_device *dev)
593{
594 struct nlattr *linkinfo;
595 int err = -EMSGSIZE;
596
597 linkinfo = nla_nest_start(skb, IFLA_LINKINFO);
598 if (linkinfo == NULL)
599 goto out;
600
601 err = rtnl_link_info_fill(skb, dev);
602 if (err < 0)
603 goto err_cancel_link;
604
605 err = rtnl_link_slave_info_fill(skb, dev);
606 if (err < 0)
607 goto err_cancel_link;
608
609 nla_nest_end(skb, linkinfo);
610 return 0;
611
38f7b870
PM		 612err_cancel_link:
613 nla_nest_cancel(skb, linkinfo);
614out:
615 return err;
616}
617
95c96174 618int rtnetlink_send(struct sk_buff *skb, struct net *net, u32 pid, unsigned int group, int echo)
1da177e4 619{
97c53cac 620 struct sock *rtnl = net->rtnl;
1da177e4
LT		 621 int err = 0;
622
ac6d439d 623 NETLINK_CB(skb).dst_group = group;
1da177e4 624 if (echo)
63354797 625 refcount_inc(&skb->users);
1da177e4
LT		 626 netlink_broadcast(rtnl, skb, pid, group, GFP_KERNEL);
627 if (echo)
628 err = netlink_unicast(rtnl, skb, pid, MSG_DONTWAIT);
629 return err;
630}
631
97c53cac 632int rtnl_unicast(struct sk_buff *skb, struct net *net, u32 pid)
2942e900 633{
97c53cac
DL		 634 struct sock *rtnl = net->rtnl;
635
2942e900
TG		 636 return nlmsg_unicast(rtnl, skb, pid);
637}
e0d087af 638EXPORT_SYMBOL(rtnl_unicast);
2942e900 639
1ce85fe4
PNA		 640void rtnl_notify(struct sk_buff *skb, struct net *net, u32 pid, u32 group,
641 struct nlmsghdr *nlh, gfp_t flags)
97676b6b 642{
97c53cac 643 struct sock *rtnl = net->rtnl;
97676b6b
TG		 644 int report = 0;
645
646 if (nlh)
647 report = nlmsg_report(nlh);
648
1ce85fe4 649 nlmsg_notify(rtnl, skb, pid, group, report, flags);
97676b6b 650}
e0d087af 651EXPORT_SYMBOL(rtnl_notify);
97676b6b 652
97c53cac 653void rtnl_set_sk_err(struct net *net, u32 group, int error)
97676b6b 654{
97c53cac
DL		 655 struct sock *rtnl = net->rtnl;
656
97676b6b
TG		 657 netlink_set_err(rtnl, 0, group, error);
658}
e0d087af 659EXPORT_SYMBOL(rtnl_set_sk_err);
97676b6b 660
1da177e4
LT		 661int rtnetlink_put_metrics(struct sk_buff *skb, u32 *metrics)
662{
2d7202bf
TG		 663 struct nlattr *mx;
664 int i, valid = 0;
665
666 mx = nla_nest_start(skb, RTA_METRICS);
667 if (mx == NULL)
668 return -ENOBUFS;
669
670 for (i = 0; i < RTAX_MAX; i++) {
671 if (metrics[i]) {
ea697639
DB		 672 if (i == RTAX_CC_ALGO - 1) {
673 char tmp[TCP_CA_NAME_MAX], *name;
674
675 name = tcp_ca_get_name_by_key(metrics[i], tmp);
676 if (!name)
677 continue;
678 if (nla_put_string(skb, i + 1, name))
679 goto nla_put_failure;
c3a8d947
DB		 680 } else if (i == RTAX_FEATURES - 1) {
681 u32 user_features = metrics[i] & RTAX_FEATURE_MASK;
682
f8edcd12
PS		 683 if (!user_features)
684 continue;
c3a8d947
DB		 685 BUILD_BUG_ON(RTAX_FEATURE_MASK & DST_FEATURE_MASK);
686 if (nla_put_u32(skb, i + 1, user_features))
687 goto nla_put_failure;
ea697639
DB		 688 } else {
689 if (nla_put_u32(skb, i + 1, metrics[i]))
690 goto nla_put_failure;
691 }
2d7202bf 692 valid++;
2d7202bf 693 }
1da177e4 694 }
1da177e4 695
a57d27fc
DM		 696 if (!valid) {
697 nla_nest_cancel(skb, mx);
698 return 0;
699 }
2d7202bf
TG		 700
701 return nla_nest_end(skb, mx);
702
703nla_put_failure:
bc3ed28c
TG		 704 nla_nest_cancel(skb, mx);
705 return -EMSGSIZE;
1da177e4 706}
e0d087af 707EXPORT_SYMBOL(rtnetlink_put_metrics);
1da177e4 708
e3703b3d 709int rtnl_put_cacheinfo(struct sk_buff *skb, struct dst_entry *dst, u32 id,
87a50699 710 long expires, u32 error)
e3703b3d
TG		 711{
712 struct rta_cacheinfo ci = {
a399a805 713 .rta_lastuse = jiffies_delta_to_clock_t(jiffies - dst->lastuse),
e3703b3d
TG		 714 .rta_used = dst->__use,
715 .rta_clntref = atomic_read(&(dst->__refcnt)),
716 .rta_error = error,
717 .rta_id = id,
e3703b3d
TG		 718 };
719
8253947e
LW		 720 if (expires) {
721 unsigned long clock;
e3703b3d 722
8253947e
LW		 723 clock = jiffies_to_clock_t(abs(expires));
724 clock = min_t(unsigned long, clock, INT_MAX);
725 ci.rta_expires = (expires > 0) ? clock : -clock;
726 }
e3703b3d
TG		 727 return nla_put(skb, RTA_CACHEINFO, sizeof(ci), &ci);
728}
e3703b3d 729EXPORT_SYMBOL_GPL(rtnl_put_cacheinfo);
1da177e4 730
93b2d4a2 731static void set_operstate(struct net_device *dev, unsigned char transition)
b00055aa
SR		 732{
733 unsigned char operstate = dev->operstate;
734
e0d087af 735 switch (transition) {
b00055aa
SR		 736 case IF_OPER_UP:
737 if ((operstate == IF_OPER_DORMANT ||
738 operstate == IF_OPER_UNKNOWN) &&
739 !netif_dormant(dev))
740 operstate = IF_OPER_UP;
741 break;
742
743 case IF_OPER_DORMANT:
744 if (operstate == IF_OPER_UP ||
745 operstate == IF_OPER_UNKNOWN)
746 operstate = IF_OPER_DORMANT;
747 break;
3ff50b79 748 }
b00055aa
SR		 749
750 if (dev->operstate != operstate) {
751 write_lock_bh(&dev_base_lock);
752 dev->operstate = operstate;
753 write_unlock_bh(&dev_base_lock);
93b2d4a2
DM		 754 netdev_state_change(dev);
755 }
b00055aa
SR		 756}
757
b1beb681
JB		 758static unsigned int rtnl_dev_get_flags(const struct net_device *dev)
759{
760 return (dev->flags & ~(IFF_PROMISC | IFF_ALLMULTI)) |
761 (dev->gflags & (IFF_PROMISC | IFF_ALLMULTI));
762}
763
3729d502
PM		 764static unsigned int rtnl_dev_combine_flags(const struct net_device *dev,
765 const struct ifinfomsg *ifm)
766{
767 unsigned int flags = ifm->ifi_flags;
768
769 /* bugwards compatibility: ifi_change == 0 is treated as ~0 */
770 if (ifm->ifi_change)
771 flags = (flags & ifm->ifi_change) |
b1beb681 772 (rtnl_dev_get_flags(dev) & ~ifm->ifi_change);
3729d502
PM		 773
774 return flags;
775}
776
b60c5115 777static void copy_rtnl_link_stats(struct rtnl_link_stats *a,
be1f3c2c 778 const struct rtnl_link_stats64 *b)
1da177e4 779{
b60c5115
TG		 780 a->rx_packets = b->rx_packets;
781 a->tx_packets = b->tx_packets;
782 a->rx_bytes = b->rx_bytes;
783 a->tx_bytes = b->tx_bytes;
784 a->rx_errors = b->rx_errors;
785 a->tx_errors = b->tx_errors;
786 a->rx_dropped = b->rx_dropped;
787 a->tx_dropped = b->tx_dropped;
788
789 a->multicast = b->multicast;
790 a->collisions = b->collisions;
791
792 a->rx_length_errors = b->rx_length_errors;
793 a->rx_over_errors = b->rx_over_errors;
794 a->rx_crc_errors = b->rx_crc_errors;
795 a->rx_frame_errors = b->rx_frame_errors;
796 a->rx_fifo_errors = b->rx_fifo_errors;
797 a->rx_missed_errors = b->rx_missed_errors;
798
799 a->tx_aborted_errors = b->tx_aborted_errors;
800 a->tx_carrier_errors = b->tx_carrier_errors;
801 a->tx_fifo_errors = b->tx_fifo_errors;
802 a->tx_heartbeat_errors = b->tx_heartbeat_errors;
803 a->tx_window_errors = b->tx_window_errors;
804
805 a->rx_compressed = b->rx_compressed;
806 a->tx_compressed = b->tx_compressed;
6e7333d3
JW		 807
808 a->rx_nohandler = b->rx_nohandler;
10708f37
JE		 809}
810
c02db8c6 811/* All VF info */
115c9b81
GR		 812static inline int rtnl_vfinfo_size(const struct net_device *dev,
813 u32 ext_filter_mask)
ebc08a6f 814{
9af15c38 815 if (dev->dev.parent && (ext_filter_mask & RTEXT_FILTER_VF)) {
c02db8c6 816 int num_vfs = dev_num_vf(dev->dev.parent);
7e75f74a 817 size_t size = nla_total_size(0);
045de01a 818 size += num_vfs *
7e75f74a
SD		 819 (nla_total_size(0) +
820 nla_total_size(sizeof(struct ifla_vf_mac)) +
821 nla_total_size(sizeof(struct ifla_vf_vlan)) +
822 nla_total_size(0) + /* nest IFLA_VF_VLAN_LIST */
79aab093
MS		 823 nla_total_size(MAX_VLAN_LIST_LEN *
824 sizeof(struct ifla_vf_vlan_info)) +
ed616689 825 nla_total_size(sizeof(struct ifla_vf_spoofchk)) +
7e75f74a 826 nla_total_size(sizeof(struct ifla_vf_tx_rate)) +
945a3676 827 nla_total_size(sizeof(struct ifla_vf_rate)) +
01a3d796 828 nla_total_size(sizeof(struct ifla_vf_link_state)) +
3b766cd8 829 nla_total_size(sizeof(struct ifla_vf_rss_query_en)) +
7e75f74a 830 nla_total_size(0) + /* nest IFLA_VF_STATS */
3b766cd8 831 /* IFLA_VF_STATS_RX_PACKETS */
343a6d8e 832 nla_total_size_64bit(sizeof(__u64)) +
3b766cd8 833 /* IFLA_VF_STATS_TX_PACKETS */
343a6d8e 834 nla_total_size_64bit(sizeof(__u64)) +
3b766cd8 835 /* IFLA_VF_STATS_RX_BYTES */
343a6d8e 836 nla_total_size_64bit(sizeof(__u64)) +
3b766cd8 837 /* IFLA_VF_STATS_TX_BYTES */
343a6d8e 838 nla_total_size_64bit(sizeof(__u64)) +
3b766cd8 839 /* IFLA_VF_STATS_BROADCAST */
343a6d8e 840 nla_total_size_64bit(sizeof(__u64)) +
3b766cd8 841 /* IFLA_VF_STATS_MULTICAST */
343a6d8e 842 nla_total_size_64bit(sizeof(__u64)) +
dd461d6a 843 nla_total_size(sizeof(struct ifla_vf_trust)));
c02db8c6
CW		 844 return size;
845 } else
ebc08a6f
WM		 846 return 0;
847}
848
c53864fd
DG		 849static size_t rtnl_port_size(const struct net_device *dev,
850 u32 ext_filter_mask)
57b61080
SF		 851{
852 size_t port_size = nla_total_size(4) /* PORT_VF */
853 + nla_total_size(PORT_PROFILE_MAX) /* PORT_PROFILE */
57b61080
SF		 854 + nla_total_size(PORT_UUID_MAX) /* PORT_INSTANCE_UUID */
855 + nla_total_size(PORT_UUID_MAX) /* PORT_HOST_UUID */
856 + nla_total_size(1) /* PROT_VDP_REQUEST */
857 + nla_total_size(2); /* PORT_VDP_RESPONSE */
858 size_t vf_ports_size = nla_total_size(sizeof(struct nlattr));
859 size_t vf_port_size = nla_total_size(sizeof(struct nlattr))
860 + port_size;
861 size_t port_self_size = nla_total_size(sizeof(struct nlattr))
862 + port_size;
863
c53864fd
DG		 864 if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent ||
865 !(ext_filter_mask & RTEXT_FILTER_VF))
57b61080
SF		 866 return 0;
867 if (dev_num_vf(dev->dev.parent))
868 return port_self_size + vf_ports_size +
869 vf_port_size * dev_num_vf(dev->dev.parent);
870 else
871 return port_self_size;
872}
873
b5cdae32 874static size_t rtnl_xdp_size(void)
d1fdd913 875{
b3cfaa31 876 size_t xdp_size = nla_total_size(0) + /* nest IFLA_XDP */
58038695
MKL		 877 nla_total_size(1) + /* XDP_ATTACHED */
878 nla_total_size(4); /* XDP_PROG_ID */
d1fdd913 879
b5cdae32 880 return xdp_size;
d1fdd913
BB		 881}
882
115c9b81
GR		 883static noinline size_t if_nlmsg_size(const struct net_device *dev,
884 u32 ext_filter_mask)
339bf98f
TG		 885{
886 return NLMSG_ALIGN(sizeof(struct ifinfomsg))
887 + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
0b815a1a 888 + nla_total_size(IFALIASZ) /* IFLA_IFALIAS */
339bf98f 889 + nla_total_size(IFNAMSIZ) /* IFLA_QDISC */
270cb4d0 890 + nla_total_size_64bit(sizeof(struct rtnl_link_ifmap))
339bf98f 891 + nla_total_size(sizeof(struct rtnl_link_stats))
35c58459 892 + nla_total_size_64bit(sizeof(struct rtnl_link_stats64))
339bf98f
TG		 893 + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
894 + nla_total_size(MAX_ADDR_LEN) /* IFLA_BROADCAST */
895 + nla_total_size(4) /* IFLA_TXQLEN */
896 + nla_total_size(4) /* IFLA_WEIGHT */
897 + nla_total_size(4) /* IFLA_MTU */
898 + nla_total_size(4) /* IFLA_LINK */
899 + nla_total_size(4) /* IFLA_MASTER */
9a57247f 900 + nla_total_size(1) /* IFLA_CARRIER */
edbc0bb3 901 + nla_total_size(4) /* IFLA_PROMISCUITY */
76ff5cc9
JP		 902 + nla_total_size(4) /* IFLA_NUM_TX_QUEUES */
903 + nla_total_size(4) /* IFLA_NUM_RX_QUEUES */
6919756c
TK		 904 + nla_total_size(4) /* IFLA_GSO_MAX_SEGS */
905 + nla_total_size(4) /* IFLA_GSO_MAX_SIZE */
339bf98f 906 + nla_total_size(1) /* IFLA_OPERSTATE */
38f7b870 907 + nla_total_size(1) /* IFLA_LINKMODE */
2d3b479d 908 + nla_total_size(4) /* IFLA_CARRIER_CHANGES */
d37512a2 909 + nla_total_size(4) /* IFLA_LINK_NETNSID */
db833d40 910 + nla_total_size(4) /* IFLA_GROUP */
115c9b81
GR		 911 + nla_total_size(ext_filter_mask
912 & RTEXT_FILTER_VF ? 4 : 0) /* IFLA_NUM_VF */
913 + rtnl_vfinfo_size(dev, ext_filter_mask) /* IFLA_VFINFO_LIST */
c53864fd 914 + rtnl_port_size(dev, ext_filter_mask) /* IFLA_VF_PORTS + IFLA_PORT_SELF */
f8ff182c 915 + rtnl_link_get_size(dev) /* IFLA_LINKINFO */
b1974ed0 916 + rtnl_link_get_af_size(dev, ext_filter_mask) /* IFLA_AF_SPEC */
82f28412 917 + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_PORT_ID */
88d6378b 918 + nla_total_size(MAX_PHYS_ITEM_ID_LEN) /* IFLA_PHYS_SWITCH_ID */
c57c7a95 919 + nla_total_size(IFNAMSIZ) /* IFLA_PHYS_PORT_NAME */
b5cdae32 920 + rtnl_xdp_size() /* IFLA_XDP */
3d3ea5af 921 + nla_total_size(4) /* IFLA_EVENT */
6621dd29 922 + nla_total_size(4) /* IFLA_NEW_NETNSID */
03ac738d 923 + nla_total_size(1) /* IFLA_PROTO_DOWN */
79e1ad14 924 + nla_total_size(4) /* IFLA_IF_NETNSID */
5e7f6597
DD		 925 + nla_total_size(4) /* IFLA_CARRIER_UP_COUNT */
926 + nla_total_size(4) /* IFLA_CARRIER_DOWN_COUNT */
79e1ad14 927 + 0;
339bf98f
TG		 928}
929
57b61080
SF		 930static int rtnl_vf_ports_fill(struct sk_buff *skb, struct net_device *dev)
931{
932 struct nlattr *vf_ports;
933 struct nlattr *vf_port;
934 int vf;
935 int err;
936
937 vf_ports = nla_nest_start(skb, IFLA_VF_PORTS);
938 if (!vf_ports)
939 return -EMSGSIZE;
940
941 for (vf = 0; vf < dev_num_vf(dev->dev.parent); vf++) {
942 vf_port = nla_nest_start(skb, IFLA_VF_PORT);
8ca94183
SF		 943 if (!vf_port)
944 goto nla_put_failure;
a6574349
DM		 945 if (nla_put_u32(skb, IFLA_PORT_VF, vf))
946 goto nla_put_failure;
57b61080 947 err = dev->netdev_ops->ndo_get_vf_port(dev, vf, skb);
8ca94183
SF		 948 if (err == -EMSGSIZE)
949 goto nla_put_failure;
57b61080 950 if (err) {
57b61080
SF		 951 nla_nest_cancel(skb, vf_port);
952 continue;
953 }
954 nla_nest_end(skb, vf_port);
955 }
956
957 nla_nest_end(skb, vf_ports);
958
959 return 0;
8ca94183
SF		 960
961nla_put_failure:
962 nla_nest_cancel(skb, vf_ports);
963 return -EMSGSIZE;
57b61080
SF		 964}
965
966static int rtnl_port_self_fill(struct sk_buff *skb, struct net_device *dev)
967{
968 struct nlattr *port_self;
969 int err;
970
971 port_self = nla_nest_start(skb, IFLA_PORT_SELF);
972 if (!port_self)
973 return -EMSGSIZE;
974
975 err = dev->netdev_ops->ndo_get_vf_port(dev, PORT_SELF_VF, skb);
976 if (err) {
977 nla_nest_cancel(skb, port_self);
8ca94183 978 return (err == -EMSGSIZE) ? err : 0;
57b61080
SF		 979 }
980
981 nla_nest_end(skb, port_self);
982
983 return 0;
984}
985
c53864fd
DG		 986static int rtnl_port_fill(struct sk_buff *skb, struct net_device *dev,
987 u32 ext_filter_mask)
57b61080
SF		 988{
989 int err;
990
c53864fd
DG		 991 if (!dev->netdev_ops->ndo_get_vf_port || !dev->dev.parent ||
992 !(ext_filter_mask & RTEXT_FILTER_VF))
57b61080
SF		 993 return 0;
994
995 err = rtnl_port_self_fill(skb, dev);
996 if (err)
997 return err;
998
999 if (dev_num_vf(dev->dev.parent)) {
1000 err = rtnl_vf_ports_fill(skb, dev);
1001 if (err)
1002 return err;
1003 }
1004
1005 return 0;
1006}
1007
66cae9ed
JP		 1008static int rtnl_phys_port_id_fill(struct sk_buff *skb, struct net_device *dev)
1009{
1010 int err;
02637fce 1011 struct netdev_phys_item_id ppid;
66cae9ed
JP		 1012
1013 err = dev_get_phys_port_id(dev, &ppid);
1014 if (err) {
1015 if (err == -EOPNOTSUPP)
1016 return 0;
1017 return err;
1018 }
1019
1020 if (nla_put(skb, IFLA_PHYS_PORT_ID, ppid.id_len, ppid.id))
1021 return -EMSGSIZE;
1022
1023 return 0;
1024}
1025
db24a904
DA		 1026static int rtnl_phys_port_name_fill(struct sk_buff *skb, struct net_device *dev)
1027{
1028 char name[IFNAMSIZ];
1029 int err;
1030
1031 err = dev_get_phys_port_name(dev, name, sizeof(name));
1032 if (err) {
1033 if (err == -EOPNOTSUPP)
1034 return 0;
1035 return err;
1036 }
1037
77ef033b 1038 if (nla_put_string(skb, IFLA_PHYS_PORT_NAME, name))
db24a904
DA		 1039 return -EMSGSIZE;
1040
1041 return 0;
1042}
1043
82f28412
JP		 1044static int rtnl_phys_switch_id_fill(struct sk_buff *skb, struct net_device *dev)
1045{
1046 int err;
f8e20a9f 1047 struct switchdev_attr attr = {
6ff64f6f 1048 .orig_dev = dev,
1f868398 1049 .id = SWITCHDEV_ATTR_ID_PORT_PARENT_ID,
f8e20a9f
SF		 1050 .flags = SWITCHDEV_F_NO_RECURSE,
1051 };
82f28412 1052
f8e20a9f 1053 err = switchdev_port_attr_get(dev, &attr);
82f28412
JP		 1054 if (err) {
1055 if (err == -EOPNOTSUPP)
1056 return 0;
1057 return err;
1058 }
1059
42275bd8
SF		 1060 if (nla_put(skb, IFLA_PHYS_SWITCH_ID, attr.u.ppid.id_len,
1061 attr.u.ppid.id))
82f28412
JP		 1062 return -EMSGSIZE;
1063
1064 return 0;
1065}
1066
b22b941b
HFS		 1067static noinline_for_stack int rtnl_fill_stats(struct sk_buff *skb,
1068 struct net_device *dev)
1069{
550bce59 1070 struct rtnl_link_stats64 *sp;
b22b941b 1071 struct nlattr *attr;
18402843 1072
58414d32
ND		 1073 attr = nla_reserve_64bit(skb, IFLA_STATS64,
1074 sizeof(struct rtnl_link_stats64), IFLA_PAD);
b22b941b
HFS		 1075 if (!attr)
1076 return -EMSGSIZE;
1077
550bce59
RP		 1078 sp = nla_data(attr);
1079 dev_get_stats(dev, sp);
b22b941b 1080
550bce59
RP		 1081 attr = nla_reserve(skb, IFLA_STATS,
1082 sizeof(struct rtnl_link_stats));
b22b941b
HFS		 1083 if (!attr)
1084 return -EMSGSIZE;
1085
550bce59 1086 copy_rtnl_link_stats(nla_data(attr), sp);
b22b941b
HFS		 1087
1088 return 0;
1089}
1090
1091static noinline_for_stack int rtnl_fill_vfinfo(struct sk_buff *skb,
1092 struct net_device *dev,
1093 int vfs_num,
1094 struct nlattr *vfinfo)
1095{
1096 struct ifla_vf_rss_query_en vf_rss_query_en;
79aab093 1097 struct nlattr *vf, *vfstats, *vfvlanlist;
b22b941b 1098 struct ifla_vf_link_state vf_linkstate;
79aab093 1099 struct ifla_vf_vlan_info vf_vlan_info;
b22b941b
HFS		 1100 struct ifla_vf_spoofchk vf_spoofchk;
1101 struct ifla_vf_tx_rate vf_tx_rate;
1102 struct ifla_vf_stats vf_stats;
1103 struct ifla_vf_trust vf_trust;
1104 struct ifla_vf_vlan vf_vlan;
1105 struct ifla_vf_rate vf_rate;
b22b941b
HFS		 1106 struct ifla_vf_mac vf_mac;
1107 struct ifla_vf_info ivi;
1108
0eed9cf5
MY		 1109 memset(&ivi, 0, sizeof(ivi));
1110
b22b941b
HFS		 1111 /* Not all SR-IOV capable drivers support the
1112 * spoofcheck and "RSS query enable" query. Preset to
1113 * -1 so the user space tool can detect that the driver
1114 * didn't report anything.
1115 */
1116 ivi.spoofchk = -1;
1117 ivi.rss_query_en = -1;
1118 ivi.trusted = -1;
b22b941b
HFS		 1119 /* The default value for VF link state is "auto"
1120 * IFLA_VF_LINK_STATE_AUTO which equals zero
1121 */
1122 ivi.linkstate = 0;
79aab093
MS		 1123 /* VLAN Protocol by default is 802.1Q */
1124 ivi.vlan_proto = htons(ETH_P_8021Q);
b22b941b
HFS		 1125 if (dev->netdev_ops->ndo_get_vf_config(dev, vfs_num, &ivi))
1126 return 0;
1127
775f4f05
DC		 1128 memset(&vf_vlan_info, 0, sizeof(vf_vlan_info));
1129
b22b941b
HFS		 1130 vf_mac.vf =
1131 vf_vlan.vf =
79aab093 1132 vf_vlan_info.vf =
b22b941b
HFS		 1133 vf_rate.vf =
1134 vf_tx_rate.vf =
1135 vf_spoofchk.vf =
1136 vf_linkstate.vf =
1137 vf_rss_query_en.vf =
1138 vf_trust.vf = ivi.vf;
1139
1140 memcpy(vf_mac.mac, ivi.mac, sizeof(ivi.mac));
1141 vf_vlan.vlan = ivi.vlan;
1142 vf_vlan.qos = ivi.qos;
79aab093
MS		 1143 vf_vlan_info.vlan = ivi.vlan;
1144 vf_vlan_info.qos = ivi.qos;
1145 vf_vlan_info.vlan_proto = ivi.vlan_proto;
b22b941b
HFS		 1146 vf_tx_rate.rate = ivi.max_tx_rate;
1147 vf_rate.min_tx_rate = ivi.min_tx_rate;
1148 vf_rate.max_tx_rate = ivi.max_tx_rate;
1149 vf_spoofchk.setting = ivi.spoofchk;
1150 vf_linkstate.link_state = ivi.linkstate;
1151 vf_rss_query_en.setting = ivi.rss_query_en;
1152 vf_trust.setting = ivi.trusted;
1153 vf = nla_nest_start(skb, IFLA_VF_INFO);
79aab093
MS		 1154 if (!vf)
1155 goto nla_put_vfinfo_failure;
b22b941b
HFS		 1156 if (nla_put(skb, IFLA_VF_MAC, sizeof(vf_mac), &vf_mac) ||
1157 nla_put(skb, IFLA_VF_VLAN, sizeof(vf_vlan), &vf_vlan) ||
1158 nla_put(skb, IFLA_VF_RATE, sizeof(vf_rate),
1159 &vf_rate) ||
1160 nla_put(skb, IFLA_VF_TX_RATE, sizeof(vf_tx_rate),
1161 &vf_tx_rate) ||
1162 nla_put(skb, IFLA_VF_SPOOFCHK, sizeof(vf_spoofchk),
1163 &vf_spoofchk) ||
1164 nla_put(skb, IFLA_VF_LINK_STATE, sizeof(vf_linkstate),
1165 &vf_linkstate) ||
1166 nla_put(skb, IFLA_VF_RSS_QUERY_EN,
1167 sizeof(vf_rss_query_en),
1168 &vf_rss_query_en) ||
1169 nla_put(skb, IFLA_VF_TRUST,
1170 sizeof(vf_trust), &vf_trust))
79aab093
MS		 1171 goto nla_put_vf_failure;
1172 vfvlanlist = nla_nest_start(skb, IFLA_VF_VLAN_LIST);
1173 if (!vfvlanlist)
1174 goto nla_put_vf_failure;
1175 if (nla_put(skb, IFLA_VF_VLAN_INFO, sizeof(vf_vlan_info),
1176 &vf_vlan_info)) {
1177 nla_nest_cancel(skb, vfvlanlist);
1178 goto nla_put_vf_failure;
1179 }
1180 nla_nest_end(skb, vfvlanlist);
b22b941b
HFS		 1181 memset(&vf_stats, 0, sizeof(vf_stats));
1182 if (dev->netdev_ops->ndo_get_vf_stats)
1183 dev->netdev_ops->ndo_get_vf_stats(dev, vfs_num,
1184 &vf_stats);
1185 vfstats = nla_nest_start(skb, IFLA_VF_STATS);
79aab093
MS		 1186 if (!vfstats)
1187 goto nla_put_vf_failure;
343a6d8e
ND		 1188 if (nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_PACKETS,
1189 vf_stats.rx_packets, IFLA_VF_STATS_PAD) ||
1190 nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_PACKETS,
1191 vf_stats.tx_packets, IFLA_VF_STATS_PAD) ||
1192 nla_put_u64_64bit(skb, IFLA_VF_STATS_RX_BYTES,
1193 vf_stats.rx_bytes, IFLA_VF_STATS_PAD) ||
1194 nla_put_u64_64bit(skb, IFLA_VF_STATS_TX_BYTES,
1195 vf_stats.tx_bytes, IFLA_VF_STATS_PAD) ||
1196 nla_put_u64_64bit(skb, IFLA_VF_STATS_BROADCAST,
1197 vf_stats.broadcast, IFLA_VF_STATS_PAD) ||
1198 nla_put_u64_64bit(skb, IFLA_VF_STATS_MULTICAST,
79aab093
MS		 1199 vf_stats.multicast, IFLA_VF_STATS_PAD)) {
1200 nla_nest_cancel(skb, vfstats);
1201 goto nla_put_vf_failure;
1202 }
b22b941b
HFS		 1203 nla_nest_end(skb, vfstats);
1204 nla_nest_end(skb, vf);
1205 return 0;
79aab093
MS		 1206
1207nla_put_vf_failure:
1208 nla_nest_cancel(skb, vf);
1209nla_put_vfinfo_failure:
1210 nla_nest_cancel(skb, vfinfo);
1211 return -EMSGSIZE;
b22b941b
HFS		 1212}
1213
250fc3df
FW		 1214static noinline_for_stack int rtnl_fill_vf(struct sk_buff *skb,
1215 struct net_device *dev,
1216 u32 ext_filter_mask)
1217{
1218 struct nlattr *vfinfo;
1219 int i, num_vfs;
1220
1221 if (!dev->dev.parent || ((ext_filter_mask & RTEXT_FILTER_VF) == 0))
1222 return 0;
1223
1224 num_vfs = dev_num_vf(dev->dev.parent);
1225 if (nla_put_u32(skb, IFLA_NUM_VF, num_vfs))
1226 return -EMSGSIZE;
1227
1228 if (!dev->netdev_ops->ndo_get_vf_config)
1229 return 0;
1230
1231 vfinfo = nla_nest_start(skb, IFLA_VFINFO_LIST);
1232 if (!vfinfo)
1233 return -EMSGSIZE;
1234
1235 for (i = 0; i < num_vfs; i++) {
1236 if (rtnl_fill_vfinfo(skb, dev, i, vfinfo))
1237 return -EMSGSIZE;
1238 }
1239
1240 nla_nest_end(skb, vfinfo);
1241 return 0;
1242}
1243
b22b941b
HFS		 1244static int rtnl_fill_link_ifmap(struct sk_buff *skb, struct net_device *dev)
1245{
5f8e4474
KL		 1246 struct rtnl_link_ifmap map;
1247
1248 memset(&map, 0, sizeof(map));
1249 map.mem_start = dev->mem_start;
1250 map.mem_end = dev->mem_end;
1251 map.base_addr = dev->base_addr;
1252 map.irq = dev->irq;
1253 map.dma = dev->dma;
1254 map.port = dev->if_port;
1255
270cb4d0 1256 if (nla_put_64bit(skb, IFLA_MAP, sizeof(map), &map, IFLA_PAD))
b22b941b
HFS		 1257 return -EMSGSIZE;
1258
1259 return 0;
1260}
1261
58038695 1262static u8 rtnl_xdp_attached_mode(struct net_device *dev, u32 *prog_id)
d67b9cd2
DB		 1263{
1264 const struct net_device_ops *ops = dev->netdev_ops;
58038695 1265 const struct bpf_prog *generic_xdp_prog;
d67b9cd2
DB		 1266
1267 ASSERT_RTNL();
1268
58038695
MKL		 1269 *prog_id = 0;
1270 generic_xdp_prog = rtnl_dereference(dev->xdp_prog);
1271 if (generic_xdp_prog) {
1272 *prog_id = generic_xdp_prog->aux->id;
d67b9cd2 1273 return XDP_ATTACHED_SKB;
58038695 1274 }
f4e63525 1275 if (!ops->ndo_bpf)
ce158e58 1276 return XDP_ATTACHED_NONE;
d67b9cd2 1277
f4e63525 1278 return __dev_xdp_attached(dev, ops->ndo_bpf, prog_id);
d67b9cd2
DB		 1279}
1280
d1fdd913
BB		 1281static int rtnl_xdp_fill(struct sk_buff *skb, struct net_device *dev)
1282{
d1fdd913 1283 struct nlattr *xdp;
58038695 1284 u32 prog_id;
d1fdd913
BB		 1285 int err;
1286
d1fdd913
BB		 1287 xdp = nla_nest_start(skb, IFLA_XDP);
1288 if (!xdp)
1289 return -EMSGSIZE;
d67b9cd2
DB		 1290
1291 err = nla_put_u8(skb, IFLA_XDP_ATTACHED,
58038695 1292 rtnl_xdp_attached_mode(dev, &prog_id));
d1fdd913
BB		 1293 if (err)
1294 goto err_cancel;
1295
58038695
MKL		 1296 if (prog_id) {
1297 err = nla_put_u32(skb, IFLA_XDP_PROG_ID, prog_id);
1298 if (err)
1299 goto err_cancel;
1300 }
1301
d1fdd913
BB		 1302 nla_nest_end(skb, xdp);
1303 return 0;
1304
1305err_cancel:
1306 nla_nest_cancel(skb, xdp);
1307 return err;
1308}
1309
3d3ea5af
VY		 1310static u32 rtnl_get_event(unsigned long event)
1311{
1312 u32 rtnl_event_type = IFLA_EVENT_NONE;
1313
1314 switch (event) {
1315 case NETDEV_REBOOT:
1316 rtnl_event_type = IFLA_EVENT_REBOOT;
1317 break;
1318 case NETDEV_FEAT_CHANGE:
1319 rtnl_event_type = IFLA_EVENT_FEATURES;
1320 break;
1321 case NETDEV_BONDING_FAILOVER:
1322 rtnl_event_type = IFLA_EVENT_BONDING_FAILOVER;
1323 break;
1324 case NETDEV_NOTIFY_PEERS:
1325 rtnl_event_type = IFLA_EVENT_NOTIFY_PEERS;
1326 break;
1327 case NETDEV_RESEND_IGMP:
1328 rtnl_event_type = IFLA_EVENT_IGMP_RESEND;
1329 break;
1330 case NETDEV_CHANGEINFODATA:
1331 rtnl_event_type = IFLA_EVENT_BONDING_OPTIONS;
1332 break;
1333 default:
1334 break;
1335 }
1336
1337 return rtnl_event_type;
1338}
1339
79110a04
FW		 1340static int put_master_ifindex(struct sk_buff *skb, struct net_device *dev)
1341{
1342 const struct net_device *upper_dev;
1343 int ret = 0;
1344
1345 rcu_read_lock();
1346
1347 upper_dev = netdev_master_upper_dev_get_rcu(dev);
1348 if (upper_dev)
1349 ret = nla_put_u32(skb, IFLA_MASTER, upper_dev->ifindex);
1350
1351 rcu_read_unlock();
1352 return ret;
1353}
1354
1355static int nla_put_iflink(struct sk_buff *skb, const struct net_device *dev)
1356{
1357 int ifindex = dev_get_iflink(dev);
1358
1359 if (dev->ifindex == ifindex)
1360 return 0;
1361
1362 return nla_put_u32(skb, IFLA_LINK, ifindex);
1363}
1364
6c557001
FW		 1365static noinline_for_stack int nla_put_ifalias(struct sk_buff *skb,
1366 struct net_device *dev)
1367{
1368 char buf[IFALIASZ];
1369 int ret;
1370
1371 ret = dev_get_alias(dev, buf, sizeof(buf));
1372 return ret > 0 ? nla_put_string(skb, IFLA_IFALIAS, buf) : 0;
1373}
1374
b1e66b9a 1375static int rtnl_fill_link_netnsid(struct sk_buff *skb,
79e1ad14
JB		 1376 const struct net_device *dev,
1377 struct net *src_net)
b1e66b9a
FW		 1378{
1379 if (dev->rtnl_link_ops && dev->rtnl_link_ops->get_link_net) {
1380 struct net *link_net = dev->rtnl_link_ops->get_link_net(dev);
1381
1382 if (!net_eq(dev_net(dev), link_net)) {
79e1ad14 1383 int id = peernet2id_alloc(src_net, link_net);
b1e66b9a
FW		 1384
1385 if (nla_put_s32(skb, IFLA_LINK_NETNSID, id))
1386 return -EMSGSIZE;
1387 }
1388 }
1389
1390 return 0;
1391}
1392
070cbf5b
FW		 1393static int rtnl_fill_link_af(struct sk_buff *skb,
1394 const struct net_device *dev,
1395 u32 ext_filter_mask)
1396{
1397 const struct rtnl_af_ops *af_ops;
1398 struct nlattr *af_spec;
1399
1400 af_spec = nla_nest_start(skb, IFLA_AF_SPEC);
1401 if (!af_spec)
1402 return -EMSGSIZE;
1403
5fa85a09 1404 list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
070cbf5b
FW		 1405 struct nlattr *af;
1406 int err;
1407
1408 if (!af_ops->fill_link_af)
1409 continue;
1410
1411 af = nla_nest_start(skb, af_ops->family);
1412 if (!af)
1413 return -EMSGSIZE;
1414
1415 err = af_ops->fill_link_af(skb, dev, ext_filter_mask);
1416 /*
1417 * Caller may return ENODATA to indicate that there
1418 * was no data to be dumped. This is not an error, it
1419 * means we should trim the attribute header and
1420 * continue.
1421 */
1422 if (err == -ENODATA)
1423 nla_nest_cancel(skb, af);
1424 else if (err < 0)
1425 return -EMSGSIZE;
1426
1427 nla_nest_end(skb, af);
1428 }
1429
1430 nla_nest_end(skb, af_spec);
1431 return 0;
1432}
1433
79e1ad14
JB		 1434static int rtnl_fill_ifinfo(struct sk_buff *skb,
1435 struct net_device *dev, struct net *src_net,
575c3e2a 1436 int type, u32 pid, u32 seq, u32 change,
3d3ea5af 1437 unsigned int flags, u32 ext_filter_mask,
79e1ad14 1438 u32 event, int *new_nsid, int tgt_netnsid)
b60c5115
TG		 1439{
1440 struct ifinfomsg *ifm;
1441 struct nlmsghdr *nlh;
1da177e4 1442
2907c35f 1443 ASSERT_RTNL();
b60c5115
TG		 1444 nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifm), flags);
1445 if (nlh == NULL)
26932566 1446 return -EMSGSIZE;
1da177e4 1447
b60c5115
TG		 1448 ifm = nlmsg_data(nlh);
1449 ifm->ifi_family = AF_UNSPEC;
1450 ifm->__ifi_pad = 0;
1451 ifm->ifi_type = dev->type;
1452 ifm->ifi_index = dev->ifindex;
1453 ifm->ifi_flags = dev_get_flags(dev);
1454 ifm->ifi_change = change;
1455
79e1ad14
JB		 1456 if (tgt_netnsid >= 0 && nla_put_s32(skb, IFLA_IF_NETNSID, tgt_netnsid))
1457 goto nla_put_failure;
1458
a6574349
DM		 1459 if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
1460 nla_put_u32(skb, IFLA_TXQLEN, dev->tx_queue_len) ||
1461 nla_put_u8(skb, IFLA_OPERSTATE,
1462 netif_running(dev) ? dev->operstate : IF_OPER_DOWN) ||
1463 nla_put_u8(skb, IFLA_LINKMODE, dev->link_mode) ||
1464 nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
1465 nla_put_u32(skb, IFLA_GROUP, dev->group) ||
edbc0bb3 1466 nla_put_u32(skb, IFLA_PROMISCUITY, dev->promiscuity) ||
76ff5cc9 1467 nla_put_u32(skb, IFLA_NUM_TX_QUEUES, dev->num_tx_queues) ||
c70ce028
ED		 1468 nla_put_u32(skb, IFLA_GSO_MAX_SEGS, dev->gso_max_segs) ||
1469 nla_put_u32(skb, IFLA_GSO_MAX_SIZE, dev->gso_max_size) ||
1d69c2b3 1470#ifdef CONFIG_RPS
76ff5cc9 1471 nla_put_u32(skb, IFLA_NUM_RX_QUEUES, dev->num_rx_queues) ||
1d69c2b3 1472#endif
79110a04
FW		 1473 nla_put_iflink(skb, dev) ||
1474 put_master_ifindex(skb, dev) ||
9a57247f 1475 nla_put_u8(skb, IFLA_CARRIER, netif_carrier_ok(dev)) ||
a6574349
DM		 1476 (dev->qdisc &&
1477 nla_put_string(skb, IFLA_QDISC, dev->qdisc->ops->id)) ||
6c557001 1478 nla_put_ifalias(skb, dev) ||
2d3b479d 1479 nla_put_u32(skb, IFLA_CARRIER_CHANGES,
5e7f6597
DD		 1480 atomic_read(&dev->carrier_up_count) +
1481 atomic_read(&dev->carrier_down_count)) ||
1482 nla_put_u8(skb, IFLA_PROTO_DOWN, dev->proto_down) ||
1483 nla_put_u32(skb, IFLA_CARRIER_UP_COUNT,
1484 atomic_read(&dev->carrier_up_count)) ||
1485 nla_put_u32(skb, IFLA_CARRIER_DOWN_COUNT,
1486 atomic_read(&dev->carrier_down_count)))
a6574349 1487 goto nla_put_failure;
0b815a1a 1488
3d3ea5af
VY		 1489 if (event != IFLA_EVENT_NONE) {
1490 if (nla_put_u32(skb, IFLA_EVENT, event))
1491 goto nla_put_failure;
1492 }
1493
b22b941b
HFS		 1494 if (rtnl_fill_link_ifmap(skb, dev))
1495 goto nla_put_failure;
1da177e4
LT		 1496
1497 if (dev->addr_len) {
a6574349
DM		 1498 if (nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr) ||
1499 nla_put(skb, IFLA_BROADCAST, dev->addr_len, dev->broadcast))
1500 goto nla_put_failure;
1da177e4
LT		 1501 }
1502
66cae9ed
JP		 1503 if (rtnl_phys_port_id_fill(skb, dev))
1504 goto nla_put_failure;
1505
db24a904
DA		 1506 if (rtnl_phys_port_name_fill(skb, dev))
1507 goto nla_put_failure;
1508
82f28412
JP		 1509 if (rtnl_phys_switch_id_fill(skb, dev))
1510 goto nla_put_failure;
1511
b22b941b 1512 if (rtnl_fill_stats(skb, dev))
10708f37 1513 goto nla_put_failure;
10708f37 1514
250fc3df 1515 if (rtnl_fill_vf(skb, dev, ext_filter_mask))
a6574349 1516 goto nla_put_failure;
57b61080 1517
c53864fd 1518 if (rtnl_port_fill(skb, dev, ext_filter_mask))
57b61080
SF		 1519 goto nla_put_failure;
1520
d1fdd913
BB		 1521 if (rtnl_xdp_fill(skb, dev))
1522 goto nla_put_failure;
1523
ba7d49b1 1524 if (dev->rtnl_link_ops || rtnl_have_link_slave_info(dev)) {
38f7b870
PM		 1525 if (rtnl_link_fill(skb, dev) < 0)
1526 goto nla_put_failure;
1527 }
1528
79e1ad14 1529 if (rtnl_fill_link_netnsid(skb, dev, src_net))
b1e66b9a 1530 goto nla_put_failure;
d37512a2 1531
6621dd29
ND		 1532 if (new_nsid &&
1533 nla_put_s32(skb, IFLA_NEW_NETNSID, *new_nsid) < 0)
1534 goto nla_put_failure;
1535
5fa85a09 1536 rcu_read_lock();
070cbf5b 1537 if (rtnl_fill_link_af(skb, dev, ext_filter_mask))
5fa85a09
FW		 1538 goto nla_put_failure_rcu;
1539 rcu_read_unlock();
f8ff182c 1540
053c095a
JB		 1541 nlmsg_end(skb, nlh);
1542 return 0;
b60c5115 1543
5fa85a09
FW		 1544nla_put_failure_rcu:
1545 rcu_read_unlock();
b60c5115 1546nla_put_failure:
26932566
PM		 1547 nlmsg_cancel(skb, nlh);
1548 return -EMSGSIZE;
1da177e4
LT		 1549}
1550
f7b12606 1551static const struct nla_policy ifla_policy[IFLA_MAX+1] = {
5176f91e 1552 [IFLA_IFNAME] = { .type = NLA_STRING, .len = IFNAMSIZ-1 },
38f7b870
PM		 1553 [IFLA_ADDRESS] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
1554 [IFLA_BROADCAST] = { .type = NLA_BINARY, .len = MAX_ADDR_LEN },
5176f91e 1555 [IFLA_MAP] = { .len = sizeof(struct rtnl_link_ifmap) },
da5e0494 1556 [IFLA_MTU] = { .type = NLA_U32 },
76e87306 1557 [IFLA_LINK] = { .type = NLA_U32 },
fbaec0ea 1558 [IFLA_MASTER] = { .type = NLA_U32 },
9a57247f 1559 [IFLA_CARRIER] = { .type = NLA_U8 },
da5e0494
TG		 1560 [IFLA_TXQLEN] = { .type = NLA_U32 },
1561 [IFLA_WEIGHT] = { .type = NLA_U32 },
1562 [IFLA_OPERSTATE] = { .type = NLA_U8 },
1563 [IFLA_LINKMODE] = { .type = NLA_U8 },
76e87306 1564 [IFLA_LINKINFO] = { .type = NLA_NESTED },
d8a5ec67 1565 [IFLA_NET_NS_PID] = { .type = NLA_U32 },
f0630529 1566 [IFLA_NET_NS_FD] = { .type = NLA_U32 },
2459b4c6
ND		 1567 /* IFLA_IFALIAS is a string, but policy is set to NLA_BINARY to
1568 * allow 0-length string (needed to remove an alias).
1569 */
1570 [IFLA_IFALIAS] = { .type = NLA_BINARY, .len = IFALIASZ - 1 },
c02db8c6 1571 [IFLA_VFINFO_LIST] = {. type = NLA_NESTED },
57b61080
SF		 1572 [IFLA_VF_PORTS] = { .type = NLA_NESTED },
1573 [IFLA_PORT_SELF] = { .type = NLA_NESTED },
f8ff182c 1574 [IFLA_AF_SPEC] = { .type = NLA_NESTED },
115c9b81 1575 [IFLA_EXT_MASK] = { .type = NLA_U32 },
edbc0bb3 1576 [IFLA_PROMISCUITY] = { .type = NLA_U32 },
76ff5cc9
JP		 1577 [IFLA_NUM_TX_QUEUES] = { .type = NLA_U32 },
1578 [IFLA_NUM_RX_QUEUES] = { .type = NLA_U32 },
02637fce 1579 [IFLA_PHYS_PORT_ID] = { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN },
2d3b479d 1580 [IFLA_CARRIER_CHANGES] = { .type = NLA_U32 }, /* ignored */
82f28412 1581 [IFLA_PHYS_SWITCH_ID] = { .type = NLA_BINARY, .len = MAX_PHYS_ITEM_ID_LEN },
317f4810 1582 [IFLA_LINK_NETNSID] = { .type = NLA_S32 },
88d6378b 1583 [IFLA_PROTO_DOWN] = { .type = NLA_U8 },
d1fdd913 1584 [IFLA_XDP] = { .type = NLA_NESTED },
3d3ea5af 1585 [IFLA_EVENT] = { .type = NLA_U32 },
db833d40 1586 [IFLA_GROUP] = { .type = NLA_U32 },
79e1ad14 1587 [IFLA_IF_NETNSID] = { .type = NLA_S32 },
5e7f6597
DD		 1588 [IFLA_CARRIER_UP_COUNT] = { .type = NLA_U32 },
1589 [IFLA_CARRIER_DOWN_COUNT] = { .type = NLA_U32 },
da5e0494
TG		 1590};
1591
38f7b870
PM		 1592static const struct nla_policy ifla_info_policy[IFLA_INFO_MAX+1] = {
1593 [IFLA_INFO_KIND] = { .type = NLA_STRING },
1594 [IFLA_INFO_DATA] = { .type = NLA_NESTED },
ba7d49b1
JP		 1595 [IFLA_INFO_SLAVE_KIND] = { .type = NLA_STRING },
1596 [IFLA_INFO_SLAVE_DATA] = { .type = NLA_NESTED },
38f7b870
PM		 1597};
1598
c02db8c6 1599static const struct nla_policy ifla_vf_policy[IFLA_VF_MAX+1] = {
364d5716
DB		 1600 [IFLA_VF_MAC] = { .len = sizeof(struct ifla_vf_mac) },
1601 [IFLA_VF_VLAN] = { .len = sizeof(struct ifla_vf_vlan) },
79aab093 1602 [IFLA_VF_VLAN_LIST] = { .type = NLA_NESTED },
364d5716
DB		 1603 [IFLA_VF_TX_RATE] = { .len = sizeof(struct ifla_vf_tx_rate) },
1604 [IFLA_VF_SPOOFCHK] = { .len = sizeof(struct ifla_vf_spoofchk) },
1605 [IFLA_VF_RATE] = { .len = sizeof(struct ifla_vf_rate) },
1606 [IFLA_VF_LINK_STATE] = { .len = sizeof(struct ifla_vf_link_state) },
01a3d796 1607 [IFLA_VF_RSS_QUERY_EN] = { .len = sizeof(struct ifla_vf_rss_query_en) },
3b766cd8 1608 [IFLA_VF_STATS] = { .type = NLA_NESTED },
dd461d6a 1609 [IFLA_VF_TRUST] = { .len = sizeof(struct ifla_vf_trust) },
cc8e27cc
EC		 1610 [IFLA_VF_IB_NODE_GUID] = { .len = sizeof(struct ifla_vf_guid) },
1611 [IFLA_VF_IB_PORT_GUID] = { .len = sizeof(struct ifla_vf_guid) },
3b766cd8
EBE		 1612};
1613
57b61080
SF		 1614static const struct nla_policy ifla_port_policy[IFLA_PORT_MAX+1] = {
1615 [IFLA_PORT_VF] = { .type = NLA_U32 },
1616 [IFLA_PORT_PROFILE] = { .type = NLA_STRING,
1617 .len = PORT_PROFILE_MAX },
57b61080
SF		 1618 [IFLA_PORT_INSTANCE_UUID] = { .type = NLA_BINARY,
1619 .len = PORT_UUID_MAX },
1620 [IFLA_PORT_HOST_UUID] = { .type = NLA_STRING,
1621 .len = PORT_UUID_MAX },
1622 [IFLA_PORT_REQUEST] = { .type = NLA_U8, },
1623 [IFLA_PORT_RESPONSE] = { .type = NLA_U16, },
025331df
DB		 1624
1625 /* Unused, but we need to keep it here since user space could
1626 * fill it. It's also broken with regard to NLA_BINARY use in
1627 * combination with structs.
1628 */
1629 [IFLA_PORT_VSI_TYPE] = { .type = NLA_BINARY,
1630 .len = sizeof(struct ifla_port_vsi) },
57b61080
SF		 1631};
1632
d1fdd913
BB		 1633static const struct nla_policy ifla_xdp_policy[IFLA_XDP_MAX + 1] = {
1634 [IFLA_XDP_FD] = { .type = NLA_S32 },
1635 [IFLA_XDP_ATTACHED] = { .type = NLA_U8 },
85de8576 1636 [IFLA_XDP_FLAGS] = { .type = NLA_U32 },
58038695 1637 [IFLA_XDP_PROG_ID] = { .type = NLA_U32 },
d1fdd913
BB		 1638};
1639
dc599f76
DA		 1640static const struct rtnl_link_ops *linkinfo_to_kind_ops(const struct nlattr *nla)
1641{
1642 const struct rtnl_link_ops *ops = NULL;
1643 struct nlattr *linfo[IFLA_INFO_MAX + 1];
1644
fceb6435
JB		 1645 if (nla_parse_nested(linfo, IFLA_INFO_MAX, nla,
1646 ifla_info_policy, NULL) < 0)
dc599f76
DA		 1647 return NULL;
1648
1649 if (linfo[IFLA_INFO_KIND]) {
1650 char kind[MODULE_NAME_LEN];
1651
1652 nla_strlcpy(kind, linfo[IFLA_INFO_KIND], sizeof(kind));
1653 ops = rtnl_link_ops_get(kind);
1654 }
1655
1656 return ops;
1657}
1658
1659static bool link_master_filtered(struct net_device *dev, int master_idx)
1660{
1661 struct net_device *master;
1662
1663 if (!master_idx)
1664 return false;
1665
1666 master = netdev_master_upper_dev_get(dev);
1667 if (!master || master->ifindex != master_idx)
1668 return true;
1669
1670 return false;
1671}
1672
1673static bool link_kind_filtered(const struct net_device *dev,
1674 const struct rtnl_link_ops *kind_ops)
1675{
1676 if (kind_ops && dev->rtnl_link_ops != kind_ops)
1677 return true;
1678
1679 return false;
1680}
1681
1682static bool link_dump_filtered(struct net_device *dev,
1683 int master_idx,
1684 const struct rtnl_link_ops *kind_ops)
1685{
1686 if (link_master_filtered(dev, master_idx) ||
1687 link_kind_filtered(dev, kind_ops))
1688 return true;
1689
1690 return false;
1691}
1692
f428fe4a 1693static struct net *get_target_net(struct sock *sk, int netnsid)
79e1ad14
JB		 1694{
1695 struct net *net;
1696
f428fe4a 1697 net = get_net_ns_by_id(sock_net(sk), netnsid);
79e1ad14
JB		 1698 if (!net)
1699 return ERR_PTR(-EINVAL);
1700
1701 /* For now, the caller is required to have CAP_NET_ADMIN in
1702 * the user namespace owning the target net ns.
1703 */
f428fe4a 1704 if (!sk_ns_capable(sk, net->user_ns, CAP_NET_ADMIN)) {
79e1ad14
JB		 1705 put_net(net);
1706 return ERR_PTR(-EACCES);
1707 }
1708 return net;
1709}
1710
f7b12606
JP		 1711static int rtnl_dump_ifinfo(struct sk_buff *skb, struct netlink_callback *cb)
1712{
1713 struct net *net = sock_net(skb->sk);
79e1ad14 1714 struct net *tgt_net = net;
f7b12606
JP		 1715 int h, s_h;
1716 int idx = 0, s_idx;
1717 struct net_device *dev;
1718 struct hlist_head *head;
1719 struct nlattr *tb[IFLA_MAX+1];
1720 u32 ext_filter_mask = 0;
dc599f76
DA		 1721 const struct rtnl_link_ops *kind_ops = NULL;
1722 unsigned int flags = NLM_F_MULTI;
1723 int master_idx = 0;
79e1ad14 1724 int netnsid = -1;
973462bb 1725 int err;
e5eca6d4 1726 int hdrlen;
f7b12606
JP		 1727
1728 s_h = cb->args[0];
1729 s_idx = cb->args[1];
1730
e5eca6d4
MS		 1731 /* A hack to preserve kernel<->userspace interface.
1732 * The correct header is ifinfomsg. It is consistent with rtnl_getlink.
1733 * However, before Linux v3.9 the code here assumed rtgenmsg and that's
1734 * what iproute2 < v3.9.0 used.
1735 * We can detect the old iproute2. Even including the IFLA_EXT_MASK
1736 * attribute, its netlink message is shorter than struct ifinfomsg.
1737 */
1738 hdrlen = nlmsg_len(cb->nlh) < sizeof(struct ifinfomsg) ?
1739 sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg);
1740
fceb6435
JB		 1741 if (nlmsg_parse(cb->nlh, hdrlen, tb, IFLA_MAX,
1742 ifla_policy, NULL) >= 0) {
79e1ad14
JB		 1743 if (tb[IFLA_IF_NETNSID]) {
1744 netnsid = nla_get_s32(tb[IFLA_IF_NETNSID]);
f428fe4a 1745 tgt_net = get_target_net(skb->sk, netnsid);
79e1ad14
JB		 1746 if (IS_ERR(tgt_net)) {
1747 tgt_net = net;
1748 netnsid = -1;
1749 }
1750 }
1751
f7b12606
JP		 1752 if (tb[IFLA_EXT_MASK])
1753 ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
dc599f76
DA		 1754
1755 if (tb[IFLA_MASTER])
1756 master_idx = nla_get_u32(tb[IFLA_MASTER]);
1757
1758 if (tb[IFLA_LINKINFO])
1759 kind_ops = linkinfo_to_kind_ops(tb[IFLA_LINKINFO]);
1760
1761 if (master_idx || kind_ops)
1762 flags |= NLM_F_DUMP_FILTERED;
f7b12606
JP		 1763 }
1764
1765 for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
1766 idx = 0;
79e1ad14 1767 head = &tgt_net->dev_index_head[h];
cac5e65e 1768 hlist_for_each_entry(dev, head, index_hlist) {
dc599f76 1769 if (link_dump_filtered(dev, master_idx, kind_ops))
3f0ae05d 1770 goto cont;
f7b12606
JP		 1771 if (idx < s_idx)
1772 goto cont;
79e1ad14
JB		 1773 err = rtnl_fill_ifinfo(skb, dev, net,
1774 RTM_NEWLINK,
973462bb
DG		 1775 NETLINK_CB(cb->skb).portid,
1776 cb->nlh->nlmsg_seq, 0,
dc599f76 1777 flags,
79e1ad14
JB		 1778 ext_filter_mask, 0, NULL,
1779 netnsid);
973462bb 1780
f6c5775f
DA		 1781 if (err < 0) {
1782 if (likely(skb->len))
1783 goto out;
1784
1785 goto out_err;
1786 }
f7b12606
JP		 1787cont:
1788 idx++;
1789 }
1790 }
1791out:
f6c5775f
DA		 1792 err = skb->len;
1793out_err:
f7b12606
JP		 1794 cb->args[1] = idx;
1795 cb->args[0] = h;
d0225784
JS		 1796 cb->seq = net->dev_base_seq;
1797 nl_dump_check_consistent(cb, nlmsg_hdr(skb));
79e1ad14
JB		 1798 if (netnsid >= 0)
1799 put_net(tgt_net);
f7b12606 1800
f6c5775f 1801 return err;
f7b12606
JP		 1802}
1803
fceb6435
JB		 1804int rtnl_nla_parse_ifla(struct nlattr **tb, const struct nlattr *head, int len,
1805 struct netlink_ext_ack *exterr)
f7b12606 1806{
fceb6435 1807 return nla_parse(tb, IFLA_MAX, head, len, ifla_policy, exterr);
f7b12606
JP		 1808}
1809EXPORT_SYMBOL(rtnl_nla_parse_ifla);
1810
81adee47
EB		 1811struct net *rtnl_link_get_net(struct net *src_net, struct nlattr *tb[])
1812{
1813 struct net *net;
1814 /* Examine the link attributes and figure out which
1815 * network namespace we are talking about.
1816 */
1817 if (tb[IFLA_NET_NS_PID])
1818 net = get_net_ns_by_pid(nla_get_u32(tb[IFLA_NET_NS_PID]));
f0630529
EB		 1819 else if (tb[IFLA_NET_NS_FD])
1820 net = get_net_ns_by_fd(nla_get_u32(tb[IFLA_NET_NS_FD]));
81adee47
EB		 1821 else
1822 net = get_net(src_net);
1823 return net;
1824}
1825EXPORT_SYMBOL(rtnl_link_get_net);
1826
cc2fbdc7
CB		 1827/* Figure out which network namespace we are talking about by
1828 * examining the link attributes in the following order:
1829 *
1830 * 1. IFLA_NET_NS_PID
1831 * 2. IFLA_NET_NS_FD
1832 * 3. IFLA_IF_NETNSID
1833 */
1834static struct net *rtnl_link_get_net_by_nlattr(struct net *src_net,
1835 struct nlattr *tb[])
1836{
1837 struct net *net;
1838
1839 if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD])
1840 return rtnl_link_get_net(src_net, tb);
1841
1842 if (!tb[IFLA_IF_NETNSID])
1843 return get_net(src_net);
1844
1845 net = get_net_ns_by_id(src_net, nla_get_u32(tb[IFLA_IF_NETNSID]));
1846 if (!net)
1847 return ERR_PTR(-EINVAL);
1848
1849 return net;
1850}
1851
1852static struct net *rtnl_link_get_net_capable(const struct sk_buff *skb,
1853 struct net *src_net,
1854 struct nlattr *tb[], int cap)
1855{
1856 struct net *net;
1857
1858 net = rtnl_link_get_net_by_nlattr(src_net, tb);
1859 if (IS_ERR(net))
1860 return net;
1861
1862 if (!netlink_ns_capable(skb, net->user_ns, cap)) {
1863 put_net(net);
1864 return ERR_PTR(-EPERM);
1865 }
1866
1867 return net;
1868}
1869
a5a1a12d
CB		 1870/* Verify that rtnetlink requests do not pass additional properties
1871 * potentially referring to different network namespaces.
1872 */
1873static int rtnl_ensure_unique_netns(struct nlattr *tb[],
1874 struct netlink_ext_ack *extack,
1875 bool netns_id_only)
1876{
1877
1878 if (netns_id_only) {
1879 if (!tb[IFLA_NET_NS_PID] && !tb[IFLA_NET_NS_FD])
1880 return 0;
1881
1882 NL_SET_ERR_MSG(extack, "specified netns attribute not supported");
1883 return -EOPNOTSUPP;
1884 }
1885
1886 if (tb[IFLA_IF_NETNSID] && (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD]))
1887 goto invalid_attr;
1888
1889 if (tb[IFLA_NET_NS_PID] && (tb[IFLA_IF_NETNSID] || tb[IFLA_NET_NS_FD]))
1890 goto invalid_attr;
1891
1892 if (tb[IFLA_NET_NS_FD] && (tb[IFLA_IF_NETNSID] || tb[IFLA_NET_NS_PID]))
1893 goto invalid_attr;
1894
1895 return 0;
1896
1897invalid_attr:
1898 NL_SET_ERR_MSG(extack, "multiple netns identifying attributes specified");
1899 return -EINVAL;
1900}
1901
1840bb13
TG		 1902static int validate_linkmsg(struct net_device *dev, struct nlattr *tb[])
1903{
1904 if (dev) {
1905 if (tb[IFLA_ADDRESS] &&
1906 nla_len(tb[IFLA_ADDRESS]) < dev->addr_len)
1907 return -EINVAL;
1908
1909 if (tb[IFLA_BROADCAST] &&
1910 nla_len(tb[IFLA_BROADCAST]) < dev->addr_len)
1911 return -EINVAL;
1912 }
1913
cf7afbfe
TG		 1914 if (tb[IFLA_AF_SPEC]) {
1915 struct nlattr *af;
1916 int rem, err;
1917
1918 nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) {
1919 const struct rtnl_af_ops *af_ops;
1920
5fa85a09
FW		 1921 rcu_read_lock();
1922 af_ops = rtnl_af_lookup(nla_type(af));
1923 if (!af_ops) {
1924 rcu_read_unlock();
cf7afbfe 1925 return -EAFNOSUPPORT;
5fa85a09 1926 }
cf7afbfe 1927
5fa85a09
FW		 1928 if (!af_ops->set_link_af) {
1929 rcu_read_unlock();
cf7afbfe 1930 return -EOPNOTSUPP;
5fa85a09 1931 }
cf7afbfe
TG		 1932
1933 if (af_ops->validate_link_af) {
6d3a9a68 1934 err = af_ops->validate_link_af(dev, af);
5fa85a09
FW		 1935 if (err < 0) {
1936 rcu_read_unlock();
cf7afbfe 1937 return err;
5fa85a09 1938 }
cf7afbfe 1939 }
5fa85a09
FW		 1940
1941 rcu_read_unlock();
cf7afbfe
TG		 1942 }
1943 }
1944
1840bb13
TG		 1945 return 0;
1946}
1947
cc8e27cc
EC		 1948static int handle_infiniband_guid(struct net_device *dev, struct ifla_vf_guid *ivt,
1949 int guid_type)
1950{
1951 const struct net_device_ops *ops = dev->netdev_ops;
1952
1953 return ops->ndo_set_vf_guid(dev, ivt->vf, ivt->guid, guid_type);
1954}
1955
1956static int handle_vf_guid(struct net_device *dev, struct ifla_vf_guid *ivt, int guid_type)
1957{
1958 if (dev->type != ARPHRD_INFINIBAND)
1959 return -EOPNOTSUPP;
1960
1961 return handle_infiniband_guid(dev, ivt, guid_type);
1962}
1963
4f7d2cdf 1964static int do_setvfinfo(struct net_device *dev, struct nlattr **tb)
c02db8c6 1965{
c02db8c6 1966 const struct net_device_ops *ops = dev->netdev_ops;
4f7d2cdf 1967 int err = -EINVAL;
c02db8c6 1968
4f7d2cdf
DB		 1969 if (tb[IFLA_VF_MAC]) {
1970 struct ifla_vf_mac *ivm = nla_data(tb[IFLA_VF_MAC]);
01a3d796 1971
4f7d2cdf
DB		 1972 err = -EOPNOTSUPP;
1973 if (ops->ndo_set_vf_mac)
1974 err = ops->ndo_set_vf_mac(dev, ivm->vf,
1975 ivm->mac);
1976 if (err < 0)
1977 return err;
1978 }
1979
1980 if (tb[IFLA_VF_VLAN]) {
1981 struct ifla_vf_vlan *ivv = nla_data(tb[IFLA_VF_VLAN]);
1982
1983 err = -EOPNOTSUPP;
1984 if (ops->ndo_set_vf_vlan)
1985 err = ops->ndo_set_vf_vlan(dev, ivv->vf, ivv->vlan,
79aab093
MS		 1986 ivv->qos,
1987 htons(ETH_P_8021Q));
1988 if (err < 0)
1989 return err;
1990 }
1991
1992 if (tb[IFLA_VF_VLAN_LIST]) {
1993 struct ifla_vf_vlan_info *ivvl[MAX_VLAN_LIST_LEN];
1994 struct nlattr *attr;
1995 int rem, len = 0;
1996
1997 err = -EOPNOTSUPP;
1998 if (!ops->ndo_set_vf_vlan)
1999 return err;
2000
2001 nla_for_each_nested(attr, tb[IFLA_VF_VLAN_LIST], rem) {
2002 if (nla_type(attr) != IFLA_VF_VLAN_INFO ||
2003 nla_len(attr) < NLA_HDRLEN) {
2004 return -EINVAL;
2005 }
2006 if (len >= MAX_VLAN_LIST_LEN)
2007 return -EOPNOTSUPP;
2008 ivvl[len] = nla_data(attr);
2009
2010 len++;
2011 }
fa34cd94
AB		 2012 if (len == 0)
2013 return -EINVAL;
2014
79aab093
MS		 2015 err = ops->ndo_set_vf_vlan(dev, ivvl[0]->vf, ivvl[0]->vlan,
2016 ivvl[0]->qos, ivvl[0]->vlan_proto);
4f7d2cdf
DB		 2017 if (err < 0)
2018 return err;
c02db8c6 2019 }
4f7d2cdf
DB		 2020
2021 if (tb[IFLA_VF_TX_RATE]) {
2022 struct ifla_vf_tx_rate *ivt = nla_data(tb[IFLA_VF_TX_RATE]);
2023 struct ifla_vf_info ivf;
2024
2025 err = -EOPNOTSUPP;
2026 if (ops->ndo_get_vf_config)
2027 err = ops->ndo_get_vf_config(dev, ivt->vf, &ivf);
2028 if (err < 0)
2029 return err;
2030
2031 err = -EOPNOTSUPP;
2032 if (ops->ndo_set_vf_rate)
2033 err = ops->ndo_set_vf_rate(dev, ivt->vf,
2034 ivf.min_tx_rate,
2035 ivt->rate);
2036 if (err < 0)
2037 return err;
2038 }
2039
2040 if (tb[IFLA_VF_RATE]) {
2041 struct ifla_vf_rate *ivt = nla_data(tb[IFLA_VF_RATE]);
2042
2043 err = -EOPNOTSUPP;
2044 if (ops->ndo_set_vf_rate)
2045 err = ops->ndo_set_vf_rate(dev, ivt->vf,
2046 ivt->min_tx_rate,
2047 ivt->max_tx_rate);
2048 if (err < 0)
2049 return err;
2050 }
2051
2052 if (tb[IFLA_VF_SPOOFCHK]) {
2053 struct ifla_vf_spoofchk *ivs = nla_data(tb[IFLA_VF_SPOOFCHK]);
2054
2055 err = -EOPNOTSUPP;
2056 if (ops->ndo_set_vf_spoofchk)
2057 err = ops->ndo_set_vf_spoofchk(dev, ivs->vf,
2058 ivs->setting);
2059 if (err < 0)
2060 return err;
2061 }
2062
2063 if (tb[IFLA_VF_LINK_STATE]) {
2064 struct ifla_vf_link_state *ivl = nla_data(tb[IFLA_VF_LINK_STATE]);
2065
2066 err = -EOPNOTSUPP;
2067 if (ops->ndo_set_vf_link_state)
2068 err = ops->ndo_set_vf_link_state(dev, ivl->vf,
2069 ivl->link_state);
2070 if (err < 0)
2071 return err;
2072 }
2073
2074 if (tb[IFLA_VF_RSS_QUERY_EN]) {
2075 struct ifla_vf_rss_query_en *ivrssq_en;
2076
2077 err = -EOPNOTSUPP;
2078 ivrssq_en = nla_data(tb[IFLA_VF_RSS_QUERY_EN]);
2079 if (ops->ndo_set_vf_rss_query_en)
2080 err = ops->ndo_set_vf_rss_query_en(dev, ivrssq_en->vf,
2081 ivrssq_en->setting);
2082 if (err < 0)
2083 return err;
2084 }
2085
dd461d6a
HS		 2086 if (tb[IFLA_VF_TRUST]) {
2087 struct ifla_vf_trust *ivt = nla_data(tb[IFLA_VF_TRUST]);
2088
2089 err = -EOPNOTSUPP;
2090 if (ops->ndo_set_vf_trust)
2091 err = ops->ndo_set_vf_trust(dev, ivt->vf, ivt->setting);
2092 if (err < 0)
2093 return err;
2094 }
2095
cc8e27cc
EC		 2096 if (tb[IFLA_VF_IB_NODE_GUID]) {
2097 struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_NODE_GUID]);
2098
2099 if (!ops->ndo_set_vf_guid)
2100 return -EOPNOTSUPP;
2101
2102 return handle_vf_guid(dev, ivt, IFLA_VF_IB_NODE_GUID);
2103 }
2104
2105 if (tb[IFLA_VF_IB_PORT_GUID]) {
2106 struct ifla_vf_guid *ivt = nla_data(tb[IFLA_VF_IB_PORT_GUID]);
2107
2108 if (!ops->ndo_set_vf_guid)
2109 return -EOPNOTSUPP;
2110
2111 return handle_vf_guid(dev, ivt, IFLA_VF_IB_PORT_GUID);
2112 }
2113
c02db8c6
CW		 2114 return err;
2115}
2116
33eaf2a6
DA		 2117static int do_set_master(struct net_device *dev, int ifindex,
2118 struct netlink_ext_ack *extack)
fbaec0ea 2119{
898e5061 2120 struct net_device *upper_dev = netdev_master_upper_dev_get(dev);
fbaec0ea
JP		 2121 const struct net_device_ops *ops;
2122 int err;
2123
898e5061
JP		 2124 if (upper_dev) {
2125 if (upper_dev->ifindex == ifindex)
fbaec0ea 2126 return 0;
898e5061 2127 ops = upper_dev->netdev_ops;
fbaec0ea 2128 if (ops->ndo_del_slave) {
898e5061 2129 err = ops->ndo_del_slave(upper_dev, dev);
fbaec0ea
JP		 2130 if (err)
2131 return err;
2132 } else {
2133 return -EOPNOTSUPP;
2134 }
2135 }
2136
2137 if (ifindex) {
898e5061
JP		 2138 upper_dev = __dev_get_by_index(dev_net(dev), ifindex);
2139 if (!upper_dev)
fbaec0ea 2140 return -EINVAL;
898e5061 2141 ops = upper_dev->netdev_ops;
fbaec0ea 2142 if (ops->ndo_add_slave) {
33eaf2a6 2143 err = ops->ndo_add_slave(upper_dev, dev, extack);
fbaec0ea
JP		 2144 if (err)
2145 return err;
2146 } else {
2147 return -EOPNOTSUPP;
2148 }
2149 }
2150 return 0;
2151}
2152
90c325e3 2153#define DO_SETLINK_MODIFIED 0x01
ba998906
ND		 2154/* notify flag means notify + modified. */
2155#define DO_SETLINK_NOTIFY 0x03
90f62cf3
EB		 2156static int do_setlink(const struct sk_buff *skb,
2157 struct net_device *dev, struct ifinfomsg *ifm,
ddf9f970 2158 struct netlink_ext_ack *extack,
90c325e3 2159 struct nlattr **tb, char *ifname, int status)
1da177e4 2160{
d314774c 2161 const struct net_device_ops *ops = dev->netdev_ops;
0157f60c 2162 int err;
1da177e4 2163
cc2fbdc7
CB		 2164 if (tb[IFLA_NET_NS_PID] || tb[IFLA_NET_NS_FD] || tb[IFLA_IF_NETNSID]) {
2165 struct net *net = rtnl_link_get_net_capable(skb, dev_net(dev),
2166 tb, CAP_NET_ADMIN);
d8a5ec67
EB		 2167 if (IS_ERR(net)) {
2168 err = PTR_ERR(net);
2169 goto errout;
2170 }
cc2fbdc7 2171
d8a5ec67
EB		 2172 err = dev_change_net_namespace(dev, net, ifname);
2173 put_net(net);
2174 if (err)
2175 goto errout;
90c325e3 2176 status |= DO_SETLINK_MODIFIED;
d8a5ec67
EB		 2177 }
2178
da5e0494 2179 if (tb[IFLA_MAP]) {
1da177e4
LT		 2180 struct rtnl_link_ifmap *u_map;
2181 struct ifmap k_map;
2182
d314774c 2183 if (!ops->ndo_set_config) {
1da177e4 2184 err = -EOPNOTSUPP;
0157f60c 2185 goto errout;
1da177e4
LT		 2186 }
2187
2188 if (!netif_device_present(dev)) {
2189 err = -ENODEV;
0157f60c 2190 goto errout;
1da177e4 2191 }
1da177e4 2192
da5e0494 2193 u_map = nla_data(tb[IFLA_MAP]);
1da177e4
LT		 2194 k_map.mem_start = (unsigned long) u_map->mem_start;
2195 k_map.mem_end = (unsigned long) u_map->mem_end;
2196 k_map.base_addr = (unsigned short) u_map->base_addr;
2197 k_map.irq = (unsigned char) u_map->irq;
2198 k_map.dma = (unsigned char) u_map->dma;
2199 k_map.port = (unsigned char) u_map->port;
2200
d314774c 2201 err = ops->ndo_set_config(dev, &k_map);
da5e0494 2202 if (err < 0)
0157f60c 2203 goto errout;
1da177e4 2204
ba998906 2205 status |= DO_SETLINK_NOTIFY;
1da177e4
LT		 2206 }
2207
da5e0494 2208 if (tb[IFLA_ADDRESS]) {
70f8e78e
DM		 2209 struct sockaddr *sa;
2210 int len;
2211
153711f9
WC		 2212 len = sizeof(sa_family_t) + max_t(size_t, dev->addr_len,
2213 sizeof(*sa));
70f8e78e
DM		 2214 sa = kmalloc(len, GFP_KERNEL);
2215 if (!sa) {
2216 err = -ENOMEM;
0157f60c 2217 goto errout;
70f8e78e
DM		 2218 }
2219 sa->sa_family = dev->type;
da5e0494 2220 memcpy(sa->sa_data, nla_data(tb[IFLA_ADDRESS]),
70f8e78e 2221 dev->addr_len);
e7c3273e 2222 err = dev_set_mac_address(dev, sa);
70f8e78e 2223 kfree(sa);
1da177e4 2224 if (err)
0157f60c 2225 goto errout;
90c325e3 2226 status |= DO_SETLINK_MODIFIED;
1da177e4
LT		 2227 }
2228
da5e0494
TG		 2229 if (tb[IFLA_MTU]) {
2230 err = dev_set_mtu(dev, nla_get_u32(tb[IFLA_MTU]));
2231 if (err < 0)
0157f60c 2232 goto errout;
90c325e3 2233 status |= DO_SETLINK_MODIFIED;
1da177e4
LT		 2234 }
2235
cbda10fa
VD		 2236 if (tb[IFLA_GROUP]) {
2237 dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP]));
ba998906 2238 status |= DO_SETLINK_NOTIFY;
cbda10fa
VD		 2239 }
2240
da5e0494
TG		 2241 /*
2242 * Interface selected by interface index but interface
2243 * name provided implies that a name change has been
2244 * requested.
2245 */
51055be8 2246 if (ifm->ifi_index > 0 && ifname[0]) {
da5e0494
TG		 2247 err = dev_change_name(dev, ifname);
2248 if (err < 0)
0157f60c 2249 goto errout;
90c325e3 2250 status |= DO_SETLINK_MODIFIED;
1da177e4
LT		 2251 }
2252
0b815a1a
SH		 2253 if (tb[IFLA_IFALIAS]) {
2254 err = dev_set_alias(dev, nla_data(tb[IFLA_IFALIAS]),
2255 nla_len(tb[IFLA_IFALIAS]));
2256 if (err < 0)
2257 goto errout;
ba998906 2258 status |= DO_SETLINK_NOTIFY;
0b815a1a
SH		 2259 }
2260
da5e0494
TG		 2261 if (tb[IFLA_BROADCAST]) {
2262 nla_memcpy(dev->broadcast, tb[IFLA_BROADCAST], dev->addr_len);
e7c3273e 2263 call_netdevice_notifiers(NETDEV_CHANGEADDR, dev);
1da177e4
LT		 2264 }
2265
83b496e9 2266 if (ifm->ifi_flags || ifm->ifi_change) {
3729d502 2267 err = dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm));
5f9021cf
JB		 2268 if (err < 0)
2269 goto errout;
83b496e9 2270 }
1da177e4 2271
fbaec0ea 2272 if (tb[IFLA_MASTER]) {
33eaf2a6 2273 err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]), extack);
fbaec0ea
JP		 2274 if (err)
2275 goto errout;
90c325e3 2276 status |= DO_SETLINK_MODIFIED;
fbaec0ea
JP		 2277 }
2278
9a57247f
JP		 2279 if (tb[IFLA_CARRIER]) {
2280 err = dev_change_carrier(dev, nla_get_u8(tb[IFLA_CARRIER]));
2281 if (err)
2282 goto errout;
90c325e3 2283 status |= DO_SETLINK_MODIFIED;
9a57247f
JP		 2284 }
2285
5d1180fc 2286 if (tb[IFLA_TXQLEN]) {
0cd29503
AD		 2287 unsigned int value = nla_get_u32(tb[IFLA_TXQLEN]);
2288 unsigned int orig_len = dev->tx_queue_len;
08294a26
JW		 2289
2290 if (dev->tx_queue_len ^ value) {
2291 dev->tx_queue_len = value;
2292 err = call_netdevice_notifiers(
2293 NETDEV_CHANGE_TX_QUEUE_LEN, dev);
2294 err = notifier_to_errno(err);
2295 if (err) {
2296 dev->tx_queue_len = orig_len;
2297 goto errout;
2298 }
2d7f669b 2299 status |= DO_SETLINK_MODIFIED;
08294a26 2300 }
5d1180fc 2301 }
b00055aa 2302
da5e0494 2303 if (tb[IFLA_OPERSTATE])
93b2d4a2 2304 set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE]));
b00055aa 2305
da5e0494 2306 if (tb[IFLA_LINKMODE]) {
1889b0e7
ND		 2307 unsigned char value = nla_get_u8(tb[IFLA_LINKMODE]);
2308
93b2d4a2 2309 write_lock_bh(&dev_base_lock);
1889b0e7 2310 if (dev->link_mode ^ value)
ba998906 2311 status |= DO_SETLINK_NOTIFY;
1889b0e7 2312 dev->link_mode = value;
93b2d4a2 2313 write_unlock_bh(&dev_base_lock);
b00055aa
SR		 2314 }
2315
c02db8c6 2316 if (tb[IFLA_VFINFO_LIST]) {
4f7d2cdf 2317 struct nlattr *vfinfo[IFLA_VF_MAX + 1];
c02db8c6
CW		 2318 struct nlattr *attr;
2319 int rem;
4f7d2cdf 2320
c02db8c6 2321 nla_for_each_nested(attr, tb[IFLA_VFINFO_LIST], rem) {
4f7d2cdf
DB		 2322 if (nla_type(attr) != IFLA_VF_INFO ||
2323 nla_len(attr) < NLA_HDRLEN) {
253683bb 2324 err = -EINVAL;
c02db8c6 2325 goto errout;
253683bb 2326 }
4f7d2cdf 2327 err = nla_parse_nested(vfinfo, IFLA_VF_MAX, attr,
fceb6435 2328 ifla_vf_policy, NULL);
4f7d2cdf
DB		 2329 if (err < 0)
2330 goto errout;
2331 err = do_setvfinfo(dev, vfinfo);
c02db8c6
CW		 2332 if (err < 0)
2333 goto errout;
ba998906 2334 status |= DO_SETLINK_NOTIFY;
c02db8c6 2335 }
ebc08a6f 2336 }
1da177e4
LT		 2337 err = 0;
2338
57b61080
SF		 2339 if (tb[IFLA_VF_PORTS]) {
2340 struct nlattr *port[IFLA_PORT_MAX+1];
2341 struct nlattr *attr;
2342 int vf;
2343 int rem;
2344
2345 err = -EOPNOTSUPP;
2346 if (!ops->ndo_set_vf_port)
2347 goto errout;
2348
2349 nla_for_each_nested(attr, tb[IFLA_VF_PORTS], rem) {
035d210f
DB		 2350 if (nla_type(attr) != IFLA_VF_PORT ||
2351 nla_len(attr) < NLA_HDRLEN) {
2352 err = -EINVAL;
2353 goto errout;
2354 }
2355 err = nla_parse_nested(port, IFLA_PORT_MAX, attr,
fceb6435 2356 ifla_port_policy, NULL);
57b61080
SF		 2357 if (err < 0)
2358 goto errout;
2359 if (!port[IFLA_PORT_VF]) {
2360 err = -EOPNOTSUPP;
2361 goto errout;
2362 }
2363 vf = nla_get_u32(port[IFLA_PORT_VF]);
2364 err = ops->ndo_set_vf_port(dev, vf, port);
2365 if (err < 0)
2366 goto errout;
ba998906 2367 status |= DO_SETLINK_NOTIFY;
57b61080
SF		 2368 }
2369 }
2370 err = 0;
2371
2372 if (tb[IFLA_PORT_SELF]) {
2373 struct nlattr *port[IFLA_PORT_MAX+1];
2374
2375 err = nla_parse_nested(port, IFLA_PORT_MAX,
fceb6435
JB		 2376 tb[IFLA_PORT_SELF], ifla_port_policy,
2377 NULL);
57b61080
SF		 2378 if (err < 0)
2379 goto errout;
2380
2381 err = -EOPNOTSUPP;
2382 if (ops->ndo_set_vf_port)
2383 err = ops->ndo_set_vf_port(dev, PORT_SELF_VF, port);
2384 if (err < 0)
2385 goto errout;
ba998906 2386 status |= DO_SETLINK_NOTIFY;
57b61080 2387 }
f8ff182c
TG		 2388
2389 if (tb[IFLA_AF_SPEC]) {
2390 struct nlattr *af;
2391 int rem;
2392
2393 nla_for_each_nested(af, tb[IFLA_AF_SPEC], rem) {
2394 const struct rtnl_af_ops *af_ops;
2395
5fa85a09
FW		 2396 rcu_read_lock();
2397
058c8d59 2398 BUG_ON(!(af_ops = rtnl_af_lookup(nla_type(af))));
f8ff182c 2399
cf7afbfe 2400 err = af_ops->set_link_af(dev, af);
5fa85a09
FW		 2401 if (err < 0) {
2402 rcu_read_unlock();
f8ff182c 2403 goto errout;
5fa85a09 2404 }
f8ff182c 2405
5fa85a09 2406 rcu_read_unlock();
ba998906 2407 status |= DO_SETLINK_NOTIFY;
f8ff182c
TG		 2408 }
2409 }
57b61080
SF		 2410 err = 0;
2411
88d6378b
AK		 2412 if (tb[IFLA_PROTO_DOWN]) {
2413 err = dev_change_proto_down(dev,
2414 nla_get_u8(tb[IFLA_PROTO_DOWN]));
2415 if (err)
2416 goto errout;
2417 status |= DO_SETLINK_NOTIFY;
2418 }
2419
d1fdd913
BB		 2420 if (tb[IFLA_XDP]) {
2421 struct nlattr *xdp[IFLA_XDP_MAX + 1];
85de8576 2422 u32 xdp_flags = 0;
d1fdd913
BB		 2423
2424 err = nla_parse_nested(xdp, IFLA_XDP_MAX, tb[IFLA_XDP],
fceb6435 2425 ifla_xdp_policy, NULL);
d1fdd913
BB		 2426 if (err < 0)
2427 goto errout;
2428
58038695 2429 if (xdp[IFLA_XDP_ATTACHED] || xdp[IFLA_XDP_PROG_ID]) {
262d8625
BB		 2430 err = -EINVAL;
2431 goto errout;
2432 }
85de8576
DB		 2433
2434 if (xdp[IFLA_XDP_FLAGS]) {
2435 xdp_flags = nla_get_u32(xdp[IFLA_XDP_FLAGS]);
2436 if (xdp_flags & ~XDP_FLAGS_MASK) {
2437 err = -EINVAL;
2438 goto errout;
2439 }
ee5d032f 2440 if (hweight32(xdp_flags & XDP_FLAGS_MODES) > 1) {
0489df9a
DB		 2441 err = -EINVAL;
2442 goto errout;
2443 }
85de8576
DB		 2444 }
2445
d1fdd913 2446 if (xdp[IFLA_XDP_FD]) {
ddf9f970 2447 err = dev_change_xdp_fd(dev, extack,
85de8576
DB		 2448 nla_get_s32(xdp[IFLA_XDP_FD]),
2449 xdp_flags);
d1fdd913
BB		 2450 if (err)
2451 goto errout;
2452 status |= DO_SETLINK_NOTIFY;
2453 }
2454 }
2455
0157f60c 2456errout:
ba998906 2457 if (status & DO_SETLINK_MODIFIED) {
64ff90cc 2458 if ((status & DO_SETLINK_NOTIFY) == DO_SETLINK_NOTIFY)
ba998906
ND		 2459 netdev_state_change(dev);
2460
2461 if (err < 0)
2462 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",
2463 dev->name);
2464 }
da5e0494 2465
0157f60c
PM		 2466 return err;
2467}
1da177e4 2468
c21ef3e3
DA		 2469static int rtnl_setlink(struct sk_buff *skb, struct nlmsghdr *nlh,
2470 struct netlink_ext_ack *extack)
0157f60c 2471{
3b1e0a65 2472 struct net *net = sock_net(skb->sk);
0157f60c
PM		 2473 struct ifinfomsg *ifm;
2474 struct net_device *dev;
2475 int err;
2476 struct nlattr *tb[IFLA_MAX+1];
2477 char ifname[IFNAMSIZ];
2478
c21ef3e3
DA		 2479 err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy,
2480 extack);
0157f60c
PM		 2481 if (err < 0)
2482 goto errout;
2483
a5a1a12d
CB		 2484 err = rtnl_ensure_unique_netns(tb, extack, false);
2485 if (err < 0)
2486 goto errout;
2487
0157f60c
PM		 2488 if (tb[IFLA_IFNAME])
2489 nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
2490 else
2491 ifname[0] = '\0';
2492
2493 err = -EINVAL;
2494 ifm = nlmsg_data(nlh);
2495 if (ifm->ifi_index > 0)
a3d12891 2496 dev = __dev_get_by_index(net, ifm->ifi_index);
0157f60c 2497 else if (tb[IFLA_IFNAME])
a3d12891 2498 dev = __dev_get_by_name(net, ifname);
0157f60c
PM		 2499 else
2500 goto errout;
2501
2502 if (dev == NULL) {
2503 err = -ENODEV;
2504 goto errout;
2505 }
2506
e0d087af
ED		 2507 err = validate_linkmsg(dev, tb);
2508 if (err < 0)
a3d12891 2509 goto errout;
0157f60c 2510
ddf9f970 2511 err = do_setlink(skb, dev, ifm, extack, tb, ifname, 0);
da5e0494 2512errout:
1da177e4
LT		 2513 return err;
2514}
2515
66400d54
WC		 2516static int rtnl_group_dellink(const struct net *net, int group)
2517{
2518 struct net_device *dev, *aux;
2519 LIST_HEAD(list_kill);
2520 bool found = false;
2521
2522 if (!group)
2523 return -EPERM;
2524
2525 for_each_netdev(net, dev) {
2526 if (dev->group == group) {
2527 const struct rtnl_link_ops *ops;
2528
2529 found = true;
2530 ops = dev->rtnl_link_ops;
2531 if (!ops || !ops->dellink)
2532 return -EOPNOTSUPP;
2533 }
2534 }
2535
2536 if (!found)
2537 return -ENODEV;
2538
2539 for_each_netdev_safe(net, dev, aux) {
2540 if (dev->group == group) {
2541 const struct rtnl_link_ops *ops;
2542
2543 ops = dev->rtnl_link_ops;
2544 ops->dellink(dev, &list_kill);
2545 }
2546 }
2547 unregister_netdevice_many(&list_kill);
2548
2549 return 0;
2550}
2551
614732ea
TG		 2552int rtnl_delete_link(struct net_device *dev)
2553{
2554 const struct rtnl_link_ops *ops;
2555 LIST_HEAD(list_kill);
2556
2557 ops = dev->rtnl_link_ops;
2558 if (!ops || !ops->dellink)
2559 return -EOPNOTSUPP;
2560
2561 ops->dellink(dev, &list_kill);
2562 unregister_netdevice_many(&list_kill);
2563
2564 return 0;
2565}
2566EXPORT_SYMBOL_GPL(rtnl_delete_link);
2567
c21ef3e3
DA		 2568static int rtnl_dellink(struct sk_buff *skb, struct nlmsghdr *nlh,
2569 struct netlink_ext_ack *extack)
38f7b870 2570{
3b1e0a65 2571 struct net *net = sock_net(skb->sk);
d238af80
CB		 2572 struct net *tgt_net = net;
2573 struct net_device *dev = NULL;
38f7b870
PM		 2574 struct ifinfomsg *ifm;
2575 char ifname[IFNAMSIZ];
2576 struct nlattr *tb[IFLA_MAX+1];
2577 int err;
d238af80 2578 int netnsid = -1;
38f7b870 2579
c21ef3e3 2580 err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack);
38f7b870
PM		 2581 if (err < 0)
2582 return err;
2583
a5a1a12d
CB		 2584 err = rtnl_ensure_unique_netns(tb, extack, true);
2585 if (err < 0)
2586 return err;
2587
38f7b870
PM		 2588 if (tb[IFLA_IFNAME])
2589 nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
2590
d238af80
CB		 2591 if (tb[IFLA_IF_NETNSID]) {
2592 netnsid = nla_get_s32(tb[IFLA_IF_NETNSID]);
2593 tgt_net = get_target_net(NETLINK_CB(skb).sk, netnsid);
2594 if (IS_ERR(tgt_net))
2595 return PTR_ERR(tgt_net);
2596 }
2597
2598 err = -EINVAL;
38f7b870
PM		 2599 ifm = nlmsg_data(nlh);
2600 if (ifm->ifi_index > 0)
d238af80 2601 dev = __dev_get_by_index(tgt_net, ifm->ifi_index);
38f7b870 2602 else if (tb[IFLA_IFNAME])
d238af80 2603 dev = __dev_get_by_name(tgt_net, ifname);
66400d54 2604 else if (tb[IFLA_GROUP])
d238af80 2605 err = rtnl_group_dellink(tgt_net, nla_get_u32(tb[IFLA_GROUP]));
38f7b870 2606 else
d238af80 2607 goto out;
38f7b870 2608
d238af80
CB		 2609 if (!dev) {
2610 if (tb[IFLA_IFNAME] || ifm->ifi_index > 0)
2611 err = -ENODEV;
2612
2613 goto out;
2614 }
2615
2616 err = rtnl_delete_link(dev);
38f7b870 2617
d238af80
CB		 2618out:
2619 if (netnsid >= 0)
2620 put_net(tgt_net);
2621
2622 return err;
38f7b870
PM		 2623}
2624
3729d502
PM		 2625int rtnl_configure_link(struct net_device *dev, const struct ifinfomsg *ifm)
2626{
2627 unsigned int old_flags;
2628 int err;
2629
2630 old_flags = dev->flags;
2631 if (ifm && (ifm->ifi_flags || ifm->ifi_change)) {
2632 err = __dev_change_flags(dev, rtnl_dev_combine_flags(dev, ifm));
2633 if (err < 0)
2634 return err;
2635 }
2636
2637 dev->rtnl_link_state = RTNL_LINK_INITIALIZED;
3729d502 2638
a528c219 2639 __dev_notify_flags(dev, old_flags, ~0U);
3729d502
PM		 2640 return 0;
2641}
2642EXPORT_SYMBOL(rtnl_configure_link);
2643
c0713563 2644struct net_device *rtnl_create_link(struct net *net,
78ebb0d0 2645 const char *ifname, unsigned char name_assign_type,
5517750f 2646 const struct rtnl_link_ops *ops, struct nlattr *tb[])
e7199288 2647{
e7199288 2648 struct net_device *dev;
d40156aa
JP		 2649 unsigned int num_tx_queues = 1;
2650 unsigned int num_rx_queues = 1;
e7199288 2651
76ff5cc9
JP		 2652 if (tb[IFLA_NUM_TX_QUEUES])
2653 num_tx_queues = nla_get_u32(tb[IFLA_NUM_TX_QUEUES]);
2654 else if (ops->get_num_tx_queues)
d40156aa 2655 num_tx_queues = ops->get_num_tx_queues();
76ff5cc9
JP		 2656
2657 if (tb[IFLA_NUM_RX_QUEUES])
2658 num_rx_queues = nla_get_u32(tb[IFLA_NUM_RX_QUEUES]);
2659 else if (ops->get_num_rx_queues)
d40156aa 2660 num_rx_queues = ops->get_num_rx_queues();
efacb309 2661
5517750f 2662 dev = alloc_netdev_mqs(ops->priv_size, ifname, name_assign_type,
c835a677 2663 ops->setup, num_tx_queues, num_rx_queues);
e7199288 2664 if (!dev)
d1892e4e 2665 return ERR_PTR(-ENOMEM);
e7199288 2666
81adee47
EB		 2667 dev_net_set(dev, net);
2668 dev->rtnl_link_ops = ops;
3729d502 2669 dev->rtnl_link_state = RTNL_LINK_INITIALIZING;
81adee47 2670
e7199288
PE		 2671 if (tb[IFLA_MTU])
2672 dev->mtu = nla_get_u32(tb[IFLA_MTU]);
2afb9b53 2673 if (tb[IFLA_ADDRESS]) {
e7199288
PE		 2674 memcpy(dev->dev_addr, nla_data(tb[IFLA_ADDRESS]),
2675 nla_len(tb[IFLA_ADDRESS]));
2afb9b53
JP		 2676 dev->addr_assign_type = NET_ADDR_SET;
2677 }
e7199288
PE		 2678 if (tb[IFLA_BROADCAST])
2679 memcpy(dev->broadcast, nla_data(tb[IFLA_BROADCAST]),
2680 nla_len(tb[IFLA_BROADCAST]));
2681 if (tb[IFLA_TXQLEN])
2682 dev->tx_queue_len = nla_get_u32(tb[IFLA_TXQLEN]);
2683 if (tb[IFLA_OPERSTATE])
93b2d4a2 2684 set_operstate(dev, nla_get_u8(tb[IFLA_OPERSTATE]));
e7199288
PE		 2685 if (tb[IFLA_LINKMODE])
2686 dev->link_mode = nla_get_u8(tb[IFLA_LINKMODE]);
ffa934f1
PM		 2687 if (tb[IFLA_GROUP])
2688 dev_set_group(dev, nla_get_u32(tb[IFLA_GROUP]));
e7199288
PE		 2689
2690 return dev;
e7199288 2691}
e0d087af 2692EXPORT_SYMBOL(rtnl_create_link);
e7199288 2693
90f62cf3
EB		 2694static int rtnl_group_changelink(const struct sk_buff *skb,
2695 struct net *net, int group,
e7ed828f 2696 struct ifinfomsg *ifm,
ddf9f970 2697 struct netlink_ext_ack *extack,
e7ed828f
VD		 2698 struct nlattr **tb)
2699{
d079535d 2700 struct net_device *dev, *aux;
e7ed828f
VD		 2701 int err;
2702
d079535d 2703 for_each_netdev_safe(net, dev, aux) {
e7ed828f 2704 if (dev->group == group) {
ddf9f970 2705 err = do_setlink(skb, dev, ifm, extack, tb, NULL, 0);
e7ed828f
VD		 2706 if (err < 0)
2707 return err;
2708 }
2709 }
2710
2711 return 0;
2712}
2713
c21ef3e3
DA		 2714static int rtnl_newlink(struct sk_buff *skb, struct nlmsghdr *nlh,
2715 struct netlink_ext_ack *extack)
38f7b870 2716{
3b1e0a65 2717 struct net *net = sock_net(skb->sk);
38f7b870 2718 const struct rtnl_link_ops *ops;
ba7d49b1 2719 const struct rtnl_link_ops *m_ops = NULL;
38f7b870 2720 struct net_device *dev;
ba7d49b1 2721 struct net_device *master_dev = NULL;
38f7b870
PM		 2722 struct ifinfomsg *ifm;
2723 char kind[MODULE_NAME_LEN];
2724 char ifname[IFNAMSIZ];
2725 struct nlattr *tb[IFLA_MAX+1];
2726 struct nlattr *linkinfo[IFLA_INFO_MAX+1];
5517750f 2727 unsigned char name_assign_type = NET_NAME_USER;
38f7b870
PM		 2728 int err;
2729
95a5afca 2730#ifdef CONFIG_MODULES
38f7b870 2731replay:
8072f085 2732#endif
c21ef3e3 2733 err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack);
38f7b870
PM		 2734 if (err < 0)
2735 return err;
2736
a5a1a12d
CB		 2737 err = rtnl_ensure_unique_netns(tb, extack, false);
2738 if (err < 0)
2739 return err;
2740
38f7b870
PM		 2741 if (tb[IFLA_IFNAME])
2742 nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
2743 else
2744 ifname[0] = '\0';
2745
2746 ifm = nlmsg_data(nlh);
2747 if (ifm->ifi_index > 0)
881d966b 2748 dev = __dev_get_by_index(net, ifm->ifi_index);
e7ed828f
VD		 2749 else {
2750 if (ifname[0])
2751 dev = __dev_get_by_name(net, ifname);
e7ed828f
VD		 2752 else
2753 dev = NULL;
2754 }
38f7b870 2755
ba7d49b1
JP		 2756 if (dev) {
2757 master_dev = netdev_master_upper_dev_get(dev);
2758 if (master_dev)
2759 m_ops = master_dev->rtnl_link_ops;
2760 }
2761
e0d087af
ED		 2762 err = validate_linkmsg(dev, tb);
2763 if (err < 0)
1840bb13
TG		 2764 return err;
2765
38f7b870
PM		 2766 if (tb[IFLA_LINKINFO]) {
2767 err = nla_parse_nested(linkinfo, IFLA_INFO_MAX,
fceb6435
JB		 2768 tb[IFLA_LINKINFO], ifla_info_policy,
2769 NULL);
38f7b870
PM		 2770 if (err < 0)
2771 return err;
2772 } else
2773 memset(linkinfo, 0, sizeof(linkinfo));
2774
2775 if (linkinfo[IFLA_INFO_KIND]) {
2776 nla_strlcpy(kind, linkinfo[IFLA_INFO_KIND], sizeof(kind));
2777 ops = rtnl_link_ops_get(kind);
2778 } else {
2779 kind[0] = '\0';
2780 ops = NULL;
2781 }
2782
2783 if (1) {
4e10fd5b
SL		 2784 struct nlattr *attr[ops ? ops->maxtype + 1 : 1];
2785 struct nlattr *slave_attr[m_ops ? m_ops->slave_maxtype + 1 : 1];
ba7d49b1
JP		 2786 struct nlattr **data = NULL;
2787 struct nlattr **slave_data = NULL;
317f4810 2788 struct net *dest_net, *link_net = NULL;
38f7b870
PM		 2789
2790 if (ops) {
2791 if (ops->maxtype && linkinfo[IFLA_INFO_DATA]) {
2792 err = nla_parse_nested(attr, ops->maxtype,
2793 linkinfo[IFLA_INFO_DATA],
fceb6435 2794 ops->policy, NULL);
38f7b870
PM		 2795 if (err < 0)
2796 return err;
2797 data = attr;
2798 }
2799 if (ops->validate) {
a8b8a889 2800 err = ops->validate(tb, data, extack);
38f7b870
PM		 2801 if (err < 0)
2802 return err;
2803 }
2804 }
2805
ba7d49b1
JP		 2806 if (m_ops) {
2807 if (m_ops->slave_maxtype &&
2808 linkinfo[IFLA_INFO_SLAVE_DATA]) {
2809 err = nla_parse_nested(slave_attr,
2810 m_ops->slave_maxtype,
2811 linkinfo[IFLA_INFO_SLAVE_DATA],
fceb6435
JB		 2812 m_ops->slave_policy,
2813 NULL);
ba7d49b1
JP		 2814 if (err < 0)
2815 return err;
2816 slave_data = slave_attr;
2817 }
ba7d49b1
JP		 2818 }
2819
38f7b870 2820 if (dev) {
90c325e3 2821 int status = 0;
38f7b870
PM		 2822
2823 if (nlh->nlmsg_flags & NLM_F_EXCL)
2824 return -EEXIST;
2825 if (nlh->nlmsg_flags & NLM_F_REPLACE)
2826 return -EOPNOTSUPP;
2827
2828 if (linkinfo[IFLA_INFO_DATA]) {
2829 if (!ops || ops != dev->rtnl_link_ops ||
2830 !ops->changelink)
2831 return -EOPNOTSUPP;
2832
ad744b22 2833 err = ops->changelink(dev, tb, data, extack);
38f7b870
PM		 2834 if (err < 0)
2835 return err;
ba998906 2836 status |= DO_SETLINK_NOTIFY;
38f7b870
PM		 2837 }
2838
ba7d49b1
JP		 2839 if (linkinfo[IFLA_INFO_SLAVE_DATA]) {
2840 if (!m_ops || !m_ops->slave_changelink)
2841 return -EOPNOTSUPP;
2842
2843 err = m_ops->slave_changelink(master_dev, dev,
17dd0ec4
MS		 2844 tb, slave_data,
2845 extack);
ba7d49b1
JP		 2846 if (err < 0)
2847 return err;
ba998906 2848 status |= DO_SETLINK_NOTIFY;
ba7d49b1
JP		 2849 }
2850
ddf9f970
JK		 2851 return do_setlink(skb, dev, ifm, extack, tb, ifname,
2852 status);
38f7b870
PM		 2853 }
2854
ffa934f1
PM		 2855 if (!(nlh->nlmsg_flags & NLM_F_CREATE)) {
2856 if (ifm->ifi_index == 0 && tb[IFLA_GROUP])
90f62cf3 2857 return rtnl_group_changelink(skb, net,
ffa934f1 2858 nla_get_u32(tb[IFLA_GROUP]),
ddf9f970 2859 ifm, extack, tb);
38f7b870 2860 return -ENODEV;
ffa934f1 2861 }
38f7b870 2862
160ca014 2863 if (tb[IFLA_MAP] || tb[IFLA_PROTINFO])
38f7b870
PM		 2864 return -EOPNOTSUPP;
2865
2866 if (!ops) {
95a5afca 2867#ifdef CONFIG_MODULES
38f7b870
PM		 2868 if (kind[0]) {
2869 __rtnl_unlock();
2870 request_module("rtnl-link-%s", kind);
2871 rtnl_lock();
2872 ops = rtnl_link_ops_get(kind);
2873 if (ops)
2874 goto replay;
2875 }
2876#endif
2877 return -EOPNOTSUPP;
2878 }
2879
b0ab2fab
JP		 2880 if (!ops->setup)
2881 return -EOPNOTSUPP;
2882
5517750f 2883 if (!ifname[0]) {
38f7b870 2884 snprintf(ifname, IFNAMSIZ, "%s%%d", ops->kind);
5517750f
TG		 2885 name_assign_type = NET_NAME_ENUM;
2886 }
e7199288 2887
3a5f32cf 2888 dest_net = rtnl_link_get_net_capable(skb, net, tb, CAP_NET_ADMIN);
13ad1774
EB		 2889 if (IS_ERR(dest_net))
2890 return PTR_ERR(dest_net);
2891
317f4810
ND		 2892 if (tb[IFLA_LINK_NETNSID]) {
2893 int id = nla_get_s32(tb[IFLA_LINK_NETNSID]);
2894
2895 link_net = get_net_ns_by_id(dest_net, id);
2896 if (!link_net) {
2897 err = -EINVAL;
2898 goto out;
2899 }
06615bed
EB		 2900 err = -EPERM;
2901 if (!netlink_ns_capable(skb, link_net->user_ns, CAP_NET_ADMIN))
2902 goto out;
317f4810
ND		 2903 }
2904
2905 dev = rtnl_create_link(link_net ? : dest_net, ifname,
2906 name_assign_type, ops, tb);
9c7dafbf 2907 if (IS_ERR(dev)) {
e7199288 2908 err = PTR_ERR(dev);
9c7dafbf
PE		 2909 goto out;
2910 }
2911
2912 dev->ifindex = ifm->ifi_index;
2913
0e0eee24 2914 if (ops->newlink) {
7a3f4a18
MS		 2915 err = ops->newlink(link_net ? : net, dev, tb, data,
2916 extack);
0e0eee24 2917 /* Drivers should call free_netdev() in ->destructor
e51fb152
CW		 2918 * and unregister it on failure after registration
2919 * so that device could be finally freed in rtnl_unlock.
0e0eee24 2920 */
e51fb152
CW		 2921 if (err < 0) {
2922 /* If device is not registered at all, free it now */
2923 if (dev->reg_state == NETREG_UNINITIALIZED)
2924 free_netdev(dev);
0e0eee24 2925 goto out;
e51fb152 2926 }
0e0eee24 2927 } else {
2d85cba2 2928 err = register_netdevice(dev);
0e0eee24
CW		 2929 if (err < 0) {
2930 free_netdev(dev);
2931 goto out;
2932 }
fce9b9be 2933 }
3729d502 2934 err = rtnl_configure_link(dev, ifm);
43638900
DM		 2935 if (err < 0)
2936 goto out_unregister;
bdef279b 2937 if (link_net) {
317f4810 2938 err = dev_change_net_namespace(dev, dest_net, ifname);
bdef279b 2939 if (err < 0)
43638900 2940 goto out_unregister;
bdef279b 2941 }
160ca014 2942 if (tb[IFLA_MASTER]) {
33eaf2a6
DA		 2943 err = do_set_master(dev, nla_get_u32(tb[IFLA_MASTER]),
2944 extack);
160ca014
TV		 2945 if (err)
2946 goto out_unregister;
2947 }
3729d502 2948out:
317f4810
ND		 2949 if (link_net)
2950 put_net(link_net);
81adee47 2951 put_net(dest_net);
38f7b870 2952 return err;
43638900
DM		 2953out_unregister:
2954 if (ops->newlink) {
2955 LIST_HEAD(list_kill);
2956
2957 ops->dellink(dev, &list_kill);
2958 unregister_netdevice_many(&list_kill);
2959 } else {
2960 unregister_netdevice(dev);
2961 }
2962 goto out;
38f7b870
PM		 2963 }
2964}
2965
c21ef3e3
DA		 2966static int rtnl_getlink(struct sk_buff *skb, struct nlmsghdr *nlh,
2967 struct netlink_ext_ack *extack)
711e2c33 2968{
3b1e0a65 2969 struct net *net = sock_net(skb->sk);
79e1ad14 2970 struct net *tgt_net = net;
b60c5115 2971 struct ifinfomsg *ifm;
a3d12891 2972 char ifname[IFNAMSIZ];
b60c5115
TG		 2973 struct nlattr *tb[IFLA_MAX+1];
2974 struct net_device *dev = NULL;
2975 struct sk_buff *nskb;
79e1ad14 2976 int netnsid = -1;
339bf98f 2977 int err;
115c9b81 2978 u32 ext_filter_mask = 0;
711e2c33 2979
c21ef3e3 2980 err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFLA_MAX, ifla_policy, extack);
b60c5115 2981 if (err < 0)
9918f230 2982 return err;
b60c5115 2983
a5a1a12d
CB		 2984 err = rtnl_ensure_unique_netns(tb, extack, true);
2985 if (err < 0)
2986 return err;
2987
79e1ad14
JB		 2988 if (tb[IFLA_IF_NETNSID]) {
2989 netnsid = nla_get_s32(tb[IFLA_IF_NETNSID]);
f428fe4a 2990 tgt_net = get_target_net(NETLINK_CB(skb).sk, netnsid);
79e1ad14
JB		 2991 if (IS_ERR(tgt_net))
2992 return PTR_ERR(tgt_net);
2993 }
2994
a3d12891
ED		 2995 if (tb[IFLA_IFNAME])
2996 nla_strlcpy(ifname, tb[IFLA_IFNAME], IFNAMSIZ);
2997
115c9b81
GR		 2998 if (tb[IFLA_EXT_MASK])
2999 ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
3000
79e1ad14 3001 err = -EINVAL;
b60c5115 3002 ifm = nlmsg_data(nlh);
a3d12891 3003 if (ifm->ifi_index > 0)
79e1ad14 3004 dev = __dev_get_by_index(tgt_net, ifm->ifi_index);
a3d12891 3005 else if (tb[IFLA_IFNAME])
79e1ad14 3006 dev = __dev_get_by_name(tgt_net, ifname);
a3d12891 3007 else
79e1ad14 3008 goto out;
711e2c33 3009
79e1ad14 3010 err = -ENODEV;
a3d12891 3011 if (dev == NULL)
79e1ad14 3012 goto out;
a3d12891 3013
79e1ad14 3014 err = -ENOBUFS;
115c9b81 3015 nskb = nlmsg_new(if_nlmsg_size(dev, ext_filter_mask), GFP_KERNEL);
a3d12891 3016 if (nskb == NULL)
79e1ad14 3017 goto out;
b60c5115 3018
79e1ad14
JB		 3019 err = rtnl_fill_ifinfo(nskb, dev, net,
3020 RTM_NEWLINK, NETLINK_CB(skb).portid,
3021 nlh->nlmsg_seq, 0, 0, ext_filter_mask,
3022 0, NULL, netnsid);
26932566
PM		 3023 if (err < 0) {
3024 /* -EMSGSIZE implies BUG in if_nlmsg_size */
3025 WARN_ON(err == -EMSGSIZE);
3026 kfree_skb(nskb);
a3d12891 3027 } else
15e47304 3028 err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid);
79e1ad14
JB		 3029out:
3030 if (netnsid >= 0)
3031 put_net(tgt_net);
711e2c33 3032
b60c5115 3033 return err;
711e2c33 3034}
711e2c33 3035
115c9b81 3036static u16 rtnl_calcit(struct sk_buff *skb, struct nlmsghdr *nlh)
c7ac8679 3037{
115c9b81
GR		 3038 struct net *net = sock_net(skb->sk);
3039 struct net_device *dev;
3040 struct nlattr *tb[IFLA_MAX+1];
3041 u32 ext_filter_mask = 0;
3042 u16 min_ifinfo_dump_size = 0;
e5eca6d4
MS		 3043 int hdrlen;
3044
3045 /* Same kernel<->userspace interface hack as in rtnl_dump_ifinfo. */
3046 hdrlen = nlmsg_len(nlh) < sizeof(struct ifinfomsg) ?
3047 sizeof(struct rtgenmsg) : sizeof(struct ifinfomsg);
115c9b81 3048
fceb6435 3049 if (nlmsg_parse(nlh, hdrlen, tb, IFLA_MAX, ifla_policy, NULL) >= 0) {
a4b64fbe
ED		 3050 if (tb[IFLA_EXT_MASK])
3051 ext_filter_mask = nla_get_u32(tb[IFLA_EXT_MASK]);
3052 }
115c9b81
GR		 3053
3054 if (!ext_filter_mask)
3055 return NLMSG_GOODSIZE;
3056 /*
3057 * traverse the list of net devices and compute the minimum
3058 * buffer size based upon the filter mask.
3059 */
6853dd48
FW		 3060 rcu_read_lock();
3061 for_each_netdev_rcu(net, dev) {
115c9b81
GR		 3062 min_ifinfo_dump_size = max_t(u16, min_ifinfo_dump_size,
3063 if_nlmsg_size(dev,
3064 ext_filter_mask));
3065 }
6853dd48 3066 rcu_read_unlock();
115c9b81 3067
93af2056 3068 return nlmsg_total_size(min_ifinfo_dump_size);
c7ac8679
GR		 3069}
3070
42bad1da 3071static int rtnl_dump_all(struct sk_buff *skb, struct netlink_callback *cb)
1da177e4
LT		 3072{
3073 int idx;
3074 int s_idx = cb->family;
3075
3076 if (s_idx == 0)
3077 s_idx = 1;
6853dd48 3078
25239cee 3079 for (idx = 1; idx <= RTNL_FAMILY_MAX; idx++) {
1da177e4 3080 int type = cb->nlh->nlmsg_type-RTM_BASE;
6853dd48
FW		 3081 struct rtnl_link *handlers;
3082 rtnl_dumpit_func dumpit;
3083
1da177e4
LT		 3084 if (idx < s_idx || idx == PF_PACKET)
3085 continue;
6853dd48
FW		 3086
3087 handlers = rtnl_dereference(rtnl_msg_handlers[idx]);
3088 if (!handlers)
1da177e4 3089 continue;
6853dd48
FW		 3090
3091 dumpit = READ_ONCE(handlers[type].dumpit);
3092 if (!dumpit)
3093 continue;
3094
0465277f 3095 if (idx > s_idx) {
1da177e4 3096 memset(&cb->args[0], 0, sizeof(cb->args));
0465277f
ND		 3097 cb->prev_seq = 0;
3098 cb->seq = 0;
3099 }
6853dd48 3100 if (dumpit(skb, cb))
1da177e4
LT		 3101 break;
3102 }
3103 cb->family = idx;
3104
3105 return skb->len;
3106}
3107
395eea6c 3108struct sk_buff *rtmsg_ifinfo_build_skb(int type, struct net_device *dev,
3d3ea5af 3109 unsigned int change,
6621dd29 3110 u32 event, gfp_t flags, int *new_nsid)
1da177e4 3111{
c346dca1 3112 struct net *net = dev_net(dev);
1da177e4 3113 struct sk_buff *skb;
0ec6d3f4 3114 int err = -ENOBUFS;
c7ac8679 3115 size_t if_info_size;
1da177e4 3116
7f294054 3117 skb = nlmsg_new((if_info_size = if_nlmsg_size(dev, 0)), flags);
0ec6d3f4
TG		 3118 if (skb == NULL)
3119 goto errout;
1da177e4 3120
79e1ad14
JB		 3121 err = rtnl_fill_ifinfo(skb, dev, dev_net(dev),
3122 type, 0, 0, change, 0, 0, event,
3123 new_nsid, -1);
26932566
PM		 3124 if (err < 0) {
3125 /* -EMSGSIZE implies BUG in if_nlmsg_size() */
3126 WARN_ON(err == -EMSGSIZE);
3127 kfree_skb(skb);
3128 goto errout;
3129 }
395eea6c 3130 return skb;
0ec6d3f4
TG		 3131errout:
3132 if (err < 0)
4b3da706 3133 rtnl_set_sk_err(net, RTNLGRP_LINK, err);
395eea6c
MB		 3134 return NULL;
3135}
3136
3137void rtmsg_ifinfo_send(struct sk_buff *skb, struct net_device *dev, gfp_t flags)
3138{
3139 struct net *net = dev_net(dev);
3140
3141 rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, flags);
3142}
3143
3d3ea5af
VY		 3144static void rtmsg_ifinfo_event(int type, struct net_device *dev,
3145 unsigned int change, u32 event,
6621dd29 3146 gfp_t flags, int *new_nsid)
395eea6c
MB		 3147{
3148 struct sk_buff *skb;
3149
ed2a80ab
ND		 3150 if (dev->reg_state != NETREG_REGISTERED)
3151 return;
3152
6621dd29 3153 skb = rtmsg_ifinfo_build_skb(type, dev, change, event, flags, new_nsid);
395eea6c
MB		 3154 if (skb)
3155 rtmsg_ifinfo_send(skb, dev, flags);
1da177e4 3156}
3d3ea5af
VY		 3157
3158void rtmsg_ifinfo(int type, struct net_device *dev, unsigned int change,
3159 gfp_t flags)
3160{
6621dd29 3161 rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags, NULL);
3d3ea5af 3162}
1da177e4 3163
6621dd29
ND		 3164void rtmsg_ifinfo_newnet(int type, struct net_device *dev, unsigned int change,
3165 gfp_t flags, int *new_nsid)
3166{
3167 rtmsg_ifinfo_event(type, dev, change, rtnl_get_event(0), flags,
3168 new_nsid);
3169}
3170
d83b0603
JF		 3171static int nlmsg_populate_fdb_fill(struct sk_buff *skb,
3172 struct net_device *dev,
1e53d5bb 3173 u8 *addr, u16 vid, u32 pid, u32 seq,
1c104a6b 3174 int type, unsigned int flags,
b3379041 3175 int nlflags, u16 ndm_state)
d83b0603
JF		 3176{
3177 struct nlmsghdr *nlh;
3178 struct ndmsg *ndm;
3179
1c104a6b 3180 nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ndm), nlflags);
d83b0603
JF		 3181 if (!nlh)
3182 return -EMSGSIZE;
3183
3184 ndm = nlmsg_data(nlh);
3185 ndm->ndm_family = AF_BRIDGE;
3186 ndm->ndm_pad1 = 0;
3187 ndm->ndm_pad2 = 0;
3188 ndm->ndm_flags = flags;
3189 ndm->ndm_type = 0;
3190 ndm->ndm_ifindex = dev->ifindex;
b3379041 3191 ndm->ndm_state = ndm_state;
d83b0603
JF		 3192
3193 if (nla_put(skb, NDA_LLADDR, ETH_ALEN, addr))
3194 goto nla_put_failure;
1e53d5bb
HS		 3195 if (vid)
3196 if (nla_put(skb, NDA_VLAN, sizeof(u16), &vid))
3197 goto nla_put_failure;
d83b0603 3198
053c095a
JB		 3199 nlmsg_end(skb, nlh);
3200 return 0;
d83b0603
JF		 3201
3202nla_put_failure:
3203 nlmsg_cancel(skb, nlh);
3204 return -EMSGSIZE;
3205}
3206
3ff661c3
JF		 3207static inline size_t rtnl_fdb_nlmsg_size(void)
3208{
f82ef3e1
SD		 3209 return NLMSG_ALIGN(sizeof(struct ndmsg)) +
3210 nla_total_size(ETH_ALEN) + /* NDA_LLADDR */
3211 nla_total_size(sizeof(u16)) + /* NDA_VLAN */
3212 0;
3ff661c3
JF		 3213}
3214
b3379041
HS		 3215static void rtnl_fdb_notify(struct net_device *dev, u8 *addr, u16 vid, int type,
3216 u16 ndm_state)
3ff661c3
JF		 3217{
3218 struct net *net = dev_net(dev);
3219 struct sk_buff *skb;
3220 int err = -ENOBUFS;
3221
3222 skb = nlmsg_new(rtnl_fdb_nlmsg_size(), GFP_ATOMIC);
3223 if (!skb)
3224 goto errout;
3225
1e53d5bb 3226 err = nlmsg_populate_fdb_fill(skb, dev, addr, vid,
b3379041 3227 0, 0, type, NTF_SELF, 0, ndm_state);
3ff661c3
JF		 3228 if (err < 0) {
3229 kfree_skb(skb);
3230 goto errout;
3231 }
3232
3233 rtnl_notify(skb, net, 0, RTNLGRP_NEIGH, NULL, GFP_ATOMIC);
3234 return;
3235errout:
3236 rtnl_set_sk_err(net, RTNLGRP_NEIGH, err);
3237}
3238
090096bf
VY		 3239/**
3240 * ndo_dflt_fdb_add - default netdevice operation to add an FDB entry
3241 */
3242int ndo_dflt_fdb_add(struct ndmsg *ndm,
3243 struct nlattr *tb[],
3244 struct net_device *dev,
f6f6424b 3245 const unsigned char *addr, u16 vid,
090096bf
VY		 3246 u16 flags)
3247{
3248 int err = -EINVAL;
3249
3250 /* If aging addresses are supported device will need to
3251 * implement its own handler for this.
3252 */
3253 if (ndm->ndm_state && !(ndm->ndm_state & NUD_PERMANENT)) {
3254 pr_info("%s: FDB only supports static addresses\n", dev->name);
3255 return err;
3256 }
3257
65891fea
OG		 3258 if (vid) {
3259 pr_info("%s: vlans aren't supported yet for dev_uc|mc_add()\n", dev->name);
3260 return err;
3261 }
3262
090096bf
VY		 3263 if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr))
3264 err = dev_uc_add_excl(dev, addr);
3265 else if (is_multicast_ether_addr(addr))
3266 err = dev_mc_add_excl(dev, addr);
3267
3268 /* Only return duplicate errors if NLM_F_EXCL is set */
3269 if (err == -EEXIST && !(flags & NLM_F_EXCL))
3270 err = 0;
3271
3272 return err;
3273}
3274EXPORT_SYMBOL(ndo_dflt_fdb_add);
3275
b88d12e4
FW		 3276static int fdb_vid_parse(struct nlattr *vlan_attr, u16 *p_vid,
3277 struct netlink_ext_ack *extack)
f6f6424b
JP		 3278{
3279 u16 vid = 0;
3280
3281 if (vlan_attr) {
3282 if (nla_len(vlan_attr) != sizeof(u16)) {
b88d12e4 3283 NL_SET_ERR_MSG(extack, "invalid vlan attribute size");
f6f6424b
JP		 3284 return -EINVAL;
3285 }
3286
3287 vid = nla_get_u16(vlan_attr);
3288
3289 if (!vid || vid >= VLAN_VID_MASK) {
b88d12e4 3290 NL_SET_ERR_MSG(extack, "invalid vlan id");
f6f6424b
JP		 3291 return -EINVAL;
3292 }
3293 }
3294 *p_vid = vid;
3295 return 0;
3296}
3297
c21ef3e3
DA		 3298static int rtnl_fdb_add(struct sk_buff *skb, struct nlmsghdr *nlh,
3299 struct netlink_ext_ack *extack)
77162022
JF		 3300{
3301 struct net *net = sock_net(skb->sk);
77162022
JF		 3302 struct ndmsg *ndm;
3303 struct nlattr *tb[NDA_MAX+1];
3304 struct net_device *dev;
3305 u8 *addr;
f6f6424b 3306 u16 vid;
77162022
JF		 3307 int err;
3308
c21ef3e3 3309 err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack);
77162022
JF		 3310 if (err < 0)
3311 return err;
3312
3313 ndm = nlmsg_data(nlh);
3314 if (ndm->ndm_ifindex == 0) {
b88d12e4 3315 NL_SET_ERR_MSG(extack, "invalid ifindex");
77162022
JF		 3316 return -EINVAL;
3317 }
3318
3319 dev = __dev_get_by_index(net, ndm->ndm_ifindex);
3320 if (dev == NULL) {
b88d12e4 3321 NL_SET_ERR_MSG(extack, "unknown ifindex");
77162022
JF		 3322 return -ENODEV;
3323 }
3324
3325 if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) {
b88d12e4 3326 NL_SET_ERR_MSG(extack, "invalid address");
77162022
JF		 3327 return -EINVAL;
3328 }
3329
3330 addr = nla_data(tb[NDA_LLADDR]);
77162022 3331
b88d12e4 3332 err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack);
f6f6424b
JP		 3333 if (err)
3334 return err;
3335
77162022
JF		 3336 err = -EOPNOTSUPP;
3337
3338 /* Support fdb on master device the net/bridge default case */
3339 if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) &&
3340 (dev->priv_flags & IFF_BRIDGE_PORT)) {
898e5061
JP		 3341 struct net_device *br_dev = netdev_master_upper_dev_get(dev);
3342 const struct net_device_ops *ops = br_dev->netdev_ops;
3343
f6f6424b
JP		 3344 err = ops->ndo_fdb_add(ndm, tb, dev, addr, vid,
3345 nlh->nlmsg_flags);
77162022
JF		 3346 if (err)
3347 goto out;
3348 else
3349 ndm->ndm_flags &= ~NTF_MASTER;
3350 }
3351
3352 /* Embedded bridge, macvlan, and any other device support */
090096bf
VY		 3353 if ((ndm->ndm_flags & NTF_SELF)) {
3354 if (dev->netdev_ops->ndo_fdb_add)
3355 err = dev->netdev_ops->ndo_fdb_add(ndm, tb, dev, addr,
f6f6424b 3356 vid,
090096bf
VY		 3357 nlh->nlmsg_flags);
3358 else
f6f6424b 3359 err = ndo_dflt_fdb_add(ndm, tb, dev, addr, vid,
090096bf 3360 nlh->nlmsg_flags);
77162022 3361
3ff661c3 3362 if (!err) {
b3379041
HS		 3363 rtnl_fdb_notify(dev, addr, vid, RTM_NEWNEIGH,
3364 ndm->ndm_state);
77162022 3365 ndm->ndm_flags &= ~NTF_SELF;
3ff661c3 3366 }
77162022
JF		 3367 }
3368out:
3369 return err;
3370}
3371
090096bf
VY		 3372/**
3373 * ndo_dflt_fdb_del - default netdevice operation to delete an FDB entry
3374 */
3375int ndo_dflt_fdb_del(struct ndmsg *ndm,
3376 struct nlattr *tb[],
3377 struct net_device *dev,
f6f6424b 3378 const unsigned char *addr, u16 vid)
090096bf 3379{
c8a89c4a 3380 int err = -EINVAL;
090096bf
VY		 3381
3382 /* If aging addresses are supported device will need to
3383 * implement its own handler for this.
3384 */
64535993 3385 if (!(ndm->ndm_state & NUD_PERMANENT)) {
090096bf 3386 pr_info("%s: FDB only supports static addresses\n", dev->name);
c8a89c4a 3387 return err;
090096bf
VY		 3388 }
3389
3390 if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr))
3391 err = dev_uc_del(dev, addr);
3392 else if (is_multicast_ether_addr(addr))
3393 err = dev_mc_del(dev, addr);
090096bf
VY		 3394
3395 return err;
3396}
3397EXPORT_SYMBOL(ndo_dflt_fdb_del);
3398
c21ef3e3
DA		 3399static int rtnl_fdb_del(struct sk_buff *skb, struct nlmsghdr *nlh,
3400 struct netlink_ext_ack *extack)
77162022
JF		 3401{
3402 struct net *net = sock_net(skb->sk);
3403 struct ndmsg *ndm;
1690be63 3404 struct nlattr *tb[NDA_MAX+1];
77162022
JF		 3405 struct net_device *dev;
3406 int err = -EINVAL;
3407 __u8 *addr;
f6f6424b 3408 u16 vid;
77162022 3409
90f62cf3 3410 if (!netlink_capable(skb, CAP_NET_ADMIN))
1690be63
VY		 3411 return -EPERM;
3412
c21ef3e3 3413 err = nlmsg_parse(nlh, sizeof(*ndm), tb, NDA_MAX, NULL, extack);
1690be63
VY		 3414 if (err < 0)
3415 return err;
77162022
JF		 3416
3417 ndm = nlmsg_data(nlh);
3418 if (ndm->ndm_ifindex == 0) {
b88d12e4 3419 NL_SET_ERR_MSG(extack, "invalid ifindex");
77162022
JF		 3420 return -EINVAL;
3421 }
3422
3423 dev = __dev_get_by_index(net, ndm->ndm_ifindex);
3424 if (dev == NULL) {
b88d12e4 3425 NL_SET_ERR_MSG(extack, "unknown ifindex");
77162022
JF		 3426 return -ENODEV;
3427 }
3428
1690be63 3429 if (!tb[NDA_LLADDR] || nla_len(tb[NDA_LLADDR]) != ETH_ALEN) {
b88d12e4 3430 NL_SET_ERR_MSG(extack, "invalid address");
1690be63
VY		 3431 return -EINVAL;
3432 }
3433
3434 addr = nla_data(tb[NDA_LLADDR]);
77162022 3435
b88d12e4 3436 err = fdb_vid_parse(tb[NDA_VLAN], &vid, extack);
f6f6424b
JP		 3437 if (err)
3438 return err;
3439
77162022
JF		 3440 err = -EOPNOTSUPP;
3441
3442 /* Support fdb on master device the net/bridge default case */
3443 if ((!ndm->ndm_flags || ndm->ndm_flags & NTF_MASTER) &&
3444 (dev->priv_flags & IFF_BRIDGE_PORT)) {
898e5061
JP		 3445 struct net_device *br_dev = netdev_master_upper_dev_get(dev);
3446 const struct net_device_ops *ops = br_dev->netdev_ops;
77162022 3447
898e5061 3448 if (ops->ndo_fdb_del)
f6f6424b 3449 err = ops->ndo_fdb_del(ndm, tb, dev, addr, vid);
77162022
JF		 3450
3451 if (err)
3452 goto out;
3453 else
3454 ndm->ndm_flags &= ~NTF_MASTER;
3455 }
3456
3457 /* Embedded bridge, macvlan, and any other device support */
090096bf
VY		 3458 if (ndm->ndm_flags & NTF_SELF) {
3459 if (dev->netdev_ops->ndo_fdb_del)
f6f6424b
JP		 3460 err = dev->netdev_ops->ndo_fdb_del(ndm, tb, dev, addr,
3461 vid);
090096bf 3462 else
f6f6424b 3463 err = ndo_dflt_fdb_del(ndm, tb, dev, addr, vid);
77162022 3464
3ff661c3 3465 if (!err) {
b3379041
HS		 3466 rtnl_fdb_notify(dev, addr, vid, RTM_DELNEIGH,
3467 ndm->ndm_state);
77162022 3468 ndm->ndm_flags &= ~NTF_SELF;
3ff661c3 3469 }
77162022
JF		 3470 }
3471out:
3472 return err;
3473}
3474
d83b0603
JF		 3475static int nlmsg_populate_fdb(struct sk_buff *skb,
3476 struct netlink_callback *cb,
3477 struct net_device *dev,
3478 int *idx,
3479 struct netdev_hw_addr_list *list)
3480{
3481 struct netdev_hw_addr *ha;
3482 int err;
15e47304 3483 u32 portid, seq;
d83b0603 3484
15e47304 3485 portid = NETLINK_CB(cb->skb).portid;
d83b0603
JF		 3486 seq = cb->nlh->nlmsg_seq;
3487
3488 list_for_each_entry(ha, &list->list, list) {
d297653d 3489 if (*idx < cb->args[2])
d83b0603
JF		 3490 goto skip;
3491
1e53d5bb 3492 err = nlmsg_populate_fdb_fill(skb, dev, ha->addr, 0,
a7a558fe 3493 portid, seq,
1c104a6b 3494 RTM_NEWNEIGH, NTF_SELF,
b3379041 3495 NLM_F_MULTI, NUD_PERMANENT);
d83b0603
JF		 3496 if (err < 0)
3497 return err;
3498skip:
3499 *idx += 1;
3500 }
3501 return 0;
3502}
3503
3504/**
2c53040f 3505 * ndo_dflt_fdb_dump - default netdevice operation to dump an FDB table.
d83b0603
JF		 3506 * @nlh: netlink message header
3507 * @dev: netdevice
3508 *
3509 * Default netdevice operation to dump the existing unicast address list.
91f3e7b1 3510 * Returns number of addresses from list put in skb.
d83b0603
JF		 3511 */
3512int ndo_dflt_fdb_dump(struct sk_buff *skb,
3513 struct netlink_callback *cb,
3514 struct net_device *dev,
5d5eacb3 3515 struct net_device *filter_dev,
d297653d 3516 int *idx)
d83b0603
JF		 3517{
3518 int err;
3519
3520 netif_addr_lock_bh(dev);
d297653d 3521 err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->uc);
d83b0603
JF		 3522 if (err)
3523 goto out;
2934c9db 3524 err = nlmsg_populate_fdb(skb, cb, dev, idx, &dev->mc);
d83b0603
JF		 3525out:
3526 netif_addr_unlock_bh(dev);
d297653d 3527 return err;
d83b0603
JF		 3528}
3529EXPORT_SYMBOL(ndo_dflt_fdb_dump);
3530
77162022
JF		 3531static int rtnl_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb)
3532{
77162022 3533 struct net_device *dev;
5e6d2435 3534 struct nlattr *tb[IFLA_MAX+1];
5e6d2435
JHS		 3535 struct net_device *br_dev = NULL;
3536 const struct net_device_ops *ops = NULL;
3537 const struct net_device_ops *cops = NULL;
3538 struct ifinfomsg *ifm = nlmsg_data(cb->nlh);
3539 struct net *net = sock_net(skb->sk);
d297653d 3540 struct hlist_head *head;
5e6d2435
JHS		 3541 int brport_idx = 0;
3542 int br_idx = 0;
d297653d
RP		 3543 int h, s_h;
3544 int idx = 0, s_idx;
3545 int err = 0;
3546 int fidx = 0;
5e6d2435 3547
0ff50e83
AP		 3548 err = nlmsg_parse(cb->nlh, sizeof(struct ifinfomsg), tb,
3549 IFLA_MAX, ifla_policy, NULL);
3550 if (err < 0) {
3551 return -EINVAL;
3552 } else if (err == 0) {
5e6d2435
JHS		 3553 if (tb[IFLA_MASTER])
3554 br_idx = nla_get_u32(tb[IFLA_MASTER]);
3555 }
3556
3557 brport_idx = ifm->ifi_index;
3558
3559 if (br_idx) {
3560 br_dev = __dev_get_by_index(net, br_idx);
3561 if (!br_dev)
3562 return -ENODEV;
3563
3564 ops = br_dev->netdev_ops;
5e6d2435
JHS		 3565 }
3566
d297653d
RP		 3567 s_h = cb->args[0];
3568 s_idx = cb->args[1];
5e6d2435 3569
d297653d
RP		 3570 for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
3571 idx = 0;
3572 head = &net->dev_index_head[h];
3573 hlist_for_each_entry(dev, head, index_hlist) {
5e6d2435 3574
d297653d 3575 if (brport_idx && (dev->ifindex != brport_idx))
5e6d2435
JHS		 3576 continue;
3577
d297653d
RP		 3578 if (!br_idx) { /* user did not specify a specific bridge */
3579 if (dev->priv_flags & IFF_BRIDGE_PORT) {
3580 br_dev = netdev_master_upper_dev_get(dev);
3581 cops = br_dev->netdev_ops;
3582 }
3583 } else {
3584 if (dev != br_dev &&
3585 !(dev->priv_flags & IFF_BRIDGE_PORT))
3586 continue;
5e6d2435 3587
d297653d
RP		 3588 if (br_dev != netdev_master_upper_dev_get(dev) &&
3589 !(dev->priv_flags & IFF_EBRIDGE))
3590 continue;
3591 cops = ops;
3592 }
77162022 3593
d297653d
RP		 3594 if (idx < s_idx)
3595 goto cont;
77162022 3596
d297653d
RP		 3597 if (dev->priv_flags & IFF_BRIDGE_PORT) {
3598 if (cops && cops->ndo_fdb_dump) {
3599 err = cops->ndo_fdb_dump(skb, cb,
3600 br_dev, dev,
3601 &fidx);
3602 if (err == -EMSGSIZE)
3603 goto out;
3604 }
3605 }
5e6d2435 3606
d297653d
RP		 3607 if (dev->netdev_ops->ndo_fdb_dump)
3608 err = dev->netdev_ops->ndo_fdb_dump(skb, cb,
3609 dev, NULL,
3610 &fidx);
3611 else
3612 err = ndo_dflt_fdb_dump(skb, cb, dev, NULL,
3613 &fidx);
3614 if (err == -EMSGSIZE)
3615 goto out;
3616
3617 cops = NULL;
3618
3619 /* reset fdb offset to 0 for rest of the interfaces */
3620 cb->args[2] = 0;
3621 fidx = 0;
3622cont:
3623 idx++;
3624 }
77162022 3625 }
77162022 3626
d297653d
RP		 3627out:
3628 cb->args[0] = h;
3629 cb->args[1] = idx;
3630 cb->args[2] = fidx;
3631
77162022
JF		 3632 return skb->len;
3633}
3634
2c3c031c
SF		 3635static int brport_nla_put_flag(struct sk_buff *skb, u32 flags, u32 mask,
3636 unsigned int attrnum, unsigned int flag)
3637{
3638 if (mask & flag)
3639 return nla_put_u8(skb, attrnum, !!(flags & flag));
3640 return 0;
3641}
3642
815cccbf 3643int ndo_dflt_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq,
2c3c031c 3644 struct net_device *dev, u16 mode,
7d4f8d87
SF		 3645 u32 flags, u32 mask, int nlflags,
3646 u32 filter_mask,
3647 int (*vlan_fill)(struct sk_buff *skb,
3648 struct net_device *dev,
3649 u32 filter_mask))
815cccbf
JF		 3650{
3651 struct nlmsghdr *nlh;
3652 struct ifinfomsg *ifm;
3653 struct nlattr *br_afspec;
2c3c031c 3654 struct nlattr *protinfo;
815cccbf 3655 u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN;
898e5061 3656 struct net_device *br_dev = netdev_master_upper_dev_get(dev);
7d4f8d87 3657 int err = 0;
815cccbf 3658
46c264da 3659 nlh = nlmsg_put(skb, pid, seq, RTM_NEWLINK, sizeof(*ifm), nlflags);
815cccbf
JF		 3660 if (nlh == NULL)
3661 return -EMSGSIZE;
3662
3663 ifm = nlmsg_data(nlh);
3664 ifm->ifi_family = AF_BRIDGE;
3665 ifm->__ifi_pad = 0;
3666 ifm->ifi_type = dev->type;
3667 ifm->ifi_index = dev->ifindex;
3668 ifm->ifi_flags = dev_get_flags(dev);
3669 ifm->ifi_change = 0;
3670
3671
3672 if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
3673 nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
3674 nla_put_u8(skb, IFLA_OPERSTATE, operstate) ||
898e5061
JP		 3675 (br_dev &&
3676 nla_put_u32(skb, IFLA_MASTER, br_dev->ifindex)) ||
815cccbf
JF		 3677 (dev->addr_len &&
3678 nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) ||
a54acb3a
ND		 3679 (dev->ifindex != dev_get_iflink(dev) &&
3680 nla_put_u32(skb, IFLA_LINK, dev_get_iflink(dev))))
815cccbf
JF		 3681 goto nla_put_failure;
3682
3683 br_afspec = nla_nest_start(skb, IFLA_AF_SPEC);
3684 if (!br_afspec)
3685 goto nla_put_failure;
3686
1d460b98 3687 if (nla_put_u16(skb, IFLA_BRIDGE_FLAGS, BRIDGE_FLAGS_SELF)) {
815cccbf
JF		 3688 nla_nest_cancel(skb, br_afspec);
3689 goto nla_put_failure;
3690 }
1d460b98
RP		 3691
3692 if (mode != BRIDGE_MODE_UNDEF) {
3693 if (nla_put_u16(skb, IFLA_BRIDGE_MODE, mode)) {
3694 nla_nest_cancel(skb, br_afspec);
3695 goto nla_put_failure;
3696 }
3697 }
7d4f8d87
SF		 3698 if (vlan_fill) {
3699 err = vlan_fill(skb, dev, filter_mask);
3700 if (err) {
3701 nla_nest_cancel(skb, br_afspec);
3702 goto nla_put_failure;
3703 }
3704 }
815cccbf
JF		 3705 nla_nest_end(skb, br_afspec);
3706
2c3c031c
SF		 3707 protinfo = nla_nest_start(skb, IFLA_PROTINFO | NLA_F_NESTED);
3708 if (!protinfo)
3709 goto nla_put_failure;
3710
3711 if (brport_nla_put_flag(skb, flags, mask,
3712 IFLA_BRPORT_MODE, BR_HAIRPIN_MODE) ||
3713 brport_nla_put_flag(skb, flags, mask,
3714 IFLA_BRPORT_GUARD, BR_BPDU_GUARD) ||
3715 brport_nla_put_flag(skb, flags, mask,
3716 IFLA_BRPORT_FAST_LEAVE,
3717 BR_MULTICAST_FAST_LEAVE) ||
3718 brport_nla_put_flag(skb, flags, mask,
3719 IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK) ||
3720 brport_nla_put_flag(skb, flags, mask,
3721 IFLA_BRPORT_LEARNING, BR_LEARNING) ||
3722 brport_nla_put_flag(skb, flags, mask,
3723 IFLA_BRPORT_LEARNING_SYNC, BR_LEARNING_SYNC) ||
3724 brport_nla_put_flag(skb, flags, mask,
3725 IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD) ||
3726 brport_nla_put_flag(skb, flags, mask,
3727 IFLA_BRPORT_PROXYARP, BR_PROXYARP)) {
3728 nla_nest_cancel(skb, protinfo);
3729 goto nla_put_failure;
3730 }
3731
3732 nla_nest_end(skb, protinfo);
3733
053c095a
JB		 3734 nlmsg_end(skb, nlh);
3735 return 0;
815cccbf
JF		 3736nla_put_failure:
3737 nlmsg_cancel(skb, nlh);
7d4f8d87 3738 return err ? err : -EMSGSIZE;
815cccbf 3739}
7d4f8d87 3740EXPORT_SYMBOL_GPL(ndo_dflt_bridge_getlink);
815cccbf 3741
e5a55a89
JF		 3742static int rtnl_bridge_getlink(struct sk_buff *skb, struct netlink_callback *cb)
3743{
3744 struct net *net = sock_net(skb->sk);
3745 struct net_device *dev;
3746 int idx = 0;
3747 u32 portid = NETLINK_CB(cb->skb).portid;
3748 u32 seq = cb->nlh->nlmsg_seq;
6cbdceeb 3749 u32 filter_mask = 0;
d64f69b0 3750 int err;
6cbdceeb 3751
aa68c20f
TG		 3752 if (nlmsg_len(cb->nlh) > sizeof(struct ifinfomsg)) {
3753 struct nlattr *extfilt;
3754
3755 extfilt = nlmsg_find_attr(cb->nlh, sizeof(struct ifinfomsg),
3756 IFLA_EXT_MASK);
3757 if (extfilt) {
3758 if (nla_len(extfilt) < sizeof(filter_mask))
3759 return -EINVAL;
3760
3761 filter_mask = nla_get_u32(extfilt);
3762 }
3763 }
e5a55a89
JF		 3764
3765 rcu_read_lock();
3766 for_each_netdev_rcu(net, dev) {
3767 const struct net_device_ops *ops = dev->netdev_ops;
898e5061 3768 struct net_device *br_dev = netdev_master_upper_dev_get(dev);
e5a55a89 3769
898e5061 3770 if (br_dev && br_dev->netdev_ops->ndo_bridge_getlink) {
d64f69b0
RP		 3771 if (idx >= cb->args[0]) {
3772 err = br_dev->netdev_ops->ndo_bridge_getlink(
3773 skb, portid, seq, dev,
3774 filter_mask, NLM_F_MULTI);
f6c5775f
DA		 3775 if (err < 0 && err != -EOPNOTSUPP) {
3776 if (likely(skb->len))
3777 break;
3778
3779 goto out_err;
3780 }
d64f69b0 3781 }
25b1e679 3782 idx++;
e5a55a89
JF		 3783 }
3784
3785 if (ops->ndo_bridge_getlink) {
d64f69b0
RP		 3786 if (idx >= cb->args[0]) {
3787 err = ops->ndo_bridge_getlink(skb, portid,
3788 seq, dev,
3789 filter_mask,
3790 NLM_F_MULTI);
f6c5775f
DA		 3791 if (err < 0 && err != -EOPNOTSUPP) {
3792 if (likely(skb->len))
3793 break;
3794
3795 goto out_err;
3796 }
d64f69b0 3797 }
25b1e679 3798 idx++;
e5a55a89
JF		 3799 }
3800 }
f6c5775f
DA		 3801 err = skb->len;
3802out_err:
e5a55a89
JF		 3803 rcu_read_unlock();
3804 cb->args[0] = idx;
3805
f6c5775f 3806 return err;
e5a55a89
JF		 3807}
3808
2469ffd7
JF		 3809static inline size_t bridge_nlmsg_size(void)
3810{
3811 return NLMSG_ALIGN(sizeof(struct ifinfomsg))
3812 + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
3813 + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
3814 + nla_total_size(sizeof(u32)) /* IFLA_MASTER */
3815 + nla_total_size(sizeof(u32)) /* IFLA_MTU */
3816 + nla_total_size(sizeof(u32)) /* IFLA_LINK */
3817 + nla_total_size(sizeof(u32)) /* IFLA_OPERSTATE */
3818 + nla_total_size(sizeof(u8)) /* IFLA_PROTINFO */
3819 + nla_total_size(sizeof(struct nlattr)) /* IFLA_AF_SPEC */
3820 + nla_total_size(sizeof(u16)) /* IFLA_BRIDGE_FLAGS */
3821 + nla_total_size(sizeof(u16)); /* IFLA_BRIDGE_MODE */
3822}
3823
02dba438 3824static int rtnl_bridge_notify(struct net_device *dev)
2469ffd7
JF		 3825{
3826 struct net *net = dev_net(dev);
2469ffd7
JF		 3827 struct sk_buff *skb;
3828 int err = -EOPNOTSUPP;
3829
02dba438
RP		 3830 if (!dev->netdev_ops->ndo_bridge_getlink)
3831 return 0;
3832
2469ffd7
JF		 3833 skb = nlmsg_new(bridge_nlmsg_size(), GFP_ATOMIC);
3834 if (!skb) {
3835 err = -ENOMEM;
3836 goto errout;
3837 }
3838
46c264da 3839 err = dev->netdev_ops->ndo_bridge_getlink(skb, 0, 0, dev, 0, 0);
02dba438
RP		 3840 if (err < 0)
3841 goto errout;
2469ffd7 3842
59ccaaaa
RP		 3843 if (!skb->len)
3844 goto errout;
3845
2469ffd7
JF		 3846 rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC);
3847 return 0;
3848errout:
3849 WARN_ON(err == -EMSGSIZE);
3850 kfree_skb(skb);
59ccaaaa
RP		 3851 if (err)
3852 rtnl_set_sk_err(net, RTNLGRP_LINK, err);
2469ffd7
JF		 3853 return err;
3854}
3855
c21ef3e3
DA		 3856static int rtnl_bridge_setlink(struct sk_buff *skb, struct nlmsghdr *nlh,
3857 struct netlink_ext_ack *extack)
e5a55a89
JF		 3858{
3859 struct net *net = sock_net(skb->sk);
3860 struct ifinfomsg *ifm;
3861 struct net_device *dev;
2469ffd7
JF		 3862 struct nlattr *br_spec, *attr = NULL;
3863 int rem, err = -EOPNOTSUPP;
4de8b413 3864 u16 flags = 0;
c38e01b8 3865 bool have_flags = false;
e5a55a89
JF		 3866
3867 if (nlmsg_len(nlh) < sizeof(*ifm))
3868 return -EINVAL;
3869
3870 ifm = nlmsg_data(nlh);
3871 if (ifm->ifi_family != AF_BRIDGE)
3872 return -EPFNOSUPPORT;
3873
3874 dev = __dev_get_by_index(net, ifm->ifi_index);
3875 if (!dev) {
b88d12e4 3876 NL_SET_ERR_MSG(extack, "unknown ifindex");
e5a55a89
JF		 3877 return -ENODEV;
3878 }
3879
2469ffd7
JF		 3880 br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
3881 if (br_spec) {
3882 nla_for_each_nested(attr, br_spec, rem) {
3883 if (nla_type(attr) == IFLA_BRIDGE_FLAGS) {
6e8d1c55
TG		 3884 if (nla_len(attr) < sizeof(flags))
3885 return -EINVAL;
3886
c38e01b8 3887 have_flags = true;
2469ffd7
JF		 3888 flags = nla_get_u16(attr);
3889 break;
3890 }
3891 }
3892 }
3893
3894 if (!flags || (flags & BRIDGE_FLAGS_MASTER)) {
898e5061
JP		 3895 struct net_device *br_dev = netdev_master_upper_dev_get(dev);
3896
3897 if (!br_dev || !br_dev->netdev_ops->ndo_bridge_setlink) {
2469ffd7
JF		 3898 err = -EOPNOTSUPP;
3899 goto out;
3900 }
3901
add511b3 3902 err = br_dev->netdev_ops->ndo_bridge_setlink(dev, nlh, flags);
e5a55a89
JF		 3903 if (err)
3904 goto out;
2469ffd7
JF		 3905
3906 flags &= ~BRIDGE_FLAGS_MASTER;
e5a55a89
JF		 3907 }
3908
2469ffd7
JF		 3909 if ((flags & BRIDGE_FLAGS_SELF)) {
3910 if (!dev->netdev_ops->ndo_bridge_setlink)
3911 err = -EOPNOTSUPP;
3912 else
add511b3
RP		 3913 err = dev->netdev_ops->ndo_bridge_setlink(dev, nlh,
3914 flags);
02dba438 3915 if (!err) {
2469ffd7 3916 flags &= ~BRIDGE_FLAGS_SELF;
02dba438
RP		 3917
3918 /* Generate event to notify upper layer of bridge
3919 * change
3920 */
3921 err = rtnl_bridge_notify(dev);
3922 }
2469ffd7 3923 }
e5a55a89 3924
c38e01b8 3925 if (have_flags)
2469ffd7 3926 memcpy(nla_data(attr), &flags, sizeof(flags));
e5a55a89
JF		 3927out:
3928 return err;
3929}
3930
c21ef3e3
DA		 3931static int rtnl_bridge_dellink(struct sk_buff *skb, struct nlmsghdr *nlh,
3932 struct netlink_ext_ack *extack)
407af329
VY		 3933{
3934 struct net *net = sock_net(skb->sk);
3935 struct ifinfomsg *ifm;
3936 struct net_device *dev;
3937 struct nlattr *br_spec, *attr = NULL;
3938 int rem, err = -EOPNOTSUPP;
4de8b413 3939 u16 flags = 0;
407af329
VY		 3940 bool have_flags = false;
3941
3942 if (nlmsg_len(nlh) < sizeof(*ifm))
3943 return -EINVAL;
3944
3945 ifm = nlmsg_data(nlh);
3946 if (ifm->ifi_family != AF_BRIDGE)
3947 return -EPFNOSUPPORT;
3948
3949 dev = __dev_get_by_index(net, ifm->ifi_index);
3950 if (!dev) {
b88d12e4 3951 NL_SET_ERR_MSG(extack, "unknown ifindex");
407af329
VY		 3952 return -ENODEV;
3953 }
3954
3955 br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
3956 if (br_spec) {
3957 nla_for_each_nested(attr, br_spec, rem) {
3958 if (nla_type(attr) == IFLA_BRIDGE_FLAGS) {
6e8d1c55
TG		 3959 if (nla_len(attr) < sizeof(flags))
3960 return -EINVAL;
3961
407af329
VY		 3962 have_flags = true;
3963 flags = nla_get_u16(attr);
3964 break;
3965 }
3966 }
3967 }
3968
407af329
VY		 3969 if (!flags || (flags & BRIDGE_FLAGS_MASTER)) {
3970 struct net_device *br_dev = netdev_master_upper_dev_get(dev);
3971
3972 if (!br_dev || !br_dev->netdev_ops->ndo_bridge_dellink) {
3973 err = -EOPNOTSUPP;
3974 goto out;
3975 }
3976
add511b3 3977 err = br_dev->netdev_ops->ndo_bridge_dellink(dev, nlh, flags);
407af329
VY		 3978 if (err)
3979 goto out;
3980
3981 flags &= ~BRIDGE_FLAGS_MASTER;
3982 }
3983
3984 if ((flags & BRIDGE_FLAGS_SELF)) {
3985 if (!dev->netdev_ops->ndo_bridge_dellink)
3986 err = -EOPNOTSUPP;
3987 else
add511b3
RP		 3988 err = dev->netdev_ops->ndo_bridge_dellink(dev, nlh,
3989 flags);
407af329 3990
02dba438 3991 if (!err) {
407af329 3992 flags &= ~BRIDGE_FLAGS_SELF;
02dba438
RP		 3993
3994 /* Generate event to notify upper layer of bridge
3995 * change
3996 */
3997 err = rtnl_bridge_notify(dev);
3998 }
407af329
VY		 3999 }
4000
4001 if (have_flags)
4002 memcpy(nla_data(attr), &flags, sizeof(flags));
407af329
VY		 4003out:
4004 return err;
4005}
4006
e8872a25
NA		 4007static bool stats_attr_valid(unsigned int mask, int attrid, int idxattr)
4008{
4009 return (mask & IFLA_STATS_FILTER_BIT(attrid)) &&
4010 (!idxattr || idxattr == attrid);
4011}
4012
69ae6ad2
NF		 4013#define IFLA_OFFLOAD_XSTATS_FIRST (IFLA_OFFLOAD_XSTATS_UNSPEC + 1)
4014static int rtnl_get_offload_stats_attr_size(int attr_id)
4015{
4016 switch (attr_id) {
4017 case IFLA_OFFLOAD_XSTATS_CPU_HIT:
4018 return sizeof(struct rtnl_link_stats64);
4019 }
4020
4021 return 0;
4022}
4023
4024static int rtnl_get_offload_stats(struct sk_buff *skb, struct net_device *dev,
4025 int *prividx)
4026{
4027 struct nlattr *attr = NULL;
4028 int attr_id, size;
4029 void *attr_data;
4030 int err;
4031
4032 if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats &&
4033 dev->netdev_ops->ndo_get_offload_stats))
4034 return -ENODATA;
4035
4036 for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST;
4037 attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) {
4038 if (attr_id < *prividx)
4039 continue;
4040
4041 size = rtnl_get_offload_stats_attr_size(attr_id);
4042 if (!size)
4043 continue;
4044
3df5b3c6 4045 if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id))
69ae6ad2
NF		 4046 continue;
4047
4048 attr = nla_reserve_64bit(skb, attr_id, size,
4049 IFLA_OFFLOAD_XSTATS_UNSPEC);
4050 if (!attr)
4051 goto nla_put_failure;
4052
4053 attr_data = nla_data(attr);
4054 memset(attr_data, 0, size);
4055 err = dev->netdev_ops->ndo_get_offload_stats(attr_id, dev,
4056 attr_data);
4057 if (err)
4058 goto get_offload_stats_failure;
4059 }
4060
4061 if (!attr)
4062 return -ENODATA;
4063
4064 *prividx = 0;
4065 return 0;
4066
4067nla_put_failure:
4068 err = -EMSGSIZE;
4069get_offload_stats_failure:
4070 *prividx = attr_id;
4071 return err;
4072}
4073
4074static int rtnl_get_offload_stats_size(const struct net_device *dev)
4075{
4076 int nla_size = 0;
4077 int attr_id;
4078 int size;
4079
4080 if (!(dev->netdev_ops && dev->netdev_ops->ndo_has_offload_stats &&
4081 dev->netdev_ops->ndo_get_offload_stats))
4082 return 0;
4083
4084 for (attr_id = IFLA_OFFLOAD_XSTATS_FIRST;
4085 attr_id <= IFLA_OFFLOAD_XSTATS_MAX; attr_id++) {
3df5b3c6 4086 if (!dev->netdev_ops->ndo_has_offload_stats(dev, attr_id))
69ae6ad2
NF		 4087 continue;
4088 size = rtnl_get_offload_stats_attr_size(attr_id);
4089 nla_size += nla_total_size_64bit(size);
4090 }
4091
4092 if (nla_size != 0)
4093 nla_size += nla_total_size(0);
4094
4095 return nla_size;
4096}
4097
10c9ead9
RP		 4098static int rtnl_fill_statsinfo(struct sk_buff *skb, struct net_device *dev,
4099 int type, u32 pid, u32 seq, u32 change,
e8872a25
NA		 4100 unsigned int flags, unsigned int filter_mask,
4101 int *idxattr, int *prividx)
10c9ead9
RP		 4102{
4103 struct if_stats_msg *ifsm;
4104 struct nlmsghdr *nlh;
4105 struct nlattr *attr;
e8872a25 4106 int s_prividx = *prividx;
69ae6ad2 4107 int err;
10c9ead9
RP		 4108
4109 ASSERT_RTNL();
4110
4111 nlh = nlmsg_put(skb, pid, seq, type, sizeof(*ifsm), flags);
4112 if (!nlh)
4113 return -EMSGSIZE;
4114
4115 ifsm = nlmsg_data(nlh);
ce024f42
NA		 4116 ifsm->family = PF_UNSPEC;
4117 ifsm->pad1 = 0;
4118 ifsm->pad2 = 0;
10c9ead9
RP		 4119 ifsm->ifindex = dev->ifindex;
4120 ifsm->filter_mask = filter_mask;
4121
e8872a25 4122 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, *idxattr)) {
10c9ead9 4123 struct rtnl_link_stats64 *sp;
10c9ead9 4124
58414d32
ND		 4125 attr = nla_reserve_64bit(skb, IFLA_STATS_LINK_64,
4126 sizeof(struct rtnl_link_stats64),
4127 IFLA_STATS_UNSPEC);
10c9ead9
RP		 4128 if (!attr)
4129 goto nla_put_failure;
4130
4131 sp = nla_data(attr);
4132 dev_get_stats(dev, sp);
4133 }
4134
97a47fac
NA		 4135 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, *idxattr)) {
4136 const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
4137
4138 if (ops && ops->fill_linkxstats) {
97a47fac
NA		 4139 *idxattr = IFLA_STATS_LINK_XSTATS;
4140 attr = nla_nest_start(skb,
4141 IFLA_STATS_LINK_XSTATS);
4142 if (!attr)
4143 goto nla_put_failure;
4144
80e73cc5
NA		 4145 err = ops->fill_linkxstats(skb, dev, prividx, *idxattr);
4146 nla_nest_end(skb, attr);
4147 if (err)
4148 goto nla_put_failure;
4149 *idxattr = 0;
4150 }
4151 }
4152
4153 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE,
4154 *idxattr)) {
4155 const struct rtnl_link_ops *ops = NULL;
4156 const struct net_device *master;
4157
4158 master = netdev_master_upper_dev_get(dev);
4159 if (master)
4160 ops = master->rtnl_link_ops;
4161 if (ops && ops->fill_linkxstats) {
80e73cc5
NA		 4162 *idxattr = IFLA_STATS_LINK_XSTATS_SLAVE;
4163 attr = nla_nest_start(skb,
4164 IFLA_STATS_LINK_XSTATS_SLAVE);
4165 if (!attr)
4166 goto nla_put_failure;
4167
4168 err = ops->fill_linkxstats(skb, dev, prividx, *idxattr);
97a47fac
NA		 4169 nla_nest_end(skb, attr);
4170 if (err)
4171 goto nla_put_failure;
4172 *idxattr = 0;
4173 }
4174 }
4175
69ae6ad2
NF		 4176 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS,
4177 *idxattr)) {
4178 *idxattr = IFLA_STATS_LINK_OFFLOAD_XSTATS;
4179 attr = nla_nest_start(skb, IFLA_STATS_LINK_OFFLOAD_XSTATS);
4180 if (!attr)
4181 goto nla_put_failure;
4182
4183 err = rtnl_get_offload_stats(skb, dev, prividx);
4184 if (err == -ENODATA)
4185 nla_nest_cancel(skb, attr);
4186 else
4187 nla_nest_end(skb, attr);
4188
4189 if (err && err != -ENODATA)
4190 goto nla_put_failure;
4191 *idxattr = 0;
4192 }
4193
aefb4d4a
RS		 4194 if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, *idxattr)) {
4195 struct rtnl_af_ops *af_ops;
4196
4197 *idxattr = IFLA_STATS_AF_SPEC;
4198 attr = nla_nest_start(skb, IFLA_STATS_AF_SPEC);
4199 if (!attr)
4200 goto nla_put_failure;
4201
5fa85a09
FW		 4202 rcu_read_lock();
4203 list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
aefb4d4a
RS		 4204 if (af_ops->fill_stats_af) {
4205 struct nlattr *af;
4206 int err;
4207
4208 af = nla_nest_start(skb, af_ops->family);
5fa85a09
FW		 4209 if (!af) {
4210 rcu_read_unlock();
aefb4d4a 4211 goto nla_put_failure;
5fa85a09 4212 }
aefb4d4a
RS		 4213 err = af_ops->fill_stats_af(skb, dev);
4214
5fa85a09 4215 if (err == -ENODATA) {
aefb4d4a 4216 nla_nest_cancel(skb, af);
5fa85a09
FW		 4217 } else if (err < 0) {
4218 rcu_read_unlock();
aefb4d4a 4219 goto nla_put_failure;
5fa85a09 4220 }
aefb4d4a
RS		 4221
4222 nla_nest_end(skb, af);
4223 }
4224 }
5fa85a09 4225 rcu_read_unlock();
aefb4d4a
RS		 4226
4227 nla_nest_end(skb, attr);
4228
4229 *idxattr = 0;
4230 }
4231
10c9ead9
RP		 4232 nlmsg_end(skb, nlh);
4233
4234 return 0;
4235
4236nla_put_failure:
e8872a25
NA		 4237 /* not a multi message or no progress mean a real error */
4238 if (!(flags & NLM_F_MULTI) || s_prividx == *prividx)
4239 nlmsg_cancel(skb, nlh);
4240 else
4241 nlmsg_end(skb, nlh);
10c9ead9
RP		 4242
4243 return -EMSGSIZE;
4244}
4245
10c9ead9
RP		 4246static size_t if_nlmsg_stats_size(const struct net_device *dev,
4247 u32 filter_mask)
4248{
4249 size_t size = 0;
4250
e8872a25 4251 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_64, 0))
10c9ead9
RP		 4252 size += nla_total_size_64bit(sizeof(struct rtnl_link_stats64));
4253
97a47fac
NA		 4254 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS, 0)) {
4255 const struct rtnl_link_ops *ops = dev->rtnl_link_ops;
80e73cc5 4256 int attr = IFLA_STATS_LINK_XSTATS;
97a47fac
NA		 4257
4258 if (ops && ops->get_linkxstats_size) {
80e73cc5
NA		 4259 size += nla_total_size(ops->get_linkxstats_size(dev,
4260 attr));
97a47fac
NA		 4261 /* for IFLA_STATS_LINK_XSTATS */
4262 size += nla_total_size(0);
4263 }
4264 }
4265
80e73cc5
NA		 4266 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_XSTATS_SLAVE, 0)) {
4267 struct net_device *_dev = (struct net_device *)dev;
4268 const struct rtnl_link_ops *ops = NULL;
4269 const struct net_device *master;
4270
4271 /* netdev_master_upper_dev_get can't take const */
4272 master = netdev_master_upper_dev_get(_dev);
4273 if (master)
4274 ops = master->rtnl_link_ops;
4275 if (ops && ops->get_linkxstats_size) {
4276 int attr = IFLA_STATS_LINK_XSTATS_SLAVE;
4277
4278 size += nla_total_size(ops->get_linkxstats_size(dev,
4279 attr));
4280 /* for IFLA_STATS_LINK_XSTATS_SLAVE */
4281 size += nla_total_size(0);
4282 }
4283 }
4284
69ae6ad2
NF		 4285 if (stats_attr_valid(filter_mask, IFLA_STATS_LINK_OFFLOAD_XSTATS, 0))
4286 size += rtnl_get_offload_stats_size(dev);
4287
aefb4d4a
RS		 4288 if (stats_attr_valid(filter_mask, IFLA_STATS_AF_SPEC, 0)) {
4289 struct rtnl_af_ops *af_ops;
4290
4291 /* for IFLA_STATS_AF_SPEC */
4292 size += nla_total_size(0);
4293
5fa85a09
FW		 4294 rcu_read_lock();
4295 list_for_each_entry_rcu(af_ops, &rtnl_af_ops, list) {
aefb4d4a
RS		 4296 if (af_ops->get_stats_af_size) {
4297 size += nla_total_size(
4298 af_ops->get_stats_af_size(dev));
4299
4300 /* for AF_* */
4301 size += nla_total_size(0);
4302 }
4303 }
5fa85a09 4304 rcu_read_unlock();
aefb4d4a
RS		 4305 }
4306
10c9ead9
RP		 4307 return size;
4308}
4309
c21ef3e3
DA		 4310static int rtnl_stats_get(struct sk_buff *skb, struct nlmsghdr *nlh,
4311 struct netlink_ext_ack *extack)
10c9ead9
RP		 4312{
4313 struct net *net = sock_net(skb->sk);
10c9ead9 4314 struct net_device *dev = NULL;
e8872a25
NA		 4315 int idxattr = 0, prividx = 0;
4316 struct if_stats_msg *ifsm;
10c9ead9
RP		 4317 struct sk_buff *nskb;
4318 u32 filter_mask;
4319 int err;
4320
4775cc1f
MK		 4321 if (nlmsg_len(nlh) < sizeof(*ifsm))
4322 return -EINVAL;
4323
10c9ead9
RP		 4324 ifsm = nlmsg_data(nlh);
4325 if (ifsm->ifindex > 0)
4326 dev = __dev_get_by_index(net, ifsm->ifindex);
4327 else
4328 return -EINVAL;
4329
4330 if (!dev)
4331 return -ENODEV;
4332
4333 filter_mask = ifsm->filter_mask;
4334 if (!filter_mask)
4335 return -EINVAL;
4336
4337 nskb = nlmsg_new(if_nlmsg_stats_size(dev, filter_mask), GFP_KERNEL);
4338 if (!nskb)
4339 return -ENOBUFS;
4340
4341 err = rtnl_fill_statsinfo(nskb, dev, RTM_NEWSTATS,
4342 NETLINK_CB(skb).portid, nlh->nlmsg_seq, 0,
e8872a25 4343 0, filter_mask, &idxattr, &prividx);
10c9ead9
RP		 4344 if (err < 0) {
4345 /* -EMSGSIZE implies BUG in if_nlmsg_stats_size */
4346 WARN_ON(err == -EMSGSIZE);
4347 kfree_skb(nskb);
4348 } else {
4349 err = rtnl_unicast(nskb, net, NETLINK_CB(skb).portid);
4350 }
4351
4352 return err;
4353}
4354
4355static int rtnl_stats_dump(struct sk_buff *skb, struct netlink_callback *cb)
4356{
e8872a25 4357 int h, s_h, err, s_idx, s_idxattr, s_prividx;
10c9ead9 4358 struct net *net = sock_net(skb->sk);
e8872a25 4359 unsigned int flags = NLM_F_MULTI;
10c9ead9 4360 struct if_stats_msg *ifsm;
10c9ead9 4361 struct hlist_head *head;
e8872a25 4362 struct net_device *dev;
10c9ead9 4363 u32 filter_mask = 0;
e8872a25 4364 int idx = 0;
10c9ead9
RP		 4365
4366 s_h = cb->args[0];
4367 s_idx = cb->args[1];
e8872a25
NA		 4368 s_idxattr = cb->args[2];
4369 s_prividx = cb->args[3];
10c9ead9
RP		 4370
4371 cb->seq = net->dev_base_seq;
4372
4775cc1f
MK		 4373 if (nlmsg_len(cb->nlh) < sizeof(*ifsm))
4374 return -EINVAL;
4375
10c9ead9
RP		 4376 ifsm = nlmsg_data(cb->nlh);
4377 filter_mask = ifsm->filter_mask;
4378 if (!filter_mask)
4379 return -EINVAL;
4380
4381 for (h = s_h; h < NETDEV_HASHENTRIES; h++, s_idx = 0) {
4382 idx = 0;
4383 head = &net->dev_index_head[h];
4384 hlist_for_each_entry(dev, head, index_hlist) {
4385 if (idx < s_idx)
4386 goto cont;
4387 err = rtnl_fill_statsinfo(skb, dev, RTM_NEWSTATS,
4388 NETLINK_CB(cb->skb).portid,
4389 cb->nlh->nlmsg_seq, 0,
e8872a25
NA		 4390 flags, filter_mask,
4391 &s_idxattr, &s_prividx);
10c9ead9
RP		 4392 /* If we ran out of room on the first message,
4393 * we're in trouble
4394 */
4395 WARN_ON((err == -EMSGSIZE) && (skb->len == 0));
4396
4397 if (err < 0)
4398 goto out;
e8872a25
NA		 4399 s_prividx = 0;
4400 s_idxattr = 0;
10c9ead9
RP		 4401 nl_dump_check_consistent(cb, nlmsg_hdr(skb));
4402cont:
4403 idx++;
4404 }
4405 }
4406out:
e8872a25
NA		 4407 cb->args[3] = s_prividx;
4408 cb->args[2] = s_idxattr;
10c9ead9
RP		 4409 cb->args[1] = idx;
4410 cb->args[0] = h;
4411
4412 return skb->len;
4413}
4414
1da177e4
LT		 4415/* Process one rtnetlink message. */
4416
2d4bc933
JB		 4417static int rtnetlink_rcv_msg(struct sk_buff *skb, struct nlmsghdr *nlh,
4418 struct netlink_ext_ack *extack)
1da177e4 4419{
3b1e0a65 4420 struct net *net = sock_net(skb->sk);
6853dd48
FW		 4421 struct rtnl_link *handlers;
4422 int err = -EOPNOTSUPP;
e2849863 4423 rtnl_doit_func doit;
62256f98 4424 unsigned int flags;
617cfc75 4425 int kind;
1da177e4
LT		 4426 int family;
4427 int type;
1da177e4 4428
1da177e4 4429 type = nlh->nlmsg_type;
1da177e4 4430 if (type > RTM_MAX)
038890fe 4431 return -EOPNOTSUPP;
1da177e4
LT		 4432
4433 type -= RTM_BASE;
4434
4435 /* All the messages must have at least 1 byte length */
573ce260 4436 if (nlmsg_len(nlh) < sizeof(struct rtgenmsg))
1da177e4
LT		 4437 return 0;
4438
573ce260 4439 family = ((struct rtgenmsg *)nlmsg_data(nlh))->rtgen_family;
1da177e4
LT		 4440 kind = type&3;
4441
90f62cf3 4442 if (kind != 2 && !netlink_net_capable(skb, CAP_NET_ADMIN))
1d00a4eb 4443 return -EPERM;
1da177e4 4444
5c2bb9b6 4445 if (family >= ARRAY_SIZE(rtnl_msg_handlers))
6853dd48
FW		 4446 family = PF_UNSPEC;
4447
4448 rcu_read_lock();
4449 handlers = rcu_dereference(rtnl_msg_handlers[family]);
4450 if (!handlers) {
4451 family = PF_UNSPEC;
4452 handlers = rcu_dereference(rtnl_msg_handlers[family]);
4453 }
4454
b8f3ab42 4455 if (kind == 2 && nlh->nlmsg_flags&NLM_F_DUMP) {
97c53cac 4456 struct sock *rtnl;
e2849863 4457 rtnl_dumpit_func dumpit;
c7ac8679 4458 u16 min_dump_alloc = 0;
1da177e4 4459
6853dd48
FW		 4460 dumpit = READ_ONCE(handlers[type].dumpit);
4461 if (!dumpit) {
4462 family = PF_UNSPEC;
4463 handlers = rcu_dereference(rtnl_msg_handlers[PF_UNSPEC]);
4464 if (!handlers)
4465 goto err_unlock;
0cc09020 4466
6853dd48
FW		 4467 dumpit = READ_ONCE(handlers[type].dumpit);
4468 if (!dumpit)
4469 goto err_unlock;
4470 }
e1fa6d21 4471
019a3169
FW		 4472 refcount_inc(&rtnl_msg_handlers_ref[family]);
4473
5c2bb9b6 4474 if (type == RTM_GETLINK - RTM_BASE)
e1fa6d21 4475 min_dump_alloc = rtnl_calcit(skb, nlh);
9ac4a169 4476
6853dd48
FW		 4477 rcu_read_unlock();
4478
97c53cac 4479 rtnl = net->rtnl;
80d326fa
PNA		 4480 {
4481 struct netlink_dump_control c = {
4482 .dump = dumpit,
4483 .min_dump_alloc = min_dump_alloc,
4484 };
4485 err = netlink_dump_start(rtnl, skb, nlh, &c);
4486 }
019a3169 4487 refcount_dec(&rtnl_msg_handlers_ref[family]);
2907c35f 4488 return err;
1da177e4
LT		 4489 }
4490
8caa38b5
FW		 4491 doit = READ_ONCE(handlers[type].doit);
4492 if (!doit) {
4493 family = PF_UNSPEC;
4494 handlers = rcu_dereference(rtnl_msg_handlers[family]);
4495 }
4496
62256f98
FW		 4497 flags = READ_ONCE(handlers[type].flags);
4498 if (flags & RTNL_FLAG_DOIT_UNLOCKED) {
4499 refcount_inc(&rtnl_msg_handlers_ref[family]);
4500 doit = READ_ONCE(handlers[type].doit);
4501 rcu_read_unlock();
4502 if (doit)
4503 err = doit(skb, nlh, extack);
4504 refcount_dec(&rtnl_msg_handlers_ref[family]);
4505 return err;
4506 }
4507
6853dd48 4508 rcu_read_unlock();
1da177e4 4509
6853dd48
FW		 4510 rtnl_lock();
4511 handlers = rtnl_dereference(rtnl_msg_handlers[family]);
4512 if (handlers) {
4513 doit = READ_ONCE(handlers[type].doit);
4514 if (doit)
4515 err = doit(skb, nlh, extack);
4516 }
0cc09020 4517 rtnl_unlock();
0cc09020
FW		 4518 return err;
4519
4520err_unlock:
6853dd48 4521 rcu_read_unlock();
0cc09020 4522 return -EOPNOTSUPP;
1da177e4
LT		 4523}
4524
cd40b7d3 4525static void rtnetlink_rcv(struct sk_buff *skb)
1da177e4 4526{
cd40b7d3 4527 netlink_rcv_skb(skb, &rtnetlink_rcv_msg);
1da177e4
LT		 4528}
4529
5f729eaa
JG		 4530static int rtnetlink_bind(struct net *net, int group)
4531{
4532 switch (group) {
4533 case RTNLGRP_IPV4_MROUTE_R:
4534 case RTNLGRP_IPV6_MROUTE_R:
4535 if (!ns_capable(net->user_ns, CAP_NET_ADMIN))
4536 return -EPERM;
4537 break;
4538 }
4539 return 0;
4540}
4541
1da177e4
LT		 4542static int rtnetlink_event(struct notifier_block *this, unsigned long event, void *ptr)
4543{
351638e7 4544 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
e9dc8653 4545
1da177e4 4546 switch (event) {
5138e86f 4547 case NETDEV_REBOOT:
8a212589 4548 case NETDEV_CHANGEMTU:
3753654e 4549 case NETDEV_CHANGEADDR:
5138e86f
VY		 4550 case NETDEV_CHANGENAME:
4551 case NETDEV_FEAT_CHANGE:
4552 case NETDEV_BONDING_FAILOVER:
e6e66594 4553 case NETDEV_POST_TYPE_CHANGE:
5138e86f 4554 case NETDEV_NOTIFY_PEERS:
dc709f37 4555 case NETDEV_CHANGEUPPER:
5138e86f 4556 case NETDEV_RESEND_IGMP:
5138e86f 4557 case NETDEV_CHANGEINFODATA:
eeda3fb9 4558 case NETDEV_CHANGELOWERSTATE:
ebdcf045 4559 case NETDEV_CHANGE_TX_QUEUE_LEN:
3d3ea5af 4560 rtmsg_ifinfo_event(RTM_NEWLINK, dev, 0, rtnl_get_event(event),
6621dd29 4561 GFP_KERNEL, NULL);
1da177e4
LT		 4562 break;
4563 default:
1da177e4
LT		 4564 break;
4565 }
4566 return NOTIFY_DONE;
4567}
4568
4569static struct notifier_block rtnetlink_dev_notifier = {
4570 .notifier_call = rtnetlink_event,
4571};
4572
97c53cac 4573
2c8c1e72 4574static int __net_init rtnetlink_net_init(struct net *net)
97c53cac
DL		 4575{
4576 struct sock *sk;
a31f2d17
PNA		 4577 struct netlink_kernel_cfg cfg = {
4578 .groups = RTNLGRP_MAX,
4579 .input = rtnetlink_rcv,
4580 .cb_mutex = &rtnl_mutex,
9785e10a 4581 .flags = NL_CFG_F_NONROOT_RECV,
5f729eaa 4582 .bind = rtnetlink_bind,
a31f2d17
PNA		 4583 };
4584
9f00d977 4585 sk = netlink_kernel_create(net, NETLINK_ROUTE, &cfg);
97c53cac
DL		 4586 if (!sk)
4587 return -ENOMEM;
97c53cac
DL		 4588 net->rtnl = sk;
4589 return 0;
4590}
4591
2c8c1e72 4592static void __net_exit rtnetlink_net_exit(struct net *net)
97c53cac 4593{
775516bf
DL		 4594 netlink_kernel_release(net->rtnl);
4595 net->rtnl = NULL;
97c53cac
DL		 4596}
4597
4598static struct pernet_operations rtnetlink_net_ops = {
4599 .init = rtnetlink_net_init,
4600 .exit = rtnetlink_net_exit,
4601};
4602
1da177e4
LT		 4603void __init rtnetlink_init(void)
4604{
d38a6512
FW		 4605 int i;
4606
4607 for (i = 0; i < ARRAY_SIZE(rtnl_msg_handlers_ref); i++)
4608 refcount_set(&rtnl_msg_handlers_ref[i], 1);
4609
97c53cac 4610 if (register_pernet_subsys(&rtnetlink_net_ops))
1da177e4 4611 panic("rtnetlink_init: cannot initialize rtnetlink\n");
97c53cac 4612
1da177e4 4613 register_netdevice_notifier(&rtnetlink_dev_notifier);
340d17fc 4614
c7ac8679 4615 rtnl_register(PF_UNSPEC, RTM_GETLINK, rtnl_getlink,
b97bac64
FW		 4616 rtnl_dump_ifinfo, 0);
4617 rtnl_register(PF_UNSPEC, RTM_SETLINK, rtnl_setlink, NULL, 0);
4618 rtnl_register(PF_UNSPEC, RTM_NEWLINK, rtnl_newlink, NULL, 0);
4619 rtnl_register(PF_UNSPEC, RTM_DELLINK, rtnl_dellink, NULL, 0);
687ad8cc 4620
b97bac64
FW		 4621 rtnl_register(PF_UNSPEC, RTM_GETADDR, NULL, rtnl_dump_all, 0);
4622 rtnl_register(PF_UNSPEC, RTM_GETROUTE, NULL, rtnl_dump_all, 0);
4623 rtnl_register(PF_UNSPEC, RTM_GETNETCONF, NULL, rtnl_dump_all, 0);
77162022 4624
b97bac64
FW		 4625 rtnl_register(PF_BRIDGE, RTM_NEWNEIGH, rtnl_fdb_add, NULL, 0);
4626 rtnl_register(PF_BRIDGE, RTM_DELNEIGH, rtnl_fdb_del, NULL, 0);
4627 rtnl_register(PF_BRIDGE, RTM_GETNEIGH, NULL, rtnl_fdb_dump, 0);
e5a55a89 4628
b97bac64
FW		 4629 rtnl_register(PF_BRIDGE, RTM_GETLINK, NULL, rtnl_bridge_getlink, 0);
4630 rtnl_register(PF_BRIDGE, RTM_DELLINK, rtnl_bridge_dellink, NULL, 0);
4631 rtnl_register(PF_BRIDGE, RTM_SETLINK, rtnl_bridge_setlink, NULL, 0);
10c9ead9
RP		 4632
4633 rtnl_register(PF_UNSPEC, RTM_GETSTATS, rtnl_stats_get, rtnl_stats_dump,
b97bac64 4634 0);
1da177e4 4635}
ubuntu-bionic-kernel mirror