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.
20 #include "interface.h"
27 VLANDEV_ATTR_INGRESS_QOS_MAPPING,
28 VLANDEV_ATTR_EGRESS_QOS_MAPPING,
32 static const struct blobmsg_policy vlandev_attrs[__VLANDEV_ATTR_MAX] = {
33 [VLANDEV_ATTR_IFNAME] = { "ifname", BLOBMSG_TYPE_STRING },
34 [VLANDEV_ATTR_VID] = { "vid", BLOBMSG_TYPE_INT32 },
35 [VLANDEV_ATTR_INGRESS_QOS_MAPPING] = { "ingress_qos_mapping", BLOBMSG_TYPE_ARRAY },
36 [VLANDEV_ATTR_EGRESS_QOS_MAPPING] = { "egress_qos_mapping", BLOBMSG_TYPE_ARRAY },
39 static const struct uci_blob_param_list vlandev_attr_list = {
40 .n_params = __VLANDEV_ATTR_MAX,
41 .params = vlandev_attrs,
44 .next = { &device_attr_list },
47 static struct device_type vlan8021q_device_type;
49 struct vlandev_device {
51 struct device_user parent;
53 device_state_cb set_state;
55 struct blob_attr *config_data;
56 struct blob_attr *ifname;
57 struct vlandev_config config;
61 vlandev_base_cb(struct device_user *dev, enum device_event ev)
63 struct vlandev_device *mvdev = container_of(dev, struct vlandev_device, parent);
67 device_set_present(&mvdev->dev, true);
69 case DEV_EVENT_REMOVE:
70 device_set_present(&mvdev->dev, false);
78 vlandev_set_down(struct vlandev_device *mvdev)
80 mvdev->set_state(&mvdev->dev, false);
81 system_vlandev_del(&mvdev->dev);
82 device_release(&mvdev->parent);
88 vlandev_set_up(struct vlandev_device *mvdev)
92 ret = device_claim(&mvdev->parent);
96 ret = system_vlandev_add(&mvdev->dev, mvdev->parent.dev, &mvdev->config);
100 ret = mvdev->set_state(&mvdev->dev, true);
107 system_vlandev_del(&mvdev->dev);
109 device_release(&mvdev->parent);
114 vlandev_set_state(struct device *dev, bool up)
116 struct vlandev_device *mvdev;
118 D(SYSTEM, "vlandev_set_state(%s, %u)\n", dev->ifname, up);
120 mvdev = container_of(dev, struct vlandev_device, dev);
122 return vlandev_set_up(mvdev);
124 return vlandev_set_down(mvdev);
128 vlandev_free(struct device *dev)
130 struct vlandev_device *mvdev;
132 mvdev = container_of(dev, struct vlandev_device, dev);
133 device_remove_user(&mvdev->parent);
134 free(mvdev->config_data);
135 vlist_simple_flush_all(&mvdev->config.ingress_qos_mapping_list);
136 vlist_simple_flush_all(&mvdev->config.egress_qos_mapping_list);
140 static void vlandev_qos_mapping_dump(struct blob_buf *b, const char *name, const struct vlist_simple_tree *qos_mapping_li)
142 const struct vlan_qos_mapping *elem;
145 a = blobmsg_open_array(b, name);
147 vlist_simple_for_each_element(qos_mapping_li, elem, node) {
148 t = blobmsg_open_table(b, NULL);
150 blobmsg_add_u32(b, "from", elem->from);
151 blobmsg_add_u32(b, "to", elem->to);
153 blobmsg_close_table(b, t);
156 blobmsg_close_array(b, a);
160 vlandev_dump_info(struct device *dev, struct blob_buf *b)
162 struct vlandev_device *mvdev;
164 mvdev = container_of(dev, struct vlandev_device, dev);
165 blobmsg_add_string(b, "parent", mvdev->parent.dev->ifname);
166 system_if_dump_info(dev, b);
167 vlandev_qos_mapping_dump(b, "ingress_qos_mapping", &mvdev->config.ingress_qos_mapping_list);
168 vlandev_qos_mapping_dump(b, "egress_qos_mapping", &mvdev->config.egress_qos_mapping_list);
172 vlandev_config_init(struct device *dev)
174 struct vlandev_device *mvdev;
175 struct device *basedev = NULL;
177 mvdev = container_of(dev, struct vlandev_device, dev);
179 basedev = device_get(blobmsg_data(mvdev->ifname), true);
181 device_add_user(&mvdev->parent, basedev);
184 static void vlandev_qos_mapping_list_apply(struct vlist_simple_tree *qos_mapping_li, struct blob_attr *list)
186 struct blob_attr *cur;
187 struct vlan_qos_mapping *qos_mapping;
190 blobmsg_for_each_attr(cur, list, rem) {
191 if (blobmsg_type(cur) != BLOBMSG_TYPE_STRING)
194 if (!blobmsg_check_attr(cur, false))
197 qos_mapping = calloc(1, sizeof(*qos_mapping));
201 rc = sscanf(blobmsg_data(cur), "%" PRIu32 ":%" PRIu32, &qos_mapping->from, &qos_mapping->to);
206 vlist_simple_add(qos_mapping_li, &qos_mapping->node);
211 vlandev_apply_settings(struct vlandev_device *mvdev, struct blob_attr **tb)
213 struct vlandev_config *cfg = &mvdev->config;
214 struct blob_attr *cur;
216 cfg->proto = (mvdev->dev.type == &vlan8021q_device_type) ?
217 VLAN_PROTO_8021Q : VLAN_PROTO_8021AD;
220 vlist_simple_update(&cfg->ingress_qos_mapping_list);
221 vlist_simple_update(&cfg->egress_qos_mapping_list);
223 if ((cur = tb[VLANDEV_ATTR_VID]))
224 cfg->vid = (uint16_t) blobmsg_get_u32(cur);
226 if ((cur = tb[VLANDEV_ATTR_INGRESS_QOS_MAPPING]))
227 vlandev_qos_mapping_list_apply(&cfg->ingress_qos_mapping_list, cur);
229 if ((cur = tb[VLANDEV_ATTR_EGRESS_QOS_MAPPING]))
230 vlandev_qos_mapping_list_apply(&cfg->egress_qos_mapping_list, cur);
232 vlist_simple_flush(&cfg->ingress_qos_mapping_list);
233 vlist_simple_flush(&cfg->egress_qos_mapping_list);
236 static enum dev_change_type
237 vlandev_reload(struct device *dev, struct blob_attr *attr)
239 struct blob_attr *tb_dev[__DEV_ATTR_MAX];
240 struct blob_attr *tb_mv[__VLANDEV_ATTR_MAX];
241 enum dev_change_type ret = DEV_CONFIG_APPLIED;
242 struct vlandev_device *mvdev;
244 mvdev = container_of(dev, struct vlandev_device, dev);
245 attr = blob_memdup(attr);
247 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, tb_dev,
248 blob_data(attr), blob_len(attr));
249 blobmsg_parse(vlandev_attrs, __VLANDEV_ATTR_MAX, tb_mv,
250 blob_data(attr), blob_len(attr));
252 device_init_settings(dev, tb_dev);
253 vlandev_apply_settings(mvdev, tb_mv);
254 mvdev->ifname = tb_mv[VLANDEV_ATTR_IFNAME];
256 if (mvdev->config_data) {
257 struct blob_attr *otb_dev[__DEV_ATTR_MAX];
258 struct blob_attr *otb_mv[__VLANDEV_ATTR_MAX];
260 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, otb_dev,
261 blob_data(mvdev->config_data), blob_len(mvdev->config_data));
263 if (uci_blob_diff(tb_dev, otb_dev, &device_attr_list, NULL))
264 ret = DEV_CONFIG_RESTART;
266 blobmsg_parse(vlandev_attrs, __VLANDEV_ATTR_MAX, otb_mv,
267 blob_data(mvdev->config_data), blob_len(mvdev->config_data));
269 if (uci_blob_diff(tb_mv, otb_mv, &vlandev_attr_list, NULL))
270 ret = DEV_CONFIG_RESTART;
272 vlandev_config_init(dev);
275 free(mvdev->config_data);
276 mvdev->config_data = attr;
280 static struct device *
281 vlandev_create(const char *name, struct device_type *devtype,
282 struct blob_attr *attr)
284 struct vlandev_device *mvdev;
285 struct device *dev = NULL;
287 mvdev = calloc(1, sizeof(*mvdev));
291 vlist_simple_init(&mvdev->config.ingress_qos_mapping_list,
292 struct vlan_qos_mapping, node);
293 vlist_simple_init(&mvdev->config.egress_qos_mapping_list,
294 struct vlan_qos_mapping, node);
298 if (device_init(dev, devtype, name) < 0) {
304 dev->config_pending = true;
306 mvdev->set_state = dev->set_state;
307 dev->set_state = vlandev_set_state;
309 dev->hotplug_ops = NULL;
310 mvdev->parent.cb = vlandev_base_cb;
312 vlandev_reload(dev, attr);
317 static struct device_type vlan8021ad_device_type = {
319 .config_params = &vlandev_attr_list,
320 .create = vlandev_create,
321 .config_init = vlandev_config_init,
322 .reload = vlandev_reload,
323 .free = vlandev_free,
324 .dump_info = vlandev_dump_info,
327 static struct device_type vlan8021q_device_type = {
329 .config_params = &vlandev_attr_list,
330 .create = vlandev_create,
331 .config_init = vlandev_config_init,
332 .reload = vlandev_reload,
333 .free = vlandev_free,
334 .dump_info = vlandev_dump_info,
337 static void __init vlandev_device_type_init(void)
339 device_type_add(&vlan8021ad_device_type);
340 device_type_add(&vlan8021q_device_type);