netifd: add segment routing support
[project/netifd.git] / config.c
index 536b7d3fa6073c21375aadfdd4e323a41ecb1e99..fa7cbe42052d28b37ffd797fb263e35537da3d2c 100644 (file)
--- a/config.c
+++ b/config.c
@@ -18,6 +18,8 @@
 
 #include <uci.h>
 
+#include <libubox/blobmsg_json.h>
+
 #include "netifd.h"
 #include "interface.h"
 #include "interface-ip.h"
@@ -31,6 +33,7 @@ bool config_init = false;
 static struct uci_context *uci_ctx;
 static struct uci_package *uci_network;
 static struct uci_package *uci_wireless;
+static struct blob_attr *board_netdevs;
 static struct blob_buf b;
 
 static int
@@ -52,6 +55,59 @@ config_section_idx(struct uci_section *s)
        return -1;
 }
 
+static bool
+config_bridge_has_vlans(const char *br_name)
+{
+       struct uci_element *e;
+
+       uci_foreach_element(&uci_network->sections, e) {
+               struct uci_section *s = uci_to_section(e);
+               const char *name;
+
+               if (strcmp(s->type, "bridge-vlan") != 0)
+                       continue;
+
+               name = uci_lookup_option_string(uci_ctx, s, "device");
+               if (!name)
+                       continue;
+
+               if (!strcmp(name, br_name))
+                       return true;
+       }
+
+       return false;
+}
+
+static void
+config_fixup_bridge_var(struct uci_section *s, const char *name, const char *val)
+{
+       struct uci_ptr ptr = {
+               .p = s->package,
+               .s = s,
+               .option = name,
+               .value = val,
+       };
+
+       uci_lookup_ptr(uci_ctx, &ptr, NULL, false);
+       if (ptr.o)
+               return;
+
+       uci_set(uci_ctx, &ptr);
+}
+
+static void
+config_fixup_bridge_vlan_filtering(struct uci_section *s, const char *name)
+{
+       bool has_vlans = config_bridge_has_vlans(name);
+
+       config_fixup_bridge_var(s, "__has_vlans", has_vlans ? "1" : "0");
+
+       if (!has_vlans)
+               return;
+
+       config_fixup_bridge_var(s, "vlan_filtering", "1");
+}
+
 static int
 config_parse_bridge_interface(struct uci_section *s, struct device_type *devtype)
 {
@@ -61,6 +117,7 @@ config_parse_bridge_interface(struct uci_section *s, struct device_type *devtype
        sprintf(name, "%s-%s", devtype->name_prefix, s->e.name);
        blobmsg_add_string(&b, "name", name);
 
+       config_fixup_bridge_vlan_filtering(s, name);
        uci_to_blob(&b, s, devtype->config_params);
        if (!device_create(name, devtype, b.head)) {
                D(INTERFACE, "Failed to create '%s' device for interface '%s'\n",
@@ -102,7 +159,7 @@ config_parse_interface(struct uci_section *s, bool alias)
 
        uci_to_blob(&b, s, &interface_attr_list);
 
-       iface = interface_alloc(s->e.name, b.head);
+       iface = interface_alloc(s->e.name, b.head, false);
        if (!iface)
                return;
 
@@ -120,7 +177,8 @@ config_parse_interface(struct uci_section *s, bool alias)
                if (!interface_add_alias(iface, config))
                        goto error_free_config;
        } else {
-               interface_add(iface, config);
+               if (!interface_add(iface, config))
+                       goto error_free_config;
        }
        return;
 
@@ -142,6 +200,17 @@ config_parse_route(struct uci_section *s, bool v6)
        interface_ip_add_route(NULL, blob_data(b.head), v6);
 }
 
+static void
+config_parse_neighbor(struct uci_section *s, bool v6)
+{
+       void *neighbor;
+       blob_buf_init(&b,0);
+       neighbor = blobmsg_open_array(&b, "neighbor");
+       uci_to_blob(&b,s, &neighbor_attr_list);
+       blobmsg_close_array(&b, neighbor);
+       interface_ip_add_neighbor(NULL, blob_data(b.head), v6);
+}
+
 static void
 config_parse_rule(struct uci_section *s, bool v6)
 {
@@ -155,7 +224,7 @@ config_parse_rule(struct uci_section *s, bool v6)
 }
 
 static void
-config_init_devices(void)
+config_init_devices(bool bridge)
 {
        struct uci_element *e;
 
@@ -177,11 +246,17 @@ config_init_devices(void)
                if (type)
                        devtype = device_type_get(type);
 
+               if (bridge != (devtype && devtype->bridge_capability))
+                       continue;
+
                if (devtype)
                        params = devtype->config_params;
                if (!params)
                        params = simple_device_type.config_params;
 
+               if (devtype && devtype->bridge_capability)
+                       config_fixup_bridge_vlan_filtering(s, name);
+
                blob_buf_init(&b, 0);
                uci_to_blob(&b, s, params);
                if (devtype) {
@@ -200,6 +275,134 @@ config_init_devices(void)
        }
 }
 
+static void
+config_parse_vlan(struct device *dev, struct uci_section *s)
+{
+       enum {
+               BRVLAN_ATTR_VID,
+               BRVLAN_ATTR_LOCAL,
+               BRVLAN_ATTR_PORTS,
+               BRVLAN_ATTR_ALIAS,
+               __BRVLAN_ATTR_MAX,
+       };
+       static const struct blobmsg_policy vlan_attrs[__BRVLAN_ATTR_MAX] = {
+               [BRVLAN_ATTR_VID] = { "vlan", BLOBMSG_TYPE_INT32 },
+               [BRVLAN_ATTR_LOCAL] = { "local", BLOBMSG_TYPE_BOOL },
+               [BRVLAN_ATTR_PORTS] = { "ports", BLOBMSG_TYPE_ARRAY },
+               [BRVLAN_ATTR_ALIAS] = { "alias", BLOBMSG_TYPE_ARRAY },
+       };
+       static const struct uci_blob_param_info vlan_attr_info[__BRVLAN_ATTR_MAX] = {
+               [BRVLAN_ATTR_PORTS] = { .type = BLOBMSG_TYPE_STRING },
+               [BRVLAN_ATTR_ALIAS] = { .type = BLOBMSG_TYPE_STRING },
+       };
+       static const struct uci_blob_param_list vlan_attr_list = {
+               .n_params = __BRVLAN_ATTR_MAX,
+               .params = vlan_attrs,
+               .info = vlan_attr_info,
+       };
+       struct blob_attr *tb[__BRVLAN_ATTR_MAX];
+       struct blob_attr *cur;
+       struct bridge_vlan_port *port;
+       struct bridge_vlan *vlan;
+       unsigned int vid;
+       const char *val;
+       char *name_buf;
+       int name_len = 0;
+       int n_ports = 0;
+       int rem;
+
+       val = uci_lookup_option_string(uci_ctx, s, "vlan");
+       if (!val)
+               return;
+
+       blob_buf_init(&b, 0);
+       uci_to_blob(&b, s, &vlan_attr_list);
+       blobmsg_parse(vlan_attrs, __BRVLAN_ATTR_MAX, tb, blob_data(b.head), blob_len(b.head));
+
+       if (!tb[BRVLAN_ATTR_VID])
+               return;
+
+       vid = blobmsg_get_u32(tb[BRVLAN_ATTR_VID]);
+       if (!vid || vid > 4095)
+               return;
+
+       blobmsg_for_each_attr(cur, tb[BRVLAN_ATTR_PORTS], rem) {
+               name_len += strlen(blobmsg_get_string(cur)) + 1;
+               n_ports++;
+       }
+
+       vlan = calloc(1, sizeof(*vlan) + n_ports * sizeof(*port) + name_len);
+       if (!vlan)
+               return;
+
+       vlan->vid = vid;
+       vlan->local = true;
+       if (tb[BRVLAN_ATTR_LOCAL])
+               vlan->local = blobmsg_get_bool(tb[BRVLAN_ATTR_LOCAL]);
+
+       vlan->n_ports = n_ports;
+       vlan->ports = port = (struct bridge_vlan_port *)&vlan[1];
+       INIT_LIST_HEAD(&vlan->hotplug_ports);
+       name_buf = (char *)&port[n_ports];
+
+       blobmsg_for_each_attr(cur, tb[BRVLAN_ATTR_PORTS], rem) {
+               char *sep;
+
+               port->ifname = name_buf;
+               port->flags = BRVLAN_F_UNTAGGED;
+               strcpy(name_buf, blobmsg_get_string(cur));
+
+               sep = strchr(name_buf, ':');
+               if (sep) {
+                       for (*sep = 0, sep++; *sep; sep++)
+                               switch (*sep) {
+                               case '*':
+                                       port->flags |= BRVLAN_F_PVID;
+                                       break;
+                               case 't':
+                                       port->flags &= ~BRVLAN_F_UNTAGGED;
+                                       break;
+                               }
+               }
+
+               name_buf += strlen(name_buf) + 1;
+               port++;
+       }
+
+       blobmsg_for_each_attr(cur, tb[BRVLAN_ATTR_ALIAS], rem)
+               kvlist_set(&dev->vlan_aliases, blobmsg_get_string(cur), &vid);
+
+       vlist_add(&dev->vlans, &vlan->node, &vlan->vid);
+}
+
+
+static void
+config_init_vlans(void)
+{
+       struct uci_element *e;
+       struct device *dev;
+
+       device_vlan_update(false);
+       uci_foreach_element(&uci_network->sections, e) {
+               struct uci_section *s = uci_to_section(e);
+               const char *name;
+
+               if (strcmp(s->type, "bridge-vlan") != 0)
+                       continue;
+
+               name = uci_lookup_option_string(uci_ctx, s, "device");
+               if (!name)
+                       continue;
+
+               dev = device_get(name, 0);
+               if (!dev || !dev->vlans.update)
+                       continue;
+
+               config_parse_vlan(dev, s);
+       }
+       device_vlan_update(true);
+}
+
 static struct uci_package *
 config_init_package(const char *config)
 {
@@ -250,7 +453,7 @@ config_init_interfaces(void)
 }
 
 static void
-config_init_routes(void)
+config_init_ip(void)
 {
        struct interface *iface;
        struct uci_element *e;
@@ -265,6 +468,10 @@ config_init_routes(void)
                        config_parse_route(s, false);
                else if (!strcmp(s->type, "route6"))
                        config_parse_route(s, true);
+               if (!strcmp(s->type, "neighbor"))
+                       config_parse_neighbor(s, false);
+               else if (!strcmp(s->type, "neighbor6"))
+                       config_parse_neighbor(s, true);
        }
 
        vlist_for_each_element(&interfaces, iface, node)
@@ -322,7 +529,7 @@ config_parse_wireless_device(struct uci_section *s)
        wireless_device_create(drv, s->e.name, b.head);
 }
 
-static void
+static struct wireless_interface*
 config_parse_wireless_interface(struct wireless_device *wdev, struct uci_section *s)
 {
        char *name;
@@ -332,7 +539,33 @@ config_parse_wireless_interface(struct wireless_device *wdev, struct uci_section
 
        blob_buf_init(&b, 0);
        uci_to_blob(&b, s, wdev->drv->interface.config);
-       wireless_interface_create(wdev, b.head, s->anonymous ? name : s->e.name);
+       return wireless_interface_create(wdev, b.head, s->anonymous ? name : s->e.name);
+}
+
+static void
+config_parse_wireless_vlan(struct wireless_device *wdev, char *vif, struct uci_section *s)
+{
+       char *name;
+
+       name = alloca(strlen(s->type) + 16);
+       sprintf(name, "@%s[%d]", s->type, config_section_idx(s));
+
+       blob_buf_init(&b, 0);
+       uci_to_blob(&b, s, wdev->drv->vlan.config);
+       wireless_vlan_create(wdev, vif, b.head, s->anonymous ? name : s->e.name);
+}
+
+static void
+config_parse_wireless_station(struct wireless_device *wdev, char *vif, struct uci_section *s)
+{
+       char *name;
+
+       name = alloca(strlen(s->type) + 16);
+       sprintf(name, "@%s[%d]", s->type, config_section_idx(s));
+
+       blob_buf_init(&b, 0);
+       uci_to_blob(&b, s, wdev->drv->station.config);
+       wireless_station_create(wdev, vif, b.head, s->anonymous ? name : s->e.name);
 }
 
 static void
@@ -362,10 +595,16 @@ config_init_wireless(void)
        vlist_for_each_element(&wireless_devices, wdev, node) {
                wdev->vif_idx = 0;
                vlist_update(&wdev->interfaces);
+               wdev->vlan_idx = 0;
+               vlist_update(&wdev->vlans);
+               wdev->sta_idx = 0;
+               vlist_update(&wdev->stations);
        }
 
        uci_foreach_element(&uci_wireless->sections, e) {
                struct uci_section *s = uci_to_section(e);
+               struct wireless_interface *vif;
+               struct uci_element *f;
 
                if (strcmp(s->type, "wifi-iface") != 0)
                        continue;
@@ -380,11 +619,93 @@ config_init_wireless(void)
                        continue;
                }
 
-               config_parse_wireless_interface(wdev, s);
+               vif = config_parse_wireless_interface(wdev, s);
+
+               if (!vif || s->anonymous)
+                       continue;
+               uci_foreach_element(&uci_wireless->sections, f) {
+                       struct uci_section *s = uci_to_section(f);
+                       const char *vif_name;
+
+                       if (strcmp(s->type, "wifi-vlan") != 0)
+                               continue;
+
+                       vif_name = uci_lookup_option_string(uci_ctx, s, "iface");
+                       if (vif_name && strcmp(e->name, vif_name))
+                               continue;
+                       config_parse_wireless_vlan(wdev, vif->name, s);
+               }
+
+               uci_foreach_element(&uci_wireless->sections, f) {
+                       struct uci_section *s = uci_to_section(f);
+                       const char *vif_name;
+
+                       if (strcmp(s->type, "wifi-station") != 0)
+                               continue;
+
+                       vif_name = uci_lookup_option_string(uci_ctx, s, "iface");
+                       if (vif_name && strcmp(e->name, vif_name))
+                               continue;
+                       config_parse_wireless_station(wdev, vif->name, s);
+               }
        }
 
-       vlist_for_each_element(&wireless_devices, wdev, node)
+       vlist_for_each_element(&wireless_devices, wdev, node) {
                vlist_flush(&wdev->interfaces);
+               vlist_flush(&wdev->vlans);
+               vlist_flush(&wdev->stations);
+       }
+}
+
+
+static struct blob_attr *
+config_find_blobmsg_attr(struct blob_attr *attr, const char *name, int type)
+{
+       struct blobmsg_policy policy = { .name = name, .type = type };
+       struct blob_attr *cur;
+
+       blobmsg_parse(&policy, 1, &cur, blobmsg_data(attr), blobmsg_len(attr));
+
+       return cur;
+}
+
+struct ether_addr *config_get_default_macaddr(const char *ifname)
+{
+       struct blob_attr *cur;
+
+       if (!board_netdevs)
+               return NULL;
+
+       cur = config_find_blobmsg_attr(board_netdevs, ifname, BLOBMSG_TYPE_TABLE);
+       if (!cur)
+               return NULL;
+
+       cur = config_find_blobmsg_attr(cur, "macaddr", BLOBMSG_TYPE_STRING);
+       if (!cur)
+               return NULL;
+
+       return ether_aton(blobmsg_get_string(cur));
+}
+
+static void
+config_init_board(void)
+{
+       struct blob_attr *cur;
+
+       blob_buf_init(&b, 0);
+
+       if (!blobmsg_add_json_from_file(&b, DEFAULT_BOARD_JSON))
+               return;
+
+       free(board_netdevs);
+       board_netdevs = NULL;
+
+       cur = config_find_blobmsg_attr(b.head, "network-device",
+                                      BLOBMSG_TYPE_TABLE);
+       if (!cur)
+               return;
+
+       board_netdevs = blob_memdup(cur);
 }
 
 int
@@ -409,14 +730,18 @@ config_init_all(void)
                ret = -1;
        }
 
+       config_init_board();
+
        vlist_update(&interfaces);
        config_init = true;
        device_lock();
 
        device_reset_config();
-       config_init_devices();
+       config_init_devices(true);
+       config_init_vlans();
+       config_init_devices(false);
        config_init_interfaces();
-       config_init_routes();
+       config_init_ip();
        config_init_rules();
        config_init_globals();
        config_init_wireless();