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_STRING
},
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
;
48 static struct blob_buf b
;
50 struct vlandev_device
{
52 struct device_user parent
;
54 device_state_cb set_state
;
56 struct blob_attr
*config_data
;
57 struct blob_attr
*ifname
;
58 struct blob_attr
*vid
;
60 struct vlandev_config config
;
64 __vlandev_hotplug_op(struct device
*dev
, struct device
*member
, struct blob_attr
*vlan
, bool add
)
66 struct vlandev_device
*mvdev
= container_of(dev
, struct vlandev_device
, dev
);
69 dev
= mvdev
->parent
.dev
;
70 if (!dev
|| !dev
->hotplug_ops
)
71 return UBUS_STATUS_NOT_SUPPORTED
;
74 a
= blobmsg_open_array(&b
, "vlans");
75 blobmsg_printf(&b
, NULL
, "%d:u", mvdev
->config
.vid
);
76 if (vlan
&& blobmsg_len(vlan
))
77 blob_put_raw(&b
, blobmsg_data(vlan
), blobmsg_len(vlan
));
78 blobmsg_close_array(&b
, a
);
81 return dev
->hotplug_ops
->add(dev
, member
, blobmsg_data(b
.head
));
83 return dev
->hotplug_ops
->del(dev
, member
, blobmsg_data(b
.head
));
87 vlandev_hotplug_add(struct device
*dev
, struct device
*member
, struct blob_attr
*vlan
)
89 return __vlandev_hotplug_op(dev
, member
, vlan
, true);
93 vlandev_hotplug_del(struct device
*dev
, struct device
*member
, struct blob_attr
*vlan
)
95 return __vlandev_hotplug_op(dev
, member
, vlan
, false);
99 vlandev_hotplug_prepare(struct device
*dev
, struct device
**bridge_dev
)
101 struct vlandev_device
*mvdev
= container_of(dev
, struct vlandev_device
, dev
);
103 dev
= mvdev
->parent
.dev
;
104 if (!dev
|| !dev
->hotplug_ops
)
105 return UBUS_STATUS_NOT_SUPPORTED
;
107 return dev
->hotplug_ops
->prepare(dev
, bridge_dev
);
110 static void vlandev_hotplug_check(struct vlandev_device
*mvdev
)
112 static const struct device_hotplug_ops hotplug_ops
= {
113 .prepare
= vlandev_hotplug_prepare
,
114 .add
= vlandev_hotplug_add
,
115 .del
= vlandev_hotplug_del
117 struct device
*dev
= mvdev
->parent
.dev
;
119 if (!dev
|| !dev
->hotplug_ops
|| avl_is_empty(&dev
->vlans
.avl
) ||
120 mvdev
->dev
.type
!= &vlan8021q_device_type
) {
121 mvdev
->dev
.hotplug_ops
= NULL
;
125 mvdev
->dev
.hotplug_ops
= &hotplug_ops
;
130 vlandev_base_cb(struct device_user
*dev
, enum device_event ev
)
132 struct vlandev_device
*mvdev
= container_of(dev
, struct vlandev_device
, parent
);
136 device_set_present(&mvdev
->dev
, true);
138 case DEV_EVENT_REMOVE
:
139 device_set_present(&mvdev
->dev
, false);
141 case DEV_EVENT_UPDATE_IFNAME
:
142 vlandev_hotplug_check(mvdev
);
144 case DEV_EVENT_TOPO_CHANGE
:
145 /* Propagate topo changes */
146 device_broadcast_event(&mvdev
->dev
, DEV_EVENT_TOPO_CHANGE
);
154 vlandev_set_down(struct vlandev_device
*mvdev
)
156 mvdev
->set_state(&mvdev
->dev
, false);
157 system_vlandev_del(&mvdev
->dev
);
158 device_release(&mvdev
->parent
);
164 vlandev_set_up(struct vlandev_device
*mvdev
)
168 ret
= device_claim(&mvdev
->parent
);
172 ret
= system_vlandev_add(&mvdev
->dev
, mvdev
->parent
.dev
, &mvdev
->config
);
176 ret
= mvdev
->set_state(&mvdev
->dev
, true);
183 system_vlandev_del(&mvdev
->dev
);
185 device_release(&mvdev
->parent
);
190 vlandev_set_state(struct device
*dev
, bool up
)
192 struct vlandev_device
*mvdev
;
194 D(SYSTEM
, "vlandev_set_state(%s, %u)\n", dev
->ifname
, up
);
196 mvdev
= container_of(dev
, struct vlandev_device
, dev
);
198 return vlandev_set_up(mvdev
);
200 return vlandev_set_down(mvdev
);
204 vlandev_free(struct device
*dev
)
206 struct vlandev_device
*mvdev
;
208 mvdev
= container_of(dev
, struct vlandev_device
, dev
);
209 device_remove_user(&mvdev
->parent
);
210 free(mvdev
->config_data
);
211 vlist_simple_flush_all(&mvdev
->config
.ingress_qos_mapping_list
);
212 vlist_simple_flush_all(&mvdev
->config
.egress_qos_mapping_list
);
216 static void vlandev_qos_mapping_dump(struct blob_buf
*b
, const char *name
, const struct vlist_simple_tree
*qos_mapping_li
)
218 const struct vlan_qos_mapping
*elem
;
221 a
= blobmsg_open_array(b
, name
);
223 vlist_simple_for_each_element(qos_mapping_li
, elem
, node
) {
224 t
= blobmsg_open_table(b
, NULL
);
226 blobmsg_add_u32(b
, "from", elem
->from
);
227 blobmsg_add_u32(b
, "to", elem
->to
);
229 blobmsg_close_table(b
, t
);
232 blobmsg_close_array(b
, a
);
236 vlandev_dump_info(struct device
*dev
, struct blob_buf
*b
)
238 struct vlandev_device
*mvdev
;
240 mvdev
= container_of(dev
, struct vlandev_device
, dev
);
241 blobmsg_add_string(b
, "parent", mvdev
->parent
.dev
->ifname
);
242 system_if_dump_info(dev
, b
);
243 blobmsg_add_u32(b
, "vid", mvdev
->config
.vid
);
244 vlandev_qos_mapping_dump(b
, "ingress_qos_mapping", &mvdev
->config
.ingress_qos_mapping_list
);
245 vlandev_qos_mapping_dump(b
, "egress_qos_mapping", &mvdev
->config
.egress_qos_mapping_list
);
249 vlandev_get_vid(struct device
*dev
, const char *id_str
)
255 id
= strtoul(id_str
, &err
, 10);
260 alias_id
= kvlist_get(&dev
->vlan_aliases
, id_str
);
271 vlandev_config_init(struct device
*dev
)
273 struct vlandev_device
*mvdev
;
274 struct device
*basedev
= NULL
;
276 mvdev
= container_of(dev
, struct vlandev_device
, dev
);
278 basedev
= device_get(blobmsg_data(mvdev
->ifname
), true);
281 mvdev
->config
.vid
= vlandev_get_vid(basedev
, blobmsg_get_string(mvdev
->vid
));
283 mvdev
->config
.vid
= 1;
285 device_add_user(&mvdev
->parent
, basedev
);
286 vlandev_hotplug_check(mvdev
);
289 static void vlandev_qos_mapping_list_apply(struct vlist_simple_tree
*qos_mapping_li
, struct blob_attr
*list
)
291 struct blob_attr
*cur
;
292 struct vlan_qos_mapping
*qos_mapping
;
296 blobmsg_for_each_attr(cur
, list
, rem
) {
297 if (blobmsg_type(cur
) != BLOBMSG_TYPE_STRING
)
300 if (!blobmsg_check_attr(cur
, false))
303 qos_mapping
= calloc(1, sizeof(*qos_mapping
));
307 rc
= sscanf(blobmsg_data(cur
), "%" PRIu32
":%" PRIu32
, &qos_mapping
->from
, &qos_mapping
->to
);
312 vlist_simple_add(qos_mapping_li
, &qos_mapping
->node
);
317 vlandev_apply_settings(struct vlandev_device
*mvdev
, struct blob_attr
**tb
)
319 struct vlandev_config
*cfg
= &mvdev
->config
;
320 struct blob_attr
*cur
;
322 cfg
->proto
= (mvdev
->dev
.type
== &vlan8021q_device_type
) ?
323 VLAN_PROTO_8021Q
: VLAN_PROTO_8021AD
;
325 vlist_simple_update(&cfg
->ingress_qos_mapping_list
);
326 vlist_simple_update(&cfg
->egress_qos_mapping_list
);
328 if ((cur
= tb
[VLANDEV_ATTR_INGRESS_QOS_MAPPING
]))
329 vlandev_qos_mapping_list_apply(&cfg
->ingress_qos_mapping_list
, cur
);
331 if ((cur
= tb
[VLANDEV_ATTR_EGRESS_QOS_MAPPING
]))
332 vlandev_qos_mapping_list_apply(&cfg
->egress_qos_mapping_list
, cur
);
334 vlist_simple_flush(&cfg
->ingress_qos_mapping_list
);
335 vlist_simple_flush(&cfg
->egress_qos_mapping_list
);
338 static enum dev_change_type
339 vlandev_reload(struct device
*dev
, struct blob_attr
*attr
)
341 struct blob_attr
*tb_dev
[__DEV_ATTR_MAX
];
342 struct blob_attr
*tb_mv
[__VLANDEV_ATTR_MAX
];
343 enum dev_change_type ret
= DEV_CONFIG_APPLIED
;
344 struct vlandev_device
*mvdev
;
346 mvdev
= container_of(dev
, struct vlandev_device
, dev
);
347 attr
= blob_memdup(attr
);
349 blobmsg_parse(device_attr_list
.params
, __DEV_ATTR_MAX
, tb_dev
,
350 blob_data(attr
), blob_len(attr
));
351 blobmsg_parse(vlandev_attrs
, __VLANDEV_ATTR_MAX
, tb_mv
,
352 blob_data(attr
), blob_len(attr
));
354 device_init_settings(dev
, tb_dev
);
355 vlandev_apply_settings(mvdev
, tb_mv
);
356 mvdev
->ifname
= tb_mv
[VLANDEV_ATTR_IFNAME
];
357 mvdev
->vid
= tb_mv
[VLANDEV_ATTR_VID
];
359 if (mvdev
->config_data
) {
360 struct blob_attr
*otb_dev
[__DEV_ATTR_MAX
];
361 struct blob_attr
*otb_mv
[__VLANDEV_ATTR_MAX
];
363 blobmsg_parse(device_attr_list
.params
, __DEV_ATTR_MAX
, otb_dev
,
364 blob_data(mvdev
->config_data
), blob_len(mvdev
->config_data
));
366 if (uci_blob_diff(tb_dev
, otb_dev
, &device_attr_list
, NULL
))
367 ret
= DEV_CONFIG_RESTART
;
369 blobmsg_parse(vlandev_attrs
, __VLANDEV_ATTR_MAX
, otb_mv
,
370 blob_data(mvdev
->config_data
), blob_len(mvdev
->config_data
));
372 if (uci_blob_diff(tb_mv
, otb_mv
, &vlandev_attr_list
, NULL
))
373 ret
= DEV_CONFIG_RESTART
;
375 vlandev_config_init(dev
);
378 free(mvdev
->config_data
);
379 mvdev
->config_data
= attr
;
383 static struct device
*
384 vlandev_create(const char *name
, struct device_type
*devtype
,
385 struct blob_attr
*attr
)
387 struct vlandev_device
*mvdev
;
388 struct device
*dev
= NULL
;
390 mvdev
= calloc(1, sizeof(*mvdev
));
394 vlist_simple_init(&mvdev
->config
.ingress_qos_mapping_list
,
395 struct vlan_qos_mapping
, node
);
396 vlist_simple_init(&mvdev
->config
.egress_qos_mapping_list
,
397 struct vlan_qos_mapping
, node
);
401 if (device_init(dev
, devtype
, name
) < 0) {
407 dev
->config_pending
= true;
409 mvdev
->set_state
= dev
->set_state
;
410 dev
->set_state
= vlandev_set_state
;
412 dev
->hotplug_ops
= NULL
;
413 mvdev
->parent
.cb
= vlandev_base_cb
;
415 vlandev_reload(dev
, attr
);
420 static struct device_type vlan8021ad_device_type
= {
422 .config_params
= &vlandev_attr_list
,
423 .create
= vlandev_create
,
424 .config_init
= vlandev_config_init
,
425 .reload
= vlandev_reload
,
426 .free
= vlandev_free
,
427 .dump_info
= vlandev_dump_info
,
430 static struct device_type vlan8021q_device_type
= {
432 .config_params
= &vlandev_attr_list
,
433 .create
= vlandev_create
,
434 .config_init
= vlandev_config_init
,
435 .reload
= vlandev_reload
,
436 .free
= vlandev_free
,
437 .dump_info
= vlandev_dump_info
,
440 static void __init
vlandev_device_type_init(void)
442 device_type_add(&vlan8021ad_device_type
);
443 device_type_add(&vlan8021q_device_type
);