Merge tag 'regmap-v5.7' of git://git.kernel.org/pub/scm/linux/kernel/git/broonie...
[linux-2.6-microblaze.git] / net / bridge / br_netlink.c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  *      Bridge netlink control interface
4  *
5  *      Authors:
6  *      Stephen Hemminger               <shemminger@osdl.org>
7  */
8
9 #include <linux/kernel.h>
10 #include <linux/slab.h>
11 #include <linux/etherdevice.h>
12 #include <net/rtnetlink.h>
13 #include <net/net_namespace.h>
14 #include <net/sock.h>
15 #include <uapi/linux/if_bridge.h>
16
17 #include "br_private.h"
18 #include "br_private_stp.h"
19 #include "br_private_tunnel.h"
20
21 static int __get_num_vlan_infos(struct net_bridge_vlan_group *vg,
22                                 u32 filter_mask)
23 {
24         struct net_bridge_vlan *v;
25         u16 vid_range_start = 0, vid_range_end = 0, vid_range_flags = 0;
26         u16 flags, pvid;
27         int num_vlans = 0;
28
29         if (!(filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED))
30                 return 0;
31
32         pvid = br_get_pvid(vg);
33         /* Count number of vlan infos */
34         list_for_each_entry_rcu(v, &vg->vlan_list, vlist) {
35                 flags = 0;
36                 /* only a context, bridge vlan not activated */
37                 if (!br_vlan_should_use(v))
38                         continue;
39                 if (v->vid == pvid)
40                         flags |= BRIDGE_VLAN_INFO_PVID;
41
42                 if (v->flags & BRIDGE_VLAN_INFO_UNTAGGED)
43                         flags |= BRIDGE_VLAN_INFO_UNTAGGED;
44
45                 if (vid_range_start == 0) {
46                         goto initvars;
47                 } else if ((v->vid - vid_range_end) == 1 &&
48                         flags == vid_range_flags) {
49                         vid_range_end = v->vid;
50                         continue;
51                 } else {
52                         if ((vid_range_end - vid_range_start) > 0)
53                                 num_vlans += 2;
54                         else
55                                 num_vlans += 1;
56                 }
57 initvars:
58                 vid_range_start = v->vid;
59                 vid_range_end = v->vid;
60                 vid_range_flags = flags;
61         }
62
63         if (vid_range_start != 0) {
64                 if ((vid_range_end - vid_range_start) > 0)
65                         num_vlans += 2;
66                 else
67                         num_vlans += 1;
68         }
69
70         return num_vlans;
71 }
72
73 static int br_get_num_vlan_infos(struct net_bridge_vlan_group *vg,
74                                  u32 filter_mask)
75 {
76         int num_vlans;
77
78         if (!vg)
79                 return 0;
80
81         if (filter_mask & RTEXT_FILTER_BRVLAN)
82                 return vg->num_vlans;
83
84         rcu_read_lock();
85         num_vlans = __get_num_vlan_infos(vg, filter_mask);
86         rcu_read_unlock();
87
88         return num_vlans;
89 }
90
91 static size_t br_get_link_af_size_filtered(const struct net_device *dev,
92                                            u32 filter_mask)
93 {
94         struct net_bridge_vlan_group *vg = NULL;
95         struct net_bridge_port *p = NULL;
96         struct net_bridge *br;
97         int num_vlan_infos;
98         size_t vinfo_sz = 0;
99
100         rcu_read_lock();
101         if (netif_is_bridge_port(dev)) {
102                 p = br_port_get_rcu(dev);
103                 vg = nbp_vlan_group_rcu(p);
104         } else if (dev->priv_flags & IFF_EBRIDGE) {
105                 br = netdev_priv(dev);
106                 vg = br_vlan_group_rcu(br);
107         }
108         num_vlan_infos = br_get_num_vlan_infos(vg, filter_mask);
109         rcu_read_unlock();
110
111         if (p && (p->flags & BR_VLAN_TUNNEL))
112                 vinfo_sz += br_get_vlan_tunnel_info_size(vg);
113
114         /* Each VLAN is returned in bridge_vlan_info along with flags */
115         vinfo_sz += num_vlan_infos * nla_total_size(sizeof(struct bridge_vlan_info));
116
117         return vinfo_sz;
118 }
119
120 static inline size_t br_port_info_size(void)
121 {
122         return nla_total_size(1)        /* IFLA_BRPORT_STATE  */
123                 + nla_total_size(2)     /* IFLA_BRPORT_PRIORITY */
124                 + nla_total_size(4)     /* IFLA_BRPORT_COST */
125                 + nla_total_size(1)     /* IFLA_BRPORT_MODE */
126                 + nla_total_size(1)     /* IFLA_BRPORT_GUARD */
127                 + nla_total_size(1)     /* IFLA_BRPORT_PROTECT */
128                 + nla_total_size(1)     /* IFLA_BRPORT_FAST_LEAVE */
129                 + nla_total_size(1)     /* IFLA_BRPORT_MCAST_TO_UCAST */
130                 + nla_total_size(1)     /* IFLA_BRPORT_LEARNING */
131                 + nla_total_size(1)     /* IFLA_BRPORT_UNICAST_FLOOD */
132                 + nla_total_size(1)     /* IFLA_BRPORT_MCAST_FLOOD */
133                 + nla_total_size(1)     /* IFLA_BRPORT_BCAST_FLOOD */
134                 + nla_total_size(1)     /* IFLA_BRPORT_PROXYARP */
135                 + nla_total_size(1)     /* IFLA_BRPORT_PROXYARP_WIFI */
136                 + nla_total_size(1)     /* IFLA_BRPORT_VLAN_TUNNEL */
137                 + nla_total_size(1)     /* IFLA_BRPORT_NEIGH_SUPPRESS */
138                 + nla_total_size(1)     /* IFLA_BRPORT_ISOLATED */
139                 + nla_total_size(sizeof(struct ifla_bridge_id)) /* IFLA_BRPORT_ROOT_ID */
140                 + nla_total_size(sizeof(struct ifla_bridge_id)) /* IFLA_BRPORT_BRIDGE_ID */
141                 + nla_total_size(sizeof(u16))   /* IFLA_BRPORT_DESIGNATED_PORT */
142                 + nla_total_size(sizeof(u16))   /* IFLA_BRPORT_DESIGNATED_COST */
143                 + nla_total_size(sizeof(u16))   /* IFLA_BRPORT_ID */
144                 + nla_total_size(sizeof(u16))   /* IFLA_BRPORT_NO */
145                 + nla_total_size(sizeof(u8))    /* IFLA_BRPORT_TOPOLOGY_CHANGE_ACK */
146                 + nla_total_size(sizeof(u8))    /* IFLA_BRPORT_CONFIG_PENDING */
147                 + nla_total_size_64bit(sizeof(u64)) /* IFLA_BRPORT_MESSAGE_AGE_TIMER */
148                 + nla_total_size_64bit(sizeof(u64)) /* IFLA_BRPORT_FORWARD_DELAY_TIMER */
149                 + nla_total_size_64bit(sizeof(u64)) /* IFLA_BRPORT_HOLD_TIMER */
150 #ifdef CONFIG_BRIDGE_IGMP_SNOOPING
151                 + nla_total_size(sizeof(u8))    /* IFLA_BRPORT_MULTICAST_ROUTER */
152 #endif
153                 + nla_total_size(sizeof(u16))   /* IFLA_BRPORT_GROUP_FWD_MASK */
154                 + 0;
155 }
156
157 static inline size_t br_nlmsg_size(struct net_device *dev, u32 filter_mask)
158 {
159         return NLMSG_ALIGN(sizeof(struct ifinfomsg))
160                 + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
161                 + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
162                 + nla_total_size(4) /* IFLA_MASTER */
163                 + nla_total_size(4) /* IFLA_MTU */
164                 + nla_total_size(4) /* IFLA_LINK */
165                 + nla_total_size(1) /* IFLA_OPERSTATE */
166                 + nla_total_size(br_port_info_size()) /* IFLA_PROTINFO */
167                 + nla_total_size(br_get_link_af_size_filtered(dev,
168                                  filter_mask)) /* IFLA_AF_SPEC */
169                 + nla_total_size(4); /* IFLA_BRPORT_BACKUP_PORT */
170 }
171
172 static int br_port_fill_attrs(struct sk_buff *skb,
173                               const struct net_bridge_port *p)
174 {
175         u8 mode = !!(p->flags & BR_HAIRPIN_MODE);
176         struct net_bridge_port *backup_p;
177         u64 timerval;
178
179         if (nla_put_u8(skb, IFLA_BRPORT_STATE, p->state) ||
180             nla_put_u16(skb, IFLA_BRPORT_PRIORITY, p->priority) ||
181             nla_put_u32(skb, IFLA_BRPORT_COST, p->path_cost) ||
182             nla_put_u8(skb, IFLA_BRPORT_MODE, mode) ||
183             nla_put_u8(skb, IFLA_BRPORT_GUARD, !!(p->flags & BR_BPDU_GUARD)) ||
184             nla_put_u8(skb, IFLA_BRPORT_PROTECT,
185                        !!(p->flags & BR_ROOT_BLOCK)) ||
186             nla_put_u8(skb, IFLA_BRPORT_FAST_LEAVE,
187                        !!(p->flags & BR_MULTICAST_FAST_LEAVE)) ||
188             nla_put_u8(skb, IFLA_BRPORT_MCAST_TO_UCAST,
189                        !!(p->flags & BR_MULTICAST_TO_UNICAST)) ||
190             nla_put_u8(skb, IFLA_BRPORT_LEARNING, !!(p->flags & BR_LEARNING)) ||
191             nla_put_u8(skb, IFLA_BRPORT_UNICAST_FLOOD,
192                        !!(p->flags & BR_FLOOD)) ||
193             nla_put_u8(skb, IFLA_BRPORT_MCAST_FLOOD,
194                        !!(p->flags & BR_MCAST_FLOOD)) ||
195             nla_put_u8(skb, IFLA_BRPORT_BCAST_FLOOD,
196                        !!(p->flags & BR_BCAST_FLOOD)) ||
197             nla_put_u8(skb, IFLA_BRPORT_PROXYARP, !!(p->flags & BR_PROXYARP)) ||
198             nla_put_u8(skb, IFLA_BRPORT_PROXYARP_WIFI,
199                        !!(p->flags & BR_PROXYARP_WIFI)) ||
200             nla_put(skb, IFLA_BRPORT_ROOT_ID, sizeof(struct ifla_bridge_id),
201                     &p->designated_root) ||
202             nla_put(skb, IFLA_BRPORT_BRIDGE_ID, sizeof(struct ifla_bridge_id),
203                     &p->designated_bridge) ||
204             nla_put_u16(skb, IFLA_BRPORT_DESIGNATED_PORT, p->designated_port) ||
205             nla_put_u16(skb, IFLA_BRPORT_DESIGNATED_COST, p->designated_cost) ||
206             nla_put_u16(skb, IFLA_BRPORT_ID, p->port_id) ||
207             nla_put_u16(skb, IFLA_BRPORT_NO, p->port_no) ||
208             nla_put_u8(skb, IFLA_BRPORT_TOPOLOGY_CHANGE_ACK,
209                        p->topology_change_ack) ||
210             nla_put_u8(skb, IFLA_BRPORT_CONFIG_PENDING, p->config_pending) ||
211             nla_put_u8(skb, IFLA_BRPORT_VLAN_TUNNEL, !!(p->flags &
212                                                         BR_VLAN_TUNNEL)) ||
213             nla_put_u16(skb, IFLA_BRPORT_GROUP_FWD_MASK, p->group_fwd_mask) ||
214             nla_put_u8(skb, IFLA_BRPORT_NEIGH_SUPPRESS,
215                        !!(p->flags & BR_NEIGH_SUPPRESS)) ||
216             nla_put_u8(skb, IFLA_BRPORT_ISOLATED, !!(p->flags & BR_ISOLATED)))
217                 return -EMSGSIZE;
218
219         timerval = br_timer_value(&p->message_age_timer);
220         if (nla_put_u64_64bit(skb, IFLA_BRPORT_MESSAGE_AGE_TIMER, timerval,
221                               IFLA_BRPORT_PAD))
222                 return -EMSGSIZE;
223         timerval = br_timer_value(&p->forward_delay_timer);
224         if (nla_put_u64_64bit(skb, IFLA_BRPORT_FORWARD_DELAY_TIMER, timerval,
225                               IFLA_BRPORT_PAD))
226                 return -EMSGSIZE;
227         timerval = br_timer_value(&p->hold_timer);
228         if (nla_put_u64_64bit(skb, IFLA_BRPORT_HOLD_TIMER, timerval,
229                               IFLA_BRPORT_PAD))
230                 return -EMSGSIZE;
231
232 #ifdef CONFIG_BRIDGE_IGMP_SNOOPING
233         if (nla_put_u8(skb, IFLA_BRPORT_MULTICAST_ROUTER,
234                        p->multicast_router))
235                 return -EMSGSIZE;
236 #endif
237
238         /* we might be called only with br->lock */
239         rcu_read_lock();
240         backup_p = rcu_dereference(p->backup_port);
241         if (backup_p)
242                 nla_put_u32(skb, IFLA_BRPORT_BACKUP_PORT,
243                             backup_p->dev->ifindex);
244         rcu_read_unlock();
245
246         return 0;
247 }
248
249 static int br_fill_ifvlaninfo_range(struct sk_buff *skb, u16 vid_start,
250                                     u16 vid_end, u16 flags)
251 {
252         struct  bridge_vlan_info vinfo;
253
254         if ((vid_end - vid_start) > 0) {
255                 /* add range to skb */
256                 vinfo.vid = vid_start;
257                 vinfo.flags = flags | BRIDGE_VLAN_INFO_RANGE_BEGIN;
258                 if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
259                             sizeof(vinfo), &vinfo))
260                         goto nla_put_failure;
261
262                 vinfo.vid = vid_end;
263                 vinfo.flags = flags | BRIDGE_VLAN_INFO_RANGE_END;
264                 if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
265                             sizeof(vinfo), &vinfo))
266                         goto nla_put_failure;
267         } else {
268                 vinfo.vid = vid_start;
269                 vinfo.flags = flags;
270                 if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
271                             sizeof(vinfo), &vinfo))
272                         goto nla_put_failure;
273         }
274
275         return 0;
276
277 nla_put_failure:
278         return -EMSGSIZE;
279 }
280
281 static int br_fill_ifvlaninfo_compressed(struct sk_buff *skb,
282                                          struct net_bridge_vlan_group *vg)
283 {
284         struct net_bridge_vlan *v;
285         u16 vid_range_start = 0, vid_range_end = 0, vid_range_flags = 0;
286         u16 flags, pvid;
287         int err = 0;
288
289         /* Pack IFLA_BRIDGE_VLAN_INFO's for every vlan
290          * and mark vlan info with begin and end flags
291          * if vlaninfo represents a range
292          */
293         pvid = br_get_pvid(vg);
294         list_for_each_entry_rcu(v, &vg->vlan_list, vlist) {
295                 flags = 0;
296                 if (!br_vlan_should_use(v))
297                         continue;
298                 if (v->vid == pvid)
299                         flags |= BRIDGE_VLAN_INFO_PVID;
300
301                 if (v->flags & BRIDGE_VLAN_INFO_UNTAGGED)
302                         flags |= BRIDGE_VLAN_INFO_UNTAGGED;
303
304                 if (vid_range_start == 0) {
305                         goto initvars;
306                 } else if ((v->vid - vid_range_end) == 1 &&
307                         flags == vid_range_flags) {
308                         vid_range_end = v->vid;
309                         continue;
310                 } else {
311                         err = br_fill_ifvlaninfo_range(skb, vid_range_start,
312                                                        vid_range_end,
313                                                        vid_range_flags);
314                         if (err)
315                                 return err;
316                 }
317
318 initvars:
319                 vid_range_start = v->vid;
320                 vid_range_end = v->vid;
321                 vid_range_flags = flags;
322         }
323
324         if (vid_range_start != 0) {
325                 /* Call it once more to send any left over vlans */
326                 err = br_fill_ifvlaninfo_range(skb, vid_range_start,
327                                                vid_range_end,
328                                                vid_range_flags);
329                 if (err)
330                         return err;
331         }
332
333         return 0;
334 }
335
336 static int br_fill_ifvlaninfo(struct sk_buff *skb,
337                               struct net_bridge_vlan_group *vg)
338 {
339         struct bridge_vlan_info vinfo;
340         struct net_bridge_vlan *v;
341         u16 pvid;
342
343         pvid = br_get_pvid(vg);
344         list_for_each_entry_rcu(v, &vg->vlan_list, vlist) {
345                 if (!br_vlan_should_use(v))
346                         continue;
347
348                 vinfo.vid = v->vid;
349                 vinfo.flags = 0;
350                 if (v->vid == pvid)
351                         vinfo.flags |= BRIDGE_VLAN_INFO_PVID;
352
353                 if (v->flags & BRIDGE_VLAN_INFO_UNTAGGED)
354                         vinfo.flags |= BRIDGE_VLAN_INFO_UNTAGGED;
355
356                 if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
357                             sizeof(vinfo), &vinfo))
358                         goto nla_put_failure;
359         }
360
361         return 0;
362
363 nla_put_failure:
364         return -EMSGSIZE;
365 }
366
367 /*
368  * Create one netlink message for one interface
369  * Contains port and master info as well as carrier and bridge state.
370  */
371 static int br_fill_ifinfo(struct sk_buff *skb,
372                           const struct net_bridge_port *port,
373                           u32 pid, u32 seq, int event, unsigned int flags,
374                           u32 filter_mask, const struct net_device *dev)
375 {
376         u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN;
377         struct net_bridge *br;
378         struct ifinfomsg *hdr;
379         struct nlmsghdr *nlh;
380
381         if (port)
382                 br = port->br;
383         else
384                 br = netdev_priv(dev);
385
386         br_debug(br, "br_fill_info event %d port %s master %s\n",
387                      event, dev->name, br->dev->name);
388
389         nlh = nlmsg_put(skb, pid, seq, event, sizeof(*hdr), flags);
390         if (nlh == NULL)
391                 return -EMSGSIZE;
392
393         hdr = nlmsg_data(nlh);
394         hdr->ifi_family = AF_BRIDGE;
395         hdr->__ifi_pad = 0;
396         hdr->ifi_type = dev->type;
397         hdr->ifi_index = dev->ifindex;
398         hdr->ifi_flags = dev_get_flags(dev);
399         hdr->ifi_change = 0;
400
401         if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
402             nla_put_u32(skb, IFLA_MASTER, br->dev->ifindex) ||
403             nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
404             nla_put_u8(skb, IFLA_OPERSTATE, operstate) ||
405             (dev->addr_len &&
406              nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) ||
407             (dev->ifindex != dev_get_iflink(dev) &&
408              nla_put_u32(skb, IFLA_LINK, dev_get_iflink(dev))))
409                 goto nla_put_failure;
410
411         if (event == RTM_NEWLINK && port) {
412                 struct nlattr *nest;
413
414                 nest = nla_nest_start(skb, IFLA_PROTINFO);
415                 if (nest == NULL || br_port_fill_attrs(skb, port) < 0)
416                         goto nla_put_failure;
417                 nla_nest_end(skb, nest);
418         }
419
420         /* Check if  the VID information is requested */
421         if ((filter_mask & RTEXT_FILTER_BRVLAN) ||
422             (filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED)) {
423                 struct net_bridge_vlan_group *vg;
424                 struct nlattr *af;
425                 int err;
426
427                 /* RCU needed because of the VLAN locking rules (rcu || rtnl) */
428                 rcu_read_lock();
429                 if (port)
430                         vg = nbp_vlan_group_rcu(port);
431                 else
432                         vg = br_vlan_group_rcu(br);
433
434                 if (!vg || !vg->num_vlans) {
435                         rcu_read_unlock();
436                         goto done;
437                 }
438                 af = nla_nest_start_noflag(skb, IFLA_AF_SPEC);
439                 if (!af) {
440                         rcu_read_unlock();
441                         goto nla_put_failure;
442                 }
443                 if (filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED)
444                         err = br_fill_ifvlaninfo_compressed(skb, vg);
445                 else
446                         err = br_fill_ifvlaninfo(skb, vg);
447
448                 if (port && (port->flags & BR_VLAN_TUNNEL))
449                         err = br_fill_vlan_tunnel_info(skb, vg);
450                 rcu_read_unlock();
451                 if (err)
452                         goto nla_put_failure;
453                 nla_nest_end(skb, af);
454         }
455
456 done:
457         nlmsg_end(skb, nlh);
458         return 0;
459
460 nla_put_failure:
461         nlmsg_cancel(skb, nlh);
462         return -EMSGSIZE;
463 }
464
465 /* Notify listeners of a change in bridge or port information */
466 void br_ifinfo_notify(int event, const struct net_bridge *br,
467                       const struct net_bridge_port *port)
468 {
469         u32 filter = RTEXT_FILTER_BRVLAN_COMPRESSED;
470         struct net_device *dev;
471         struct sk_buff *skb;
472         int err = -ENOBUFS;
473         struct net *net;
474         u16 port_no = 0;
475
476         if (WARN_ON(!port && !br))
477                 return;
478
479         if (port) {
480                 dev = port->dev;
481                 br = port->br;
482                 port_no = port->port_no;
483         } else {
484                 dev = br->dev;
485         }
486
487         net = dev_net(dev);
488         br_debug(br, "port %u(%s) event %d\n", port_no, dev->name, event);
489
490         skb = nlmsg_new(br_nlmsg_size(dev, filter), GFP_ATOMIC);
491         if (skb == NULL)
492                 goto errout;
493
494         err = br_fill_ifinfo(skb, port, 0, 0, event, 0, filter, dev);
495         if (err < 0) {
496                 /* -EMSGSIZE implies BUG in br_nlmsg_size() */
497                 WARN_ON(err == -EMSGSIZE);
498                 kfree_skb(skb);
499                 goto errout;
500         }
501         rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC);
502         return;
503 errout:
504         rtnl_set_sk_err(net, RTNLGRP_LINK, err);
505 }
506
507 /*
508  * Dump information about all ports, in response to GETLINK
509  */
510 int br_getlink(struct sk_buff *skb, u32 pid, u32 seq,
511                struct net_device *dev, u32 filter_mask, int nlflags)
512 {
513         struct net_bridge_port *port = br_port_get_rtnl(dev);
514
515         if (!port && !(filter_mask & RTEXT_FILTER_BRVLAN) &&
516             !(filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED))
517                 return 0;
518
519         return br_fill_ifinfo(skb, port, pid, seq, RTM_NEWLINK, nlflags,
520                               filter_mask, dev);
521 }
522
523 static int br_vlan_info(struct net_bridge *br, struct net_bridge_port *p,
524                         int cmd, struct bridge_vlan_info *vinfo, bool *changed,
525                         struct netlink_ext_ack *extack)
526 {
527         bool curr_change;
528         int err = 0;
529
530         switch (cmd) {
531         case RTM_SETLINK:
532                 if (p) {
533                         /* if the MASTER flag is set this will act on the global
534                          * per-VLAN entry as well
535                          */
536                         err = nbp_vlan_add(p, vinfo->vid, vinfo->flags,
537                                            &curr_change, extack);
538                 } else {
539                         vinfo->flags |= BRIDGE_VLAN_INFO_BRENTRY;
540                         err = br_vlan_add(br, vinfo->vid, vinfo->flags,
541                                           &curr_change, extack);
542                 }
543                 if (curr_change)
544                         *changed = true;
545                 break;
546
547         case RTM_DELLINK:
548                 if (p) {
549                         if (!nbp_vlan_delete(p, vinfo->vid))
550                                 *changed = true;
551
552                         if ((vinfo->flags & BRIDGE_VLAN_INFO_MASTER) &&
553                             !br_vlan_delete(p->br, vinfo->vid))
554                                 *changed = true;
555                 } else if (!br_vlan_delete(br, vinfo->vid)) {
556                         *changed = true;
557                 }
558                 break;
559         }
560
561         return err;
562 }
563
564 int br_process_vlan_info(struct net_bridge *br,
565                          struct net_bridge_port *p, int cmd,
566                          struct bridge_vlan_info *vinfo_curr,
567                          struct bridge_vlan_info **vinfo_last,
568                          bool *changed,
569                          struct netlink_ext_ack *extack)
570 {
571         int err, rtm_cmd;
572
573         if (!br_vlan_valid_id(vinfo_curr->vid, extack))
574                 return -EINVAL;
575
576         /* needed for vlan-only NEWVLAN/DELVLAN notifications */
577         rtm_cmd = br_afspec_cmd_to_rtm(cmd);
578
579         if (vinfo_curr->flags & BRIDGE_VLAN_INFO_RANGE_BEGIN) {
580                 if (!br_vlan_valid_range(vinfo_curr, *vinfo_last, extack))
581                         return -EINVAL;
582                 *vinfo_last = vinfo_curr;
583                 return 0;
584         }
585
586         if (*vinfo_last) {
587                 struct bridge_vlan_info tmp_vinfo;
588                 int v, v_change_start = 0;
589
590                 if (!br_vlan_valid_range(vinfo_curr, *vinfo_last, extack))
591                         return -EINVAL;
592
593                 memcpy(&tmp_vinfo, *vinfo_last,
594                        sizeof(struct bridge_vlan_info));
595                 for (v = (*vinfo_last)->vid; v <= vinfo_curr->vid; v++) {
596                         bool curr_change = false;
597
598                         tmp_vinfo.vid = v;
599                         err = br_vlan_info(br, p, cmd, &tmp_vinfo, &curr_change,
600                                            extack);
601                         if (err)
602                                 break;
603                         if (curr_change) {
604                                 *changed = curr_change;
605                                 if (!v_change_start)
606                                         v_change_start = v;
607                         } else {
608                                 /* nothing to notify yet */
609                                 if (!v_change_start)
610                                         continue;
611                                 br_vlan_notify(br, p, v_change_start,
612                                                v - 1, rtm_cmd);
613                                 v_change_start = 0;
614                         }
615                 }
616                 /* v_change_start is set only if the last/whole range changed */
617                 if (v_change_start)
618                         br_vlan_notify(br, p, v_change_start,
619                                        v - 1, rtm_cmd);
620
621                 *vinfo_last = NULL;
622
623                 return err;
624         }
625
626         err = br_vlan_info(br, p, cmd, vinfo_curr, changed, extack);
627         if (*changed)
628                 br_vlan_notify(br, p, vinfo_curr->vid, 0, rtm_cmd);
629
630         return err;
631 }
632
633 static int br_afspec(struct net_bridge *br,
634                      struct net_bridge_port *p,
635                      struct nlattr *af_spec,
636                      int cmd, bool *changed,
637                      struct netlink_ext_ack *extack)
638 {
639         struct bridge_vlan_info *vinfo_curr = NULL;
640         struct bridge_vlan_info *vinfo_last = NULL;
641         struct nlattr *attr;
642         struct vtunnel_info tinfo_last = {};
643         struct vtunnel_info tinfo_curr = {};
644         int err = 0, rem;
645
646         nla_for_each_nested(attr, af_spec, rem) {
647                 err = 0;
648                 switch (nla_type(attr)) {
649                 case IFLA_BRIDGE_VLAN_TUNNEL_INFO:
650                         if (!p || !(p->flags & BR_VLAN_TUNNEL))
651                                 return -EINVAL;
652                         err = br_parse_vlan_tunnel_info(attr, &tinfo_curr);
653                         if (err)
654                                 return err;
655                         err = br_process_vlan_tunnel_info(br, p, cmd,
656                                                           &tinfo_curr,
657                                                           &tinfo_last,
658                                                           changed);
659                         if (err)
660                                 return err;
661                         break;
662                 case IFLA_BRIDGE_VLAN_INFO:
663                         if (nla_len(attr) != sizeof(struct bridge_vlan_info))
664                                 return -EINVAL;
665                         vinfo_curr = nla_data(attr);
666                         err = br_process_vlan_info(br, p, cmd, vinfo_curr,
667                                                    &vinfo_last, changed,
668                                                    extack);
669                         if (err)
670                                 return err;
671                         break;
672                 }
673         }
674
675         return err;
676 }
677
678 static const struct nla_policy br_port_policy[IFLA_BRPORT_MAX + 1] = {
679         [IFLA_BRPORT_STATE]     = { .type = NLA_U8 },
680         [IFLA_BRPORT_COST]      = { .type = NLA_U32 },
681         [IFLA_BRPORT_PRIORITY]  = { .type = NLA_U16 },
682         [IFLA_BRPORT_MODE]      = { .type = NLA_U8 },
683         [IFLA_BRPORT_GUARD]     = { .type = NLA_U8 },
684         [IFLA_BRPORT_PROTECT]   = { .type = NLA_U8 },
685         [IFLA_BRPORT_FAST_LEAVE]= { .type = NLA_U8 },
686         [IFLA_BRPORT_LEARNING]  = { .type = NLA_U8 },
687         [IFLA_BRPORT_UNICAST_FLOOD] = { .type = NLA_U8 },
688         [IFLA_BRPORT_PROXYARP]  = { .type = NLA_U8 },
689         [IFLA_BRPORT_PROXYARP_WIFI] = { .type = NLA_U8 },
690         [IFLA_BRPORT_MULTICAST_ROUTER] = { .type = NLA_U8 },
691         [IFLA_BRPORT_MCAST_TO_UCAST] = { .type = NLA_U8 },
692         [IFLA_BRPORT_MCAST_FLOOD] = { .type = NLA_U8 },
693         [IFLA_BRPORT_BCAST_FLOOD] = { .type = NLA_U8 },
694         [IFLA_BRPORT_VLAN_TUNNEL] = { .type = NLA_U8 },
695         [IFLA_BRPORT_GROUP_FWD_MASK] = { .type = NLA_U16 },
696         [IFLA_BRPORT_NEIGH_SUPPRESS] = { .type = NLA_U8 },
697         [IFLA_BRPORT_ISOLATED]  = { .type = NLA_U8 },
698         [IFLA_BRPORT_BACKUP_PORT] = { .type = NLA_U32 },
699 };
700
701 /* Change the state of the port and notify spanning tree */
702 static int br_set_port_state(struct net_bridge_port *p, u8 state)
703 {
704         if (state > BR_STATE_BLOCKING)
705                 return -EINVAL;
706
707         /* if kernel STP is running, don't allow changes */
708         if (p->br->stp_enabled == BR_KERNEL_STP)
709                 return -EBUSY;
710
711         /* if device is not up, change is not allowed
712          * if link is not present, only allowable state is disabled
713          */
714         if (!netif_running(p->dev) ||
715             (!netif_oper_up(p->dev) && state != BR_STATE_DISABLED))
716                 return -ENETDOWN;
717
718         br_set_state(p, state);
719         br_port_state_selection(p->br);
720         return 0;
721 }
722
723 /* Set/clear or port flags based on attribute */
724 static int br_set_port_flag(struct net_bridge_port *p, struct nlattr *tb[],
725                             int attrtype, unsigned long mask)
726 {
727         unsigned long flags;
728         int err;
729
730         if (!tb[attrtype])
731                 return 0;
732
733         if (nla_get_u8(tb[attrtype]))
734                 flags = p->flags | mask;
735         else
736                 flags = p->flags & ~mask;
737
738         err = br_switchdev_set_port_flag(p, flags, mask);
739         if (err)
740                 return err;
741
742         p->flags = flags;
743         return 0;
744 }
745
746 /* Process bridge protocol info on port */
747 static int br_setport(struct net_bridge_port *p, struct nlattr *tb[])
748 {
749         unsigned long old_flags = p->flags;
750         bool br_vlan_tunnel_old = false;
751         int err;
752
753         err = br_set_port_flag(p, tb, IFLA_BRPORT_MODE, BR_HAIRPIN_MODE);
754         if (err)
755                 return err;
756
757         err = br_set_port_flag(p, tb, IFLA_BRPORT_GUARD, BR_BPDU_GUARD);
758         if (err)
759                 return err;
760
761         err = br_set_port_flag(p, tb, IFLA_BRPORT_FAST_LEAVE, BR_MULTICAST_FAST_LEAVE);
762         if (err)
763                 return err;
764
765         err = br_set_port_flag(p, tb, IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK);
766         if (err)
767                 return err;
768
769         err = br_set_port_flag(p, tb, IFLA_BRPORT_LEARNING, BR_LEARNING);
770         if (err)
771                 return err;
772
773         err = br_set_port_flag(p, tb, IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD);
774         if (err)
775                 return err;
776
777         err = br_set_port_flag(p, tb, IFLA_BRPORT_MCAST_FLOOD, BR_MCAST_FLOOD);
778         if (err)
779                 return err;
780
781         err = br_set_port_flag(p, tb, IFLA_BRPORT_MCAST_TO_UCAST, BR_MULTICAST_TO_UNICAST);
782         if (err)
783                 return err;
784
785         err = br_set_port_flag(p, tb, IFLA_BRPORT_BCAST_FLOOD, BR_BCAST_FLOOD);
786         if (err)
787                 return err;
788
789         err = br_set_port_flag(p, tb, IFLA_BRPORT_PROXYARP, BR_PROXYARP);
790         if (err)
791                 return err;
792
793         err = br_set_port_flag(p, tb, IFLA_BRPORT_PROXYARP_WIFI, BR_PROXYARP_WIFI);
794         if (err)
795                 return err;
796
797         br_vlan_tunnel_old = (p->flags & BR_VLAN_TUNNEL) ? true : false;
798         err = br_set_port_flag(p, tb, IFLA_BRPORT_VLAN_TUNNEL, BR_VLAN_TUNNEL);
799         if (err)
800                 return err;
801
802         if (br_vlan_tunnel_old && !(p->flags & BR_VLAN_TUNNEL))
803                 nbp_vlan_tunnel_info_flush(p);
804
805         if (tb[IFLA_BRPORT_COST]) {
806                 err = br_stp_set_path_cost(p, nla_get_u32(tb[IFLA_BRPORT_COST]));
807                 if (err)
808                         return err;
809         }
810
811         if (tb[IFLA_BRPORT_PRIORITY]) {
812                 err = br_stp_set_port_priority(p, nla_get_u16(tb[IFLA_BRPORT_PRIORITY]));
813                 if (err)
814                         return err;
815         }
816
817         if (tb[IFLA_BRPORT_STATE]) {
818                 err = br_set_port_state(p, nla_get_u8(tb[IFLA_BRPORT_STATE]));
819                 if (err)
820                         return err;
821         }
822
823         if (tb[IFLA_BRPORT_FLUSH])
824                 br_fdb_delete_by_port(p->br, p, 0, 0);
825
826 #ifdef CONFIG_BRIDGE_IGMP_SNOOPING
827         if (tb[IFLA_BRPORT_MULTICAST_ROUTER]) {
828                 u8 mcast_router = nla_get_u8(tb[IFLA_BRPORT_MULTICAST_ROUTER]);
829
830                 err = br_multicast_set_port_router(p, mcast_router);
831                 if (err)
832                         return err;
833         }
834 #endif
835
836         if (tb[IFLA_BRPORT_GROUP_FWD_MASK]) {
837                 u16 fwd_mask = nla_get_u16(tb[IFLA_BRPORT_GROUP_FWD_MASK]);
838
839                 if (fwd_mask & BR_GROUPFWD_MACPAUSE)
840                         return -EINVAL;
841                 p->group_fwd_mask = fwd_mask;
842         }
843
844         err = br_set_port_flag(p, tb, IFLA_BRPORT_NEIGH_SUPPRESS,
845                                BR_NEIGH_SUPPRESS);
846         if (err)
847                 return err;
848
849         err = br_set_port_flag(p, tb, IFLA_BRPORT_ISOLATED, BR_ISOLATED);
850         if (err)
851                 return err;
852
853         if (tb[IFLA_BRPORT_BACKUP_PORT]) {
854                 struct net_device *backup_dev = NULL;
855                 u32 backup_ifindex;
856
857                 backup_ifindex = nla_get_u32(tb[IFLA_BRPORT_BACKUP_PORT]);
858                 if (backup_ifindex) {
859                         backup_dev = __dev_get_by_index(dev_net(p->dev),
860                                                         backup_ifindex);
861                         if (!backup_dev)
862                                 return -ENOENT;
863                 }
864
865                 err = nbp_backup_change(p, backup_dev);
866                 if (err)
867                         return err;
868         }
869
870         br_port_flags_change(p, old_flags ^ p->flags);
871         return 0;
872 }
873
874 /* Change state and parameters on port. */
875 int br_setlink(struct net_device *dev, struct nlmsghdr *nlh, u16 flags,
876                struct netlink_ext_ack *extack)
877 {
878         struct net_bridge *br = (struct net_bridge *)netdev_priv(dev);
879         struct nlattr *tb[IFLA_BRPORT_MAX + 1];
880         struct net_bridge_port *p;
881         struct nlattr *protinfo;
882         struct nlattr *afspec;
883         bool changed = false;
884         int err = 0;
885
886         protinfo = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_PROTINFO);
887         afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
888         if (!protinfo && !afspec)
889                 return 0;
890
891         p = br_port_get_rtnl(dev);
892         /* We want to accept dev as bridge itself if the AF_SPEC
893          * is set to see if someone is setting vlan info on the bridge
894          */
895         if (!p && !afspec)
896                 return -EINVAL;
897
898         if (p && protinfo) {
899                 if (protinfo->nla_type & NLA_F_NESTED) {
900                         err = nla_parse_nested_deprecated(tb, IFLA_BRPORT_MAX,
901                                                           protinfo,
902                                                           br_port_policy,
903                                                           NULL);
904                         if (err)
905                                 return err;
906
907                         spin_lock_bh(&p->br->lock);
908                         err = br_setport(p, tb);
909                         spin_unlock_bh(&p->br->lock);
910                 } else {
911                         /* Binary compatibility with old RSTP */
912                         if (nla_len(protinfo) < sizeof(u8))
913                                 return -EINVAL;
914
915                         spin_lock_bh(&p->br->lock);
916                         err = br_set_port_state(p, nla_get_u8(protinfo));
917                         spin_unlock_bh(&p->br->lock);
918                 }
919                 if (err)
920                         goto out;
921                 changed = true;
922         }
923
924         if (afspec)
925                 err = br_afspec(br, p, afspec, RTM_SETLINK, &changed, extack);
926
927         if (changed)
928                 br_ifinfo_notify(RTM_NEWLINK, br, p);
929 out:
930         return err;
931 }
932
933 /* Delete port information */
934 int br_dellink(struct net_device *dev, struct nlmsghdr *nlh, u16 flags)
935 {
936         struct net_bridge *br = (struct net_bridge *)netdev_priv(dev);
937         struct net_bridge_port *p;
938         struct nlattr *afspec;
939         bool changed = false;
940         int err = 0;
941
942         afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
943         if (!afspec)
944                 return 0;
945
946         p = br_port_get_rtnl(dev);
947         /* We want to accept dev as bridge itself as well */
948         if (!p && !(dev->priv_flags & IFF_EBRIDGE))
949                 return -EINVAL;
950
951         err = br_afspec(br, p, afspec, RTM_DELLINK, &changed, NULL);
952         if (changed)
953                 /* Send RTM_NEWLINK because userspace
954                  * expects RTM_NEWLINK for vlan dels
955                  */
956                 br_ifinfo_notify(RTM_NEWLINK, br, p);
957
958         return err;
959 }
960
961 static int br_validate(struct nlattr *tb[], struct nlattr *data[],
962                        struct netlink_ext_ack *extack)
963 {
964         if (tb[IFLA_ADDRESS]) {
965                 if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
966                         return -EINVAL;
967                 if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
968                         return -EADDRNOTAVAIL;
969         }
970
971         if (!data)
972                 return 0;
973
974 #ifdef CONFIG_BRIDGE_VLAN_FILTERING
975         if (data[IFLA_BR_VLAN_PROTOCOL]) {
976                 switch (nla_get_be16(data[IFLA_BR_VLAN_PROTOCOL])) {
977                 case htons(ETH_P_8021Q):
978                 case htons(ETH_P_8021AD):
979                         break;
980                 default:
981                         return -EPROTONOSUPPORT;
982                 }
983         }
984
985         if (data[IFLA_BR_VLAN_DEFAULT_PVID]) {
986                 __u16 defpvid = nla_get_u16(data[IFLA_BR_VLAN_DEFAULT_PVID]);
987
988                 if (defpvid >= VLAN_VID_MASK)
989                         return -EINVAL;
990         }
991 #endif
992
993         return 0;
994 }
995
996 static int br_port_slave_changelink(struct net_device *brdev,
997                                     struct net_device *dev,
998                                     struct nlattr *tb[],
999                                     struct nlattr *data[],
1000                                     struct netlink_ext_ack *extack)
1001 {
1002         struct net_bridge *br = netdev_priv(brdev);
1003         int ret;
1004
1005         if (!data)
1006                 return 0;
1007
1008         spin_lock_bh(&br->lock);
1009         ret = br_setport(br_port_get_rtnl(dev), data);
1010         spin_unlock_bh(&br->lock);
1011
1012         return ret;
1013 }
1014
1015 static int br_port_fill_slave_info(struct sk_buff *skb,
1016                                    const struct net_device *brdev,
1017                                    const struct net_device *dev)
1018 {
1019         return br_port_fill_attrs(skb, br_port_get_rtnl(dev));
1020 }
1021
1022 static size_t br_port_get_slave_size(const struct net_device *brdev,
1023                                      const struct net_device *dev)
1024 {
1025         return br_port_info_size();
1026 }
1027
1028 static const struct nla_policy br_policy[IFLA_BR_MAX + 1] = {
1029         [IFLA_BR_FORWARD_DELAY] = { .type = NLA_U32 },
1030         [IFLA_BR_HELLO_TIME]    = { .type = NLA_U32 },
1031         [IFLA_BR_MAX_AGE]       = { .type = NLA_U32 },
1032         [IFLA_BR_AGEING_TIME] = { .type = NLA_U32 },
1033         [IFLA_BR_STP_STATE] = { .type = NLA_U32 },
1034         [IFLA_BR_PRIORITY] = { .type = NLA_U16 },
1035         [IFLA_BR_VLAN_FILTERING] = { .type = NLA_U8 },
1036         [IFLA_BR_VLAN_PROTOCOL] = { .type = NLA_U16 },
1037         [IFLA_BR_GROUP_FWD_MASK] = { .type = NLA_U16 },
1038         [IFLA_BR_GROUP_ADDR] = { .type = NLA_BINARY,
1039                                  .len  = ETH_ALEN },
1040         [IFLA_BR_MCAST_ROUTER] = { .type = NLA_U8 },
1041         [IFLA_BR_MCAST_SNOOPING] = { .type = NLA_U8 },
1042         [IFLA_BR_MCAST_QUERY_USE_IFADDR] = { .type = NLA_U8 },
1043         [IFLA_BR_MCAST_QUERIER] = { .type = NLA_U8 },
1044         [IFLA_BR_MCAST_HASH_ELASTICITY] = { .type = NLA_U32 },
1045         [IFLA_BR_MCAST_HASH_MAX] = { .type = NLA_U32 },
1046         [IFLA_BR_MCAST_LAST_MEMBER_CNT] = { .type = NLA_U32 },
1047         [IFLA_BR_MCAST_STARTUP_QUERY_CNT] = { .type = NLA_U32 },
1048         [IFLA_BR_MCAST_LAST_MEMBER_INTVL] = { .type = NLA_U64 },
1049         [IFLA_BR_MCAST_MEMBERSHIP_INTVL] = { .type = NLA_U64 },
1050         [IFLA_BR_MCAST_QUERIER_INTVL] = { .type = NLA_U64 },
1051         [IFLA_BR_MCAST_QUERY_INTVL] = { .type = NLA_U64 },
1052         [IFLA_BR_MCAST_QUERY_RESPONSE_INTVL] = { .type = NLA_U64 },
1053         [IFLA_BR_MCAST_STARTUP_QUERY_INTVL] = { .type = NLA_U64 },
1054         [IFLA_BR_NF_CALL_IPTABLES] = { .type = NLA_U8 },
1055         [IFLA_BR_NF_CALL_IP6TABLES] = { .type = NLA_U8 },
1056         [IFLA_BR_NF_CALL_ARPTABLES] = { .type = NLA_U8 },
1057         [IFLA_BR_VLAN_DEFAULT_PVID] = { .type = NLA_U16 },
1058         [IFLA_BR_VLAN_STATS_ENABLED] = { .type = NLA_U8 },
1059         [IFLA_BR_MCAST_STATS_ENABLED] = { .type = NLA_U8 },
1060         [IFLA_BR_MCAST_IGMP_VERSION] = { .type = NLA_U8 },
1061         [IFLA_BR_MCAST_MLD_VERSION] = { .type = NLA_U8 },
1062         [IFLA_BR_VLAN_STATS_PER_PORT] = { .type = NLA_U8 },
1063         [IFLA_BR_MULTI_BOOLOPT] = { .type = NLA_EXACT_LEN,
1064                                     .len = sizeof(struct br_boolopt_multi) },
1065 };
1066
1067 static int br_changelink(struct net_device *brdev, struct nlattr *tb[],
1068                          struct nlattr *data[],
1069                          struct netlink_ext_ack *extack)
1070 {
1071         struct net_bridge *br = netdev_priv(brdev);
1072         int err;
1073
1074         if (!data)
1075                 return 0;
1076
1077         if (data[IFLA_BR_FORWARD_DELAY]) {
1078                 err = br_set_forward_delay(br, nla_get_u32(data[IFLA_BR_FORWARD_DELAY]));
1079                 if (err)
1080                         return err;
1081         }
1082
1083         if (data[IFLA_BR_HELLO_TIME]) {
1084                 err = br_set_hello_time(br, nla_get_u32(data[IFLA_BR_HELLO_TIME]));
1085                 if (err)
1086                         return err;
1087         }
1088
1089         if (data[IFLA_BR_MAX_AGE]) {
1090                 err = br_set_max_age(br, nla_get_u32(data[IFLA_BR_MAX_AGE]));
1091                 if (err)
1092                         return err;
1093         }
1094
1095         if (data[IFLA_BR_AGEING_TIME]) {
1096                 err = br_set_ageing_time(br, nla_get_u32(data[IFLA_BR_AGEING_TIME]));
1097                 if (err)
1098                         return err;
1099         }
1100
1101         if (data[IFLA_BR_STP_STATE]) {
1102                 u32 stp_enabled = nla_get_u32(data[IFLA_BR_STP_STATE]);
1103
1104                 br_stp_set_enabled(br, stp_enabled);
1105         }
1106
1107         if (data[IFLA_BR_PRIORITY]) {
1108                 u32 priority = nla_get_u16(data[IFLA_BR_PRIORITY]);
1109
1110                 br_stp_set_bridge_priority(br, priority);
1111         }
1112
1113         if (data[IFLA_BR_VLAN_FILTERING]) {
1114                 u8 vlan_filter = nla_get_u8(data[IFLA_BR_VLAN_FILTERING]);
1115
1116                 err = __br_vlan_filter_toggle(br, vlan_filter);
1117                 if (err)
1118                         return err;
1119         }
1120
1121 #ifdef CONFIG_BRIDGE_VLAN_FILTERING
1122         if (data[IFLA_BR_VLAN_PROTOCOL]) {
1123                 __be16 vlan_proto = nla_get_be16(data[IFLA_BR_VLAN_PROTOCOL]);
1124
1125                 err = __br_vlan_set_proto(br, vlan_proto);
1126                 if (err)
1127                         return err;
1128         }
1129
1130         if (data[IFLA_BR_VLAN_DEFAULT_PVID]) {
1131                 __u16 defpvid = nla_get_u16(data[IFLA_BR_VLAN_DEFAULT_PVID]);
1132
1133                 err = __br_vlan_set_default_pvid(br, defpvid, extack);
1134                 if (err)
1135                         return err;
1136         }
1137
1138         if (data[IFLA_BR_VLAN_STATS_ENABLED]) {
1139                 __u8 vlan_stats = nla_get_u8(data[IFLA_BR_VLAN_STATS_ENABLED]);
1140
1141                 err = br_vlan_set_stats(br, vlan_stats);
1142                 if (err)
1143                         return err;
1144         }
1145
1146         if (data[IFLA_BR_VLAN_STATS_PER_PORT]) {
1147                 __u8 per_port = nla_get_u8(data[IFLA_BR_VLAN_STATS_PER_PORT]);
1148
1149                 err = br_vlan_set_stats_per_port(br, per_port);
1150                 if (err)
1151                         return err;
1152         }
1153 #endif
1154
1155         if (data[IFLA_BR_GROUP_FWD_MASK]) {
1156                 u16 fwd_mask = nla_get_u16(data[IFLA_BR_GROUP_FWD_MASK]);
1157
1158                 if (fwd_mask & BR_GROUPFWD_RESTRICTED)
1159                         return -EINVAL;
1160                 br->group_fwd_mask = fwd_mask;
1161         }
1162
1163         if (data[IFLA_BR_GROUP_ADDR]) {
1164                 u8 new_addr[ETH_ALEN];
1165
1166                 if (nla_len(data[IFLA_BR_GROUP_ADDR]) != ETH_ALEN)
1167                         return -EINVAL;
1168                 memcpy(new_addr, nla_data(data[IFLA_BR_GROUP_ADDR]), ETH_ALEN);
1169                 if (!is_link_local_ether_addr(new_addr))
1170                         return -EINVAL;
1171                 if (new_addr[5] == 1 ||         /* 802.3x Pause address */
1172                     new_addr[5] == 2 ||         /* 802.3ad Slow protocols */
1173                     new_addr[5] == 3)           /* 802.1X PAE address */
1174                         return -EINVAL;
1175                 spin_lock_bh(&br->lock);
1176                 memcpy(br->group_addr, new_addr, sizeof(br->group_addr));
1177                 spin_unlock_bh(&br->lock);
1178                 br_opt_toggle(br, BROPT_GROUP_ADDR_SET, true);
1179                 br_recalculate_fwd_mask(br);
1180         }
1181
1182         if (data[IFLA_BR_FDB_FLUSH])
1183                 br_fdb_flush(br);
1184
1185 #ifdef CONFIG_BRIDGE_IGMP_SNOOPING
1186         if (data[IFLA_BR_MCAST_ROUTER]) {
1187                 u8 multicast_router = nla_get_u8(data[IFLA_BR_MCAST_ROUTER]);
1188
1189                 err = br_multicast_set_router(br, multicast_router);
1190                 if (err)
1191                         return err;
1192         }
1193
1194         if (data[IFLA_BR_MCAST_SNOOPING]) {
1195                 u8 mcast_snooping = nla_get_u8(data[IFLA_BR_MCAST_SNOOPING]);
1196
1197                 br_multicast_toggle(br, mcast_snooping);
1198         }
1199
1200         if (data[IFLA_BR_MCAST_QUERY_USE_IFADDR]) {
1201                 u8 val;
1202
1203                 val = nla_get_u8(data[IFLA_BR_MCAST_QUERY_USE_IFADDR]);
1204                 br_opt_toggle(br, BROPT_MULTICAST_QUERY_USE_IFADDR, !!val);
1205         }
1206
1207         if (data[IFLA_BR_MCAST_QUERIER]) {
1208                 u8 mcast_querier = nla_get_u8(data[IFLA_BR_MCAST_QUERIER]);
1209
1210                 err = br_multicast_set_querier(br, mcast_querier);
1211                 if (err)
1212                         return err;
1213         }
1214
1215         if (data[IFLA_BR_MCAST_HASH_ELASTICITY])
1216                 br_warn(br, "the hash_elasticity option has been deprecated and is always %u\n",
1217                         RHT_ELASTICITY);
1218
1219         if (data[IFLA_BR_MCAST_HASH_MAX])
1220                 br->hash_max = nla_get_u32(data[IFLA_BR_MCAST_HASH_MAX]);
1221
1222         if (data[IFLA_BR_MCAST_LAST_MEMBER_CNT]) {
1223                 u32 val = nla_get_u32(data[IFLA_BR_MCAST_LAST_MEMBER_CNT]);
1224
1225                 br->multicast_last_member_count = val;
1226         }
1227
1228         if (data[IFLA_BR_MCAST_STARTUP_QUERY_CNT]) {
1229                 u32 val = nla_get_u32(data[IFLA_BR_MCAST_STARTUP_QUERY_CNT]);
1230
1231                 br->multicast_startup_query_count = val;
1232         }
1233
1234         if (data[IFLA_BR_MCAST_LAST_MEMBER_INTVL]) {
1235                 u64 val = nla_get_u64(data[IFLA_BR_MCAST_LAST_MEMBER_INTVL]);
1236
1237                 br->multicast_last_member_interval = clock_t_to_jiffies(val);
1238         }
1239
1240         if (data[IFLA_BR_MCAST_MEMBERSHIP_INTVL]) {
1241                 u64 val = nla_get_u64(data[IFLA_BR_MCAST_MEMBERSHIP_INTVL]);
1242
1243                 br->multicast_membership_interval = clock_t_to_jiffies(val);
1244         }
1245
1246         if (data[IFLA_BR_MCAST_QUERIER_INTVL]) {
1247                 u64 val = nla_get_u64(data[IFLA_BR_MCAST_QUERIER_INTVL]);
1248
1249                 br->multicast_querier_interval = clock_t_to_jiffies(val);
1250         }
1251
1252         if (data[IFLA_BR_MCAST_QUERY_INTVL]) {
1253                 u64 val = nla_get_u64(data[IFLA_BR_MCAST_QUERY_INTVL]);
1254
1255                 br->multicast_query_interval = clock_t_to_jiffies(val);
1256         }
1257
1258         if (data[IFLA_BR_MCAST_QUERY_RESPONSE_INTVL]) {
1259                 u64 val = nla_get_u64(data[IFLA_BR_MCAST_QUERY_RESPONSE_INTVL]);
1260
1261                 br->multicast_query_response_interval = clock_t_to_jiffies(val);
1262         }
1263
1264         if (data[IFLA_BR_MCAST_STARTUP_QUERY_INTVL]) {
1265                 u64 val = nla_get_u64(data[IFLA_BR_MCAST_STARTUP_QUERY_INTVL]);
1266
1267                 br->multicast_startup_query_interval = clock_t_to_jiffies(val);
1268         }
1269
1270         if (data[IFLA_BR_MCAST_STATS_ENABLED]) {
1271                 __u8 mcast_stats;
1272
1273                 mcast_stats = nla_get_u8(data[IFLA_BR_MCAST_STATS_ENABLED]);
1274                 br_opt_toggle(br, BROPT_MULTICAST_STATS_ENABLED, !!mcast_stats);
1275         }
1276
1277         if (data[IFLA_BR_MCAST_IGMP_VERSION]) {
1278                 __u8 igmp_version;
1279
1280                 igmp_version = nla_get_u8(data[IFLA_BR_MCAST_IGMP_VERSION]);
1281                 err = br_multicast_set_igmp_version(br, igmp_version);
1282                 if (err)
1283                         return err;
1284         }
1285
1286 #if IS_ENABLED(CONFIG_IPV6)
1287         if (data[IFLA_BR_MCAST_MLD_VERSION]) {
1288                 __u8 mld_version;
1289
1290                 mld_version = nla_get_u8(data[IFLA_BR_MCAST_MLD_VERSION]);
1291                 err = br_multicast_set_mld_version(br, mld_version);
1292                 if (err)
1293                         return err;
1294         }
1295 #endif
1296 #endif
1297 #if IS_ENABLED(CONFIG_BRIDGE_NETFILTER)
1298         if (data[IFLA_BR_NF_CALL_IPTABLES]) {
1299                 u8 val = nla_get_u8(data[IFLA_BR_NF_CALL_IPTABLES]);
1300
1301                 br_opt_toggle(br, BROPT_NF_CALL_IPTABLES, !!val);
1302         }
1303
1304         if (data[IFLA_BR_NF_CALL_IP6TABLES]) {
1305                 u8 val = nla_get_u8(data[IFLA_BR_NF_CALL_IP6TABLES]);
1306
1307                 br_opt_toggle(br, BROPT_NF_CALL_IP6TABLES, !!val);
1308         }
1309
1310         if (data[IFLA_BR_NF_CALL_ARPTABLES]) {
1311                 u8 val = nla_get_u8(data[IFLA_BR_NF_CALL_ARPTABLES]);
1312
1313                 br_opt_toggle(br, BROPT_NF_CALL_ARPTABLES, !!val);
1314         }
1315 #endif
1316
1317         if (data[IFLA_BR_MULTI_BOOLOPT]) {
1318                 struct br_boolopt_multi *bm;
1319
1320                 bm = nla_data(data[IFLA_BR_MULTI_BOOLOPT]);
1321                 err = br_boolopt_multi_toggle(br, bm, extack);
1322                 if (err)
1323                         return err;
1324         }
1325
1326         return 0;
1327 }
1328
1329 static int br_dev_newlink(struct net *src_net, struct net_device *dev,
1330                           struct nlattr *tb[], struct nlattr *data[],
1331                           struct netlink_ext_ack *extack)
1332 {
1333         struct net_bridge *br = netdev_priv(dev);
1334         int err;
1335
1336         err = register_netdevice(dev);
1337         if (err)
1338                 return err;
1339
1340         if (tb[IFLA_ADDRESS]) {
1341                 spin_lock_bh(&br->lock);
1342                 br_stp_change_bridge_id(br, nla_data(tb[IFLA_ADDRESS]));
1343                 spin_unlock_bh(&br->lock);
1344         }
1345
1346         err = br_changelink(dev, tb, data, extack);
1347         if (err)
1348                 br_dev_delete(dev, NULL);
1349
1350         return err;
1351 }
1352
1353 static size_t br_get_size(const struct net_device *brdev)
1354 {
1355         return nla_total_size(sizeof(u32)) +    /* IFLA_BR_FORWARD_DELAY  */
1356                nla_total_size(sizeof(u32)) +    /* IFLA_BR_HELLO_TIME */
1357                nla_total_size(sizeof(u32)) +    /* IFLA_BR_MAX_AGE */
1358                nla_total_size(sizeof(u32)) +    /* IFLA_BR_AGEING_TIME */
1359                nla_total_size(sizeof(u32)) +    /* IFLA_BR_STP_STATE */
1360                nla_total_size(sizeof(u16)) +    /* IFLA_BR_PRIORITY */
1361                nla_total_size(sizeof(u8)) +     /* IFLA_BR_VLAN_FILTERING */
1362 #ifdef CONFIG_BRIDGE_VLAN_FILTERING
1363                nla_total_size(sizeof(__be16)) + /* IFLA_BR_VLAN_PROTOCOL */
1364                nla_total_size(sizeof(u16)) +    /* IFLA_BR_VLAN_DEFAULT_PVID */
1365                nla_total_size(sizeof(u8)) +     /* IFLA_BR_VLAN_STATS_ENABLED */
1366                nla_total_size(sizeof(u8)) +     /* IFLA_BR_VLAN_STATS_PER_PORT */
1367 #endif
1368                nla_total_size(sizeof(u16)) +    /* IFLA_BR_GROUP_FWD_MASK */
1369                nla_total_size(sizeof(struct ifla_bridge_id)) +   /* IFLA_BR_ROOT_ID */
1370                nla_total_size(sizeof(struct ifla_bridge_id)) +   /* IFLA_BR_BRIDGE_ID */
1371                nla_total_size(sizeof(u16)) +    /* IFLA_BR_ROOT_PORT */
1372                nla_total_size(sizeof(u32)) +    /* IFLA_BR_ROOT_PATH_COST */
1373                nla_total_size(sizeof(u8)) +     /* IFLA_BR_TOPOLOGY_CHANGE */
1374                nla_total_size(sizeof(u8)) +     /* IFLA_BR_TOPOLOGY_CHANGE_DETECTED */
1375                nla_total_size_64bit(sizeof(u64)) + /* IFLA_BR_HELLO_TIMER */
1376                nla_total_size_64bit(sizeof(u64)) + /* IFLA_BR_TCN_TIMER */
1377                nla_total_size_64bit(sizeof(u64)) + /* IFLA_BR_TOPOLOGY_CHANGE_TIMER */
1378                nla_total_size_64bit(sizeof(u64)) + /* IFLA_BR_GC_TIMER */
1379                nla_total_size(ETH_ALEN) +       /* IFLA_BR_GROUP_ADDR */
1380 #ifdef CONFIG_BRIDGE_IGMP_SNOOPING
1381                nla_total_size(sizeof(u8)) +     /* IFLA_BR_MCAST_ROUTER */
1382                nla_total_size(sizeof(u8)) +     /* IFLA_BR_MCAST_SNOOPING */
1383                nla_total_size(sizeof(u8)) +     /* IFLA_BR_MCAST_QUERY_USE_IFADDR */
1384                nla_total_size(sizeof(u8)) +     /* IFLA_BR_MCAST_QUERIER */
1385                nla_total_size(sizeof(u8)) +     /* IFLA_BR_MCAST_STATS_ENABLED */
1386                nla_total_size(sizeof(u32)) +    /* IFLA_BR_MCAST_HASH_ELASTICITY */
1387                nla_total_size(sizeof(u32)) +    /* IFLA_BR_MCAST_HASH_MAX */
1388                nla_total_size(sizeof(u32)) +    /* IFLA_BR_MCAST_LAST_MEMBER_CNT */
1389                nla_total_size(sizeof(u32)) +    /* IFLA_BR_MCAST_STARTUP_QUERY_CNT */
1390                nla_total_size_64bit(sizeof(u64)) + /* IFLA_BR_MCAST_LAST_MEMBER_INTVL */
1391                nla_total_size_64bit(sizeof(u64)) + /* IFLA_BR_MCAST_MEMBERSHIP_INTVL */
1392                nla_total_size_64bit(sizeof(u64)) + /* IFLA_BR_MCAST_QUERIER_INTVL */
1393                nla_total_size_64bit(sizeof(u64)) + /* IFLA_BR_MCAST_QUERY_INTVL */
1394                nla_total_size_64bit(sizeof(u64)) + /* IFLA_BR_MCAST_QUERY_RESPONSE_INTVL */
1395                nla_total_size_64bit(sizeof(u64)) + /* IFLA_BR_MCAST_STARTUP_QUERY_INTVL */
1396                nla_total_size(sizeof(u8)) +     /* IFLA_BR_MCAST_IGMP_VERSION */
1397                nla_total_size(sizeof(u8)) +     /* IFLA_BR_MCAST_MLD_VERSION */
1398 #endif
1399 #if IS_ENABLED(CONFIG_BRIDGE_NETFILTER)
1400                nla_total_size(sizeof(u8)) +     /* IFLA_BR_NF_CALL_IPTABLES */
1401                nla_total_size(sizeof(u8)) +     /* IFLA_BR_NF_CALL_IP6TABLES */
1402                nla_total_size(sizeof(u8)) +     /* IFLA_BR_NF_CALL_ARPTABLES */
1403 #endif
1404                nla_total_size(sizeof(struct br_boolopt_multi)) + /* IFLA_BR_MULTI_BOOLOPT */
1405                0;
1406 }
1407
1408 static int br_fill_info(struct sk_buff *skb, const struct net_device *brdev)
1409 {
1410         struct net_bridge *br = netdev_priv(brdev);
1411         u32 forward_delay = jiffies_to_clock_t(br->forward_delay);
1412         u32 hello_time = jiffies_to_clock_t(br->hello_time);
1413         u32 age_time = jiffies_to_clock_t(br->max_age);
1414         u32 ageing_time = jiffies_to_clock_t(br->ageing_time);
1415         u32 stp_enabled = br->stp_enabled;
1416         u16 priority = (br->bridge_id.prio[0] << 8) | br->bridge_id.prio[1];
1417         u8 vlan_enabled = br_vlan_enabled(br->dev);
1418         struct br_boolopt_multi bm;
1419         u64 clockval;
1420
1421         clockval = br_timer_value(&br->hello_timer);
1422         if (nla_put_u64_64bit(skb, IFLA_BR_HELLO_TIMER, clockval, IFLA_BR_PAD))
1423                 return -EMSGSIZE;
1424         clockval = br_timer_value(&br->tcn_timer);
1425         if (nla_put_u64_64bit(skb, IFLA_BR_TCN_TIMER, clockval, IFLA_BR_PAD))
1426                 return -EMSGSIZE;
1427         clockval = br_timer_value(&br->topology_change_timer);
1428         if (nla_put_u64_64bit(skb, IFLA_BR_TOPOLOGY_CHANGE_TIMER, clockval,
1429                               IFLA_BR_PAD))
1430                 return -EMSGSIZE;
1431         clockval = br_timer_value(&br->gc_work.timer);
1432         if (nla_put_u64_64bit(skb, IFLA_BR_GC_TIMER, clockval, IFLA_BR_PAD))
1433                 return -EMSGSIZE;
1434
1435         br_boolopt_multi_get(br, &bm);
1436         if (nla_put_u32(skb, IFLA_BR_FORWARD_DELAY, forward_delay) ||
1437             nla_put_u32(skb, IFLA_BR_HELLO_TIME, hello_time) ||
1438             nla_put_u32(skb, IFLA_BR_MAX_AGE, age_time) ||
1439             nla_put_u32(skb, IFLA_BR_AGEING_TIME, ageing_time) ||
1440             nla_put_u32(skb, IFLA_BR_STP_STATE, stp_enabled) ||
1441             nla_put_u16(skb, IFLA_BR_PRIORITY, priority) ||
1442             nla_put_u8(skb, IFLA_BR_VLAN_FILTERING, vlan_enabled) ||
1443             nla_put_u16(skb, IFLA_BR_GROUP_FWD_MASK, br->group_fwd_mask) ||
1444             nla_put(skb, IFLA_BR_BRIDGE_ID, sizeof(struct ifla_bridge_id),
1445                     &br->bridge_id) ||
1446             nla_put(skb, IFLA_BR_ROOT_ID, sizeof(struct ifla_bridge_id),
1447                     &br->designated_root) ||
1448             nla_put_u16(skb, IFLA_BR_ROOT_PORT, br->root_port) ||
1449             nla_put_u32(skb, IFLA_BR_ROOT_PATH_COST, br->root_path_cost) ||
1450             nla_put_u8(skb, IFLA_BR_TOPOLOGY_CHANGE, br->topology_change) ||
1451             nla_put_u8(skb, IFLA_BR_TOPOLOGY_CHANGE_DETECTED,
1452                        br->topology_change_detected) ||
1453             nla_put(skb, IFLA_BR_GROUP_ADDR, ETH_ALEN, br->group_addr) ||
1454             nla_put(skb, IFLA_BR_MULTI_BOOLOPT, sizeof(bm), &bm))
1455                 return -EMSGSIZE;
1456
1457 #ifdef CONFIG_BRIDGE_VLAN_FILTERING
1458         if (nla_put_be16(skb, IFLA_BR_VLAN_PROTOCOL, br->vlan_proto) ||
1459             nla_put_u16(skb, IFLA_BR_VLAN_DEFAULT_PVID, br->default_pvid) ||
1460             nla_put_u8(skb, IFLA_BR_VLAN_STATS_ENABLED,
1461                        br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) ||
1462             nla_put_u8(skb, IFLA_BR_VLAN_STATS_PER_PORT,
1463                        br_opt_get(br, BROPT_VLAN_STATS_PER_PORT)))
1464                 return -EMSGSIZE;
1465 #endif
1466 #ifdef CONFIG_BRIDGE_IGMP_SNOOPING
1467         if (nla_put_u8(skb, IFLA_BR_MCAST_ROUTER, br->multicast_router) ||
1468             nla_put_u8(skb, IFLA_BR_MCAST_SNOOPING,
1469                        br_opt_get(br, BROPT_MULTICAST_ENABLED)) ||
1470             nla_put_u8(skb, IFLA_BR_MCAST_QUERY_USE_IFADDR,
1471                        br_opt_get(br, BROPT_MULTICAST_QUERY_USE_IFADDR)) ||
1472             nla_put_u8(skb, IFLA_BR_MCAST_QUERIER,
1473                        br_opt_get(br, BROPT_MULTICAST_QUERIER)) ||
1474             nla_put_u8(skb, IFLA_BR_MCAST_STATS_ENABLED,
1475                        br_opt_get(br, BROPT_MULTICAST_STATS_ENABLED)) ||
1476             nla_put_u32(skb, IFLA_BR_MCAST_HASH_ELASTICITY, RHT_ELASTICITY) ||
1477             nla_put_u32(skb, IFLA_BR_MCAST_HASH_MAX, br->hash_max) ||
1478             nla_put_u32(skb, IFLA_BR_MCAST_LAST_MEMBER_CNT,
1479                         br->multicast_last_member_count) ||
1480             nla_put_u32(skb, IFLA_BR_MCAST_STARTUP_QUERY_CNT,
1481                         br->multicast_startup_query_count) ||
1482             nla_put_u8(skb, IFLA_BR_MCAST_IGMP_VERSION,
1483                        br->multicast_igmp_version))
1484                 return -EMSGSIZE;
1485 #if IS_ENABLED(CONFIG_IPV6)
1486         if (nla_put_u8(skb, IFLA_BR_MCAST_MLD_VERSION,
1487                        br->multicast_mld_version))
1488                 return -EMSGSIZE;
1489 #endif
1490         clockval = jiffies_to_clock_t(br->multicast_last_member_interval);
1491         if (nla_put_u64_64bit(skb, IFLA_BR_MCAST_LAST_MEMBER_INTVL, clockval,
1492                               IFLA_BR_PAD))
1493                 return -EMSGSIZE;
1494         clockval = jiffies_to_clock_t(br->multicast_membership_interval);
1495         if (nla_put_u64_64bit(skb, IFLA_BR_MCAST_MEMBERSHIP_INTVL, clockval,
1496                               IFLA_BR_PAD))
1497                 return -EMSGSIZE;
1498         clockval = jiffies_to_clock_t(br->multicast_querier_interval);
1499         if (nla_put_u64_64bit(skb, IFLA_BR_MCAST_QUERIER_INTVL, clockval,
1500                               IFLA_BR_PAD))
1501                 return -EMSGSIZE;
1502         clockval = jiffies_to_clock_t(br->multicast_query_interval);
1503         if (nla_put_u64_64bit(skb, IFLA_BR_MCAST_QUERY_INTVL, clockval,
1504                               IFLA_BR_PAD))
1505                 return -EMSGSIZE;
1506         clockval = jiffies_to_clock_t(br->multicast_query_response_interval);
1507         if (nla_put_u64_64bit(skb, IFLA_BR_MCAST_QUERY_RESPONSE_INTVL, clockval,
1508                               IFLA_BR_PAD))
1509                 return -EMSGSIZE;
1510         clockval = jiffies_to_clock_t(br->multicast_startup_query_interval);
1511         if (nla_put_u64_64bit(skb, IFLA_BR_MCAST_STARTUP_QUERY_INTVL, clockval,
1512                               IFLA_BR_PAD))
1513                 return -EMSGSIZE;
1514 #endif
1515 #if IS_ENABLED(CONFIG_BRIDGE_NETFILTER)
1516         if (nla_put_u8(skb, IFLA_BR_NF_CALL_IPTABLES,
1517                        br_opt_get(br, BROPT_NF_CALL_IPTABLES) ? 1 : 0) ||
1518             nla_put_u8(skb, IFLA_BR_NF_CALL_IP6TABLES,
1519                        br_opt_get(br, BROPT_NF_CALL_IP6TABLES) ? 1 : 0) ||
1520             nla_put_u8(skb, IFLA_BR_NF_CALL_ARPTABLES,
1521                        br_opt_get(br, BROPT_NF_CALL_ARPTABLES) ? 1 : 0))
1522                 return -EMSGSIZE;
1523 #endif
1524
1525         return 0;
1526 }
1527
1528 static size_t br_get_linkxstats_size(const struct net_device *dev, int attr)
1529 {
1530         struct net_bridge_port *p = NULL;
1531         struct net_bridge_vlan_group *vg;
1532         struct net_bridge_vlan *v;
1533         struct net_bridge *br;
1534         int numvls = 0;
1535
1536         switch (attr) {
1537         case IFLA_STATS_LINK_XSTATS:
1538                 br = netdev_priv(dev);
1539                 vg = br_vlan_group(br);
1540                 break;
1541         case IFLA_STATS_LINK_XSTATS_SLAVE:
1542                 p = br_port_get_rtnl(dev);
1543                 if (!p)
1544                         return 0;
1545                 br = p->br;
1546                 vg = nbp_vlan_group(p);
1547                 break;
1548         default:
1549                 return 0;
1550         }
1551
1552         if (vg) {
1553                 /* we need to count all, even placeholder entries */
1554                 list_for_each_entry(v, &vg->vlan_list, vlist)
1555                         numvls++;
1556         }
1557
1558         return numvls * nla_total_size(sizeof(struct bridge_vlan_xstats)) +
1559                nla_total_size(sizeof(struct br_mcast_stats)) +
1560                nla_total_size(0);
1561 }
1562
1563 static int br_fill_linkxstats(struct sk_buff *skb,
1564                               const struct net_device *dev,
1565                               int *prividx, int attr)
1566 {
1567         struct nlattr *nla __maybe_unused;
1568         struct net_bridge_port *p = NULL;
1569         struct net_bridge_vlan_group *vg;
1570         struct net_bridge_vlan *v;
1571         struct net_bridge *br;
1572         struct nlattr *nest;
1573         int vl_idx = 0;
1574
1575         switch (attr) {
1576         case IFLA_STATS_LINK_XSTATS:
1577                 br = netdev_priv(dev);
1578                 vg = br_vlan_group(br);
1579                 break;
1580         case IFLA_STATS_LINK_XSTATS_SLAVE:
1581                 p = br_port_get_rtnl(dev);
1582                 if (!p)
1583                         return 0;
1584                 br = p->br;
1585                 vg = nbp_vlan_group(p);
1586                 break;
1587         default:
1588                 return -EINVAL;
1589         }
1590
1591         nest = nla_nest_start_noflag(skb, LINK_XSTATS_TYPE_BRIDGE);
1592         if (!nest)
1593                 return -EMSGSIZE;
1594
1595         if (vg) {
1596                 u16 pvid;
1597
1598                 pvid = br_get_pvid(vg);
1599                 list_for_each_entry(v, &vg->vlan_list, vlist) {
1600                         struct bridge_vlan_xstats vxi;
1601                         struct br_vlan_stats stats;
1602
1603                         if (++vl_idx < *prividx)
1604                                 continue;
1605                         memset(&vxi, 0, sizeof(vxi));
1606                         vxi.vid = v->vid;
1607                         vxi.flags = v->flags;
1608                         if (v->vid == pvid)
1609                                 vxi.flags |= BRIDGE_VLAN_INFO_PVID;
1610                         br_vlan_get_stats(v, &stats);
1611                         vxi.rx_bytes = stats.rx_bytes;
1612                         vxi.rx_packets = stats.rx_packets;
1613                         vxi.tx_bytes = stats.tx_bytes;
1614                         vxi.tx_packets = stats.tx_packets;
1615
1616                         if (nla_put(skb, BRIDGE_XSTATS_VLAN, sizeof(vxi), &vxi))
1617                                 goto nla_put_failure;
1618                 }
1619         }
1620
1621 #ifdef CONFIG_BRIDGE_IGMP_SNOOPING
1622         if (++vl_idx >= *prividx) {
1623                 nla = nla_reserve_64bit(skb, BRIDGE_XSTATS_MCAST,
1624                                         sizeof(struct br_mcast_stats),
1625                                         BRIDGE_XSTATS_PAD);
1626                 if (!nla)
1627                         goto nla_put_failure;
1628                 br_multicast_get_stats(br, p, nla_data(nla));
1629         }
1630 #endif
1631
1632         if (p) {
1633                 nla = nla_reserve_64bit(skb, BRIDGE_XSTATS_STP,
1634                                         sizeof(p->stp_xstats),
1635                                         BRIDGE_XSTATS_PAD);
1636                 if (!nla)
1637                         goto nla_put_failure;
1638
1639                 spin_lock_bh(&br->lock);
1640                 memcpy(nla_data(nla), &p->stp_xstats, sizeof(p->stp_xstats));
1641                 spin_unlock_bh(&br->lock);
1642         }
1643
1644         nla_nest_end(skb, nest);
1645         *prividx = 0;
1646
1647         return 0;
1648
1649 nla_put_failure:
1650         nla_nest_end(skb, nest);
1651         *prividx = vl_idx;
1652
1653         return -EMSGSIZE;
1654 }
1655
1656 static struct rtnl_af_ops br_af_ops __read_mostly = {
1657         .family                 = AF_BRIDGE,
1658         .get_link_af_size       = br_get_link_af_size_filtered,
1659 };
1660
1661 struct rtnl_link_ops br_link_ops __read_mostly = {
1662         .kind                   = "bridge",
1663         .priv_size              = sizeof(struct net_bridge),
1664         .setup                  = br_dev_setup,
1665         .maxtype                = IFLA_BR_MAX,
1666         .policy                 = br_policy,
1667         .validate               = br_validate,
1668         .newlink                = br_dev_newlink,
1669         .changelink             = br_changelink,
1670         .dellink                = br_dev_delete,
1671         .get_size               = br_get_size,
1672         .fill_info              = br_fill_info,
1673         .fill_linkxstats        = br_fill_linkxstats,
1674         .get_linkxstats_size    = br_get_linkxstats_size,
1675
1676         .slave_maxtype          = IFLA_BRPORT_MAX,
1677         .slave_policy           = br_port_policy,
1678         .slave_changelink       = br_port_slave_changelink,
1679         .get_slave_size         = br_port_get_slave_size,
1680         .fill_slave_info        = br_port_fill_slave_info,
1681 };
1682
1683 int __init br_netlink_init(void)
1684 {
1685         int err;
1686
1687         br_mdb_init();
1688         br_vlan_rtnl_init();
1689         rtnl_af_register(&br_af_ops);
1690
1691         err = rtnl_link_register(&br_link_ops);
1692         if (err)
1693                 goto out_af;
1694
1695         return 0;
1696
1697 out_af:
1698         rtnl_af_unregister(&br_af_ops);
1699         br_mdb_uninit();
1700         return err;
1701 }
1702
1703 void br_netlink_fini(void)
1704 {
1705         br_mdb_uninit();
1706         br_vlan_rtnl_uninit();
1707         rtnl_af_unregister(&br_af_ops);
1708         rtnl_link_unregister(&br_link_ops);
1709 }