5390536d500c6fee9970226bf2e584475f2daa5f
[platform/kernel/linux-rpi.git] / net / bridge / br_netlink.c
1 /*
2  *      Bridge netlink control interface
3  *
4  *      Authors:
5  *      Stephen Hemminger               <shemminger@osdl.org>
6  *
7  *      This program is free software; you can redistribute it and/or
8  *      modify it under the terms of the GNU General Public License
9  *      as published by the Free Software Foundation; either version
10  *      2 of the License, or (at your option) any later version.
11  */
12
13 #include <linux/kernel.h>
14 #include <linux/slab.h>
15 #include <linux/etherdevice.h>
16 #include <net/rtnetlink.h>
17 #include <net/net_namespace.h>
18 #include <net/sock.h>
19 #include <net/switchdev.h>
20 #include <uapi/linux/if_bridge.h>
21
22 #include "br_private.h"
23 #include "br_private_stp.h"
24
25 static int br_get_num_vlan_infos(const struct net_port_vlans *pv,
26                                  u32 filter_mask)
27 {
28         u16 vid_range_start = 0, vid_range_end = 0;
29         u16 vid_range_flags = 0;
30         u16 pvid, vid, flags;
31         int num_vlans = 0;
32
33         if (filter_mask & RTEXT_FILTER_BRVLAN)
34                 return pv->num_vlans;
35
36         if (!(filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED))
37                 return 0;
38
39         /* Count number of vlan info's
40          */
41         pvid = br_get_pvid(pv);
42         for_each_set_bit(vid, pv->vlan_bitmap, VLAN_N_VID) {
43                 flags = 0;
44                 if (vid == pvid)
45                         flags |= BRIDGE_VLAN_INFO_PVID;
46
47                 if (test_bit(vid, pv->untagged_bitmap))
48                         flags |= BRIDGE_VLAN_INFO_UNTAGGED;
49
50                 if (vid_range_start == 0) {
51                         goto initvars;
52                 } else if ((vid - vid_range_end) == 1 &&
53                         flags == vid_range_flags) {
54                         vid_range_end = vid;
55                         continue;
56                 } else {
57                         if ((vid_range_end - vid_range_start) > 0)
58                                 num_vlans += 2;
59                         else
60                                 num_vlans += 1;
61                 }
62 initvars:
63                 vid_range_start = vid;
64                 vid_range_end = vid;
65                 vid_range_flags = flags;
66         }
67
68         if (vid_range_start != 0) {
69                 if ((vid_range_end - vid_range_start) > 0)
70                         num_vlans += 2;
71                 else
72                         num_vlans += 1;
73         }
74
75         return num_vlans;
76 }
77
78 static size_t br_get_link_af_size_filtered(const struct net_device *dev,
79                                            u32 filter_mask)
80 {
81         struct net_port_vlans *pv;
82         int num_vlan_infos;
83
84         rcu_read_lock();
85         if (br_port_exists(dev))
86                 pv = nbp_get_vlan_info(br_port_get_rcu(dev));
87         else if (dev->priv_flags & IFF_EBRIDGE)
88                 pv = br_get_vlan_info((struct net_bridge *)netdev_priv(dev));
89         else
90                 pv = NULL;
91         if (pv)
92                 num_vlan_infos = br_get_num_vlan_infos(pv, filter_mask);
93         else
94                 num_vlan_infos = 0;
95         rcu_read_unlock();
96
97         if (!num_vlan_infos)
98                 return 0;
99
100         /* Each VLAN is returned in bridge_vlan_info along with flags */
101         return num_vlan_infos * nla_total_size(sizeof(struct bridge_vlan_info));
102 }
103
104 static inline size_t br_port_info_size(void)
105 {
106         return nla_total_size(1)        /* IFLA_BRPORT_STATE  */
107                 + nla_total_size(2)     /* IFLA_BRPORT_PRIORITY */
108                 + nla_total_size(4)     /* IFLA_BRPORT_COST */
109                 + nla_total_size(1)     /* IFLA_BRPORT_MODE */
110                 + nla_total_size(1)     /* IFLA_BRPORT_GUARD */
111                 + nla_total_size(1)     /* IFLA_BRPORT_PROTECT */
112                 + nla_total_size(1)     /* IFLA_BRPORT_FAST_LEAVE */
113                 + nla_total_size(1)     /* IFLA_BRPORT_LEARNING */
114                 + nla_total_size(1)     /* IFLA_BRPORT_UNICAST_FLOOD */
115                 + nla_total_size(1)     /* IFLA_BRPORT_PROXYARP */
116                 + 0;
117 }
118
119 static inline size_t br_nlmsg_size(struct net_device *dev, u32 filter_mask)
120 {
121         return NLMSG_ALIGN(sizeof(struct ifinfomsg))
122                 + nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
123                 + nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
124                 + nla_total_size(4) /* IFLA_MASTER */
125                 + nla_total_size(4) /* IFLA_MTU */
126                 + nla_total_size(4) /* IFLA_LINK */
127                 + nla_total_size(1) /* IFLA_OPERSTATE */
128                 + nla_total_size(br_port_info_size()) /* IFLA_PROTINFO */
129                 + nla_total_size(br_get_link_af_size_filtered(dev,
130                                  filter_mask)); /* IFLA_AF_SPEC */
131 }
132
133 static int br_port_fill_attrs(struct sk_buff *skb,
134                               const struct net_bridge_port *p)
135 {
136         u8 mode = !!(p->flags & BR_HAIRPIN_MODE);
137
138         if (nla_put_u8(skb, IFLA_BRPORT_STATE, p->state) ||
139             nla_put_u16(skb, IFLA_BRPORT_PRIORITY, p->priority) ||
140             nla_put_u32(skb, IFLA_BRPORT_COST, p->path_cost) ||
141             nla_put_u8(skb, IFLA_BRPORT_MODE, mode) ||
142             nla_put_u8(skb, IFLA_BRPORT_GUARD, !!(p->flags & BR_BPDU_GUARD)) ||
143             nla_put_u8(skb, IFLA_BRPORT_PROTECT, !!(p->flags & BR_ROOT_BLOCK)) ||
144             nla_put_u8(skb, IFLA_BRPORT_FAST_LEAVE, !!(p->flags & BR_MULTICAST_FAST_LEAVE)) ||
145             nla_put_u8(skb, IFLA_BRPORT_LEARNING, !!(p->flags & BR_LEARNING)) ||
146             nla_put_u8(skb, IFLA_BRPORT_UNICAST_FLOOD, !!(p->flags & BR_FLOOD)) ||
147             nla_put_u8(skb, IFLA_BRPORT_PROXYARP, !!(p->flags & BR_PROXYARP)) ||
148             nla_put_u8(skb, IFLA_BRPORT_PROXYARP_WIFI,
149                        !!(p->flags & BR_PROXYARP_WIFI)))
150                 return -EMSGSIZE;
151
152         return 0;
153 }
154
155 static int br_fill_ifvlaninfo_range(struct sk_buff *skb, u16 vid_start,
156                                     u16 vid_end, u16 flags)
157 {
158         struct  bridge_vlan_info vinfo;
159
160         if ((vid_end - vid_start) > 0) {
161                 /* add range to skb */
162                 vinfo.vid = vid_start;
163                 vinfo.flags = flags | BRIDGE_VLAN_INFO_RANGE_BEGIN;
164                 if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
165                             sizeof(vinfo), &vinfo))
166                         goto nla_put_failure;
167
168                 vinfo.flags &= ~BRIDGE_VLAN_INFO_RANGE_BEGIN;
169
170                 vinfo.vid = vid_end;
171                 vinfo.flags = flags | BRIDGE_VLAN_INFO_RANGE_END;
172                 if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
173                             sizeof(vinfo), &vinfo))
174                         goto nla_put_failure;
175         } else {
176                 vinfo.vid = vid_start;
177                 vinfo.flags = flags;
178                 if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
179                             sizeof(vinfo), &vinfo))
180                         goto nla_put_failure;
181         }
182
183         return 0;
184
185 nla_put_failure:
186         return -EMSGSIZE;
187 }
188
189 static int br_fill_ifvlaninfo_compressed(struct sk_buff *skb,
190                                          const struct net_port_vlans *pv)
191 {
192         u16 vid_range_start = 0, vid_range_end = 0;
193         u16 vid_range_flags = 0;
194         u16 pvid, vid, flags;
195         int err = 0;
196
197         /* Pack IFLA_BRIDGE_VLAN_INFO's for every vlan
198          * and mark vlan info with begin and end flags
199          * if vlaninfo represents a range
200          */
201         pvid = br_get_pvid(pv);
202         for_each_set_bit(vid, pv->vlan_bitmap, VLAN_N_VID) {
203                 flags = 0;
204                 if (vid == pvid)
205                         flags |= BRIDGE_VLAN_INFO_PVID;
206
207                 if (test_bit(vid, pv->untagged_bitmap))
208                         flags |= BRIDGE_VLAN_INFO_UNTAGGED;
209
210                 if (vid_range_start == 0) {
211                         goto initvars;
212                 } else if ((vid - vid_range_end) == 1 &&
213                         flags == vid_range_flags) {
214                         vid_range_end = vid;
215                         continue;
216                 } else {
217                         err = br_fill_ifvlaninfo_range(skb, vid_range_start,
218                                                        vid_range_end,
219                                                        vid_range_flags);
220                         if (err)
221                                 return err;
222                 }
223
224 initvars:
225                 vid_range_start = vid;
226                 vid_range_end = vid;
227                 vid_range_flags = flags;
228         }
229
230         if (vid_range_start != 0) {
231                 /* Call it once more to send any left over vlans */
232                 err = br_fill_ifvlaninfo_range(skb, vid_range_start,
233                                                vid_range_end,
234                                                vid_range_flags);
235                 if (err)
236                         return err;
237         }
238
239         return 0;
240 }
241
242 static int br_fill_ifvlaninfo(struct sk_buff *skb,
243                               const struct net_port_vlans *pv)
244 {
245         struct bridge_vlan_info vinfo;
246         u16 pvid, vid;
247
248         pvid = br_get_pvid(pv);
249         for_each_set_bit(vid, pv->vlan_bitmap, VLAN_N_VID) {
250                 vinfo.vid = vid;
251                 vinfo.flags = 0;
252                 if (vid == pvid)
253                         vinfo.flags |= BRIDGE_VLAN_INFO_PVID;
254
255                 if (test_bit(vid, pv->untagged_bitmap))
256                         vinfo.flags |= BRIDGE_VLAN_INFO_UNTAGGED;
257
258                 if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
259                             sizeof(vinfo), &vinfo))
260                         goto nla_put_failure;
261         }
262
263         return 0;
264
265 nla_put_failure:
266         return -EMSGSIZE;
267 }
268
269 /*
270  * Create one netlink message for one interface
271  * Contains port and master info as well as carrier and bridge state.
272  */
273 static int br_fill_ifinfo(struct sk_buff *skb,
274                           const struct net_bridge_port *port,
275                           u32 pid, u32 seq, int event, unsigned int flags,
276                           u32 filter_mask, const struct net_device *dev)
277 {
278         const struct net_bridge *br;
279         struct ifinfomsg *hdr;
280         struct nlmsghdr *nlh;
281         u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN;
282
283         if (port)
284                 br = port->br;
285         else
286                 br = netdev_priv(dev);
287
288         br_debug(br, "br_fill_info event %d port %s master %s\n",
289                      event, dev->name, br->dev->name);
290
291         nlh = nlmsg_put(skb, pid, seq, event, sizeof(*hdr), flags);
292         if (nlh == NULL)
293                 return -EMSGSIZE;
294
295         hdr = nlmsg_data(nlh);
296         hdr->ifi_family = AF_BRIDGE;
297         hdr->__ifi_pad = 0;
298         hdr->ifi_type = dev->type;
299         hdr->ifi_index = dev->ifindex;
300         hdr->ifi_flags = dev_get_flags(dev);
301         hdr->ifi_change = 0;
302
303         if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
304             nla_put_u32(skb, IFLA_MASTER, br->dev->ifindex) ||
305             nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
306             nla_put_u8(skb, IFLA_OPERSTATE, operstate) ||
307             (dev->addr_len &&
308              nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) ||
309             (dev->ifindex != dev_get_iflink(dev) &&
310              nla_put_u32(skb, IFLA_LINK, dev_get_iflink(dev))))
311                 goto nla_put_failure;
312
313         if (event == RTM_NEWLINK && port) {
314                 struct nlattr *nest
315                         = nla_nest_start(skb, IFLA_PROTINFO | NLA_F_NESTED);
316
317                 if (nest == NULL || br_port_fill_attrs(skb, port) < 0)
318                         goto nla_put_failure;
319                 nla_nest_end(skb, nest);
320         }
321
322         /* Check if  the VID information is requested */
323         if ((filter_mask & RTEXT_FILTER_BRVLAN) ||
324             (filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED)) {
325                 const struct net_port_vlans *pv;
326                 struct nlattr *af;
327                 int err;
328
329                 if (port)
330                         pv = nbp_get_vlan_info(port);
331                 else
332                         pv = br_get_vlan_info(br);
333
334                 if (!pv || bitmap_empty(pv->vlan_bitmap, VLAN_N_VID))
335                         goto done;
336
337                 af = nla_nest_start(skb, IFLA_AF_SPEC);
338                 if (!af)
339                         goto nla_put_failure;
340
341                 if (filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED)
342                         err = br_fill_ifvlaninfo_compressed(skb, pv);
343                 else
344                         err = br_fill_ifvlaninfo(skb, pv);
345                 if (err)
346                         goto nla_put_failure;
347                 nla_nest_end(skb, af);
348         }
349
350 done:
351         nlmsg_end(skb, nlh);
352         return 0;
353
354 nla_put_failure:
355         nlmsg_cancel(skb, nlh);
356         return -EMSGSIZE;
357 }
358
359 /*
360  * Notify listeners of a change in port information
361  */
362 void br_ifinfo_notify(int event, struct net_bridge_port *port)
363 {
364         struct net *net;
365         struct sk_buff *skb;
366         int err = -ENOBUFS;
367         u32 filter = RTEXT_FILTER_BRVLAN_COMPRESSED;
368
369         if (!port)
370                 return;
371
372         net = dev_net(port->dev);
373         br_debug(port->br, "port %u(%s) event %d\n",
374                  (unsigned int)port->port_no, port->dev->name, event);
375
376         skb = nlmsg_new(br_nlmsg_size(port->dev, filter), GFP_ATOMIC);
377         if (skb == NULL)
378                 goto errout;
379
380         err = br_fill_ifinfo(skb, port, 0, 0, event, 0, filter, port->dev);
381         if (err < 0) {
382                 /* -EMSGSIZE implies BUG in br_nlmsg_size() */
383                 WARN_ON(err == -EMSGSIZE);
384                 kfree_skb(skb);
385                 goto errout;
386         }
387         rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC);
388         return;
389 errout:
390         rtnl_set_sk_err(net, RTNLGRP_LINK, err);
391 }
392
393
394 /*
395  * Dump information about all ports, in response to GETLINK
396  */
397 int br_getlink(struct sk_buff *skb, u32 pid, u32 seq,
398                struct net_device *dev, u32 filter_mask, int nlflags)
399 {
400         struct net_bridge_port *port = br_port_get_rtnl(dev);
401
402         if (!port && !(filter_mask & RTEXT_FILTER_BRVLAN) &&
403             !(filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED))
404                 return 0;
405
406         return br_fill_ifinfo(skb, port, pid, seq, RTM_NEWLINK, nlflags,
407                               filter_mask, dev);
408 }
409
410 static int br_vlan_info(struct net_bridge *br, struct net_bridge_port *p,
411                         int cmd, struct bridge_vlan_info *vinfo)
412 {
413         int err = 0;
414
415         switch (cmd) {
416         case RTM_SETLINK:
417                 if (p) {
418                         err = nbp_vlan_add(p, vinfo->vid, vinfo->flags);
419                         if (err)
420                                 break;
421
422                         if (vinfo->flags & BRIDGE_VLAN_INFO_MASTER)
423                                 err = br_vlan_add(p->br, vinfo->vid,
424                                                   vinfo->flags);
425                 } else {
426                         err = br_vlan_add(br, vinfo->vid, vinfo->flags);
427                 }
428                 break;
429
430         case RTM_DELLINK:
431                 if (p) {
432                         nbp_vlan_delete(p, vinfo->vid);
433                         if (vinfo->flags & BRIDGE_VLAN_INFO_MASTER)
434                                 br_vlan_delete(p->br, vinfo->vid);
435                 } else {
436                         br_vlan_delete(br, vinfo->vid);
437                 }
438                 break;
439         }
440
441         return err;
442 }
443
444 static int br_afspec(struct net_bridge *br,
445                      struct net_bridge_port *p,
446                      struct nlattr *af_spec,
447                      int cmd)
448 {
449         struct bridge_vlan_info *vinfo_start = NULL;
450         struct bridge_vlan_info *vinfo = NULL;
451         struct nlattr *attr;
452         int err = 0;
453         int rem;
454
455         nla_for_each_nested(attr, af_spec, rem) {
456                 if (nla_type(attr) != IFLA_BRIDGE_VLAN_INFO)
457                         continue;
458                 if (nla_len(attr) != sizeof(struct bridge_vlan_info))
459                         return -EINVAL;
460                 vinfo = nla_data(attr);
461                 if (!vinfo->vid || vinfo->vid >= VLAN_VID_MASK)
462                         return -EINVAL;
463                 if (vinfo->flags & BRIDGE_VLAN_INFO_RANGE_BEGIN) {
464                         if (vinfo_start)
465                                 return -EINVAL;
466                         vinfo_start = vinfo;
467                         continue;
468                 }
469
470                 if (vinfo_start) {
471                         struct bridge_vlan_info tmp_vinfo;
472                         int v;
473
474                         if (!(vinfo->flags & BRIDGE_VLAN_INFO_RANGE_END))
475                                 return -EINVAL;
476
477                         if (vinfo->vid <= vinfo_start->vid)
478                                 return -EINVAL;
479
480                         memcpy(&tmp_vinfo, vinfo_start,
481                                sizeof(struct bridge_vlan_info));
482
483                         for (v = vinfo_start->vid; v <= vinfo->vid; v++) {
484                                 tmp_vinfo.vid = v;
485                                 err = br_vlan_info(br, p, cmd, &tmp_vinfo);
486                                 if (err)
487                                         break;
488                         }
489                         vinfo_start = NULL;
490                 } else {
491                         err = br_vlan_info(br, p, cmd, vinfo);
492                 }
493                 if (err)
494                         break;
495         }
496
497         return err;
498 }
499
500 static const struct nla_policy br_port_policy[IFLA_BRPORT_MAX + 1] = {
501         [IFLA_BRPORT_STATE]     = { .type = NLA_U8 },
502         [IFLA_BRPORT_COST]      = { .type = NLA_U32 },
503         [IFLA_BRPORT_PRIORITY]  = { .type = NLA_U16 },
504         [IFLA_BRPORT_MODE]      = { .type = NLA_U8 },
505         [IFLA_BRPORT_GUARD]     = { .type = NLA_U8 },
506         [IFLA_BRPORT_PROTECT]   = { .type = NLA_U8 },
507         [IFLA_BRPORT_FAST_LEAVE]= { .type = NLA_U8 },
508         [IFLA_BRPORT_LEARNING]  = { .type = NLA_U8 },
509         [IFLA_BRPORT_UNICAST_FLOOD] = { .type = NLA_U8 },
510         [IFLA_BRPORT_PROXYARP]  = { .type = NLA_U8 },
511 };
512
513 /* Change the state of the port and notify spanning tree */
514 static int br_set_port_state(struct net_bridge_port *p, u8 state)
515 {
516         if (state > BR_STATE_BLOCKING)
517                 return -EINVAL;
518
519         /* if kernel STP is running, don't allow changes */
520         if (p->br->stp_enabled == BR_KERNEL_STP)
521                 return -EBUSY;
522
523         /* if device is not up, change is not allowed
524          * if link is not present, only allowable state is disabled
525          */
526         if (!netif_running(p->dev) ||
527             (!netif_oper_up(p->dev) && state != BR_STATE_DISABLED))
528                 return -ENETDOWN;
529
530         br_set_state(p, state);
531         br_log_state(p);
532         br_port_state_selection(p->br);
533         return 0;
534 }
535
536 /* Set/clear or port flags based on attribute */
537 static void br_set_port_flag(struct net_bridge_port *p, struct nlattr *tb[],
538                            int attrtype, unsigned long mask)
539 {
540         if (tb[attrtype]) {
541                 u8 flag = nla_get_u8(tb[attrtype]);
542                 if (flag)
543                         p->flags |= mask;
544                 else
545                         p->flags &= ~mask;
546         }
547 }
548
549 /* Process bridge protocol info on port */
550 static int br_setport(struct net_bridge_port *p, struct nlattr *tb[])
551 {
552         int err;
553         unsigned long old_flags = p->flags;
554
555         br_set_port_flag(p, tb, IFLA_BRPORT_MODE, BR_HAIRPIN_MODE);
556         br_set_port_flag(p, tb, IFLA_BRPORT_GUARD, BR_BPDU_GUARD);
557         br_set_port_flag(p, tb, IFLA_BRPORT_FAST_LEAVE, BR_MULTICAST_FAST_LEAVE);
558         br_set_port_flag(p, tb, IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK);
559         br_set_port_flag(p, tb, IFLA_BRPORT_LEARNING, BR_LEARNING);
560         br_set_port_flag(p, tb, IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD);
561         br_set_port_flag(p, tb, IFLA_BRPORT_PROXYARP, BR_PROXYARP);
562         br_set_port_flag(p, tb, IFLA_BRPORT_PROXYARP_WIFI, BR_PROXYARP_WIFI);
563
564         if (tb[IFLA_BRPORT_COST]) {
565                 err = br_stp_set_path_cost(p, nla_get_u32(tb[IFLA_BRPORT_COST]));
566                 if (err)
567                         return err;
568         }
569
570         if (tb[IFLA_BRPORT_PRIORITY]) {
571                 err = br_stp_set_port_priority(p, nla_get_u16(tb[IFLA_BRPORT_PRIORITY]));
572                 if (err)
573                         return err;
574         }
575
576         if (tb[IFLA_BRPORT_STATE]) {
577                 err = br_set_port_state(p, nla_get_u8(tb[IFLA_BRPORT_STATE]));
578                 if (err)
579                         return err;
580         }
581
582         br_port_flags_change(p, old_flags ^ p->flags);
583         return 0;
584 }
585
586 /* Change state and parameters on port. */
587 int br_setlink(struct net_device *dev, struct nlmsghdr *nlh, u16 flags)
588 {
589         struct nlattr *protinfo;
590         struct nlattr *afspec;
591         struct net_bridge_port *p;
592         struct nlattr *tb[IFLA_BRPORT_MAX + 1];
593         int err = 0;
594
595         protinfo = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_PROTINFO);
596         afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
597         if (!protinfo && !afspec)
598                 return 0;
599
600         p = br_port_get_rtnl(dev);
601         /* We want to accept dev as bridge itself if the AF_SPEC
602          * is set to see if someone is setting vlan info on the bridge
603          */
604         if (!p && !afspec)
605                 return -EINVAL;
606
607         if (p && protinfo) {
608                 if (protinfo->nla_type & NLA_F_NESTED) {
609                         err = nla_parse_nested(tb, IFLA_BRPORT_MAX,
610                                                protinfo, br_port_policy);
611                         if (err)
612                                 return err;
613
614                         spin_lock_bh(&p->br->lock);
615                         err = br_setport(p, tb);
616                         spin_unlock_bh(&p->br->lock);
617                 } else {
618                         /* Binary compatibility with old RSTP */
619                         if (nla_len(protinfo) < sizeof(u8))
620                                 return -EINVAL;
621
622                         spin_lock_bh(&p->br->lock);
623                         err = br_set_port_state(p, nla_get_u8(protinfo));
624                         spin_unlock_bh(&p->br->lock);
625                 }
626                 if (err)
627                         goto out;
628         }
629
630         if (afspec) {
631                 err = br_afspec((struct net_bridge *)netdev_priv(dev), p,
632                                 afspec, RTM_SETLINK);
633         }
634
635         if (err == 0)
636                 br_ifinfo_notify(RTM_NEWLINK, p);
637 out:
638         return err;
639 }
640
641 /* Delete port information */
642 int br_dellink(struct net_device *dev, struct nlmsghdr *nlh, u16 flags)
643 {
644         struct nlattr *afspec;
645         struct net_bridge_port *p;
646         int err = 0;
647
648         afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
649         if (!afspec)
650                 return 0;
651
652         p = br_port_get_rtnl(dev);
653         /* We want to accept dev as bridge itself as well */
654         if (!p && !(dev->priv_flags & IFF_EBRIDGE))
655                 return -EINVAL;
656
657         err = br_afspec((struct net_bridge *)netdev_priv(dev), p,
658                         afspec, RTM_DELLINK);
659         if (err == 0)
660                 /* Send RTM_NEWLINK because userspace
661                  * expects RTM_NEWLINK for vlan dels
662                  */
663                 br_ifinfo_notify(RTM_NEWLINK, p);
664
665         return err;
666 }
667 static int br_validate(struct nlattr *tb[], struct nlattr *data[])
668 {
669         if (tb[IFLA_ADDRESS]) {
670                 if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
671                         return -EINVAL;
672                 if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
673                         return -EADDRNOTAVAIL;
674         }
675
676         return 0;
677 }
678
679 static int br_dev_newlink(struct net *src_net, struct net_device *dev,
680                           struct nlattr *tb[], struct nlattr *data[])
681 {
682         struct net_bridge *br = netdev_priv(dev);
683
684         if (tb[IFLA_ADDRESS]) {
685                 spin_lock_bh(&br->lock);
686                 br_stp_change_bridge_id(br, nla_data(tb[IFLA_ADDRESS]));
687                 spin_unlock_bh(&br->lock);
688         }
689
690         return register_netdevice(dev);
691 }
692
693 static int br_port_slave_changelink(struct net_device *brdev,
694                                     struct net_device *dev,
695                                     struct nlattr *tb[],
696                                     struct nlattr *data[])
697 {
698         struct net_bridge *br = netdev_priv(brdev);
699         int ret;
700
701         if (!data)
702                 return 0;
703
704         spin_lock_bh(&br->lock);
705         ret = br_setport(br_port_get_rtnl(dev), data);
706         spin_unlock_bh(&br->lock);
707
708         return ret;
709 }
710
711 static int br_port_fill_slave_info(struct sk_buff *skb,
712                                    const struct net_device *brdev,
713                                    const struct net_device *dev)
714 {
715         return br_port_fill_attrs(skb, br_port_get_rtnl(dev));
716 }
717
718 static size_t br_port_get_slave_size(const struct net_device *brdev,
719                                      const struct net_device *dev)
720 {
721         return br_port_info_size();
722 }
723
724 static const struct nla_policy br_policy[IFLA_BR_MAX + 1] = {
725         [IFLA_BR_FORWARD_DELAY] = { .type = NLA_U32 },
726         [IFLA_BR_HELLO_TIME]    = { .type = NLA_U32 },
727         [IFLA_BR_MAX_AGE]       = { .type = NLA_U32 },
728         [IFLA_BR_AGEING_TIME] = { .type = NLA_U32 },
729         [IFLA_BR_STP_STATE] = { .type = NLA_U32 },
730         [IFLA_BR_PRIORITY] = { .type = NLA_U16 },
731 };
732
733 static int br_changelink(struct net_device *brdev, struct nlattr *tb[],
734                          struct nlattr *data[])
735 {
736         struct net_bridge *br = netdev_priv(brdev);
737         int err;
738
739         if (!data)
740                 return 0;
741
742         if (data[IFLA_BR_FORWARD_DELAY]) {
743                 err = br_set_forward_delay(br, nla_get_u32(data[IFLA_BR_FORWARD_DELAY]));
744                 if (err)
745                         return err;
746         }
747
748         if (data[IFLA_BR_HELLO_TIME]) {
749                 err = br_set_hello_time(br, nla_get_u32(data[IFLA_BR_HELLO_TIME]));
750                 if (err)
751                         return err;
752         }
753
754         if (data[IFLA_BR_MAX_AGE]) {
755                 err = br_set_max_age(br, nla_get_u32(data[IFLA_BR_MAX_AGE]));
756                 if (err)
757                         return err;
758         }
759
760         if (data[IFLA_BR_AGEING_TIME]) {
761                 u32 ageing_time = nla_get_u32(data[IFLA_BR_AGEING_TIME]);
762
763                 br->ageing_time = clock_t_to_jiffies(ageing_time);
764         }
765
766         if (data[IFLA_BR_STP_STATE]) {
767                 u32 stp_enabled = nla_get_u32(data[IFLA_BR_STP_STATE]);
768
769                 br_stp_set_enabled(br, stp_enabled);
770         }
771
772         if (data[IFLA_BR_PRIORITY]) {
773                 u32 priority = nla_get_u16(data[IFLA_BR_PRIORITY]);
774
775                 br_stp_set_bridge_priority(br, priority);
776         }
777
778         return 0;
779 }
780
781 static size_t br_get_size(const struct net_device *brdev)
782 {
783         return nla_total_size(sizeof(u32)) +    /* IFLA_BR_FORWARD_DELAY  */
784                nla_total_size(sizeof(u32)) +    /* IFLA_BR_HELLO_TIME */
785                nla_total_size(sizeof(u32)) +    /* IFLA_BR_MAX_AGE */
786                nla_total_size(sizeof(u32)) +    /* IFLA_BR_AGEING_TIME */
787                nla_total_size(sizeof(u32)) +    /* IFLA_BR_STP_STATE */
788                nla_total_size(sizeof(u16)) +    /* IFLA_BR_PRIORITY */
789                0;
790 }
791
792 static int br_fill_info(struct sk_buff *skb, const struct net_device *brdev)
793 {
794         struct net_bridge *br = netdev_priv(brdev);
795         u32 forward_delay = jiffies_to_clock_t(br->forward_delay);
796         u32 hello_time = jiffies_to_clock_t(br->hello_time);
797         u32 age_time = jiffies_to_clock_t(br->max_age);
798         u32 ageing_time = jiffies_to_clock_t(br->ageing_time);
799         u32 stp_enabled = br->stp_enabled;
800         u16 priority = (br->bridge_id.prio[0] << 8) | br->bridge_id.prio[1];
801
802         if (nla_put_u32(skb, IFLA_BR_FORWARD_DELAY, forward_delay) ||
803             nla_put_u32(skb, IFLA_BR_HELLO_TIME, hello_time) ||
804             nla_put_u32(skb, IFLA_BR_MAX_AGE, age_time) ||
805             nla_put_u32(skb, IFLA_BR_AGEING_TIME, ageing_time) ||
806             nla_put_u32(skb, IFLA_BR_STP_STATE, stp_enabled) ||
807             nla_put_u16(skb, IFLA_BR_PRIORITY, priority))
808                 return -EMSGSIZE;
809
810         return 0;
811 }
812
813 static size_t br_get_link_af_size(const struct net_device *dev)
814 {
815         struct net_port_vlans *pv;
816
817         if (br_port_exists(dev))
818                 pv = nbp_get_vlan_info(br_port_get_rtnl(dev));
819         else if (dev->priv_flags & IFF_EBRIDGE)
820                 pv = br_get_vlan_info((struct net_bridge *)netdev_priv(dev));
821         else
822                 return 0;
823
824         if (!pv)
825                 return 0;
826
827         /* Each VLAN is returned in bridge_vlan_info along with flags */
828         return pv->num_vlans * nla_total_size(sizeof(struct bridge_vlan_info));
829 }
830
831 static struct rtnl_af_ops br_af_ops __read_mostly = {
832         .family                 = AF_BRIDGE,
833         .get_link_af_size       = br_get_link_af_size,
834 };
835
836 struct rtnl_link_ops br_link_ops __read_mostly = {
837         .kind                   = "bridge",
838         .priv_size              = sizeof(struct net_bridge),
839         .setup                  = br_dev_setup,
840         .maxtype                = IFLA_BRPORT_MAX,
841         .policy                 = br_policy,
842         .validate               = br_validate,
843         .newlink                = br_dev_newlink,
844         .changelink             = br_changelink,
845         .dellink                = br_dev_delete,
846         .get_size               = br_get_size,
847         .fill_info              = br_fill_info,
848
849         .slave_maxtype          = IFLA_BRPORT_MAX,
850         .slave_policy           = br_port_policy,
851         .slave_changelink       = br_port_slave_changelink,
852         .get_slave_size         = br_port_get_slave_size,
853         .fill_slave_info        = br_port_fill_slave_info,
854 };
855
856 int __init br_netlink_init(void)
857 {
858         int err;
859
860         br_mdb_init();
861         rtnl_af_register(&br_af_ops);
862
863         err = rtnl_link_register(&br_link_ops);
864         if (err)
865                 goto out_af;
866
867         return 0;
868
869 out_af:
870         rtnl_af_unregister(&br_af_ops);
871         br_mdb_uninit();
872         return err;
873 }
874
875 void br_netlink_fini(void)
876 {
877         br_mdb_uninit();
878         rtnl_af_unregister(&br_af_ops);
879         rtnl_link_unregister(&br_link_ops);
880 }