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_IGMP_SNOOP,
  30         BRIDGE_ATTR_AGEING_TIME,
  31         BRIDGE_ATTR_HELLO_TIME,
  32         BRIDGE_ATTR_MAX_AGE,
  33         __BRIDGE_ATTR_MAX
  34 };
  35
  36 static const struct blobmsg_policy bridge_attrs[__BRIDGE_ATTR_MAX] = {
  37         [BRIDGE_ATTR_IFNAME] = { "ifname", BLOBMSG_TYPE_ARRAY },
  38         [BRIDGE_ATTR_STP] = { "stp", BLOBMSG_TYPE_BOOL },
  39         [BRIDGE_ATTR_FORWARD_DELAY] = { "forward_delay", BLOBMSG_TYPE_INT32 },
  40         [BRIDGE_ATTR_AGEING_TIME] = { "ageing_time", BLOBMSG_TYPE_INT32 },
  41         [BRIDGE_ATTR_HELLO_TIME] = { "hello_time", BLOBMSG_TYPE_INT32 },
  42         [BRIDGE_ATTR_MAX_AGE] = { "max_age", BLOBMSG_TYPE_INT32 },
  43         [BRIDGE_ATTR_IGMP_SNOOP] = { "igmp_snooping", BLOBMSG_TYPE_BOOL },
  44 };
  45
  46 static const union config_param_info bridge_attr_info[__BRIDGE_ATTR_MAX] = {
  47         [BRIDGE_ATTR_IFNAME] = { .type = BLOBMSG_TYPE_STRING },
  48 };
  49
  50 static const struct config_param_list bridge_attr_list = {
  51         .n_params = __BRIDGE_ATTR_MAX,
  52         .params = bridge_attrs,
  53         .info = bridge_attr_info,
  54
  55         .n_next = 1,
  56         .next = { &device_attr_list },
  57 };
  58
  59 static struct device *bridge_create(const char *name, struct blob_attr *attr);
  60 static void bridge_config_init(struct device *dev);
  61 static void bridge_free(struct device *dev);
  62 static void bridge_dump_info(struct device *dev, struct blob_buf *b);
  63 enum dev_change_type
  64 bridge_reload(struct device *dev, struct blob_attr *attr);
  65
  66 const struct device_type bridge_device_type = {
  67         .name = "Bridge",
  68         .config_params = &bridge_attr_list,
  69
  70         .create = bridge_create,
  71         .config_init = bridge_config_init,
  72         .reload = bridge_reload,
  73         .free = bridge_free,
  74         .dump_info = bridge_dump_info,
  75 };
  76
  77 struct bridge_state {
  78         struct device dev;
  79         device_state_cb set_state;
  80
  81         struct blob_attr *config_data;
  82         struct bridge_config config;
  83         struct blob_attr *ifnames;
  84         bool active;
  85         bool force_active;
  86
  87         struct bridge_member *primary_port;
  88         struct vlist_tree members;
  89         int n_present;
  90 };
  91
  92 struct bridge_member {
  93         struct vlist_node node;
  94         struct bridge_state *bst;
  95         struct device_user dev;
  96         bool present;
  97         char name[];
  98 };
  99
 100 static void
 101 bridge_reset_primary(struct bridge_state *bst)
 102 {
 103         struct bridge_member *bm;
 104
 105         bst->primary_port = NULL;
 106         vlist_for_each_element(&bst->members, bm, node) {
 107                 if (!bm->present)
 108                         continue;
 109
 110                 bst->primary_port = bm;
 111                 memcpy(bst->dev.settings.macaddr, bm->dev.dev->settings.macaddr, 6);
 112                 bst->dev.settings.flags |= DEV_OPT_MACADDR;
 113                 return;
 114         }
 115 }
 116
 117 static int
 118 bridge_disable_member(struct bridge_member *bm)
 119 {
 120         struct bridge_state *bst = bm->bst;
 121
 122         if (!bm->present)
 123                 return 0;
 124
 125         system_bridge_delif(&bst->dev, bm->dev.dev);
 126         device_release(&bm->dev);
 127
 128         return 0;
 129 }
 130
 131 static int
 132 bridge_enable_member(struct bridge_member *bm)
 133 {
 134         struct bridge_state *bst = bm->bst;
 135         int ret;
 136
 137         if (!bm->present)
 138                 return 0;
 139
 140         ret = device_claim(&bm->dev);
 141         if (ret < 0)
 142                 goto error;
 143
 144         ret = system_bridge_addif(&bst->dev, bm->dev.dev);
 145         if (ret < 0) {
 146                 D(DEVICE, "Bridge device %s could not be added\n", bm->dev.dev->ifname);
 147                 goto error;
 148         }
 149
 150         return 0;
 151
 152 error:
 153         bm->present = false;
 154         bst->n_present--;
 155         return ret;
 156 }
 157
 158 static void
 159 bridge_remove_member(struct bridge_member *bm)
 160 {
 161         struct bridge_state *bst = bm->bst;
 162
 163         if (!bm->present)
 164                 return;
 165
 166         if (bm == bst->primary_port);
 167                 bridge_reset_primary(bst);
 168
 169         if (bst->dev.active)
 170                 bridge_disable_member(bm);
 171
 172         bm->present = false;
 173         bm->bst->n_present--;
 174
 175         bst->force_active = false;
 176         if (bst->n_present == 0)
 177                 device_set_present(&bst->dev, false);
 178 }
 179
 180 static void
 181 bridge_member_cb(struct device_user *dev, enum device_event ev)
 182 {
 183         struct bridge_member *bm = container_of(dev, struct bridge_member, dev);
 184         struct bridge_state *bst = bm->bst;
 185
 186         switch (ev) {
 187         case DEV_EVENT_ADD:
 188                 assert(!bm->present);
 189
 190                 bm->present = true;
 191                 bst->n_present++;
 192
 193                 if (bst->dev.active)
 194                         bridge_enable_member(bm);
 195                 else if (bst->n_present == 1)
 196                         device_set_present(&bst->dev, true);
 197
 198                 break;
 199         case DEV_EVENT_REMOVE:
 200                 if (dev->hotplug) {
 201                         vlist_delete(&bst->members, &bm->node);
 202                         return;
 203                 }
 204
 205                 if (bm->present)
 206                         bridge_remove_member(bm);
 207
 208                 break;
 209         default:
 210                 return;
 211         }
 212 }
 213
 214 static int
 215 bridge_set_down(struct bridge_state *bst)
 216 {
 217         struct bridge_member *bm;
 218
 219         bst->set_state(&bst->dev, false);
 220
 221         vlist_for_each_element(&bst->members, bm, node)
 222                 bridge_disable_member(bm);
 223
 224         system_bridge_delbr(&bst->dev);
 225
 226         return 0;
 227 }
 228
 229 static int
 230 bridge_set_up(struct bridge_state *bst)
 231 {
 232         struct bridge_member *bm;
 233         int ret;
 234
 235         if (!bst->force_active && !bst->n_present)
 236                 return -ENOENT;
 237
 238         ret = system_bridge_addbr(&bst->dev, &bst->config);
 239         if (ret < 0)
 240                 goto out;
 241
 242         vlist_for_each_element(&bst->members, bm, node)
 243                 bridge_enable_member(bm);
 244
 245         if (!bst->force_active && !bst->n_present) {
 246                 /* initialization of all member interfaces failed */
 247                 system_bridge_delbr(&bst->dev);
 248                 device_set_present(&bst->dev, false);
 249                 return -ENOENT;
 250         }
 251
 252         bridge_reset_primary(bst);
 253         ret = bst->set_state(&bst->dev, true);
 254         if (ret < 0)
 255                 bridge_set_down(bst);
 256
 257 out:
 258         return ret;
 259 }
 260
 261 static int
 262 bridge_set_state(struct device *dev, bool up)
 263 {
 264         struct bridge_state *bst;
 265
 266         bst = container_of(dev, struct bridge_state, dev);
 267
 268         if (up)
 269                 return bridge_set_up(bst);
 270         else
 271                 return bridge_set_down(bst);
 272 }
 273
 274 static struct bridge_member *
 275 bridge_create_member(struct bridge_state *bst, struct device *dev, bool hotplug)
 276 {
 277         struct bridge_member *bm;
 278
 279         bm = calloc(1, sizeof(*bm) + strlen(dev->ifname) + 1);
 280         bm->bst = bst;
 281         bm->dev.cb = bridge_member_cb;
 282         bm->dev.hotplug = hotplug;
 283         strcpy(bm->name, dev->ifname);
 284         bm->dev.dev = dev;
 285         vlist_add(&bst->members, &bm->node, bm->name);
 286         if (hotplug)
 287                 bm->node.version = -1;
 288
 289         return bm;
 290 }
 291
 292 static void
 293 bridge_member_update(struct vlist_tree *tree, struct vlist_node *node_new,
 294                      struct vlist_node *node_old)
 295 {
 296         struct bridge_member *bm;
 297         struct device *dev;
 298
 299         if (node_new) {
 300                 bm = container_of(node_new, struct bridge_member, node);
 301
 302                 if (node_old) {
 303                         free(bm);
 304                         return;
 305                 }
 306
 307                 dev = bm->dev.dev;
 308                 bm->dev.dev = NULL;
 309                 device_add_user(&bm->dev, dev);
 310         }
 311
 312
 313         if (node_old) {
 314                 bm = container_of(node_old, struct bridge_member, node);
 315                 bridge_remove_member(bm);
 316                 device_remove_user(&bm->dev);
 317                 free(bm);
 318         }
 319 }
 320
 321
 322 static void
 323 bridge_add_member(struct bridge_state *bst, const char *name)
 324 {
 325         struct device *dev;
 326
 327         dev = device_get(name, true);
 328         if (!dev)
 329                 return;
 330
 331         bridge_create_member(bst, dev, false);
 332 }
 333
 334 static int
 335 bridge_hotplug_add(struct device *dev, struct device *member)
 336 {
 337         struct bridge_state *bst = container_of(dev, struct bridge_state, dev);
 338
 339         bridge_create_member(bst, member, true);
 340
 341         return 0;
 342 }
 343
 344 static int
 345 bridge_hotplug_del(struct device *dev, struct device *member)
 346 {
 347         struct bridge_state *bst = container_of(dev, struct bridge_state, dev);
 348         struct bridge_member *bm;
 349
 350         bm = vlist_find(&bst->members, member->ifname, bm, node);
 351         if (!bm)
 352                 return UBUS_STATUS_NOT_FOUND;
 353
 354         vlist_delete(&bst->members, &bm->node);
 355         return 0;
 356 }
 357
 358 static int
 359 bridge_hotplug_prepare(struct device *dev)
 360 {
 361         struct bridge_state *bst;
 362
 363         bst = container_of(dev, struct bridge_state, dev);
 364         bst->force_active = true;
 365         device_set_present(&bst->dev, true);
 366
 367         return 0;
 368 }
 369
 370 static const struct device_hotplug_ops bridge_ops = {
 371         .prepare = bridge_hotplug_prepare,
 372         .add = bridge_hotplug_add,
 373         .del = bridge_hotplug_del
 374 };
 375
 376 static void
 377 bridge_free(struct device *dev)
 378 {
 379         struct bridge_state *bst;
 380
 381         bst = container_of(dev, struct bridge_state, dev);
 382         vlist_flush_all(&bst->members);
 383         free(bst);
 384 }
 385
 386 static void
 387 bridge_dump_info(struct device *dev, struct blob_buf *b)
 388 {
 389         struct bridge_state *bst;
 390         struct bridge_member *bm;
 391         void *list;
 392
 393         bst = container_of(dev, struct bridge_state, dev);
 394
 395         system_if_dump_info(dev, b);
 396         list = blobmsg_open_array(b, "bridge-members");
 397
 398         vlist_for_each_element(&bst->members, bm, node)
 399                 blobmsg_add_string(b, NULL, bm->dev.dev->ifname);
 400
 401         blobmsg_close_array(b, list);
 402 }
 403
 404 static void
 405 bridge_config_init(struct device *dev)
 406 {
 407         struct bridge_state *bst;
 408         struct blob_attr *cur;
 409         int rem;
 410
 411         bst = container_of(dev, struct bridge_state, dev);
 412
 413         if (!bst->ifnames)
 414                 return;
 415
 416         vlist_update(&bst->members);
 417         blobmsg_for_each_attr(cur, bst->ifnames, rem) {
 418                 bridge_add_member(bst, blobmsg_data(cur));
 419         }
 420         vlist_flush(&bst->members);
 421 }
 422
 423 static void
 424 bridge_apply_settings(struct bridge_state *bst, struct blob_attr **tb)
 425 {
 426         struct bridge_config *cfg = &bst->config;
 427         struct blob_attr *cur;
 428
 429         /* defaults */
 430         cfg->stp = false;
 431         cfg->forward_delay = 2;
 432         cfg->igmp_snoop = true;
 433
 434         if ((cur = tb[BRIDGE_ATTR_STP]))
 435                 cfg->stp = blobmsg_get_bool(cur);
 436
 437         if ((cur = tb[BRIDGE_ATTR_FORWARD_DELAY]))
 438                 cfg->forward_delay = blobmsg_get_u32(cur);
 439
 440         if ((cur = tb[BRIDGE_ATTR_IGMP_SNOOP]))
 441                 cfg->igmp_snoop = blobmsg_get_bool(cur);
 442
 443         if ((cur = tb[BRIDGE_ATTR_AGEING_TIME])) {
 444                 cfg->ageing_time = blobmsg_get_u32(cur);
 445                 cfg->flags |= BRIDGE_OPT_AGEING_TIME;
 446         }
 447
 448         if ((cur = tb[BRIDGE_ATTR_HELLO_TIME])) {
 449                 cfg->hello_time = blobmsg_get_u32(cur);
 450                 cfg->flags |= BRIDGE_OPT_HELLO_TIME;
 451         }
 452
 453         if ((cur = tb[BRIDGE_ATTR_MAX_AGE])) {
 454                 cfg->max_age = blobmsg_get_u32(cur);
 455                 cfg->flags |= BRIDGE_OPT_MAX_AGE;
 456         }
 457 }
 458
 459 enum dev_change_type
 460 bridge_reload(struct device *dev, struct blob_attr *attr)
 461 {
 462         struct blob_attr *tb_dev[__DEV_ATTR_MAX];
 463         struct blob_attr *tb_br[__BRIDGE_ATTR_MAX];
 464         enum dev_change_type ret = DEV_CONFIG_APPLIED;
 465         unsigned long diff;
 466         struct bridge_state *bst;
 467
 468         BUILD_BUG_ON(sizeof(diff) < __BRIDGE_ATTR_MAX / 8);
 469         BUILD_BUG_ON(sizeof(diff) < __DEV_ATTR_MAX / 8);
 470
 471         bst = container_of(dev, struct bridge_state, dev);
 472
 473         blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, tb_dev,
 474                 blob_data(attr), blob_len(attr));
 475         blobmsg_parse(bridge_attrs, __BRIDGE_ATTR_MAX, tb_br,
 476                 blob_data(attr), blob_len(attr));
 477
 478         bst->ifnames = tb_br[BRIDGE_ATTR_IFNAME];
 479         device_init_settings(dev, tb_dev);
 480         bridge_apply_settings(bst, tb_br);
 481
 482         if (bst->config_data) {
 483                 struct blob_attr *otb_dev[__DEV_ATTR_MAX];
 484                 struct blob_attr *otb_br[__BRIDGE_ATTR_MAX];
 485
 486                 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, otb_dev,
 487                         blob_data(bst->config_data), blob_len(bst->config_data));
 488
 489                 diff = 0;
 490                 config_diff(tb_dev, otb_dev, &device_attr_list, &diff);
 491                 if (diff & ~(1 << DEV_ATTR_IFNAME))
 492                     ret = DEV_CONFIG_RESTART;
 493
 494                 blobmsg_parse(bridge_attrs, __BRIDGE_ATTR_MAX, otb_br,
 495                         blob_data(bst->config_data), blob_len(bst->config_data));
 496
 497                 diff = 0;
 498                 config_diff(tb_br, otb_br, &bridge_attr_list, &diff);
 499                 if (diff & ~(1 << BRIDGE_ATTR_IFNAME))
 500                     ret = DEV_CONFIG_RESTART;
 501
 502                 bridge_config_init(dev);
 503         }
 504
 505         bst->config_data = attr;
 506         return ret;
 507 }
 508
 509 static struct device *
 510 bridge_create(const char *name, struct blob_attr *attr)
 511 {
 512         struct bridge_state *bst;
 513         struct device *dev = NULL;
 514
 515         bst = calloc(1, sizeof(*bst));
 516         if (!bst)
 517                 return NULL;
 518
 519         dev = &bst->dev;
 520         device_init(dev, &bridge_device_type, name);
 521         dev->config_pending = true;
 522
 523         bst->set_state = dev->set_state;
 524         dev->set_state = bridge_set_state;
 525
 526         dev->hotplug_ops = &bridge_ops;
 527
 528         vlist_init(&bst->members, avl_strcmp, bridge_member_update);
 529         bst->members.keep_old = true;
 530         bridge_reload(dev, attr);
 531
 532         return dev;
 533 }
 534
 535