0c538baa8782885fd6f50c3ef5f58bd43a2a36c3
[project/netifd.git] / 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_MAX
42 };
43
44 static const struct blobmsg_policy bridge_attrs[__BRIDGE_ATTR_MAX] = {
45 [BRIDGE_ATTR_IFNAME] = { "ifname", BLOBMSG_TYPE_ARRAY },
46 [BRIDGE_ATTR_STP] = { "stp", BLOBMSG_TYPE_BOOL },
47 [BRIDGE_ATTR_FORWARD_DELAY] = { "forward_delay", BLOBMSG_TYPE_INT32 },
48 [BRIDGE_ATTR_PRIORITY] = { "priority", BLOBMSG_TYPE_INT32 },
49 [BRIDGE_ATTR_AGEING_TIME] = { "ageing_time", BLOBMSG_TYPE_INT32 },
50 [BRIDGE_ATTR_HELLO_TIME] = { "hello_time", BLOBMSG_TYPE_INT32 },
51 [BRIDGE_ATTR_MAX_AGE] = { "max_age", BLOBMSG_TYPE_INT32 },
52 [BRIDGE_ATTR_IGMP_SNOOP] = { "igmp_snooping", BLOBMSG_TYPE_BOOL },
53 [BRIDGE_ATTR_BRIDGE_EMPTY] = { "bridge_empty", BLOBMSG_TYPE_BOOL },
54 [BRIDGE_ATTR_MULTICAST_QUERIER] = { "multicast_querier", BLOBMSG_TYPE_BOOL },
55 [BRIDGE_ATTR_HASH_MAX] = { "hash_max", BLOBMSG_TYPE_INT32 },
56 [BRIDGE_ATTR_ROBUSTNESS] = { "robustness", BLOBMSG_TYPE_INT32 },
57 [BRIDGE_ATTR_QUERY_INTERVAL] = { "query_interval", BLOBMSG_TYPE_INT32 },
58 [BRIDGE_ATTR_QUERY_RESPONSE_INTERVAL] = { "query_response_interval", BLOBMSG_TYPE_INT32 },
59 [BRIDGE_ATTR_LAST_MEMBER_INTERVAL] = { "last_member_interval", BLOBMSG_TYPE_INT32 },
60 };
61
62 static const struct uci_blob_param_info bridge_attr_info[__BRIDGE_ATTR_MAX] = {
63 [BRIDGE_ATTR_IFNAME] = { .type = BLOBMSG_TYPE_STRING },
64 };
65
66 static const struct uci_blob_param_list bridge_attr_list = {
67 .n_params = __BRIDGE_ATTR_MAX,
68 .params = bridge_attrs,
69 .info = bridge_attr_info,
70
71 .n_next = 1,
72 .next = { &device_attr_list },
73 };
74
75 static struct device *bridge_create(const char *name, struct device_type *devtype,
76 struct blob_attr *attr);
77 static void bridge_config_init(struct device *dev);
78 static void bridge_free(struct device *dev);
79 static void bridge_dump_info(struct device *dev, struct blob_buf *b);
80 enum dev_change_type
81 bridge_reload(struct device *dev, struct blob_attr *attr);
82
83 struct device_type bridge_device_type = {
84 .name = "bridge",
85 .config_params = &bridge_attr_list,
86
87 .create = bridge_create,
88 .config_init = bridge_config_init,
89 .reload = bridge_reload,
90 .free = bridge_free,
91 .dump_info = bridge_dump_info,
92 };
93
94 struct bridge_state {
95 struct device dev;
96 device_state_cb set_state;
97
98 struct blob_attr *config_data;
99 struct bridge_config config;
100 struct blob_attr *ifnames;
101 bool active;
102 bool force_active;
103
104 struct uloop_timeout retry;
105 struct bridge_member *primary_port;
106 struct vlist_tree members;
107 int n_present;
108 int n_failed;
109 };
110
111 struct bridge_member {
112 struct vlist_node node;
113 struct bridge_state *bst;
114 struct device_user dev;
115 bool present;
116 char name[];
117 };
118
119 static void
120 bridge_reset_primary(struct bridge_state *bst)
121 {
122 struct bridge_member *bm;
123
124 if (!bst->primary_port &&
125 (bst->dev.settings.flags & DEV_OPT_MACADDR))
126 return;
127
128 bst->primary_port = NULL;
129 bst->dev.settings.flags &= ~DEV_OPT_MACADDR;
130 vlist_for_each_element(&bst->members, bm, node) {
131 uint8_t *macaddr;
132
133 if (!bm->present)
134 continue;
135
136 bst->primary_port = bm;
137 if (bm->dev.dev->settings.flags & DEV_OPT_MACADDR)
138 macaddr = bm->dev.dev->settings.macaddr;
139 else
140 macaddr = bm->dev.dev->orig_settings.macaddr;
141 memcpy(bst->dev.settings.macaddr, macaddr, 6);
142 bst->dev.settings.flags |= DEV_OPT_MACADDR;
143 return;
144 }
145 }
146
147 static int
148 bridge_disable_member(struct bridge_member *bm)
149 {
150 struct bridge_state *bst = bm->bst;
151
152 if (!bm->present)
153 return 0;
154
155 system_bridge_delif(&bst->dev, bm->dev.dev);
156 device_release(&bm->dev);
157
158 device_broadcast_event(&bst->dev, DEV_EVENT_TOPO_CHANGE);
159
160 return 0;
161 }
162
163 static int
164 bridge_enable_interface(struct bridge_state *bst)
165 {
166 int ret;
167
168 if (bst->active)
169 return 0;
170
171 ret = system_bridge_addbr(&bst->dev, &bst->config);
172 if (ret < 0)
173 return ret;
174
175 bst->active = true;
176 return 0;
177 }
178
179 static void
180 bridge_disable_interface(struct bridge_state *bst)
181 {
182 if (!bst->active)
183 return;
184
185 system_bridge_delbr(&bst->dev);
186 bst->active = false;
187 }
188
189 static int
190 bridge_enable_member(struct bridge_member *bm)
191 {
192 struct bridge_state *bst = bm->bst;
193 int ret;
194
195 if (!bm->present)
196 return 0;
197
198 ret = bridge_enable_interface(bst);
199 if (ret)
200 goto error;
201
202 /* Disable IPv6 for bridge members */
203 if (!(bm->dev.dev->settings.flags & DEV_OPT_IPV6)) {
204 bm->dev.dev->settings.ipv6 = 0;
205 bm->dev.dev->settings.flags |= DEV_OPT_IPV6;
206 }
207
208 ret = device_claim(&bm->dev);
209 if (ret < 0)
210 goto error;
211
212 ret = system_bridge_addif(&bst->dev, bm->dev.dev);
213 if (ret < 0) {
214 D(DEVICE, "Bridge device %s could not be added\n", bm->dev.dev->ifname);
215 goto error;
216 }
217
218 device_set_present(&bst->dev, true);
219 device_broadcast_event(&bst->dev, DEV_EVENT_TOPO_CHANGE);
220
221 return 0;
222
223 error:
224 bst->n_failed++;
225 bm->present = false;
226 bst->n_present--;
227 device_release(&bm->dev);
228
229 return ret;
230 }
231
232 static void
233 bridge_remove_member(struct bridge_member *bm)
234 {
235 struct bridge_state *bst = bm->bst;
236
237 if (!bm->present)
238 return;
239
240 if (bm == bst->primary_port)
241 bridge_reset_primary(bst);
242
243 if (bst->dev.active)
244 bridge_disable_member(bm);
245
246 bm->present = false;
247 bm->bst->n_present--;
248
249 if (bst->config.bridge_empty)
250 return;
251
252 bst->force_active = false;
253 if (bst->n_present == 0)
254 device_set_present(&bst->dev, false);
255 }
256
257 static void
258 bridge_free_member(struct bridge_member *bm)
259 {
260 struct device *dev = bm->dev.dev;
261
262 bridge_remove_member(bm);
263 device_remove_user(&bm->dev);
264
265 /*
266 * When reloading the config and moving a device from one bridge to
267 * another, the other bridge may have tried to claim this device
268 * before it was removed here.
269 * Ensure that claiming the device is retried by toggling its present
270 * state
271 */
272 if (dev->present) {
273 device_set_present(dev, false);
274 device_set_present(dev, true);
275 }
276
277 free(bm);
278 }
279
280 static void
281 bridge_check_retry(struct bridge_state *bst)
282 {
283 if (!bst->n_failed)
284 return;
285
286 uloop_timeout_set(&bst->retry, 100);
287 }
288
289 static void
290 bridge_member_cb(struct device_user *dev, enum device_event ev)
291 {
292 struct bridge_member *bm = container_of(dev, struct bridge_member, dev);
293 struct bridge_state *bst = bm->bst;
294
295 switch (ev) {
296 case DEV_EVENT_ADD:
297 assert(!bm->present);
298
299 bm->present = true;
300 bst->n_present++;
301
302 if (bst->n_present == 1)
303 device_set_present(&bst->dev, true);
304 if (bst->dev.active && !bridge_enable_member(bm)) {
305 /*
306 * Adding a bridge member can overwrite the bridge mtu
307 * in the kernel, apply the bridge settings in case the
308 * bridge mtu is set
309 */
310 system_if_apply_settings(&bst->dev, &bst->dev.settings,
311 DEV_OPT_MTU | DEV_OPT_MTU6);
312 }
313
314 break;
315 case DEV_EVENT_REMOVE:
316 if (dev->hotplug) {
317 vlist_delete(&bst->members, &bm->node);
318 return;
319 }
320
321 if (bm->present)
322 bridge_remove_member(bm);
323
324 break;
325 default:
326 return;
327 }
328 }
329
330 static int
331 bridge_set_down(struct bridge_state *bst)
332 {
333 struct bridge_member *bm;
334
335 bst->set_state(&bst->dev, false);
336
337 vlist_for_each_element(&bst->members, bm, node)
338 bridge_disable_member(bm);
339
340 bridge_disable_interface(bst);
341
342 return 0;
343 }
344
345 static int
346 bridge_set_up(struct bridge_state *bst)
347 {
348 struct bridge_member *bm;
349 int ret;
350
351 if (!bst->n_present) {
352 if (!bst->force_active)
353 return -ENOENT;
354
355 ret = bridge_enable_interface(bst);
356 if (ret)
357 return ret;
358 }
359
360 bst->n_failed = 0;
361 vlist_for_each_element(&bst->members, bm, node)
362 bridge_enable_member(bm);
363 bridge_check_retry(bst);
364
365 if (!bst->force_active && !bst->n_present) {
366 /* initialization of all member interfaces failed */
367 bridge_disable_interface(bst);
368 device_set_present(&bst->dev, false);
369 return -ENOENT;
370 }
371
372 bridge_reset_primary(bst);
373 ret = bst->set_state(&bst->dev, true);
374 if (ret < 0)
375 bridge_set_down(bst);
376
377 return ret;
378 }
379
380 static int
381 bridge_set_state(struct device *dev, bool up)
382 {
383 struct bridge_state *bst;
384
385 bst = container_of(dev, struct bridge_state, dev);
386
387 if (up)
388 return bridge_set_up(bst);
389 else
390 return bridge_set_down(bst);
391 }
392
393 static struct bridge_member *
394 bridge_create_member(struct bridge_state *bst, struct device *dev, bool hotplug)
395 {
396 struct bridge_member *bm;
397
398 bm = calloc(1, sizeof(*bm) + strlen(dev->ifname) + 1);
399 if (!bm)
400 return NULL;
401
402 bm->bst = bst;
403 bm->dev.cb = bridge_member_cb;
404 bm->dev.hotplug = hotplug;
405 strcpy(bm->name, dev->ifname);
406 bm->dev.dev = dev;
407 vlist_add(&bst->members, &bm->node, bm->name);
408 // Need to look up the bridge member again as the above
409 // created pointer will be freed in case the bridge member
410 // already existed
411 bm = vlist_find(&bst->members, dev->ifname, bm, node);
412 if (hotplug && bm)
413 bm->node.version = -1;
414
415 return bm;
416 }
417
418 static void
419 bridge_member_update(struct vlist_tree *tree, struct vlist_node *node_new,
420 struct vlist_node *node_old)
421 {
422 struct bridge_member *bm;
423 struct device *dev;
424
425 if (node_new) {
426 bm = container_of(node_new, struct bridge_member, node);
427
428 if (node_old) {
429 free(bm);
430 return;
431 }
432
433 dev = bm->dev.dev;
434 bm->dev.dev = NULL;
435 device_add_user(&bm->dev, dev);
436 }
437
438
439 if (node_old) {
440 bm = container_of(node_old, struct bridge_member, node);
441 bridge_free_member(bm);
442 }
443 }
444
445
446 static void
447 bridge_add_member(struct bridge_state *bst, const char *name)
448 {
449 struct device *dev;
450
451 dev = device_get(name, true);
452 if (!dev)
453 return;
454
455 bridge_create_member(bst, dev, false);
456 }
457
458 static int
459 bridge_hotplug_add(struct device *dev, struct device *member)
460 {
461 struct bridge_state *bst = container_of(dev, struct bridge_state, dev);
462
463 bridge_create_member(bst, member, true);
464
465 return 0;
466 }
467
468 static int
469 bridge_hotplug_del(struct device *dev, struct device *member)
470 {
471 struct bridge_state *bst = container_of(dev, struct bridge_state, dev);
472 struct bridge_member *bm;
473
474 bm = vlist_find(&bst->members, member->ifname, bm, node);
475 if (!bm)
476 return UBUS_STATUS_NOT_FOUND;
477
478 vlist_delete(&bst->members, &bm->node);
479 return 0;
480 }
481
482 static int
483 bridge_hotplug_prepare(struct device *dev)
484 {
485 struct bridge_state *bst;
486
487 bst = container_of(dev, struct bridge_state, dev);
488 bst->force_active = true;
489 device_set_present(&bst->dev, true);
490
491 return 0;
492 }
493
494 static const struct device_hotplug_ops bridge_ops = {
495 .prepare = bridge_hotplug_prepare,
496 .add = bridge_hotplug_add,
497 .del = bridge_hotplug_del
498 };
499
500 static void
501 bridge_free(struct device *dev)
502 {
503 struct bridge_state *bst;
504
505 bst = container_of(dev, struct bridge_state, dev);
506 vlist_flush_all(&bst->members);
507 free(bst->config_data);
508 free(bst);
509 }
510
511 static void
512 bridge_dump_info(struct device *dev, struct blob_buf *b)
513 {
514 struct bridge_state *bst;
515 struct bridge_member *bm;
516 void *list;
517
518 bst = container_of(dev, struct bridge_state, dev);
519
520 system_if_dump_info(dev, b);
521 list = blobmsg_open_array(b, "bridge-members");
522
523 vlist_for_each_element(&bst->members, bm, node)
524 blobmsg_add_string(b, NULL, bm->dev.dev->ifname);
525
526 blobmsg_close_array(b, list);
527 }
528
529 static void
530 bridge_config_init(struct device *dev)
531 {
532 struct bridge_state *bst;
533 struct blob_attr *cur;
534 int rem;
535
536 bst = container_of(dev, struct bridge_state, dev);
537
538 if (bst->config.bridge_empty) {
539 bst->force_active = true;
540 device_set_present(&bst->dev, true);
541 }
542
543 bst->n_failed = 0;
544 vlist_update(&bst->members);
545 if (bst->ifnames) {
546 blobmsg_for_each_attr(cur, bst->ifnames, rem) {
547 bridge_add_member(bst, blobmsg_data(cur));
548 }
549 }
550 vlist_flush(&bst->members);
551 bridge_check_retry(bst);
552 }
553
554 static void
555 bridge_apply_settings(struct bridge_state *bst, struct blob_attr **tb)
556 {
557 struct bridge_config *cfg = &bst->config;
558 struct blob_attr *cur;
559
560 /* defaults */
561 cfg->stp = false;
562 cfg->forward_delay = 2;
563 cfg->igmp_snoop = true;
564 cfg->multicast_querier = true;
565 cfg->robustness = 2;
566 cfg->query_interval = 12500;
567 cfg->query_response_interval = 1000;
568 cfg->last_member_interval = 100;
569 cfg->hash_max = 512;
570 cfg->bridge_empty = false;
571 cfg->priority = 0x7FFF;
572
573 if ((cur = tb[BRIDGE_ATTR_STP]))
574 cfg->stp = blobmsg_get_bool(cur);
575
576 if ((cur = tb[BRIDGE_ATTR_FORWARD_DELAY]))
577 cfg->forward_delay = blobmsg_get_u32(cur);
578
579 if ((cur = tb[BRIDGE_ATTR_PRIORITY]))
580 cfg->priority = blobmsg_get_u32(cur);
581
582 if ((cur = tb[BRIDGE_ATTR_IGMP_SNOOP]))
583 cfg->multicast_querier = cfg->igmp_snoop = blobmsg_get_bool(cur);
584
585 if ((cur = tb[BRIDGE_ATTR_MULTICAST_QUERIER]))
586 cfg->multicast_querier = blobmsg_get_bool(cur);
587
588 if ((cur = tb[BRIDGE_ATTR_HASH_MAX]))
589 cfg->hash_max = blobmsg_get_u32(cur);
590
591 if ((cur = tb[BRIDGE_ATTR_ROBUSTNESS])) {
592 cfg->robustness = blobmsg_get_u32(cur);
593 cfg->flags |= BRIDGE_OPT_ROBUSTNESS;
594 }
595
596 if ((cur = tb[BRIDGE_ATTR_QUERY_INTERVAL])) {
597 cfg->query_interval = blobmsg_get_u32(cur);
598 cfg->flags |= BRIDGE_OPT_QUERY_INTERVAL;
599 }
600
601 if ((cur = tb[BRIDGE_ATTR_QUERY_RESPONSE_INTERVAL])) {
602 cfg->query_response_interval = blobmsg_get_u32(cur);
603 cfg->flags |= BRIDGE_OPT_QUERY_RESPONSE_INTERVAL;
604 }
605
606 if ((cur = tb[BRIDGE_ATTR_LAST_MEMBER_INTERVAL])) {
607 cfg->last_member_interval = blobmsg_get_u32(cur);
608 cfg->flags |= BRIDGE_OPT_LAST_MEMBER_INTERVAL;
609 }
610
611 if ((cur = tb[BRIDGE_ATTR_AGEING_TIME])) {
612 cfg->ageing_time = blobmsg_get_u32(cur);
613 cfg->flags |= BRIDGE_OPT_AGEING_TIME;
614 }
615
616 if ((cur = tb[BRIDGE_ATTR_HELLO_TIME])) {
617 cfg->hello_time = blobmsg_get_u32(cur);
618 cfg->flags |= BRIDGE_OPT_HELLO_TIME;
619 }
620
621 if ((cur = tb[BRIDGE_ATTR_MAX_AGE])) {
622 cfg->max_age = blobmsg_get_u32(cur);
623 cfg->flags |= BRIDGE_OPT_MAX_AGE;
624 }
625
626 if ((cur = tb[BRIDGE_ATTR_BRIDGE_EMPTY]))
627 cfg->bridge_empty = blobmsg_get_bool(cur);
628 }
629
630 enum dev_change_type
631 bridge_reload(struct device *dev, struct blob_attr *attr)
632 {
633 struct blob_attr *tb_dev[__DEV_ATTR_MAX];
634 struct blob_attr *tb_br[__BRIDGE_ATTR_MAX];
635 enum dev_change_type ret = DEV_CONFIG_APPLIED;
636 unsigned long diff;
637 struct bridge_state *bst;
638
639 BUILD_BUG_ON(sizeof(diff) < __BRIDGE_ATTR_MAX / 8);
640 BUILD_BUG_ON(sizeof(diff) < __DEV_ATTR_MAX / 8);
641
642 bst = container_of(dev, struct bridge_state, dev);
643 attr = blob_memdup(attr);
644
645 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, tb_dev,
646 blob_data(attr), blob_len(attr));
647 blobmsg_parse(bridge_attrs, __BRIDGE_ATTR_MAX, tb_br,
648 blob_data(attr), blob_len(attr));
649
650 bst->ifnames = tb_br[BRIDGE_ATTR_IFNAME];
651 device_init_settings(dev, tb_dev);
652 bridge_apply_settings(bst, tb_br);
653
654 if (bst->config_data) {
655 struct blob_attr *otb_dev[__DEV_ATTR_MAX];
656 struct blob_attr *otb_br[__BRIDGE_ATTR_MAX];
657
658 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, otb_dev,
659 blob_data(bst->config_data), blob_len(bst->config_data));
660
661 diff = 0;
662 uci_blob_diff(tb_dev, otb_dev, &device_attr_list, &diff);
663 if (diff)
664 ret = DEV_CONFIG_RESTART;
665
666 blobmsg_parse(bridge_attrs, __BRIDGE_ATTR_MAX, otb_br,
667 blob_data(bst->config_data), blob_len(bst->config_data));
668
669 diff = 0;
670 uci_blob_diff(tb_br, otb_br, &bridge_attr_list, &diff);
671 if (diff & ~(1 << BRIDGE_ATTR_IFNAME))
672 ret = DEV_CONFIG_RESTART;
673
674 bridge_config_init(dev);
675 }
676
677 free(bst->config_data);
678 bst->config_data = attr;
679 return ret;
680 }
681
682 static void
683 bridge_retry_members(struct uloop_timeout *timeout)
684 {
685 struct bridge_state *bst = container_of(timeout, struct bridge_state, retry);
686 struct bridge_member *bm;
687
688 bst->n_failed = 0;
689 vlist_for_each_element(&bst->members, bm, node) {
690 if (bm->present)
691 continue;
692
693 if (!bm->dev.dev->present)
694 continue;
695
696 bm->present = true;
697 bst->n_present++;
698 bridge_enable_member(bm);
699 }
700 }
701
702 static struct device *
703 bridge_create(const char *name, struct device_type *devtype,
704 struct blob_attr *attr)
705 {
706 struct bridge_state *bst;
707 struct device *dev = NULL;
708
709 bst = calloc(1, sizeof(*bst));
710 if (!bst)
711 return NULL;
712
713 dev = &bst->dev;
714 device_init(dev, devtype, name);
715 dev->config_pending = true;
716 bst->retry.cb = bridge_retry_members;
717
718 bst->set_state = dev->set_state;
719 dev->set_state = bridge_set_state;
720
721 dev->hotplug_ops = &bridge_ops;
722
723 vlist_init(&bst->members, avl_strcmp, bridge_member_update);
724 bst->members.keep_old = true;
725 bridge_reload(dev, attr);
726
727 return dev;
728 }