bridge.c

   1 /*
   2  * netifd - network interface daemon
   3  * Copyright (C) 2012 Felix Fietkau <nbd@openwrt.org>
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License version 2
   7  * as published by the Free Software Foundation
   8  *
   9  * This program is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  */
  14 #include <string.h>
  15 #include <stdlib.h>
  16 #include <stdio.h>
  17 #include <assert.h>
  18 #include <errno.h>
  19
  20 #include "netifd.h"
  21 #include "device.h"
  22 #include "interface.h"
  23 #include "system.h"
  24 #include "ubus.h"
  25
  26 enum {
  27         BRIDGE_ATTR_PORTS,
  28         BRIDGE_ATTR_STP,
  29         BRIDGE_ATTR_FORWARD_DELAY,
  30         BRIDGE_ATTR_PRIORITY,
  31         BRIDGE_ATTR_IGMP_SNOOP,
  32         BRIDGE_ATTR_AGEING_TIME,
  33         BRIDGE_ATTR_HELLO_TIME,
  34         BRIDGE_ATTR_MAX_AGE,
  35         BRIDGE_ATTR_BRIDGE_EMPTY,
  36         BRIDGE_ATTR_MULTICAST_QUERIER,
  37         BRIDGE_ATTR_HASH_MAX,
  38         BRIDGE_ATTR_ROBUSTNESS,
  39         BRIDGE_ATTR_QUERY_INTERVAL,
  40         BRIDGE_ATTR_QUERY_RESPONSE_INTERVAL,
  41         BRIDGE_ATTR_LAST_MEMBER_INTERVAL,
  42         BRIDGE_ATTR_VLAN_FILTERING,
  43         BRIDGE_ATTR_HAS_VLANS,
  44         BRIDGE_ATTR_STP_KERNEL,
  45         BRIDGE_ATTR_STP_PROTO,
  46         __BRIDGE_ATTR_MAX
  47 };
  48
  49 static const struct blobmsg_policy bridge_attrs[__BRIDGE_ATTR_MAX] = {
  50         [BRIDGE_ATTR_PORTS] = { "ports", BLOBMSG_TYPE_ARRAY },
  51         [BRIDGE_ATTR_STP] = { "stp", BLOBMSG_TYPE_BOOL },
  52         [BRIDGE_ATTR_FORWARD_DELAY] = { "forward_delay", BLOBMSG_TYPE_INT32 },
  53         [BRIDGE_ATTR_PRIORITY] = { "priority", BLOBMSG_TYPE_INT32 },
  54         [BRIDGE_ATTR_AGEING_TIME] = { "ageing_time", BLOBMSG_TYPE_INT32 },
  55         [BRIDGE_ATTR_HELLO_TIME] = { "hello_time", BLOBMSG_TYPE_INT32 },
  56         [BRIDGE_ATTR_MAX_AGE] = { "max_age", BLOBMSG_TYPE_INT32 },
  57         [BRIDGE_ATTR_IGMP_SNOOP] = { "igmp_snooping", BLOBMSG_TYPE_BOOL },
  58         [BRIDGE_ATTR_BRIDGE_EMPTY] = { "bridge_empty", BLOBMSG_TYPE_BOOL },
  59         [BRIDGE_ATTR_MULTICAST_QUERIER] = { "multicast_querier", BLOBMSG_TYPE_BOOL },
  60         [BRIDGE_ATTR_HASH_MAX] = { "hash_max", BLOBMSG_TYPE_INT32 },
  61         [BRIDGE_ATTR_ROBUSTNESS] = { "robustness", BLOBMSG_TYPE_INT32 },
  62         [BRIDGE_ATTR_QUERY_INTERVAL] = { "query_interval", BLOBMSG_TYPE_INT32 },
  63         [BRIDGE_ATTR_QUERY_RESPONSE_INTERVAL] = { "query_response_interval", BLOBMSG_TYPE_INT32 },
  64         [BRIDGE_ATTR_LAST_MEMBER_INTERVAL] = { "last_member_interval", BLOBMSG_TYPE_INT32 },
  65         [BRIDGE_ATTR_VLAN_FILTERING] = { "vlan_filtering", BLOBMSG_TYPE_BOOL },
  66         [BRIDGE_ATTR_HAS_VLANS] = { "__has_vlans", BLOBMSG_TYPE_BOOL }, /* internal */
  67         [BRIDGE_ATTR_STP_KERNEL] = { "stp_kernel", BLOBMSG_TYPE_BOOL },
  68         [BRIDGE_ATTR_STP_PROTO] = { "stp_proto", BLOBMSG_TYPE_STRING },
  69 };
  70
  71 static const struct uci_blob_param_info bridge_attr_info[__BRIDGE_ATTR_MAX] = {
  72         [BRIDGE_ATTR_PORTS] = { .type = BLOBMSG_TYPE_STRING },
  73 };
  74
  75 static const struct uci_blob_param_list bridge_attr_list = {
  76         .n_params = __BRIDGE_ATTR_MAX,
  77         .params = bridge_attrs,
  78         .info = bridge_attr_info,
  79
  80         .n_next = 1,
  81         .next = { &device_attr_list },
  82 };
  83
  84 static struct blob_buf b;
  85 static struct device *bridge_create(const char *name, struct device_type *devtype,
  86         struct blob_attr *attr);
  87 static void bridge_config_init(struct device *dev);
  88 static void bridge_dev_vlan_update(struct device *dev);
  89 static void bridge_free(struct device *dev);
  90 static void bridge_stp_init(struct device *dev);
  91 static void bridge_dump_info(struct device *dev, struct blob_buf *b);
  92 static enum dev_change_type
  93 bridge_reload(struct device *dev, struct blob_attr *attr);
  94
  95 static struct device_type bridge_device_type = {
  96         .name = "bridge",
  97         .config_params = &bridge_attr_list,
  98
  99         .bridge_capability = true,
 100         .name_prefix = "br",
 101
 102         .create = bridge_create,
 103         .config_init = bridge_config_init,
 104         .vlan_update = bridge_dev_vlan_update,
 105         .reload = bridge_reload,
 106         .free = bridge_free,
 107         .dump_info = bridge_dump_info,
 108         .stp_init = bridge_stp_init,
 109 };
 110
 111 struct bridge_state {
 112         struct device dev;
 113         device_state_cb set_state;
 114
 115         struct blob_attr *config_data;
 116         struct bridge_config config;
 117         struct blob_attr *ports;
 118         bool active;
 119         bool force_active;
 120         bool has_vlans;
 121
 122         struct uloop_timeout retry;
 123         struct bridge_member *primary_port;
 124         struct vlist_tree members;
 125         int n_present;
 126         int n_failed;
 127 };
 128
 129 struct bridge_member {
 130         struct vlist_node node;
 131         struct bridge_state *bst;
 132         struct device_user dev;
 133         struct uloop_timeout check_timer;
 134         struct device_vlan_range *extra_vlan;
 135         int n_extra_vlan;
 136         uint16_t pvid;
 137         bool present;
 138         bool active;
 139         char name[];
 140 };
 141
 142 static void
 143 bridge_reset_primary(struct bridge_state *bst)
 144 {
 145         struct bridge_member *bm;
 146
 147         if (!bst->primary_port &&
 148             (bst->dev.settings.flags & DEV_OPT_MACADDR))
 149                 return;
 150
 151         bst->primary_port = NULL;
 152         bst->dev.settings.flags &= ~DEV_OPT_MACADDR;
 153         vlist_for_each_element(&bst->members, bm, node) {
 154                 uint8_t *macaddr;
 155
 156                 if (!bm->present)
 157                         continue;
 158
 159                 bst->primary_port = bm;
 160                 if (bm->dev.dev->settings.flags & DEV_OPT_MACADDR)
 161                         macaddr = bm->dev.dev->settings.macaddr;
 162                 else
 163                         macaddr = bm->dev.dev->orig_settings.macaddr;
 164                 memcpy(bst->dev.settings.macaddr, macaddr, 6);
 165                 bst->dev.settings.flags |= DEV_OPT_MACADDR;
 166                 return;
 167         }
 168 }
 169
 170 static struct bridge_vlan_port *
 171 bridge_find_vlan_member_port(struct bridge_member *bm, struct bridge_vlan *vlan)
 172 {
 173         struct bridge_vlan_hotplug_port *port;
 174         const char *ifname = bm->dev.dev->ifname;
 175         int i;
 176
 177         for (i = 0; i < vlan->n_ports; i++) {
 178                 if (strcmp(vlan->ports[i].ifname, ifname) != 0)
 179                         continue;
 180
 181                 return &vlan->ports[i];
 182         }
 183
 184         list_for_each_entry(port, &vlan->hotplug_ports, list) {
 185                 if (strcmp(port->port.ifname, ifname) != 0)
 186                         continue;
 187
 188                 return &port->port;
 189         }
 190
 191         return NULL;
 192 }
 193
 194 static bool
 195 bridge_member_vlan_is_pvid(struct bridge_member *bm, struct bridge_vlan_port *port)
 196 {
 197         return (!bm->pvid && (port->flags & BRVLAN_F_UNTAGGED)) ||
 198                (port->flags & BRVLAN_F_PVID);
 199 }
 200
 201 static void
 202 __bridge_set_member_vlan(struct bridge_member *bm, struct bridge_vlan *vlan,
 203                          struct bridge_vlan_port *port, bool add)
 204 {
 205         uint16_t flags;
 206
 207         flags = port->flags;
 208         if (bm->pvid == vlan->vid)
 209                 flags |= BRVLAN_F_PVID;
 210
 211         system_bridge_vlan(port->ifname, vlan->vid, -1, add, flags);
 212 }
 213
 214 static void
 215 bridge_set_member_vlan(struct bridge_member *bm, struct bridge_vlan *vlan, bool add)
 216 {
 217         struct bridge_vlan_port *port;
 218
 219         if (!bm->present)
 220                 return;
 221
 222         port = bridge_find_vlan_member_port(bm, vlan);
 223         if (!port)
 224                 return;
 225
 226         if (bridge_member_vlan_is_pvid(bm, port))
 227                 bm->pvid = vlan->vid;
 228
 229         __bridge_set_member_vlan(bm, vlan, port, add);
 230 }
 231
 232 static void
 233 bridge_set_local_vlan(struct bridge_state *bst, struct bridge_vlan *vlan, bool add)
 234 {
 235         if (!vlan->local && add)
 236                 return;
 237
 238         system_bridge_vlan(bst->dev.ifname, vlan->vid, -1, add, BRVLAN_F_SELF);
 239 }
 240
 241 static void
 242 bridge_set_local_vlans(struct bridge_state *bst, bool add)
 243 {
 244         struct bridge_vlan *vlan;
 245
 246         vlist_for_each_element(&bst->dev.vlans, vlan, node)
 247                 bridge_set_local_vlan(bst, vlan, add);
 248 }
 249
 250 static struct bridge_vlan *
 251 bridge_recalc_member_pvid(struct bridge_member *bm)
 252 {
 253         struct bridge_state *bst = bm->bst;
 254         struct bridge_vlan_port *port;
 255         struct bridge_vlan *vlan, *ret = NULL;
 256
 257         vlist_for_each_element(&bst->dev.vlans, vlan, node) {
 258                 port = bridge_find_vlan_member_port(bm, vlan);
 259                 if (!port)
 260                         continue;
 261
 262                 if (!bridge_member_vlan_is_pvid(bm, port))
 263                         continue;
 264
 265                 ret = vlan;
 266                 if (port->flags & BRVLAN_F_PVID)
 267                         break;
 268         }
 269
 270         return ret;
 271 }
 272
 273 static void
 274 bridge_set_vlan_state(struct bridge_state *bst, struct bridge_vlan *vlan, bool add)
 275 {
 276         struct bridge_member *bm;
 277         struct bridge_vlan *vlan2;
 278
 279         bridge_set_local_vlan(bst, vlan, add);
 280
 281         vlist_for_each_element(&bst->members, bm, node) {
 282                 struct bridge_vlan_port *port;
 283                 int new_pvid = -1;
 284
 285                 port = bridge_find_vlan_member_port(bm, vlan);
 286                 if (!port)
 287                         continue;
 288
 289                 if (add) {
 290                         if (bridge_member_vlan_is_pvid(bm, port))
 291                                 bm->pvid = vlan->vid;
 292                 } else if (bm->pvid == vlan->vid) {
 293                         vlan2 = bridge_recalc_member_pvid(bm);
 294                         if (vlan2 && vlan2->vid != vlan->vid) {
 295                                 bridge_set_member_vlan(bm, vlan2, false);
 296                                 bridge_set_member_vlan(bm, vlan2, true);
 297                         }
 298                         new_pvid = vlan2 ? vlan2->vid : 0;
 299                 }
 300
 301                 if (!bm->present)
 302                         continue;
 303
 304                 __bridge_set_member_vlan(bm, vlan, port, add);
 305                 if (new_pvid >= 0)
 306                         bm->pvid = new_pvid;
 307         }
 308 }
 309
 310 static int
 311 bridge_disable_member(struct bridge_member *bm, bool keep_dev)
 312 {
 313         struct bridge_state *bst = bm->bst;
 314         struct bridge_vlan *vlan;
 315
 316         if (!bm->present || !bm->active)
 317                 return 0;
 318
 319         bm->active = false;
 320         vlist_for_each_element(&bst->dev.vlans, vlan, node)
 321                 bridge_set_member_vlan(bm, vlan, false);
 322
 323         system_bridge_delif(&bst->dev, bm->dev.dev);
 324         if (!keep_dev)
 325                 device_release(&bm->dev);
 326
 327         device_broadcast_event(&bst->dev, DEV_EVENT_TOPO_CHANGE);
 328
 329         return 0;
 330 }
 331
 332 static void bridge_stp_notify(struct bridge_state *bst)
 333 {
 334         struct bridge_config *cfg = &bst->config;
 335
 336         if (!cfg->stp || cfg->stp_kernel)
 337                 return;
 338
 339         blob_buf_init(&b, 0);
 340         blobmsg_add_string(&b, "name", bst->dev.ifname);
 341         if (cfg->stp_proto)
 342                 blobmsg_add_string(&b, "proto", cfg->stp_proto);
 343         blobmsg_add_u32(&b, "forward_delay", cfg->forward_delay);
 344         blobmsg_add_u32(&b, "hello_time", cfg->hello_time);
 345         blobmsg_add_u32(&b, "max_age", cfg->max_age);
 346         if (cfg->flags & BRIDGE_OPT_AGEING_TIME)
 347                 blobmsg_add_u32(&b, "ageing_time", cfg->ageing_time);
 348         netifd_ubus_device_notify("stp_init", b.head, 1000);
 349 }
 350
 351 static int
 352 bridge_enable_interface(struct bridge_state *bst)
 353 {
 354         struct device *dev = &bst->dev;
 355         int i, ret;
 356
 357         if (bst->active)
 358                 return 0;
 359
 360         bridge_stp_notify(bst);
 361         ret = system_bridge_addbr(dev, &bst->config);
 362         if (ret < 0)
 363                 return ret;
 364
 365         if (bst->has_vlans) {
 366                 /* delete default VLAN 1 */
 367                 system_bridge_vlan(bst->dev.ifname, 1, -1, false, BRVLAN_F_SELF);
 368
 369                 bridge_set_local_vlans(bst, true);
 370         }
 371
 372         for (i = 0; i < dev->n_extra_vlan; i++)
 373                 system_bridge_vlan(dev->ifname, dev->extra_vlan[i].start,
 374                                    dev->extra_vlan[i].end, true, BRVLAN_F_SELF);
 375
 376         bst->active = true;
 377         return 0;
 378 }
 379
 380 static void
 381 bridge_stp_init(struct device *dev)
 382 {
 383         struct bridge_state *bst;
 384
 385         bst = container_of(dev, struct bridge_state, dev);
 386         if (!bst->config.stp || !bst->active)
 387                 return;
 388
 389         bridge_stp_notify(bst);
 390         system_bridge_set_stp_state(&bst->dev, false);
 391         system_bridge_set_stp_state(&bst->dev, true);
 392 }
 393
 394 static void
 395 bridge_disable_interface(struct bridge_state *bst)
 396 {
 397         if (!bst->active)
 398                 return;
 399
 400         system_bridge_delbr(&bst->dev);
 401         bst->active = false;
 402 }
 403
 404 static struct bridge_vlan *
 405 bridge_hotplug_get_vlan(struct bridge_state *bst, uint16_t vid, bool create)
 406 {
 407         struct bridge_vlan *vlan;
 408
 409         vlan = vlist_find(&bst->dev.vlans, &vid, vlan, node);
 410         if (vlan || !create)
 411                 return vlan;
 412
 413         vlan = calloc(1, sizeof(*vlan));
 414         vlan->vid = vid;
 415         vlan->local = true;
 416         INIT_LIST_HEAD(&vlan->hotplug_ports);
 417         vlist_add(&bst->dev.vlans, &vlan->node, &vlan->vid);
 418         vlan->node.version = -1;
 419
 420         return vlan;
 421 }
 422
 423 static struct bridge_vlan_hotplug_port *
 424 bridge_hotplug_get_vlan_port(struct bridge_vlan *vlan, const char *ifname)
 425 {
 426         struct bridge_vlan_hotplug_port *port;
 427
 428         list_for_each_entry(port, &vlan->hotplug_ports, list)
 429                 if (!strcmp(port->port.ifname, ifname))
 430                         return port;
 431
 432         return NULL;
 433 }
 434
 435 static void
 436 bridge_hotplug_set_member_vlans(struct bridge_state *bst, struct blob_attr *vlans,
 437                                 struct bridge_member *bm, bool add, bool untracked)
 438 {
 439         const char *ifname = bm->name;
 440         struct device_vlan_range *r;
 441         struct bridge_vlan *vlan;
 442         struct blob_attr *cur;
 443         int n_vlans;
 444         size_t rem;
 445
 446         if (!vlans)
 447                 return;
 448
 449         if (add) {
 450                 bm->n_extra_vlan = 0;
 451                 n_vlans = blobmsg_check_array(vlans, BLOBMSG_TYPE_STRING);
 452                 if (n_vlans < 1)
 453                         return;
 454
 455                 bm->extra_vlan = realloc(bm->extra_vlan, n_vlans * sizeof(*bm->extra_vlan));
 456         }
 457
 458         blobmsg_for_each_attr(cur, vlans, rem) {
 459                 struct bridge_vlan_hotplug_port *port;
 460                 unsigned int vid, vid_end;
 461                 uint16_t flags = 0;
 462                 char *name_buf;
 463                 char *end;
 464
 465                 if (blobmsg_type(cur) != BLOBMSG_TYPE_STRING)
 466                         continue;
 467
 468                 vid = strtoul(blobmsg_get_string(cur), &end, 0);
 469                 vid_end = vid;
 470                 if (!vid || vid > 4095)
 471                         continue;
 472
 473                 if (*end == '-') {
 474                         vid_end = strtoul(end + 1, &end, 0);
 475                         if (vid_end < vid)
 476                                 continue;
 477                 }
 478
 479                 if (end && *end) {
 480                         if (*end != ':')
 481                                 continue;
 482
 483                         for (end++; *end; end++) {
 484                                 switch (*end) {
 485                                 case 'u':
 486                                         flags |= BRVLAN_F_UNTAGGED;
 487                                         fallthrough;
 488                                 case '*':
 489                                         flags |= BRVLAN_F_PVID;
 490                                         break;
 491                                 }
 492                         }
 493                 }
 494
 495                 vlan = bridge_hotplug_get_vlan(bst, vid, !!flags);
 496                 if (!vlan || vid_end > vid || untracked) {
 497                         if (add) {
 498                                 if (!untracked) {
 499                                         r = &bm->extra_vlan[bm->n_extra_vlan++];
 500                                         r->start = vid;
 501                                         r->end = vid_end;
 502                                 }
 503                                 if (bm->active)
 504                                         system_bridge_vlan(ifname, vid, vid_end, true, flags);
 505                         } else if (bm->active) {
 506                                 system_bridge_vlan(ifname, vid, vid_end, false, 0);
 507                         }
 508                         continue;
 509                 }
 510
 511                 if (vlan->pending) {
 512                         vlan->pending = false;
 513                         bridge_set_vlan_state(bst, vlan, true);
 514                 }
 515
 516                 port = bridge_hotplug_get_vlan_port(vlan, ifname);
 517                 if (!add) {
 518                         if (!port)
 519                                 continue;
 520
 521                         __bridge_set_member_vlan(bm, vlan, &port->port, false);
 522                         list_del(&port->list);
 523                         free(port);
 524                         continue;
 525                 }
 526
 527                 if (port) {
 528                         if (port->port.flags == flags)
 529                                 continue;
 530
 531                         __bridge_set_member_vlan(bm, vlan, &port->port, false);
 532                         port->port.flags = flags;
 533                         __bridge_set_member_vlan(bm, vlan, &port->port, true);
 534                         continue;
 535                 }
 536
 537                 port = calloc_a(sizeof(*port), &name_buf, strlen(ifname) + 1);
 538                 if (!port)
 539                         continue;
 540
 541                 port->port.flags = flags;
 542                 port->port.ifname = strcpy(name_buf, ifname);
 543                 list_add_tail(&port->list, &vlan->hotplug_ports);
 544
 545                 if (!bm)
 546                         continue;
 547
 548                 __bridge_set_member_vlan(bm, vlan, &port->port, true);
 549         }
 550 }
 551
 552
 553 static void
 554 bridge_member_add_extra_vlans(struct bridge_member *bm)
 555 {
 556         struct device *dev = bm->dev.dev;
 557         int i;
 558
 559         for (i = 0; i < dev->n_extra_vlan; i++)
 560                 system_bridge_vlan(dev->ifname, dev->extra_vlan[i].start,
 561                                    dev->extra_vlan[i].end, true, 0);
 562         for (i = 0; i < bm->n_extra_vlan; i++)
 563                 system_bridge_vlan(dev->ifname, bm->extra_vlan[i].start,
 564                                    bm->extra_vlan[i].end, true, 0);
 565 }
 566
 567 static void
 568 bridge_member_enable_vlans(struct bridge_member *bm)
 569 {
 570         struct bridge_state *bst = bm->bst;
 571         struct device *dev = bm->dev.dev;
 572         struct bridge_vlan *vlan;
 573
 574         if (dev->settings.auth && !dev->auth_status)
 575                 return;
 576
 577         bridge_member_add_extra_vlans(bm);
 578         vlist_for_each_element(&bst->dev.vlans, vlan, node)
 579                 bridge_set_member_vlan(bm, vlan, true);
 580         if (dev->settings.auth && dev->auth_vlans)
 581                 bridge_hotplug_set_member_vlans(bst, dev->auth_vlans, bm, true, true);
 582 }
 583
 584 static int
 585 bridge_enable_member(struct bridge_member *bm)
 586 {
 587         struct bridge_state *bst = bm->bst;
 588         struct device *dev;
 589         int ret;
 590
 591         if (!bm->present)
 592                 return 0;
 593
 594         ret = bridge_enable_interface(bst);
 595         if (ret)
 596                 goto error;
 597
 598         /* Disable IPv6 for bridge members */
 599         if (!(bm->dev.dev->settings.flags & DEV_OPT_IPV6)) {
 600                 bm->dev.dev->settings.ipv6 = 0;
 601                 bm->dev.dev->settings.flags |= DEV_OPT_IPV6;
 602         }
 603
 604         ret = device_claim(&bm->dev);
 605         if (ret < 0)
 606                 goto error;
 607
 608         dev = bm->dev.dev;
 609         if (dev->settings.auth && !bst->has_vlans && !dev->auth_status)
 610                 return -1;
 611
 612         if (!bm->active) {
 613                 ret = system_bridge_addif(&bst->dev, bm->dev.dev);
 614                 if (ret < 0) {
 615                         D(DEVICE, "Bridge device %s could not be added\n", bm->dev.dev->ifname);
 616                         goto error;
 617                 }
 618
 619                 bm->active = true;
 620         }
 621
 622         if (bst->has_vlans) {
 623                 /* delete default VLAN 1 */
 624                 system_bridge_vlan(bm->dev.dev->ifname, 1, -1, false, 0);
 625
 626                 bridge_member_enable_vlans(bm);
 627         }
 628
 629         device_set_present(&bst->dev, true);
 630         if (!dev->settings.auth || dev->auth_status)
 631                 device_broadcast_event(&bst->dev, DEV_EVENT_TOPO_CHANGE);
 632
 633         return 0;
 634
 635 error:
 636         bst->n_failed++;
 637         bm->present = false;
 638         bst->n_present--;
 639         device_release(&bm->dev);
 640
 641         return ret;
 642 }
 643
 644 static void
 645 bridge_remove_member(struct bridge_member *bm)
 646 {
 647         struct bridge_state *bst = bm->bst;
 648
 649         if (!bm->present)
 650                 return;
 651
 652         if (bst->dev.active)
 653                 bridge_disable_member(bm, false);
 654
 655         bm->present = false;
 656         bm->bst->n_present--;
 657
 658         if (bm == bst->primary_port)
 659                 bridge_reset_primary(bst);
 660
 661         if (bst->config.bridge_empty)
 662                 return;
 663
 664         bst->force_active = false;
 665         if (bst->n_present == 0)
 666                 device_set_present(&bst->dev, false);
 667 }
 668
 669 static void
 670 bridge_free_member(struct bridge_member *bm)
 671 {
 672         struct bridge_state *bst = bm->bst;
 673         struct device *dev = bm->dev.dev;
 674         const char *ifname = dev->ifname;
 675         struct bridge_vlan *vlan;
 676
 677         bridge_remove_member(bm);
 678
 679 restart:
 680         vlist_for_each_element(&bst->dev.vlans, vlan, node) {
 681                 struct bridge_vlan_hotplug_port *port, *tmp;
 682                 bool free_port = false;
 683
 684                 list_for_each_entry_safe(port, tmp, &vlan->hotplug_ports, list) {
 685                         if (strcmp(port->port.ifname, ifname) != 0)
 686                                 continue;
 687
 688                         list_del(&port->list);
 689                         free(port);
 690                         free_port = true;
 691                 }
 692
 693                 if (!free_port || !list_empty(&vlan->hotplug_ports) ||
 694                     vlan->n_ports || vlan->node.version != -1)
 695                         continue;
 696
 697                 vlist_delete(&bst->dev.vlans, &vlan->node);
 698                 goto restart;
 699         }
 700
 701         device_remove_user(&bm->dev);
 702         uloop_timeout_cancel(&bm->check_timer);
 703
 704         /*
 705          * When reloading the config and moving a device from one bridge to
 706          * another, the other bridge may have tried to claim this device
 707          * before it was removed here.
 708          * Ensure that claiming the device is retried by toggling its present
 709          * state
 710          */
 711         if (dev->present) {
 712                 device_set_present(dev, false);
 713                 device_set_present(dev, true);
 714         }
 715
 716         free(bm);
 717 }
 718
 719 static void
 720 bridge_check_retry(struct bridge_state *bst)
 721 {
 722         if (!bst->n_failed)
 723                 return;
 724
 725         uloop_timeout_set(&bst->retry, 100);
 726 }
 727
 728 static void
 729 bridge_member_check_cb(struct uloop_timeout *t)
 730 {
 731         struct bridge_member *bm;
 732         struct bridge_state *bst;
 733
 734         bm = container_of(t, struct bridge_member, check_timer);
 735         bst = bm->bst;
 736
 737         if (system_bridge_vlan_check(&bst->dev, bm->dev.dev->ifname) <= 0)
 738                 return;
 739
 740         bridge_disable_member(bm, true);
 741         bridge_enable_member(bm);
 742 }
 743
 744 static void
 745 bridge_member_cb(struct device_user *dep, enum device_event ev)
 746 {
 747         struct bridge_member *bm = container_of(dep, struct bridge_member, dev);
 748         struct bridge_state *bst = bm->bst;
 749         struct device *dev = dep->dev;
 750
 751         switch (ev) {
 752         case DEV_EVENT_ADD:
 753                 assert(!bm->present);
 754
 755                 bm->present = true;
 756                 bst->n_present++;
 757
 758                 if (bst->n_present == 1)
 759                         device_set_present(&bst->dev, true);
 760                 fallthrough;
 761         case DEV_EVENT_AUTH_UP:
 762                 if (!bst->dev.active)
 763                         break;
 764
 765                 if (bridge_enable_member(bm))
 766                         break;
 767
 768                 /*
 769                  * Adding a bridge member can overwrite the bridge mtu
 770                  * in the kernel, apply the bridge settings in case the
 771                  * bridge mtu is set
 772                  */
 773                 system_if_apply_settings(&bst->dev, &bst->dev.settings,
 774                                          DEV_OPT_MTU | DEV_OPT_MTU6);
 775                 break;
 776         case DEV_EVENT_LINK_UP:
 777                 if (!bst->has_vlans)
 778                         break;
 779
 780                 if (dev->settings.auth)
 781                         bridge_enable_member(bm);
 782
 783                 uloop_timeout_set(&bm->check_timer, 1000);
 784                 break;
 785         case DEV_EVENT_LINK_DOWN:
 786                 if (!dev->settings.auth)
 787                         break;
 788
 789                 bridge_disable_member(bm, true);
 790                 break;
 791         case DEV_EVENT_REMOVE:
 792                 if (dep->hotplug) {
 793                         vlist_delete(&bst->members, &bm->node);
 794                         return;
 795                 }
 796
 797                 if (bm->present)
 798                         bridge_remove_member(bm);
 799
 800                 break;
 801         default:
 802                 return;
 803         }
 804 }
 805
 806 static int
 807 bridge_set_down(struct bridge_state *bst)
 808 {
 809         struct bridge_member *bm;
 810
 811         bst->set_state(&bst->dev, false);
 812
 813         vlist_for_each_element(&bst->members, bm, node)
 814                 bridge_disable_member(bm, false);
 815
 816         bridge_disable_interface(bst);
 817
 818         return 0;
 819 }
 820
 821 static int
 822 bridge_set_up(struct bridge_state *bst)
 823 {
 824         struct bridge_member *bm;
 825         int ret;
 826
 827         bst->has_vlans = !avl_is_empty(&bst->dev.vlans.avl);
 828         if (!bst->n_present) {
 829                 if (!bst->force_active)
 830                         return -ENOENT;
 831
 832                 ret = bridge_enable_interface(bst);
 833                 if (ret)
 834                         return ret;
 835         }
 836
 837         bst->n_failed = 0;
 838         vlist_for_each_element(&bst->members, bm, node)
 839                 bridge_enable_member(bm);
 840         bridge_check_retry(bst);
 841
 842         if (!bst->force_active && !bst->n_present) {
 843                 /* initialization of all member interfaces failed */
 844                 bridge_disable_interface(bst);
 845                 device_set_present(&bst->dev, false);
 846                 return -ENOENT;
 847         }
 848
 849         bridge_reset_primary(bst);
 850         ret = bst->set_state(&bst->dev, true);
 851         if (ret < 0)
 852                 bridge_set_down(bst);
 853
 854         return ret;
 855 }
 856
 857 static int
 858 bridge_set_state(struct device *dev, bool up)
 859 {
 860         struct bridge_state *bst;
 861
 862         bst = container_of(dev, struct bridge_state, dev);
 863
 864         if (up)
 865                 return bridge_set_up(bst);
 866         else
 867                 return bridge_set_down(bst);
 868 }
 869
 870 static struct bridge_member *
 871 bridge_alloc_member(struct bridge_state *bst, const char *name,
 872                     struct device *dev, bool hotplug)
 873 {
 874         struct bridge_member *bm;
 875
 876         bm = calloc(1, sizeof(*bm) + strlen(name) + 1);
 877         if (!bm)
 878                 return NULL;
 879
 880         bm->bst = bst;
 881         bm->dev.cb = bridge_member_cb;
 882         bm->dev.hotplug = hotplug;
 883         bm->check_timer.cb = bridge_member_check_cb;
 884         strcpy(bm->name, name);
 885         bm->dev.dev = dev;
 886
 887         return bm;
 888 }
 889
 890 static void bridge_insert_member(struct bridge_member *bm, const char *name)
 891 {
 892         struct bridge_state *bst = bm->bst;
 893         bool hotplug = bm->dev.hotplug;
 894
 895         vlist_add(&bst->members, &bm->node, bm->name);
 896         /*
 897          * Need to look up the bridge member again as the above
 898          * created pointer will be freed in case the bridge member
 899          * already existed
 900          */
 901         bm = vlist_find(&bst->members, name, bm, node);
 902         if (hotplug && bm)
 903                 bm->node.version = -1;
 904 }
 905
 906 static void
 907 bridge_create_member(struct bridge_state *bst, const char *name,
 908                      struct device *dev, bool hotplug)
 909 {
 910         struct bridge_member *bm;
 911
 912         bm = bridge_alloc_member(bst, name, dev, hotplug);
 913         if (bm)
 914                 bridge_insert_member(bm, name);
 915 }
 916
 917 static void
 918 bridge_member_update(struct vlist_tree *tree, struct vlist_node *node_new,
 919                      struct vlist_node *node_old)
 920 {
 921         struct bridge_member *bm;
 922         struct device *dev;
 923
 924         if (node_new) {
 925                 bm = container_of(node_new, struct bridge_member, node);
 926
 927                 if (node_old) {
 928                         free(bm);
 929                         return;
 930                 }
 931
 932                 dev = bm->dev.dev;
 933                 bm->dev.dev = NULL;
 934                 device_add_user(&bm->dev, dev);
 935         }
 936
 937
 938         if (node_old) {
 939                 bm = container_of(node_old, struct bridge_member, node);
 940                 bridge_free_member(bm);
 941         }
 942 }
 943
 944
 945 static void
 946 bridge_add_member(struct bridge_state *bst, const char *name)
 947 {
 948         struct device *dev;
 949
 950         dev = device_get(name, true);
 951         if (!dev)
 952                 return;
 953
 954         bridge_create_member(bst, name, dev, false);
 955 }
 956
 957 static int
 958 bridge_hotplug_add(struct device *dev, struct device *member, struct blob_attr *vlan)
 959 {
 960         struct bridge_state *bst = container_of(dev, struct bridge_state, dev);
 961         struct bridge_member *bm;
 962         bool new_entry = false;
 963
 964         bm = vlist_find(&bst->members, member->ifname, bm, node);
 965         if (!bm) {
 966             new_entry = true;
 967             bm = bridge_alloc_member(bst, member->ifname, member, true);
 968         }
 969         bridge_hotplug_set_member_vlans(bst, vlan, bm, true, false);
 970         if (new_entry)
 971                 bridge_insert_member(bm, member->ifname);
 972
 973         return 0;
 974 }
 975
 976 static int
 977 bridge_hotplug_del(struct device *dev, struct device *member, struct blob_attr *vlan)
 978 {
 979         struct bridge_state *bst = container_of(dev, struct bridge_state, dev);
 980         struct bridge_member *bm;
 981
 982         bm = vlist_find(&bst->members, member->ifname, bm, node);
 983         if (!bm)
 984                 return UBUS_STATUS_NOT_FOUND;
 985
 986         bridge_hotplug_set_member_vlans(bst, vlan, bm, false, false);
 987         if (!bm->dev.hotplug)
 988                 return 0;
 989
 990         vlist_delete(&bst->members, &bm->node);
 991         return 0;
 992 }
 993
 994 static int
 995 bridge_hotplug_prepare(struct device *dev, struct device **bridge_dev)
 996 {
 997         struct bridge_state *bst;
 998
 999         if (bridge_dev)
1000                 *bridge_dev = dev;
1001
1002         bst = container_of(dev, struct bridge_state, dev);
1003         bst->force_active = true;
1004         device_set_present(&bst->dev, true);
1005
1006         return 0;
1007 }
1008
1009 static const struct device_hotplug_ops bridge_ops = {
1010         .prepare = bridge_hotplug_prepare,
1011         .add = bridge_hotplug_add,
1012         .del = bridge_hotplug_del
1013 };
1014
1015 static void
1016 bridge_free(struct device *dev)
1017 {
1018         struct bridge_state *bst;
1019
1020         bst = container_of(dev, struct bridge_state, dev);
1021         vlist_flush_all(&bst->members);
1022         vlist_flush_all(&dev->vlans);
1023         kvlist_free(&dev->vlan_aliases);
1024         free(bst->config_data);
1025         free(bst);
1026 }
1027
1028 static void
1029 bridge_dump_port(struct blob_buf *b, struct bridge_vlan_port *port)
1030 {
1031         bool tagged = !(port->flags & BRVLAN_F_UNTAGGED);
1032         bool pvid = (port->flags & BRVLAN_F_PVID);
1033
1034         blobmsg_printf(b, NULL, "%s%s%s%s", port->ifname,
1035                 tagged || pvid ? ":" : "",
1036                 tagged ? "t" : "",
1037                 pvid ? "*" : "");
1038 }
1039
1040 static void
1041 bridge_dump_vlan(struct blob_buf *b, struct bridge_vlan *vlan)
1042 {
1043         struct bridge_vlan_hotplug_port *port;
1044         void *c, *p;
1045         int i;
1046
1047         c = blobmsg_open_table(b, NULL);
1048
1049         blobmsg_add_u32(b, "id", vlan->vid);
1050         blobmsg_add_u8(b, "local", vlan->local);
1051
1052         p = blobmsg_open_array(b, "ports");
1053
1054         for (i = 0; i < vlan->n_ports; i++)
1055             bridge_dump_port(b, &vlan->ports[i]);
1056
1057         list_for_each_entry(port, &vlan->hotplug_ports, list)
1058                 bridge_dump_port(b, &port->port);
1059
1060         blobmsg_close_array(b, p);
1061
1062         blobmsg_close_table(b, c);
1063 }
1064
1065 static void
1066 bridge_dump_info(struct device *dev, struct blob_buf *b)
1067 {
1068         struct bridge_config *cfg;
1069         struct bridge_state *bst;
1070         struct bridge_member *bm;
1071         struct bridge_vlan *vlan;
1072         void *list;
1073         void *c;
1074
1075         bst = container_of(dev, struct bridge_state, dev);
1076         cfg = &bst->config;
1077
1078         system_if_dump_info(dev, b);
1079         list = blobmsg_open_array(b, "bridge-members");
1080
1081         vlist_for_each_element(&bst->members, bm, node) {
1082                 if (bm->dev.dev->hidden)
1083                         continue;
1084
1085                 blobmsg_add_string(b, NULL, bm->dev.dev->ifname);
1086         }
1087
1088         blobmsg_close_array(b, list);
1089
1090         c = blobmsg_open_table(b, "bridge-attributes");
1091
1092         blobmsg_add_u8(b, "stp", cfg->stp);
1093         blobmsg_add_u32(b, "forward_delay", cfg->forward_delay);
1094         blobmsg_add_u32(b, "priority", cfg->priority);
1095         blobmsg_add_u32(b, "ageing_time", cfg->ageing_time);
1096         blobmsg_add_u32(b, "hello_time", cfg->hello_time);
1097         blobmsg_add_u32(b, "max_age", cfg->max_age);
1098         blobmsg_add_u8(b, "igmp_snooping", cfg->igmp_snoop);
1099         blobmsg_add_u8(b, "bridge_empty", cfg->bridge_empty);
1100         blobmsg_add_u8(b, "multicast_querier", cfg->multicast_querier);
1101         blobmsg_add_u32(b, "hash_max", cfg->hash_max);
1102         blobmsg_add_u32(b, "robustness", cfg->robustness);
1103         blobmsg_add_u32(b, "query_interval", cfg->query_interval);
1104         blobmsg_add_u32(b, "query_response_interval", cfg->query_response_interval);
1105         blobmsg_add_u32(b, "last_member_interval", cfg->last_member_interval);
1106         blobmsg_add_u8(b, "vlan_filtering", cfg->vlan_filtering);
1107         blobmsg_add_u8(b, "stp_kernel", cfg->stp_kernel);
1108         if (cfg->stp_proto)
1109                 blobmsg_add_string(b, "stp_proto", cfg->stp_proto);
1110
1111         blobmsg_close_table(b, c);
1112
1113         if (avl_is_empty(&dev->vlans.avl))
1114                 return;
1115
1116         list = blobmsg_open_array(b, "bridge-vlans");
1117
1118         vlist_for_each_element(&bst->dev.vlans, vlan, node)
1119                 bridge_dump_vlan(b, vlan);
1120
1121         blobmsg_close_array(b, list);
1122 }
1123
1124 static void
1125 bridge_config_init(struct device *dev)
1126 {
1127         struct bridge_state *bst;
1128         struct bridge_vlan *vlan;
1129         struct blob_attr *cur;
1130         size_t rem;
1131         int i;
1132
1133         bst = container_of(dev, struct bridge_state, dev);
1134
1135         if (bst->config.bridge_empty) {
1136                 bst->force_active = true;
1137                 device_set_present(&bst->dev, true);
1138         }
1139
1140         bst->n_failed = 0;
1141         vlist_update(&bst->members);
1142         if (bst->ports) {
1143                 blobmsg_for_each_attr(cur, bst->ports, rem) {
1144                         bridge_add_member(bst, blobmsg_data(cur));
1145                 }
1146         }
1147
1148         vlist_for_each_element(&bst->dev.vlans, vlan, node)
1149                 for (i = 0; i < vlan->n_ports; i++)
1150                         bridge_add_member(bst, vlan->ports[i].ifname);
1151
1152         vlist_flush(&bst->members);
1153         bridge_check_retry(bst);
1154 }
1155
1156 static void
1157 bridge_apply_settings(struct bridge_state *bst, struct blob_attr **tb)
1158 {
1159         struct bridge_config *cfg = &bst->config;
1160         struct blob_attr *cur;
1161
1162         /* defaults */
1163         memset(cfg, 0, sizeof(*cfg));
1164         cfg->stp = false;
1165         cfg->stp_kernel = false;
1166         cfg->robustness = 2;
1167         cfg->igmp_snoop = false;
1168         cfg->multicast_querier = false;
1169         cfg->query_interval = 12500;
1170         cfg->query_response_interval = 1000;
1171         cfg->last_member_interval = 100;
1172         cfg->hash_max = 512;
1173         cfg->bridge_empty = false;
1174         cfg->priority = 0x7FFF;
1175         cfg->vlan_filtering = false;
1176
1177         cfg->forward_delay = 8;
1178         cfg->max_age = 10;
1179         cfg->hello_time = 1;
1180
1181         if ((cur = tb[BRIDGE_ATTR_STP]))
1182                 cfg->stp = blobmsg_get_bool(cur);
1183
1184         if ((cur = tb[BRIDGE_ATTR_STP_KERNEL]))
1185                 cfg->stp = blobmsg_get_bool(cur);
1186
1187         if ((cur = tb[BRIDGE_ATTR_STP_PROTO]))
1188                 cfg->stp_proto = blobmsg_get_string(cur);
1189
1190         if ((cur = tb[BRIDGE_ATTR_FORWARD_DELAY]))
1191                 cfg->forward_delay = blobmsg_get_u32(cur);
1192
1193         if ((cur = tb[BRIDGE_ATTR_PRIORITY]))
1194                 cfg->priority = blobmsg_get_u32(cur);
1195
1196         if ((cur = tb[BRIDGE_ATTR_IGMP_SNOOP]))
1197                 cfg->multicast_querier = cfg->igmp_snoop = blobmsg_get_bool(cur);
1198
1199         if ((cur = tb[BRIDGE_ATTR_MULTICAST_QUERIER]))
1200                 cfg->multicast_querier = blobmsg_get_bool(cur);
1201
1202         if ((cur = tb[BRIDGE_ATTR_HASH_MAX]))
1203                 cfg->hash_max = blobmsg_get_u32(cur);
1204
1205         if ((cur = tb[BRIDGE_ATTR_ROBUSTNESS])) {
1206                 cfg->robustness = blobmsg_get_u32(cur);
1207                 cfg->flags |= BRIDGE_OPT_ROBUSTNESS;
1208         }
1209
1210         if ((cur = tb[BRIDGE_ATTR_QUERY_INTERVAL])) {
1211                 cfg->query_interval = blobmsg_get_u32(cur);
1212                 cfg->flags |= BRIDGE_OPT_QUERY_INTERVAL;
1213         }
1214
1215         if ((cur = tb[BRIDGE_ATTR_QUERY_RESPONSE_INTERVAL])) {
1216                 cfg->query_response_interval = blobmsg_get_u32(cur);
1217                 cfg->flags |= BRIDGE_OPT_QUERY_RESPONSE_INTERVAL;
1218         }
1219
1220         if ((cur = tb[BRIDGE_ATTR_LAST_MEMBER_INTERVAL])) {
1221                 cfg->last_member_interval = blobmsg_get_u32(cur);
1222                 cfg->flags |= BRIDGE_OPT_LAST_MEMBER_INTERVAL;
1223         }
1224
1225         if ((cur = tb[BRIDGE_ATTR_AGEING_TIME])) {
1226                 cfg->ageing_time = blobmsg_get_u32(cur);
1227                 cfg->flags |= BRIDGE_OPT_AGEING_TIME;
1228         }
1229
1230         if ((cur = tb[BRIDGE_ATTR_HELLO_TIME]))
1231                 cfg->hello_time = blobmsg_get_u32(cur);
1232
1233         if ((cur = tb[BRIDGE_ATTR_MAX_AGE]))
1234                 cfg->max_age = blobmsg_get_u32(cur);
1235
1236         if ((cur = tb[BRIDGE_ATTR_BRIDGE_EMPTY]))
1237                 cfg->bridge_empty = blobmsg_get_bool(cur);
1238
1239         if ((cur = tb[BRIDGE_ATTR_VLAN_FILTERING]))
1240                 cfg->vlan_filtering = blobmsg_get_bool(cur);
1241 }
1242
1243 static enum dev_change_type
1244 bridge_reload(struct device *dev, struct blob_attr *attr)
1245 {
1246         struct blob_attr *tb_dev[__DEV_ATTR_MAX];
1247         struct blob_attr *tb_br[__BRIDGE_ATTR_MAX];
1248         enum dev_change_type ret = DEV_CONFIG_APPLIED;
1249         struct bridge_state *bst;
1250         unsigned long diff[2];
1251
1252         BUILD_BUG_ON(sizeof(diff) < __BRIDGE_ATTR_MAX / BITS_PER_LONG);
1253         BUILD_BUG_ON(sizeof(diff) < __DEV_ATTR_MAX / BITS_PER_LONG);
1254
1255         bst = container_of(dev, struct bridge_state, dev);
1256         attr = blob_memdup(attr);
1257
1258         blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, tb_dev,
1259                 blob_data(attr), blob_len(attr));
1260         blobmsg_parse(bridge_attrs, __BRIDGE_ATTR_MAX, tb_br,
1261                 blob_data(attr), blob_len(attr));
1262
1263         if (tb_dev[DEV_ATTR_MACADDR])
1264                 bst->primary_port = NULL;
1265
1266         bst->ports = tb_br[BRIDGE_ATTR_PORTS];
1267         device_init_settings(dev, tb_dev);
1268         bridge_apply_settings(bst, tb_br);
1269
1270         if (bst->config_data) {
1271                 struct blob_attr *otb_dev[__DEV_ATTR_MAX];
1272                 struct blob_attr *otb_br[__BRIDGE_ATTR_MAX];
1273
1274                 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, otb_dev,
1275                         blob_data(bst->config_data), blob_len(bst->config_data));
1276
1277                 diff[0] = diff[1] = 0;
1278                 uci_blob_diff(tb_dev, otb_dev, &device_attr_list, diff);
1279                 if (diff[0] | diff[1]) {
1280                         ret = DEV_CONFIG_RESTART;
1281                         D(DEVICE, "Bridge %s device attributes have changed, diff=[%lx %lx]\n",
1282                           dev->ifname, diff[1], diff[0]);
1283                 }
1284
1285                 blobmsg_parse(bridge_attrs, __BRIDGE_ATTR_MAX, otb_br,
1286                         blob_data(bst->config_data), blob_len(bst->config_data));
1287
1288                 diff[0] = diff[1] = 0;
1289                 uci_blob_diff(tb_br, otb_br, &bridge_attr_list, diff);
1290                 if (diff[0] & ~(1 << BRIDGE_ATTR_PORTS)) {
1291                         ret = DEV_CONFIG_RESTART;
1292                         D(DEVICE, "Bridge %s attributes have changed, diff=[%lx %lx]\n",
1293                           dev->ifname, diff[1], diff[0]);
1294                 }
1295
1296                 bridge_config_init(dev);
1297         }
1298
1299         free(bst->config_data);
1300         bst->config_data = attr;
1301         return ret;
1302 }
1303
1304 static void
1305 bridge_retry_members(struct uloop_timeout *timeout)
1306 {
1307         struct bridge_state *bst = container_of(timeout, struct bridge_state, retry);
1308         struct bridge_member *bm;
1309
1310         bst->n_failed = 0;
1311         vlist_for_each_element(&bst->members, bm, node) {
1312                 if (bm->present)
1313                         continue;
1314
1315                 if (!bm->dev.dev->present)
1316                         continue;
1317
1318                 bm->present = true;
1319                 bst->n_present++;
1320                 bridge_enable_member(bm);
1321         }
1322 }
1323
1324 static int bridge_avl_cmp_u16(const void *k1, const void *k2, void *ptr)
1325 {
1326         const uint16_t *i1 = k1, *i2 = k2;
1327
1328         return *i1 - *i2;
1329 }
1330
1331 static bool
1332 bridge_vlan_equal(struct bridge_vlan *v1, struct bridge_vlan *v2)
1333 {
1334         int i;
1335
1336         if (v1->n_ports != v2->n_ports)
1337                 return false;
1338
1339         for (i = 0; i < v1->n_ports; i++)
1340                 if (v1->ports[i].flags != v2->ports[i].flags ||
1341                     strcmp(v1->ports[i].ifname, v2->ports[i].ifname) != 0)
1342                         return false;
1343
1344         return true;
1345 }
1346
1347 static void
1348 bridge_vlan_free(struct bridge_vlan *vlan)
1349 {
1350         struct bridge_vlan_hotplug_port *port, *tmp;
1351
1352         if (!vlan)
1353                 return;
1354
1355         list_for_each_entry_safe(port, tmp, &vlan->hotplug_ports, list)
1356                 free(port);
1357
1358         free(vlan);
1359 }
1360
1361 static void
1362 bridge_vlan_update(struct vlist_tree *tree, struct vlist_node *node_new,
1363                    struct vlist_node *node_old)
1364 {
1365         struct bridge_state *bst = container_of(tree, struct bridge_state, dev.vlans);
1366         struct bridge_vlan *vlan_new = NULL, *vlan_old = NULL;
1367
1368         if (!bst->has_vlans || !bst->active)
1369                 goto out;
1370
1371         if (node_old)
1372                 vlan_old = container_of(node_old, struct bridge_vlan, node);
1373         if (node_new)
1374                 vlan_new = container_of(node_new, struct bridge_vlan, node);
1375
1376         if (node_new && node_old && bridge_vlan_equal(vlan_old, vlan_new)) {
1377                 list_splice_init(&vlan_old->hotplug_ports, &vlan_new->hotplug_ports);
1378                 goto out;
1379         }
1380
1381         if (node_old)
1382                 bridge_set_vlan_state(bst, vlan_old, false);
1383
1384         if (node_old && node_new)
1385                 list_splice_init(&vlan_old->hotplug_ports, &vlan_new->hotplug_ports);
1386
1387         if (node_new)
1388                 vlan_new->pending = true;
1389
1390         bst->dev.config_pending = true;
1391
1392 out:
1393         bridge_vlan_free(vlan_old);
1394 }
1395
1396 static void
1397 bridge_dev_vlan_update(struct device *dev)
1398 {
1399         struct bridge_state *bst = container_of(dev, struct bridge_state, dev);
1400         struct bridge_vlan *vlan;
1401
1402         vlist_for_each_element(&dev->vlans, vlan, node) {
1403                 if (!vlan->pending)
1404                         continue;
1405
1406                 vlan->pending = false;
1407                 bridge_set_vlan_state(bst, vlan, true);
1408         }
1409 }
1410
1411 static struct device *
1412 bridge_create(const char *name, struct device_type *devtype,
1413         struct blob_attr *attr)
1414 {
1415         struct bridge_state *bst;
1416         struct device *dev = NULL;
1417
1418         bst = calloc(1, sizeof(*bst));
1419         if (!bst)
1420                 return NULL;
1421
1422         dev = &bst->dev;
1423
1424         if (device_init(dev, devtype, name) < 0) {
1425                 device_cleanup(dev);
1426                 free(bst);
1427                 return NULL;
1428         }
1429
1430         dev->config_pending = true;
1431         bst->retry.cb = bridge_retry_members;
1432
1433         bst->set_state = dev->set_state;
1434         dev->set_state = bridge_set_state;
1435
1436         dev->hotplug_ops = &bridge_ops;
1437
1438         vlist_init(&bst->members, avl_strcmp, bridge_member_update);
1439         bst->members.keep_old = true;
1440
1441         vlist_init(&dev->vlans, bridge_avl_cmp_u16, bridge_vlan_update);
1442
1443         bridge_reload(dev, attr);
1444
1445         return dev;
1446 }
1447
1448 static void __init bridge_device_type_init(void)
1449 {
1450         device_type_add(&bridge_device_type);
1451 }