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