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