macvlan.c

   1 /*
   2  * netifd - network interface daemon
   3  * Copyright (C) 2012 Felix Fietkau <nbd@openwrt.org>
   4  * Copyright (C) 2013 Jo-Philipp Wich <jow@openwrt.org>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2
   8  * as published by the Free Software Foundation
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  */
  15 #include <string.h>
  16 #include <stdlib.h>
  17 #include <stdio.h>
  18 #include <assert.h>
  19 #include <errno.h>
  20 #include <net/ethernet.h>
  21
  22 #ifdef linux
  23 #include <netinet/ether.h>
  24 #endif
  25
  26 #include "netifd.h"
  27 #include "device.h"
  28 #include "interface.h"
  29 #include "system.h"
  30
  31 enum {
  32         MACVLAN_ATTR_IFNAME,
  33         MACVLAN_ATTR_MACADDR,
  34         MACVLAN_ATTR_MODE,
  35         __MACVLAN_ATTR_MAX
  36 };
  37
  38 static const struct blobmsg_policy macvlan_attrs[__MACVLAN_ATTR_MAX] = {
  39         [MACVLAN_ATTR_IFNAME]  = { "ifname", BLOBMSG_TYPE_STRING },
  40         [MACVLAN_ATTR_MACADDR] = { "macaddr", BLOBMSG_TYPE_STRING },
  41         [MACVLAN_ATTR_MODE] = { "mode", BLOBMSG_TYPE_STRING },
  42 };
  43
  44 static const struct uci_blob_param_list macvlan_attr_list = {
  45         .n_params = __MACVLAN_ATTR_MAX,
  46         .params = macvlan_attrs,
  47 };
  48
  49 struct macvlan_device {
  50         struct device dev;
  51         struct device_user parent;
  52
  53         device_state_cb set_state;
  54
  55         struct blob_attr *config_data;
  56         struct blob_attr *ifname;
  57         struct macvlan_config config;
  58 };
  59
  60 static void
  61 macvlan_base_cb(struct device_user *dev, enum device_event ev)
  62 {
  63         struct macvlan_device *mvdev = container_of(dev, struct macvlan_device, parent);
  64
  65         switch (ev) {
  66         case DEV_EVENT_ADD:
  67                 device_set_present(&mvdev->dev, true);
  68                 break;
  69         case DEV_EVENT_REMOVE:
  70                 device_set_present(&mvdev->dev, false);
  71                 break;
  72         default:
  73                 return;
  74         }
  75 }
  76
  77 static int
  78 macvlan_set_down(struct macvlan_device *mvdev)
  79 {
  80         mvdev->set_state(&mvdev->dev, false);
  81         system_macvlan_del(&mvdev->dev);
  82         device_release(&mvdev->parent);
  83
  84         return 0;
  85 }
  86
  87 static int
  88 macvlan_set_up(struct macvlan_device *mvdev)
  89 {
  90         int ret;
  91
  92         ret = device_claim(&mvdev->parent);
  93         if (ret < 0)
  94                 return ret;
  95
  96         ret = system_macvlan_add(&mvdev->dev, mvdev->parent.dev, &mvdev->config);
  97         if (ret < 0)
  98                 goto release;
  99
 100         ret = mvdev->set_state(&mvdev->dev, true);
 101         if (ret)
 102                 goto delete;
 103
 104         return 0;
 105
 106 delete:
 107         system_macvlan_del(&mvdev->dev);
 108 release:
 109         device_release(&mvdev->parent);
 110         return ret;
 111 }
 112
 113 static int
 114 macvlan_set_state(struct device *dev, bool up)
 115 {
 116         struct macvlan_device *mvdev;
 117
 118         D(SYSTEM, "macvlan_set_state(%s, %u)\n", dev->ifname, up);
 119
 120         mvdev = container_of(dev, struct macvlan_device, dev);
 121         if (up)
 122                 return macvlan_set_up(mvdev);
 123         else
 124                 return macvlan_set_down(mvdev);
 125 }
 126
 127 static void
 128 macvlan_free(struct device *dev)
 129 {
 130         struct macvlan_device *mvdev;
 131
 132         mvdev = container_of(dev, struct macvlan_device, dev);
 133         device_remove_user(&mvdev->parent);
 134         free(mvdev);
 135 }
 136
 137 static void
 138 macvlan_dump_info(struct device *dev, struct blob_buf *b)
 139 {
 140         struct macvlan_device *mvdev;
 141
 142         mvdev = container_of(dev, struct macvlan_device, dev);
 143         blobmsg_add_string(b, "parent", mvdev->parent.dev->ifname);
 144         system_if_dump_info(dev, b);
 145 }
 146
 147 static void
 148 macvlan_config_init(struct device *dev)
 149 {
 150         struct macvlan_device *mvdev;
 151         struct device *basedev = NULL;
 152
 153         mvdev = container_of(dev, struct macvlan_device, dev);
 154         if (mvdev->ifname)
 155                 basedev = device_get(blobmsg_data(mvdev->ifname), true);
 156
 157         device_add_user(&mvdev->parent, basedev);
 158 }
 159
 160 static void
 161 macvlan_apply_settings(struct macvlan_device *mvdev, struct blob_attr **tb)
 162 {
 163         struct macvlan_config *cfg = &mvdev->config;
 164         struct blob_attr *cur;
 165         struct ether_addr *ea;
 166
 167         cfg->flags = 0;
 168         cfg->mode = NULL;
 169
 170         if ((cur = tb[MACVLAN_ATTR_MACADDR])) {
 171                 ea = ether_aton(blobmsg_data(cur));
 172                 if (ea) {
 173                         memcpy(cfg->macaddr, ea, 6);
 174                         cfg->flags |= MACVLAN_OPT_MACADDR;
 175                 }
 176         }
 177
 178         if ((cur = tb[MACVLAN_ATTR_MODE]))
 179                 cfg->mode = blobmsg_data(cur);
 180 }
 181
 182 static enum dev_change_type
 183 macvlan_reload(struct device *dev, struct blob_attr *attr)
 184 {
 185         struct blob_attr *tb_dev[__DEV_ATTR_MAX];
 186         struct blob_attr *tb_mv[__MACVLAN_ATTR_MAX];
 187         enum dev_change_type ret = DEV_CONFIG_APPLIED;
 188         struct macvlan_device *mvdev;
 189
 190         mvdev = container_of(dev, struct macvlan_device, dev);
 191
 192         blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, tb_dev,
 193                 blob_data(attr), blob_len(attr));
 194         blobmsg_parse(macvlan_attrs, __MACVLAN_ATTR_MAX, tb_mv,
 195                 blob_data(attr), blob_len(attr));
 196
 197         device_init_settings(dev, tb_dev);
 198         macvlan_apply_settings(mvdev, tb_mv);
 199         mvdev->ifname = tb_mv[MACVLAN_ATTR_IFNAME];
 200
 201         if (mvdev->config_data) {
 202                 struct blob_attr *otb_dev[__DEV_ATTR_MAX];
 203                 struct blob_attr *otb_mv[__MACVLAN_ATTR_MAX];
 204
 205                 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, otb_dev,
 206                         blob_data(mvdev->config_data), blob_len(mvdev->config_data));
 207
 208                 if (uci_blob_diff(tb_dev, otb_dev, &device_attr_list, NULL))
 209                     ret = DEV_CONFIG_RESTART;
 210
 211                 blobmsg_parse(macvlan_attrs, __MACVLAN_ATTR_MAX, otb_mv,
 212                         blob_data(mvdev->config_data), blob_len(mvdev->config_data));
 213
 214                 if (uci_blob_diff(tb_mv, otb_mv, &macvlan_attr_list, NULL))
 215                     ret = DEV_CONFIG_RESTART;
 216
 217                 macvlan_config_init(dev);
 218         }
 219
 220         mvdev->config_data = attr;
 221         return ret;
 222 }
 223
 224 static struct device *
 225 macvlan_create(const char *name, struct blob_attr *attr)
 226 {
 227         struct macvlan_device *mvdev;
 228         struct device *dev = NULL;
 229
 230         mvdev = calloc(1, sizeof(*mvdev));
 231         if (!mvdev)
 232                 return NULL;
 233
 234         dev = &mvdev->dev;
 235         device_init(dev, &macvlan_device_type, name);
 236         dev->config_pending = true;
 237
 238         mvdev->set_state = dev->set_state;
 239         dev->set_state = macvlan_set_state;
 240
 241         dev->hotplug_ops = NULL;
 242         mvdev->parent.cb = macvlan_base_cb;
 243
 244         macvlan_reload(dev, attr);
 245
 246         return dev;
 247 }
 248
 249 const struct device_type macvlan_device_type = {
 250         .name = "MAC VLAN",
 251         .config_params = &macvlan_attr_list,
 252
 253         .create = macvlan_create,
 254         .config_init = macvlan_config_init,
 255         .reload = macvlan_reload,
 256         .free = macvlan_free,
 257         .dump_info = macvlan_dump_info,
 258 };