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
));
226 if (device_init(dev
, devtype
, name
) < 0) {
232 dev
->config_pending
= true;
234 mvdev
->set_state
= dev
->set_state
;
235 dev
->set_state
= vlandev_set_state
;
237 dev
->hotplug_ops
= NULL
;
238 mvdev
->parent
.cb
= vlandev_base_cb
;
240 vlandev_reload(dev
, attr
);
245 static struct device_type vlan8021ad_device_type
= {
247 .config_params
= &vlandev_attr_list
,
248 .create
= vlandev_create
,
249 .config_init
= vlandev_config_init
,
250 .reload
= vlandev_reload
,
251 .free
= vlandev_free
,
252 .dump_info
= vlandev_dump_info
,
255 static struct device_type vlan8021q_device_type
= {
257 .config_params
= &vlandev_attr_list
,
258 .create
= vlandev_create
,
259 .config_init
= vlandev_config_init
,
260 .reload
= vlandev_reload
,
261 .free
= vlandev_free
,
262 .dump_info
= vlandev_dump_info
,
265 static void __init
vlandev_device_type_init(void)
267 device_type_add(&vlan8021ad_device_type
);
268 device_type_add(&vlan8021q_device_type
);