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
  25 enum {
  26         BRIDGE_ATTR_IFNAME,
  27         BRIDGE_ATTR_STP,
  28         BRIDGE_ATTR_FORWARD_DELAY,
  29         BRIDGE_ATTR_PRIORITY,
  30         BRIDGE_ATTR_IGMP_SNOOP,
  31         BRIDGE_ATTR_AGEING_TIME,
  32         BRIDGE_ATTR_HELLO_TIME,
  33         BRIDGE_ATTR_MAX_AGE,
  34         BRIDGE_ATTR_BRIDGE_EMPTY,
  35         BRIDGE_ATTR_MULTICAST_QUERIER,
  36         BRIDGE_ATTR_HASH_MAX,
  37         BRIDGE_ATTR_ROBUSTNESS,
  38         BRIDGE_ATTR_QUERY_INTERVAL,
  39         BRIDGE_ATTR_QUERY_RESPONSE_INTERVAL,
  40         BRIDGE_ATTR_LAST_MEMBER_INTERVAL,
  41         BRIDGE_ATTR_VLAN_FILTERING,
  42         BRIDGE_ATTR_HAS_VLANS,
  43         __BRIDGE_ATTR_MAX
  44 };
  45
  46 static const struct blobmsg_policy bridge_attrs[__BRIDGE_ATTR_MAX] = {
  47         [BRIDGE_ATTR_IFNAME] = { "ifname", BLOBMSG_TYPE_ARRAY },
  48         [BRIDGE_ATTR_STP] = { "stp", BLOBMSG_TYPE_BOOL },
  49         [BRIDGE_ATTR_FORWARD_DELAY] = { "forward_delay", BLOBMSG_TYPE_INT32 },
  50         [BRIDGE_ATTR_PRIORITY] = { "priority", BLOBMSG_TYPE_INT32 },
  51         [BRIDGE_ATTR_AGEING_TIME] = { "ageing_time", BLOBMSG_TYPE_INT32 },
  52         [BRIDGE_ATTR_HELLO_TIME] = { "hello_time", BLOBMSG_TYPE_INT32 },
  53         [BRIDGE_ATTR_MAX_AGE] = { "max_age", BLOBMSG_TYPE_INT32 },
  54         [BRIDGE_ATTR_IGMP_SNOOP] = { "igmp_snooping", BLOBMSG_TYPE_BOOL },
  55         [BRIDGE_ATTR_BRIDGE_EMPTY] = { "bridge_empty", BLOBMSG_TYPE_BOOL },
  56         [BRIDGE_ATTR_MULTICAST_QUERIER] = { "multicast_querier", BLOBMSG_TYPE_BOOL },
  57         [BRIDGE_ATTR_HASH_MAX] = { "hash_max", BLOBMSG_TYPE_INT32 },
  58         [BRIDGE_ATTR_ROBUSTNESS] = { "robustness", BLOBMSG_TYPE_INT32 },
  59         [BRIDGE_ATTR_QUERY_INTERVAL] = { "query_interval", BLOBMSG_TYPE_INT32 },
  60         [BRIDGE_ATTR_QUERY_RESPONSE_INTERVAL] = { "query_response_interval", BLOBMSG_TYPE_INT32 },
  61         [BRIDGE_ATTR_LAST_MEMBER_INTERVAL] = { "last_member_interval", BLOBMSG_TYPE_INT32 },
  62         [BRIDGE_ATTR_VLAN_FILTERING] = { "vlan_filtering", BLOBMSG_TYPE_BOOL },
  63         [BRIDGE_ATTR_HAS_VLANS] = { "__has_vlans", BLOBMSG_TYPE_BOOL }, /* internal */
  64 };
  65
  66 static const struct uci_blob_param_info bridge_attr_info[__BRIDGE_ATTR_MAX] = {
  67         [BRIDGE_ATTR_IFNAME] = { .type = BLOBMSG_TYPE_STRING },
  68 };
  69
  70 static const struct uci_blob_param_list bridge_attr_list = {
  71         .n_params = __BRIDGE_ATTR_MAX,
  72         .params = bridge_attrs,
  73         .info = bridge_attr_info,
  74
  75         .n_next = 1,
  76         .next = { &device_attr_list },
  77 };
  78
  79 static struct device *bridge_create(const char *name, struct device_type *devtype,
  80         struct blob_attr *attr);
  81 static void bridge_config_init(struct device *dev);
  82 static void bridge_free(struct device *dev);
  83 static void bridge_dump_info(struct device *dev, struct blob_buf *b);
  84 static enum dev_change_type
  85 bridge_reload(struct device *dev, struct blob_attr *attr);
  86
  87 static struct device_type bridge_device_type = {
  88         .name = "bridge",
  89         .config_params = &bridge_attr_list,
  90
  91         .bridge_capability = true,
  92         .name_prefix = "br",
  93
  94         .create = bridge_create,
  95         .config_init = bridge_config_init,
  96         .reload = bridge_reload,
  97         .free = bridge_free,
  98         .dump_info = bridge_dump_info,
  99 };
 100
 101 struct bridge_state {
 102         struct device dev;
 103         device_state_cb set_state;
 104
 105         struct blob_attr *config_data;
 106         struct bridge_config config;
 107         struct blob_attr *ifnames;
 108         bool active;
 109         bool force_active;
 110         bool has_vlans;
 111
 112         struct uloop_timeout retry;
 113         struct bridge_member *primary_port;
 114         struct vlist_tree members;
 115         int n_present;
 116         int n_failed;
 117 };
 118
 119 struct bridge_member {
 120         struct vlist_node node;
 121         struct bridge_state *bst;
 122         struct device_user dev;
 123         uint16_t pvid;
 124         bool present;
 125         char name[];
 126 };
 127
 128 struct bridge_vlan_hotplug_port {
 129         struct list_head list;
 130         struct bridge_vlan_port port;
 131 };
 132
 133 static void
 134 bridge_reset_primary(struct bridge_state *bst)
 135 {
 136         struct bridge_member *bm;
 137
 138         if (!bst->primary_port &&
 139             (bst->dev.settings.flags & DEV_OPT_MACADDR))
 140                 return;
 141
 142         bst->primary_port = NULL;
 143         bst->dev.settings.flags &= ~DEV_OPT_MACADDR;
 144         vlist_for_each_element(&bst->members, bm, node) {
 145                 uint8_t *macaddr;
 146
 147                 if (!bm->present)
 148                         continue;
 149
 150                 bst->primary_port = bm;
 151                 if (bm->dev.dev->settings.flags & DEV_OPT_MACADDR)
 152                         macaddr = bm->dev.dev->settings.macaddr;
 153                 else
 154                         macaddr = bm->dev.dev->orig_settings.macaddr;
 155                 memcpy(bst->dev.settings.macaddr, macaddr, 6);
 156                 bst->dev.settings.flags |= DEV_OPT_MACADDR;
 157                 return;
 158         }
 159 }
 160
 161 static struct bridge_vlan_port *
 162 bridge_find_vlan_member_port(struct bridge_member *bm, struct bridge_vlan *vlan)
 163 {
 164         struct bridge_vlan_hotplug_port *port;
 165         const char *ifname = bm->dev.dev->ifname;
 166         int i;
 167
 168         for (i = 0; i < vlan->n_ports; i++) {
 169                 if (strcmp(vlan->ports[i].ifname, ifname) != 0)
 170                         continue;
 171
 172                 return &vlan->ports[i];
 173         }
 174
 175         list_for_each_entry(port, &vlan->hotplug_ports, list) {
 176                 if (strcmp(port->port.ifname, ifname) != 0)
 177                         continue;
 178
 179                 return &port->port;
 180         }
 181
 182         return NULL;
 183 }
 184
 185 static bool
 186 bridge_member_vlan_is_pvid(struct bridge_member *bm, struct bridge_vlan_port *port)
 187 {
 188         return (!bm->pvid && (port->flags & BRVLAN_F_UNTAGGED)) ||
 189                (port->flags & BRVLAN_F_PVID);
 190 }
 191
 192 static void
 193 __bridge_set_member_vlan(struct bridge_member *bm, struct bridge_vlan *vlan,
 194                          struct bridge_vlan_port *port, bool add)
 195 {
 196         uint16_t flags;
 197
 198         flags = port->flags;
 199         if (bm->pvid == vlan->vid)
 200                 flags |= BRVLAN_F_PVID;
 201
 202         system_bridge_vlan(port->ifname, vlan->vid, add, flags);
 203 }
 204
 205 static void
 206 bridge_set_member_vlan(struct bridge_member *bm, struct bridge_vlan *vlan, bool add)
 207 {
 208         struct bridge_vlan_port *port;
 209
 210         if (!bm->present)
 211                 return;
 212
 213         port = bridge_find_vlan_member_port(bm, vlan);
 214         if (!port)
 215                 return;
 216
 217         if (bridge_member_vlan_is_pvid(bm, port))
 218                 bm->pvid = vlan->vid;
 219
 220         __bridge_set_member_vlan(bm, vlan, port, add);
 221 }
 222
 223 static void
 224 bridge_set_local_vlan(struct bridge_state *bst, struct bridge_vlan *vlan, bool add)
 225 {
 226         if (!vlan->local && add)
 227                 return;
 228
 229         system_bridge_vlan(bst->dev.ifname, vlan->vid, add, BRVLAN_F_SELF);
 230 }
 231
 232 static void
 233 bridge_set_local_vlans(struct bridge_state *bst, bool add)
 234 {
 235         struct bridge_vlan *vlan;
 236
 237         vlist_for_each_element(&bst->dev.vlans, vlan, node)
 238                 bridge_set_local_vlan(bst, vlan, add);
 239 }
 240
 241 static struct bridge_vlan *
 242 bridge_recalc_member_pvid(struct bridge_member *bm)
 243 {
 244         struct bridge_state *bst = bm->bst;
 245         struct bridge_vlan_port *port;
 246         struct bridge_vlan *vlan, *ret = NULL;
 247
 248         vlist_for_each_element(&bst->dev.vlans, vlan, node) {
 249                 port = bridge_find_vlan_member_port(bm, vlan);
 250                 if (!port)
 251                         continue;
 252
 253                 if (!bridge_member_vlan_is_pvid(bm, port))
 254                         continue;
 255
 256                 ret = vlan;
 257                 if (port->flags & BRVLAN_F_PVID)
 258                         break;
 259         }
 260
 261         return ret;
 262 }
 263
 264 static void
 265 bridge_set_vlan_state(struct bridge_state *bst, struct bridge_vlan *vlan, bool add)
 266 {
 267         struct bridge_member *bm;
 268         struct bridge_vlan *vlan2;
 269
 270         bridge_set_local_vlan(bst, vlan, add);
 271
 272         vlist_for_each_element(&bst->members, bm, node) {
 273                 struct bridge_vlan_port *port;
 274                 int new_pvid = -1;
 275
 276                 port = bridge_find_vlan_member_port(bm, vlan);
 277                 if (!port)
 278                         continue;
 279
 280                 if (add) {
 281                         if (bridge_member_vlan_is_pvid(bm, port))
 282                                 bm->pvid = vlan->vid;
 283                 } else if (bm->pvid == vlan->vid) {
 284                         vlan2 = bridge_recalc_member_pvid(bm);
 285                         if (vlan2 && vlan2->vid != vlan->vid) {
 286                                 bridge_set_member_vlan(bm, vlan2, false);
 287                                 bridge_set_member_vlan(bm, vlan2, true);
 288                         }
 289                         new_pvid = vlan2 ? vlan2->vid : 0;
 290                 }
 291
 292                 if (!bm->present)
 293                         continue;
 294
 295                 __bridge_set_member_vlan(bm, vlan, port, add);
 296                 if (new_pvid >= 0)
 297                         bm->pvid = new_pvid;
 298         }
 299 }
 300
 301 static int
 302 bridge_disable_member(struct bridge_member *bm)
 303 {
 304         struct bridge_state *bst = bm->bst;
 305         struct bridge_vlan *vlan;
 306
 307         if (!bm->present)
 308                 return 0;
 309
 310         vlist_for_each_element(&bst->dev.vlans, vlan, node)
 311                 bridge_set_member_vlan(bm, vlan, false);
 312
 313         system_bridge_delif(&bst->dev, bm->dev.dev);
 314         device_release(&bm->dev);
 315
 316         device_broadcast_event(&bst->dev, DEV_EVENT_TOPO_CHANGE);
 317
 318         return 0;
 319 }
 320
 321 static int
 322 bridge_enable_interface(struct bridge_state *bst)
 323 {
 324         int ret;
 325
 326         if (bst->active)
 327                 return 0;
 328
 329         ret = system_bridge_addbr(&bst->dev, &bst->config);
 330         if (ret < 0)
 331                 return ret;
 332
 333         if (bst->has_vlans) {
 334                 /* delete default VLAN 1 */
 335                 system_bridge_vlan(bst->dev.ifname, 1, false, BRVLAN_F_SELF);
 336
 337                 bridge_set_local_vlans(bst, true);
 338         }
 339
 340         bst->active = true;
 341         return 0;
 342 }
 343
 344 static void
 345 bridge_disable_interface(struct bridge_state *bst)
 346 {
 347         if (!bst->active)
 348                 return;
 349
 350         system_bridge_delbr(&bst->dev);
 351         bst->active = false;
 352 }
 353
 354 static int
 355 bridge_enable_member(struct bridge_member *bm)
 356 {
 357         struct bridge_state *bst = bm->bst;
 358         struct bridge_vlan *vlan;
 359         int ret;
 360
 361         if (!bm->present)
 362                 return 0;
 363
 364         ret = bridge_enable_interface(bst);
 365         if (ret)
 366                 goto error;
 367
 368         /* Disable IPv6 for bridge members */
 369         if (!(bm->dev.dev->settings.flags & DEV_OPT_IPV6)) {
 370                 bm->dev.dev->settings.ipv6 = 0;
 371                 bm->dev.dev->settings.flags |= DEV_OPT_IPV6;
 372         }
 373
 374         ret = device_claim(&bm->dev);
 375         if (ret < 0)
 376                 goto error;
 377
 378         ret = system_bridge_addif(&bst->dev, bm->dev.dev);
 379         if (ret < 0) {
 380                 D(DEVICE, "Bridge device %s could not be added\n", bm->dev.dev->ifname);
 381                 goto error;
 382         }
 383
 384         if (bst->has_vlans) {
 385                 /* delete default VLAN 1 */
 386                 system_bridge_vlan(bm->dev.dev->ifname, 1, false, 0);
 387
 388                 vlist_for_each_element(&bst->dev.vlans, vlan, node)
 389                         bridge_set_member_vlan(bm, vlan, true);
 390         }
 391
 392         device_set_present(&bst->dev, true);
 393         device_broadcast_event(&bst->dev, DEV_EVENT_TOPO_CHANGE);
 394
 395         return 0;
 396
 397 error:
 398         bst->n_failed++;
 399         bm->present = false;
 400         bst->n_present--;
 401         device_release(&bm->dev);
 402
 403         return ret;
 404 }
 405
 406 static void
 407 bridge_remove_member(struct bridge_member *bm)
 408 {
 409         struct bridge_state *bst = bm->bst;
 410
 411         if (!bm->present)
 412                 return;
 413
 414         if (bst->dev.active)
 415                 bridge_disable_member(bm);
 416
 417         bm->present = false;
 418         bm->bst->n_present--;
 419
 420         if (bm == bst->primary_port)
 421                 bridge_reset_primary(bst);
 422
 423         if (bst->config.bridge_empty)
 424                 return;
 425
 426         bst->force_active = false;
 427         if (bst->n_present == 0)
 428                 device_set_present(&bst->dev, false);
 429 }
 430
 431 static void
 432 bridge_free_member(struct bridge_member *bm)
 433 {
 434         struct bridge_state *bst = bm->bst;
 435         struct device *dev = bm->dev.dev;
 436         const char *ifname = dev->ifname;
 437         struct bridge_vlan *vlan;
 438
 439         bridge_remove_member(bm);
 440
 441         vlist_for_each_element(&bst->dev.vlans, vlan, node) {
 442                 struct bridge_vlan_hotplug_port *port, *tmp;
 443
 444                 list_for_each_entry_safe(port, tmp, &vlan->hotplug_ports, list) {
 445                         if (strcmp(port->port.ifname, ifname) != 0)
 446                                 continue;
 447
 448                         list_del(&port->list);
 449                         free(port);
 450                 }
 451         }
 452
 453         device_lock();
 454
 455         device_remove_user(&bm->dev);
 456
 457         /*
 458          * When reloading the config and moving a device from one bridge to
 459          * another, the other bridge may have tried to claim this device
 460          * before it was removed here.
 461          * Ensure that claiming the device is retried by toggling its present
 462          * state
 463          */
 464         if (dev->present) {
 465                 device_set_present(dev, false);
 466                 device_set_present(dev, true);
 467         }
 468
 469         device_unlock();
 470
 471         free(bm);
 472 }
 473
 474 static void
 475 bridge_check_retry(struct bridge_state *bst)
 476 {
 477         if (!bst->n_failed)
 478                 return;
 479
 480         uloop_timeout_set(&bst->retry, 100);
 481 }
 482
 483 static void
 484 bridge_member_cb(struct device_user *dev, enum device_event ev)
 485 {
 486         struct bridge_member *bm = container_of(dev, struct bridge_member, dev);
 487         struct bridge_state *bst = bm->bst;
 488
 489         switch (ev) {
 490         case DEV_EVENT_ADD:
 491                 assert(!bm->present);
 492
 493                 bm->present = true;
 494                 bst->n_present++;
 495
 496                 if (bst->n_present == 1)
 497                         device_set_present(&bst->dev, true);
 498                 if (bst->dev.active && !bridge_enable_member(bm)) {
 499                         /*
 500                          * Adding a bridge member can overwrite the bridge mtu
 501                          * in the kernel, apply the bridge settings in case the
 502                          * bridge mtu is set
 503                          */
 504                         system_if_apply_settings(&bst->dev, &bst->dev.settings,
 505                                                  DEV_OPT_MTU | DEV_OPT_MTU6);
 506                 }
 507
 508                 break;
 509         case DEV_EVENT_REMOVE:
 510                 if (dev->hotplug) {
 511                         vlist_delete(&bst->members, &bm->node);
 512                         return;
 513                 }
 514
 515                 if (bm->present)
 516                         bridge_remove_member(bm);
 517
 518                 break;
 519         default:
 520                 return;
 521         }
 522 }
 523
 524 static int
 525 bridge_set_down(struct bridge_state *bst)
 526 {
 527         struct bridge_member *bm;
 528
 529         bst->set_state(&bst->dev, false);
 530
 531         vlist_for_each_element(&bst->members, bm, node)
 532                 bridge_disable_member(bm);
 533
 534         bridge_disable_interface(bst);
 535
 536         return 0;
 537 }
 538
 539 static int
 540 bridge_set_up(struct bridge_state *bst)
 541 {
 542         struct bridge_member *bm;
 543         int ret;
 544
 545         bst->has_vlans = !avl_is_empty(&bst->dev.vlans.avl);
 546         if (!bst->n_present) {
 547                 if (!bst->force_active)
 548                         return -ENOENT;
 549
 550                 ret = bridge_enable_interface(bst);
 551                 if (ret)
 552                         return ret;
 553         }
 554
 555         bst->n_failed = 0;
 556         vlist_for_each_element(&bst->members, bm, node)
 557                 bridge_enable_member(bm);
 558         bridge_check_retry(bst);
 559
 560         if (!bst->force_active && !bst->n_present) {
 561                 /* initialization of all member interfaces failed */
 562                 bridge_disable_interface(bst);
 563                 device_set_present(&bst->dev, false);
 564                 return -ENOENT;
 565         }
 566
 567         bridge_reset_primary(bst);
 568         ret = bst->set_state(&bst->dev, true);
 569         if (ret < 0)
 570                 bridge_set_down(bst);
 571
 572         return ret;
 573 }
 574
 575 static int
 576 bridge_set_state(struct device *dev, bool up)
 577 {
 578         struct bridge_state *bst;
 579
 580         bst = container_of(dev, struct bridge_state, dev);
 581
 582         if (up)
 583                 return bridge_set_up(bst);
 584         else
 585                 return bridge_set_down(bst);
 586 }
 587
 588 static struct bridge_member *
 589 bridge_create_member(struct bridge_state *bst, const char *name,
 590                      struct device *dev, bool hotplug)
 591 {
 592         struct bridge_member *bm;
 593
 594         bm = calloc(1, sizeof(*bm) + strlen(name) + 1);
 595         if (!bm)
 596                 return NULL;
 597
 598         bm->bst = bst;
 599         bm->dev.cb = bridge_member_cb;
 600         bm->dev.hotplug = hotplug;
 601         strcpy(bm->name, name);
 602         bm->dev.dev = dev;
 603         vlist_add(&bst->members, &bm->node, bm->name);
 604         /*
 605          * Need to look up the bridge member again as the above
 606          * created pointer will be freed in case the bridge member
 607          * already existed
 608          */
 609         bm = vlist_find(&bst->members, name, bm, node);
 610         if (hotplug && bm)
 611                 bm->node.version = -1;
 612
 613         return bm;
 614 }
 615
 616 static void
 617 bridge_member_update(struct vlist_tree *tree, struct vlist_node *node_new,
 618                      struct vlist_node *node_old)
 619 {
 620         struct bridge_member *bm;
 621         struct device *dev;
 622
 623         if (node_new) {
 624                 bm = container_of(node_new, struct bridge_member, node);
 625
 626                 if (node_old) {
 627                         free(bm);
 628                         return;
 629                 }
 630
 631                 dev = bm->dev.dev;
 632                 bm->dev.dev = NULL;
 633                 device_add_user(&bm->dev, dev);
 634         }
 635
 636
 637         if (node_old) {
 638                 bm = container_of(node_old, struct bridge_member, node);
 639                 bridge_free_member(bm);
 640         }
 641 }
 642
 643
 644 static void
 645 bridge_add_member(struct bridge_state *bst, const char *name)
 646 {
 647         struct device *dev;
 648
 649         dev = device_get(name, true);
 650         if (!dev)
 651                 return;
 652
 653         bridge_create_member(bst, name, dev, false);
 654 }
 655
 656 static void
 657 bridge_hotplug_create_member_vlans(struct bridge_state *bst, struct blob_attr *vlans, const char *ifname)
 658 {
 659         struct bridge_vlan *vlan;
 660         struct blob_attr *cur;
 661         int rem;
 662
 663         if (!vlans)
 664                 return;
 665
 666         blobmsg_for_each_attr(cur, vlans, rem) {
 667                 struct bridge_vlan_hotplug_port *port;
 668                 uint16_t flags = BRVLAN_F_UNTAGGED;
 669                 char *name_buf;
 670                 unsigned int vid;
 671                 char *end;
 672
 673                 if (blobmsg_type(cur) != BLOBMSG_TYPE_STRING)
 674                         continue;
 675
 676                 vid = strtoul(blobmsg_get_string(cur), &end, 0);
 677                 if (!vid || vid > 4095)
 678                         continue;
 679
 680                 vlan = vlist_find(&bst->dev.vlans, &vid, vlan, node);
 681                 if (!vlan)
 682                         continue;
 683
 684                 if (end && *end) {
 685                         if (*end != ':')
 686                                 continue;
 687
 688                         for (end++; *end; end++) {
 689                                 switch (*end) {
 690                                 case 't':
 691                                         flags &= ~BRVLAN_F_UNTAGGED;
 692                                         break;
 693                                 case '*':
 694                                         flags |= BRVLAN_F_PVID;
 695                                         break;
 696                                 }
 697                         }
 698                 }
 699
 700                 port = calloc_a(sizeof(*port), &name_buf, strlen(ifname) + 1);
 701                 if (!port)
 702                         continue;
 703
 704                 port->port.flags = flags;
 705                 port->port.ifname = strcpy(name_buf, ifname);
 706                 list_add_tail(&port->list, &vlan->hotplug_ports);
 707         }
 708 }
 709
 710 static int
 711 bridge_hotplug_add(struct device *dev, struct device *member, struct blob_attr *vlan)
 712 {
 713         struct bridge_state *bst = container_of(dev, struct bridge_state, dev);
 714
 715         bridge_hotplug_create_member_vlans(bst, vlan, member->ifname);
 716         bridge_create_member(bst, member->ifname, member, true);
 717
 718         return 0;
 719 }
 720
 721 static int
 722 bridge_hotplug_del(struct device *dev, struct device *member)
 723 {
 724         struct bridge_state *bst = container_of(dev, struct bridge_state, dev);
 725         struct bridge_member *bm;
 726
 727         bm = vlist_find(&bst->members, member->ifname, bm, node);
 728         if (!bm)
 729                 return UBUS_STATUS_NOT_FOUND;
 730
 731         vlist_delete(&bst->members, &bm->node);
 732         return 0;
 733 }
 734
 735 static int
 736 bridge_hotplug_prepare(struct device *dev, struct device **bridge_dev)
 737 {
 738         struct bridge_state *bst;
 739
 740         if (bridge_dev)
 741                 *bridge_dev = dev;
 742
 743         bst = container_of(dev, struct bridge_state, dev);
 744         bst->force_active = true;
 745         device_set_present(&bst->dev, true);
 746
 747         return 0;
 748 }
 749
 750 static const struct device_hotplug_ops bridge_ops = {
 751         .prepare = bridge_hotplug_prepare,
 752         .add = bridge_hotplug_add,
 753         .del = bridge_hotplug_del
 754 };
 755
 756 static void
 757 bridge_free(struct device *dev)
 758 {
 759         struct bridge_state *bst;
 760
 761         bst = container_of(dev, struct bridge_state, dev);
 762         vlist_flush_all(&bst->members);
 763         vlist_flush_all(&dev->vlans);
 764         kvlist_free(&dev->vlan_aliases);
 765         free(bst->config_data);
 766         free(bst);
 767 }
 768
 769 static void
 770 bridge_dump_port(struct blob_buf *b, struct bridge_vlan_port *port)
 771 {
 772         bool tagged = !(port->flags & BRVLAN_F_UNTAGGED);
 773         bool pvid = (port->flags & BRVLAN_F_PVID);
 774
 775         blobmsg_printf(b, "%s%s%s%s\n", port->ifname,
 776                 tagged || pvid ? ":" : "",
 777                 tagged ? "t" : "",
 778                 pvid ? "*" : "");
 779 }
 780
 781 static void
 782 bridge_dump_vlan(struct blob_buf *b, struct bridge_vlan *vlan)
 783 {
 784         struct bridge_vlan_hotplug_port *port;
 785         void *c, *p;
 786         int i;
 787
 788         c = blobmsg_open_table(b, NULL);
 789
 790         blobmsg_add_u32(b, "id", vlan->vid);
 791         blobmsg_add_u8(b, "local", vlan->local);
 792
 793         p = blobmsg_open_array(b, "ports");
 794
 795         for (i = 0; i < vlan->n_ports; i++)
 796             bridge_dump_port(b, &vlan->ports[i]);
 797
 798         list_for_each_entry(port, &vlan->hotplug_ports, list)
 799                 bridge_dump_port(b, &port->port);
 800
 801         blobmsg_close_array(b, p);
 802
 803         blobmsg_close_table(b, c);
 804 }
 805
 806 static void
 807 bridge_dump_info(struct device *dev, struct blob_buf *b)
 808 {
 809         struct bridge_state *bst;
 810         struct bridge_member *bm;
 811         struct bridge_vlan *vlan;
 812         void *list;
 813
 814         bst = container_of(dev, struct bridge_state, dev);
 815
 816         system_if_dump_info(dev, b);
 817         list = blobmsg_open_array(b, "bridge-members");
 818
 819         vlist_for_each_element(&bst->members, bm, node) {
 820                 if (bm->dev.dev->hidden)
 821                         continue;
 822
 823                 blobmsg_add_string(b, NULL, bm->dev.dev->ifname);
 824         }
 825
 826         blobmsg_close_array(b, list);
 827
 828         if (avl_is_empty(&dev->vlans.avl))
 829                 return;
 830
 831         list = blobmsg_open_array(b, "bridge-vlans");
 832
 833         vlist_for_each_element(&bst->dev.vlans, vlan, node)
 834                 bridge_dump_vlan(b, vlan);
 835
 836         blobmsg_close_array(b, list);
 837 }
 838
 839 static void
 840 bridge_config_init(struct device *dev)
 841 {
 842         struct bridge_state *bst;
 843         struct bridge_vlan *vlan;
 844         struct blob_attr *cur;
 845         int i, rem;
 846
 847         bst = container_of(dev, struct bridge_state, dev);
 848
 849         if (bst->config.bridge_empty) {
 850                 bst->force_active = true;
 851                 device_set_present(&bst->dev, true);
 852         }
 853
 854         bst->n_failed = 0;
 855         vlist_update(&bst->members);
 856         if (bst->ifnames) {
 857                 blobmsg_for_each_attr(cur, bst->ifnames, rem) {
 858                         bridge_add_member(bst, blobmsg_data(cur));
 859                 }
 860         }
 861
 862         vlist_for_each_element(&bst->dev.vlans, vlan, node)
 863                 for (i = 0; i < vlan->n_ports; i++)
 864                         bridge_add_member(bst, vlan->ports[i].ifname);
 865
 866         vlist_flush(&bst->members);
 867         bridge_check_retry(bst);
 868 }
 869
 870 static void
 871 bridge_apply_settings(struct bridge_state *bst, struct blob_attr **tb)
 872 {
 873         struct bridge_config *cfg = &bst->config;
 874         struct blob_attr *cur;
 875
 876         /* defaults */
 877         cfg->stp = false;
 878         cfg->forward_delay = 2;
 879         cfg->robustness = 2;
 880         cfg->query_interval = 12500;
 881         cfg->query_response_interval = 1000;
 882         cfg->last_member_interval = 100;
 883         cfg->hash_max = 512;
 884         cfg->bridge_empty = false;
 885         cfg->priority = 0x7FFF;
 886         cfg->vlan_filtering = false;
 887
 888         if ((cur = tb[BRIDGE_ATTR_STP]))
 889                 cfg->stp = blobmsg_get_bool(cur);
 890
 891         if ((cur = tb[BRIDGE_ATTR_FORWARD_DELAY]))
 892                 cfg->forward_delay = blobmsg_get_u32(cur);
 893
 894         if ((cur = tb[BRIDGE_ATTR_PRIORITY]))
 895                 cfg->priority = blobmsg_get_u32(cur);
 896
 897         if ((cur = tb[BRIDGE_ATTR_IGMP_SNOOP]))
 898                 cfg->multicast_querier = cfg->igmp_snoop = blobmsg_get_bool(cur);
 899
 900         if ((cur = tb[BRIDGE_ATTR_MULTICAST_QUERIER]))
 901                 cfg->multicast_querier = blobmsg_get_bool(cur);
 902
 903         if ((cur = tb[BRIDGE_ATTR_HASH_MAX]))
 904                 cfg->hash_max = blobmsg_get_u32(cur);
 905
 906         if ((cur = tb[BRIDGE_ATTR_ROBUSTNESS])) {
 907                 cfg->robustness = blobmsg_get_u32(cur);
 908                 cfg->flags |= BRIDGE_OPT_ROBUSTNESS;
 909         }
 910
 911         if ((cur = tb[BRIDGE_ATTR_QUERY_INTERVAL])) {
 912                 cfg->query_interval = blobmsg_get_u32(cur);
 913                 cfg->flags |= BRIDGE_OPT_QUERY_INTERVAL;
 914         }
 915
 916         if ((cur = tb[BRIDGE_ATTR_QUERY_RESPONSE_INTERVAL])) {
 917                 cfg->query_response_interval = blobmsg_get_u32(cur);
 918                 cfg->flags |= BRIDGE_OPT_QUERY_RESPONSE_INTERVAL;
 919         }
 920
 921         if ((cur = tb[BRIDGE_ATTR_LAST_MEMBER_INTERVAL])) {
 922                 cfg->last_member_interval = blobmsg_get_u32(cur);
 923                 cfg->flags |= BRIDGE_OPT_LAST_MEMBER_INTERVAL;
 924         }
 925
 926         if ((cur = tb[BRIDGE_ATTR_AGEING_TIME])) {
 927                 cfg->ageing_time = blobmsg_get_u32(cur);
 928                 cfg->flags |= BRIDGE_OPT_AGEING_TIME;
 929         }
 930
 931         if ((cur = tb[BRIDGE_ATTR_HELLO_TIME])) {
 932                 cfg->hello_time = blobmsg_get_u32(cur);
 933                 cfg->flags |= BRIDGE_OPT_HELLO_TIME;
 934         }
 935
 936         if ((cur = tb[BRIDGE_ATTR_MAX_AGE])) {
 937                 cfg->max_age = blobmsg_get_u32(cur);
 938                 cfg->flags |= BRIDGE_OPT_MAX_AGE;
 939         }
 940
 941         if ((cur = tb[BRIDGE_ATTR_BRIDGE_EMPTY]))
 942                 cfg->bridge_empty = blobmsg_get_bool(cur);
 943
 944         if ((cur = tb[BRIDGE_ATTR_VLAN_FILTERING]))
 945                 cfg->vlan_filtering = blobmsg_get_bool(cur);
 946 }
 947
 948 static enum dev_change_type
 949 bridge_reload(struct device *dev, struct blob_attr *attr)
 950 {
 951         struct blob_attr *tb_dev[__DEV_ATTR_MAX];
 952         struct blob_attr *tb_br[__BRIDGE_ATTR_MAX];
 953         enum dev_change_type ret = DEV_CONFIG_APPLIED;
 954         unsigned long diff;
 955         struct bridge_state *bst;
 956
 957         BUILD_BUG_ON(sizeof(diff) < __BRIDGE_ATTR_MAX / 8);
 958         BUILD_BUG_ON(sizeof(diff) < __DEV_ATTR_MAX / 8);
 959
 960         bst = container_of(dev, struct bridge_state, dev);
 961         attr = blob_memdup(attr);
 962
 963         blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, tb_dev,
 964                 blob_data(attr), blob_len(attr));
 965         blobmsg_parse(bridge_attrs, __BRIDGE_ATTR_MAX, tb_br,
 966                 blob_data(attr), blob_len(attr));
 967
 968         if (tb_dev[DEV_ATTR_MACADDR])
 969                 bst->primary_port = NULL;
 970
 971         bst->ifnames = tb_br[BRIDGE_ATTR_IFNAME];
 972         device_init_settings(dev, tb_dev);
 973         bridge_apply_settings(bst, tb_br);
 974
 975         if (bst->config_data) {
 976                 struct blob_attr *otb_dev[__DEV_ATTR_MAX];
 977                 struct blob_attr *otb_br[__BRIDGE_ATTR_MAX];
 978
 979                 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, otb_dev,
 980                         blob_data(bst->config_data), blob_len(bst->config_data));
 981
 982                 diff = 0;
 983                 uci_blob_diff(tb_dev, otb_dev, &device_attr_list, &diff);
 984                 if (diff)
 985                     ret = DEV_CONFIG_RESTART;
 986
 987                 blobmsg_parse(bridge_attrs, __BRIDGE_ATTR_MAX, otb_br,
 988                         blob_data(bst->config_data), blob_len(bst->config_data));
 989
 990                 diff = 0;
 991                 uci_blob_diff(tb_br, otb_br, &bridge_attr_list, &diff);
 992                 if (diff & ~(1 << BRIDGE_ATTR_IFNAME))
 993                     ret = DEV_CONFIG_RESTART;
 994
 995                 bridge_config_init(dev);
 996         }
 997
 998         free(bst->config_data);
 999         bst->config_data = attr;
