2 * netifd - network interface daemon
3 * Copyright (C) 2014 Gioacchino Mazzurco <gio@eigenlab.org>
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
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.
19 #include "interface.h"
28 static const struct blobmsg_policy vlandev_attrs[__VLANDEV_ATTR_MAX] = {
29 [VLANDEV_ATTR_IFNAME] = { "ifname", BLOBMSG_TYPE_STRING },
30 [VLANDEV_ATTR_VID] = { "vid", BLOBMSG_TYPE_INT32 },
33 static const struct uci_blob_param_list vlandev_attr_list = {
34 .n_params = __VLANDEV_ATTR_MAX,
35 .params = vlandev_attrs,
38 .next = { &device_attr_list },
41 static struct device_type vlan8021q_device_type;
43 struct vlandev_device {
45 struct device_user parent;
47 device_state_cb set_state;
49 struct blob_attr *config_data;
50 struct blob_attr *ifname;
51 struct vlandev_config config;
55 vlandev_base_cb(struct device_user *dev, enum device_event ev)
57 struct vlandev_device *mvdev = container_of(dev, struct vlandev_device, parent);
61 device_set_present(&mvdev->dev, true);
63 case DEV_EVENT_REMOVE:
64 device_set_present(&mvdev->dev, false);
72 vlandev_set_down(struct vlandev_device *mvdev)
74 mvdev->set_state(&mvdev->dev, false);
75 system_vlandev_del(&mvdev->dev);
76 device_release(&mvdev->parent);
82 vlandev_set_up(struct vlandev_device *mvdev)
86 ret = device_claim(&mvdev->parent);
90 ret = system_vlandev_add(&mvdev->dev, mvdev->parent.dev, &mvdev->config);
94 ret = mvdev->set_state(&mvdev->dev, true);
101 system_vlandev_del(&mvdev->dev);
103 device_release(&mvdev->parent);
108 vlandev_set_state(struct device *dev, bool up)
110 struct vlandev_device *mvdev;
112 D(SYSTEM, "vlandev_set_state(%s, %u)\n", dev->ifname, up);
114 mvdev = container_of(dev, struct vlandev_device, dev);
116 return vlandev_set_up(mvdev);
118 return vlandev_set_down(mvdev);
122 vlandev_free(struct device *dev)
124 struct vlandev_device *mvdev;
126 mvdev = container_of(dev, struct vlandev_device, dev);
127 device_remove_user(&mvdev->parent);
128 free(mvdev->config_data);
133 vlandev_dump_info(struct device *dev, struct blob_buf *b)
135 struct vlandev_device *mvdev;
137 mvdev = container_of(dev, struct vlandev_device, dev);
138 blobmsg_add_string(b, "parent", mvdev->parent.dev->ifname);
139 system_if_dump_info(dev, b);
143 vlandev_config_init(struct device *dev)
145 struct vlandev_device *mvdev;
146 struct device *basedev = NULL;
148 mvdev = container_of(dev, struct vlandev_device, dev);
150 basedev = device_get(blobmsg_data(mvdev->ifname), true);
152 device_add_user(&mvdev->parent, basedev);
156 vlandev_apply_settings(struct vlandev_device *mvdev, struct blob_attr **tb)
158 struct vlandev_config *cfg = &mvdev->config;
159 struct blob_attr *cur;
161 cfg->proto = (mvdev->dev.type == &vlan8021q_device_type) ?
162 VLAN_PROTO_8021Q : VLAN_PROTO_8021AD;
165 if ((cur = tb[VLANDEV_ATTR_VID]))
166 cfg->vid = (uint16_t) blobmsg_get_u32(cur);
169 static enum dev_change_type
170 vlandev_reload(struct device *dev, struct blob_attr *attr)
172 struct blob_attr *tb_dev[__DEV_ATTR_MAX];
173 struct blob_attr *tb_mv[__VLANDEV_ATTR_MAX];
174 enum dev_change_type ret = DEV_CONFIG_APPLIED;
175 struct vlandev_device *mvdev;
177 mvdev = container_of(dev, struct vlandev_device, dev);
178 attr = blob_memdup(attr);
180 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, tb_dev,
181 blob_data(attr), blob_len(attr));
182 blobmsg_parse(vlandev_attrs, __VLANDEV_ATTR_MAX, tb_mv,
183 blob_data(attr), blob_len(attr));
185 device_init_settings(dev, tb_dev);
186 vlandev_apply_settings(mvdev, tb_mv);
187 mvdev->ifname = tb_mv[VLANDEV_ATTR_IFNAME];
189 if (mvdev->config_data) {
190 struct blob_attr *otb_dev[__DEV_ATTR_MAX];
191 struct blob_attr *otb_mv[__VLANDEV_ATTR_MAX];
193 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, otb_dev,
194 blob_data(mvdev->config_data), blob_len(mvdev->config_data));
196 if (uci_blob_diff(tb_dev, otb_dev, &device_attr_list, NULL))
197 ret = DEV_CONFIG_RESTART;
199 blobmsg_parse(vlandev_attrs, __VLANDEV_ATTR_MAX, otb_mv,
200 blob_data(mvdev->config_data), blob_len(mvdev->config_data));
202 if (uci_blob_diff(tb_mv, otb_mv, &vlandev_attr_list, NULL))
203 ret = DEV_CONFIG_RESTART;
205 vlandev_config_init(dev);
208 free(mvdev->config_data);
209 mvdev->config_data = attr;
213 static struct device *
214 vlandev_create(const char *name, struct device_type *devtype,
215 struct blob_attr *attr)
217 struct vlandev_device *mvdev;
218 struct device *dev = NULL;
220 mvdev = calloc(1, sizeof(*mvdev));
225 device_init(dev, devtype, name);
226 dev->config_pending = true;
228 mvdev->set_state = dev->set_state;
229 dev->set_state = vlandev_set_state;
231 dev->hotplug_ops = NULL;
232 mvdev->parent.cb = vlandev_base_cb;
234 vlandev_reload(dev, attr);
239 static struct device_type vlan8021ad_device_type = {
241 .config_params = &vlandev_attr_list,
242 .create = vlandev_create,
243 .config_init = vlandev_config_init,
244 .reload = vlandev_reload,
245 .free = vlandev_free,
246 .dump_info = vlandev_dump_info,
249 static struct device_type vlan8021q_device_type = {
251 .config_params = &vlandev_attr_list,
252 .create = vlandev_create,
253 .config_init = vlandev_config_init,
254 .reload = vlandev_reload,
255 .free = vlandev_free,
256 .dump_info = vlandev_dump_info,
259 static void __init vlandev_device_type_init(void)
261 device_type_add(&vlan8021ad_device_type);
262 device_type_add(&vlan8021q_device_type);