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->vid || vinfo->vid >= VLAN_VID_MASK)
 461                         return -EINVAL;
 462                 if (vinfo->flags & BRIDGE_VLAN_INFO_RANGE_BEGIN) {
 463                         if (vinfo_start)
 464                                 return -EINVAL;
 465                         vinfo_start = vinfo;
 466                         continue;
 467                 }
 468
 469                 if (vinfo_start) {
 470                         struct bridge_vlan_info tmp_vinfo;
 471                         int v;
 472
 473                         if (!(vinfo->flags & BRIDGE_VLAN_INFO_RANGE_END))
 474                                 return -EINVAL;
 475
 476                         if (vinfo->vid <= vinfo_start->vid)
 477                                 return -EINVAL;
 478
 479                         memcpy(&tmp_vinfo, vinfo_start,
 480                                sizeof(struct bridge_vlan_info));
 481
 482                         for (v = vinfo_start->vid; v <= vinfo->vid; v++) {
 483                                 tmp_vinfo.vid = v;
 484                                 err = br_vlan_info(br, p, cmd, &tmp_vinfo);
 485                                 if (err)
 486                                         break;
 487                         }
 488                         vinfo_start = NULL;
 489                 } else {
 490                         err = br_vlan_info(br, p, cmd, vinfo);
 491                 }
 492                 if (err)
 493                         break;
 494         }
 495
 496         return err;
 497 }
 498
 499 static const struct nla_policy br_port_policy[IFLA_BRPORT_MAX + 1] = {
 500         [IFLA_BRPORT_STATE]     = { .type = NLA_U8 },
 501         [IFLA_BRPORT_COST]      = { .type = NLA_U32 },
 502         [IFLA_BRPORT_PRIORITY]  = { .type = NLA_U16 },
 503         [IFLA_BRPORT_MODE]      = { .type = NLA_U8 },
 504         [IFLA_BRPORT_GUARD]     = { .type = NLA_U8 },
 505         [IFLA_BRPORT_PROTECT]   = { .type = NLA_U8 },
 506         [IFLA_BRPORT_FAST_LEAVE]= { .type = NLA_U8 },
 507         [IFLA_BRPORT_LEARNING]  = { .type = NLA_U8 },
 508         [IFLA_BRPORT_UNICAST_FLOOD] = { .type = NLA_U8 },
 509 };
 510
 511 /* Change the state of the port and notify spanning tree */
 512 static int br_set_port_state(struct net_bridge_port *p, u8 state)
 513 {
 514         if (state > BR_STATE_BLOCKING)
 515                 return -EINVAL;
 516
 517         /* if kernel STP is running, don't allow changes */
 518         if (p->br->stp_enabled == BR_KERNEL_STP)
 519                 return -EBUSY;
 520
 521         /* if device is not up, change is not allowed
 522          * if link is not present, only allowable state is disabled
 523          */
 524         if (!netif_running(p->dev) ||
 525             (!netif_oper_up(p->dev) && state != BR_STATE_DISABLED))
 526                 return -ENETDOWN;
 527
 528         br_set_state(p, state);
 529         br_log_state(p);
 530         br_port_state_selection(p->br);
 531         return 0;
 532 }
 533
 534 /* Set/clear or port flags based on attribute */
 535 static void br_set_port_flag(struct net_bridge_port *p, struct nlattr *tb[],
 536                            int attrtype, unsigned long mask)
 537 {
 538         if (tb[attrtype]) {
 539                 u8 flag = nla_get_u8(tb[attrtype]);
 540                 if (flag)
 541                         p->flags |= mask;
 542                 else
 543                         p->flags &= ~mask;
 544         }
 545 }
 546
 547 /* Process bridge protocol info on port */
 548 static int br_setport(struct net_bridge_port *p, struct nlattr *tb[])
 549 {
 550         int err;
 551         unsigned long old_flags = p->flags;
 552
 553         br_set_port_flag(p, tb, IFLA_BRPORT_MODE, BR_HAIRPIN_MODE);
 554         br_set_port_flag(p, tb, IFLA_BRPORT_GUARD, BR_BPDU_GUARD);
 555         br_set_port_flag(p, tb, IFLA_BRPORT_FAST_LEAVE, BR_MULTICAST_FAST_LEAVE);
 556         br_set_port_flag(p, tb, IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK);
 557         br_set_port_flag(p, tb, IFLA_BRPORT_LEARNING, BR_LEARNING);
 558         br_set_port_flag(p, tb, IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD);
 559         br_set_port_flag(p, tb, IFLA_BRPORT_PROXYARP, BR_PROXYARP);
 560         br_set_port_flag(p, tb, IFLA_BRPORT_PROXYARP_WIFI, BR_PROXYARP_WIFI);
 561
 562         if (tb[IFLA_BRPORT_COST]) {
 563                 err = br_stp_set_path_cost(p, nla_get_u32(tb[IFLA_BRPORT_COST]));
 564                 if (err)
 565                         return err;
 566         }
 567
 568         if (tb[IFLA_BRPORT_PRIORITY]) {
 569                 err = br_stp_set_port_priority(p, nla_get_u16(tb[IFLA_BRPORT_PRIORITY]));
 570                 if (err)
 571                         return err;
 572         }
 573
 574         if (tb[IFLA_BRPORT_STATE]) {
 575                 err = br_set_port_state(p, nla_get_u8(tb[IFLA_BRPORT_STATE]));
 576                 if (err)
 577                         return err;
 578         }
 579
 580         br_port_flags_change(p, old_flags ^ p->flags);
 581         return 0;
 582 }
 583
 584 /* Change state and parameters on port. */
 585 int br_setlink(struct net_device *dev, struct nlmsghdr *nlh, u16 flags)
 586 {
 587         struct nlattr *protinfo;
 588         struct nlattr *afspec;
 589         struct net_bridge_port *p;
 590         struct nlattr *tb[IFLA_BRPORT_MAX + 1];
 591         int err = 0;
 592
 593         protinfo = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_PROTINFO);
 594         afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
 595         if (!protinfo && !afspec)
 596                 return 0;
 597
 598         p = br_port_get_rtnl(dev);
 599         /* We want to accept dev as bridge itself if the AF_SPEC
 600          * is set to see if someone is setting vlan info on the bridge
 601          */
 602         if (!p && !afspec)
 603                 return -EINVAL;
 604
 605         if (p && protinfo) {
 606                 if (protinfo->nla_type & NLA_F_NESTED) {
 607                         err = nla_parse_nested(tb, IFLA_BRPORT_MAX,
 608                                                protinfo, br_port_policy);
 609                         if (err)
 610                                 return err;
 611
 612                         spin_lock_bh(&p->br->lock);
 613                         err = br_setport(p, tb);
 614                         spin_unlock_bh(&p->br->lock);
 615                 } else {
 616                         /* Binary compatibility with old RSTP */
 617                         if (nla_len(protinfo) < sizeof(u8))
 618                                 return -EINVAL;
 619
 620                         spin_lock_bh(&p->br->lock);
 621                         err = br_set_port_state(p, nla_get_u8(protinfo));
 622                         spin_unlock_bh(&p->br->lock);
 623                 }
 624                 if (err)
 625                         goto out;
 626         }
 627
 628         if (afspec) {
 629                 err = br_afspec((struct net_bridge *)netdev_priv(dev), p,
 630                                 afspec, RTM_SETLINK);
 631         }
 632
 633         if (err == 0)
 634                 br_ifinfo_notify(RTM_NEWLINK, p);
 635 out:
 636         return err;
 637 }
 638
 639 /* Delete port information */
 640 int br_dellink(struct net_device *dev, struct nlmsghdr *nlh, u16 flags)
 641 {
 642         struct nlattr *afspec;
 643         struct net_bridge_port *p;
 644         int err = 0;
 645
 646         afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
 647         if (!afspec)
 648                 return 0;
 649
 650         p = br_port_get_rtnl(dev);
 651         /* We want to accept dev as bridge itself as well */
 652         if (!p && !(dev->priv_flags & IFF_EBRIDGE))
 653                 return -EINVAL;
 654
 655         err = br_afspec((struct net_bridge *)netdev_priv(dev), p,
 656                         afspec, RTM_DELLINK);
 657         if (err == 0)
 658                 /* Send RTM_NEWLINK because userspace
 659                  * expects RTM_NEWLINK for vlan dels
 660                  */
 661                 br_ifinfo_notify(RTM_NEWLINK, p);
 662
 663         return err;
 664 }
 665 static int br_validate(struct nlattr *tb[], struct nlattr *data[])
 666 {
 667         if (tb[IFLA_ADDRESS]) {
 668                 if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
 669                         return -EINVAL;
 670                 if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
 671                         return -EADDRNOTAVAIL;
 672         }
 673
 674         return 0;
 675 }
 676
 677 static int br_dev_newlink(struct net *src_net, struct net_device *dev,
 678                           struct nlattr *tb[], struct nlattr *data[])
 679 {
 680         struct net_bridge *br = netdev_priv(dev);
 681
 682         if (tb[IFLA_ADDRESS]) {
 683                 spin_lock_bh(&br->lock);
 684                 br_stp_change_bridge_id(br, nla_data(tb[IFLA_ADDRESS]));
 685                 spin_unlock_bh(&br->lock);
 686         }
 687
 688         return register_netdevice(dev);
 689 }
 690
 691 static int br_port_slave_changelink(struct net_device *brdev,
 692                                     struct net_device *dev,
 693                                     struct nlattr *tb[],
 694                                     struct nlattr *data[])
 695 {
 696         if (!data)
 697                 return 0;
 698         return br_setport(br_port_get_rtnl(dev), data);
 699 }
 700
 701 static int br_port_fill_slave_info(struct sk_buff *skb,
 702                                    const struct net_device *brdev,
 703                                    const struct net_device *dev)
 704 {
 705         return br_port_fill_attrs(skb, br_port_get_rtnl(dev));
 706 }
 707
 708 static size_t br_port_get_slave_size(const struct net_device *brdev,
 709                                      const struct net_device *dev)
 710 {
 711         return br_port_info_size();
 712 }
 713
 714 static const struct nla_policy br_policy[IFLA_BR_MAX + 1] = {
 715         [IFLA_BR_FORWARD_DELAY] = { .type = NLA_U32 },
 716         [IFLA_BR_HELLO_TIME]    = { .type = NLA_U32 },
 717         [IFLA_BR_MAX_AGE]       = { .type = NLA_U32 },
 718         [IFLA_BR_AGEING_TIME] = { .type = NLA_U32 },
 719         [IFLA_BR_STP_STATE] = { .type = NLA_U32 },
 720         [IFLA_BR_PRIORITY] = { .type = NLA_U16 },
 721 };
 722
 723 static int br_changelink(struct net_device *brdev, struct nlattr *tb[],
 724                          struct nlattr *data[])
 725 {
 726         struct net_bridge *br = netdev_priv(brdev);
 727         int err;
 728
 729         if (!data)
 730                 return 0;
 731
 732         if (data[IFLA_BR_FORWARD_DELAY]) {
 733                 err = br_set_forward_delay(br, nla_get_u32(data[IFLA_BR_FORWARD_DELAY]));
 734                 if (err)
 735                         return err;
 736         }
 737
 738         if (data[IFLA_BR_HELLO_TIME]) {
 739                 err = br_set_hello_time(br, nla_get_u32(data[IFLA_BR_HELLO_TIME]));
 740                 if (err)
 741                         return err;
 742         }
 743
 744         if (data[IFLA_BR_MAX_AGE]) {
 745                 err = br_set_max_age(br, nla_get_u32(data[IFLA_BR_MAX_AGE]));
 746                 if (err)
 747                         return err;
 748         }
 749
 750         if (data[IFLA_BR_AGEING_TIME]) {
 751                 u32 ageing_time = nla_get_u32(data[IFLA_BR_AGEING_TIME]);
 752
 753                 br->ageing_time = clock_t_to_jiffies(ageing_time);
 754         }
 755
 756         if (data[IFLA_BR_STP_STATE]) {
 757                 u32 stp_enabled = nla_get_u32(data[IFLA_BR_STP_STATE]);
 758
 759                 br_stp_set_enabled(br, stp_enabled);
 760         }
 761
 762         if (data[IFLA_BR_PRIORITY]) {
 763                 u32 priority = nla_get_u16(data[IFLA_BR_PRIORITY]);
 764
 765                 br_stp_set_bridge_priority(br, priority);
 766         }
 767
 768         return 0;
 769 }
 770
 771 static size_t br_get_size(const struct net_device *brdev)
 772 {
 773         return nla_total_size(sizeof(u32)) +    /* IFLA_BR_FORWARD_DELAY  */
 774                nla_total_size(sizeof(u32)) +    /* IFLA_BR_HELLO_TIME */
 775                nla_total_size(sizeof(u32)) +    /* IFLA_BR_MAX_AGE */
 776                nla_total_size(sizeof(u32)) +    /* IFLA_BR_AGEING_TIME */
 777                nla_total_size(sizeof(u32)) +    /* IFLA_BR_STP_STATE */
 778                nla_total_size(sizeof(u16)) +    /* IFLA_BR_PRIORITY */
 779                0;
 780 }
 781
 782 static int br_fill_info(struct sk_buff *skb, const struct net_device *brdev)
 783 {
 784         struct net_bridge *br = netdev_priv(brdev);
 785         u32 forward_delay = jiffies_to_clock_t(br->forward_delay);
 786         u32 hello_time = jiffies_to_clock_t(br->hello_time);
 787         u32 age_time = jiffies_to_clock_t(br->max_age);
 788         u32 ageing_time = jiffies_to_clock_t(br->ageing_time);
 789         u32 stp_enabled = br->stp_enabled;
 790         u16 priority = (br->bridge_id.prio[0] << 8) | br->bridge_id.prio[1];
 791
 792         if (nla_put_u32(skb, IFLA_BR_FORWARD_DELAY, forward_delay) ||
 793             nla_put_u32(skb, IFLA_BR_HELLO_TIME, hello_time) ||
 794             nla_put_u32(skb, IFLA_BR_MAX_AGE, age_time) ||
 795             nla_put_u32(skb, IFLA_BR_AGEING_TIME, ageing_time) ||
 796             nla_put_u32(skb, IFLA_BR_STP_STATE, stp_enabled) ||
 797             nla_put_u16(skb, IFLA_BR_PRIORITY, priority))
 798                 return -EMSGSIZE;
 799
 800         return 0;
 801 }
 802
 803 static size_t br_get_link_af_size(const struct net_device *dev)
 804 {
 805         struct net_port_vlans *pv;
 806
 807         if (br_port_exists(dev))
 808                 pv = nbp_get_vlan_info(br_port_get_rtnl(dev));
 809         else if (dev->priv_flags & IFF_EBRIDGE)
 810                 pv = br_get_vlan_info((struct net_bridge *)netdev_priv(dev));
 811         else
 812                 return 0;
 813
 814         if (!pv)
 815                 return 0;
 816
 817         /* Each VLAN is returned in bridge_vlan_info along with flags */
 818         return pv->num_vlans * nla_total_size(sizeof(struct bridge_vlan_info));
 819 }
 820
 821 static struct rtnl_af_ops br_af_ops __read_mostly = {
 822         .family                 = AF_BRIDGE,
 823         .get_link_af_size       = br_get_link_af_size,
 824 };
 825
 826 struct rtnl_link_ops br_link_ops __read_mostly = {
 827         .kind                   = "bridge",
 828         .priv_size              = sizeof(struct net_bridge),
 829         .setup                  = br_dev_setup,
 830         .maxtype                = IFLA_BRPORT_MAX,
 831         .policy                 = br_policy,
 832         .validate               = br_validate,
 833         .newlink                = br_dev_newlink,
 834         .changelink             = br_changelink,
 835         .dellink                = br_dev_delete,
 836         .get_size               = br_get_size,
 837         .fill_info              = br_fill_info,
 838
 839         .slave_maxtype          = IFLA_BRPORT_MAX,
 840         .slave_policy           = br_port_policy,
 841         .slave_changelink       = br_port_slave_changelink,
 842         .get_slave_size         = br_port_get_slave_size,
 843         .fill_slave_info        = br_port_fill_slave_info,
 844 };
 845
 846 int __init br_netlink_init(void)
 847 {
 848         int err;
 849
 850         br_mdb_init();
 851         rtnl_af_register(&br_af_ops);
 852
 853         err = rtnl_link_register(&br_link_ops);
 854         if (err)
 855                 goto out_af;
 856
 857         return 0;
 858
 859 out_af:
 860         rtnl_af_unregister(&br_af_ops);
 861         br_mdb_uninit();
 862         return err;
 863 }
 864
 865 void br_netlink_fini(void)
 866 {
 867         br_mdb_uninit();
 868         rtnl_af_unregister(&br_af_ops);
 869         rtnl_link_unregister(&br_link_ops);
 870 }