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