1000         return ret;
1001 }
1002
1003 static void
1004 bridge_retry_members(struct uloop_timeout *timeout)
1005 {
1006         struct bridge_state *bst = container_of(timeout, struct bridge_state, retry);
1007         struct bridge_member *bm;
1008
1009         bst->n_failed = 0;
1010         vlist_for_each_element(&bst->members, bm, node) {
1011                 if (bm->present)
1012                         continue;
1013
1014                 if (!bm->dev.dev->present)
1015                         continue;
1016
1017                 bm->present = true;
1018                 bst->n_present++;
1019                 bridge_enable_member(bm);
1020         }
1021 }
1022
1023 static int bridge_avl_cmp_u16(const void *k1, const void *k2, void *ptr)
1024 {
1025         const uint16_t *i1 = k1, *i2 = k2;
1026
1027         return *i1 - *i2;
1028 }
1029
1030 static bool
1031 bridge_vlan_equal(struct bridge_vlan *v1, struct bridge_vlan *v2)
1032 {
1033         int i;
1034
1035         if (v1->n_ports != v2->n_ports)
1036                 return false;
1037
1038         for (i = 0; i < v1->n_ports; i++)
1039                 if (v1->ports[i].flags != v2->ports[i].flags ||
1040                     strcmp(v1->ports[i].ifname, v2->ports[i].ifname) != 0)
1041                         return false;
1042
1043         return true;
1044 }
1045
1046 static void
1047 bridge_vlan_free(struct bridge_vlan *vlan)
1048 {
1049         struct bridge_vlan_hotplug_port *port, *tmp;
1050
1051         if (!vlan)
1052                 return;
1053
1054         list_for_each_entry_safe(port, tmp, &vlan->hotplug_ports, list)
1055                 free(port);
1056
1057         free(vlan);
1058 }
1059
1060 static void
1061 bridge_vlan_update(struct vlist_tree *tree, struct vlist_node *node_new,
1062                    struct vlist_node *node_old)
1063 {
1064         struct bridge_state *bst = container_of(tree, struct bridge_state, dev.vlans);
1065         struct bridge_vlan *vlan_new = NULL, *vlan_old = NULL;
1066
1067         if (!bst->has_vlans || !bst->active)
1068                 goto out;
1069
1070         if (node_old)
1071                 vlan_old = container_of(node_old, struct bridge_vlan, node);
1072         if (node_new)
1073                 vlan_new = container_of(node_new, struct bridge_vlan, node);
1074
1075         if (node_new && node_old && bridge_vlan_equal(vlan_old, vlan_new)) {
1076                 list_splice_init(&vlan_old->hotplug_ports, &vlan_new->hotplug_ports);
1077                 goto out;
1078         }
1079
1080         if (node_old)
1081                 bridge_set_vlan_state(bst, vlan_old, false);
1082
1083         if (node_old && node_new)
1084                 list_splice_init(&vlan_old->hotplug_ports, &vlan_new->hotplug_ports);
1085
1086         if (node_new)
1087                 bridge_set_vlan_state(bst, vlan_new, true);
1088
1089         bst->dev.config_pending = true;
1090
1091 out:
1092         bridge_vlan_free(vlan_old);
1093 }
1094
1095 static struct device *
1096 bridge_create(const char *name, struct device_type *devtype,
1097         struct blob_attr *attr)
1098 {
1099         struct bridge_state *bst;
1100         struct device *dev = NULL;
1101
1102         bst = calloc(1, sizeof(*bst));
1103         if (!bst)
1104                 return NULL;
1105
1106         dev = &bst->dev;
1107
1108         if (device_init(dev, devtype, name) < 0) {
1109                 device_cleanup(dev);
1110                 free(bst);
1111                 return NULL;
1112         }
1113
1114         dev->config_pending = true;
1115         bst->retry.cb = bridge_retry_members;
1116
1117         bst->set_state = dev->set_state;
1118         dev->set_state = bridge_set_state;
1119
1120         dev->hotplug_ops = &bridge_ops;
1121
1122         vlist_init(&bst->members, avl_strcmp, bridge_member_update);
1123         bst->members.keep_old = true;
1124
1125         vlist_init(&dev->vlans, bridge_avl_cmp_u16, bridge_vlan_update);
1126
1127         bridge_reload(dev, attr);
1128
1129         return dev;
1130 }
1131
1132 static void __init bridge_device_type_init(void)
1133 {
1134         device_type_add(&bridge_device_type);
1135 }