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