wireless: add retry_setup_failed to status notification
[project/netifd.git] / vlandev.c
1 /*
2  * netifd - network interface daemon
3  * Copyright (C) 2014 Gioacchino Mazzurco <gio@eigenlab.org>
4  *
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
8  *
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.
13  */
14
15 #include <string.h>
16
17 #include "netifd.h"
18 #include "device.h"
19 #include "interface.h"
20 #include "system.h"
21
22 enum {
23         VLANDEV_ATTR_TYPE,
24         VLANDEV_ATTR_IFNAME,
25         VLANDEV_ATTR_VID,
26         __VLANDEV_ATTR_MAX
27 };
28
29 static const struct blobmsg_policy vlandev_attrs[__VLANDEV_ATTR_MAX] = {
30         [VLANDEV_ATTR_TYPE] = { "type", BLOBMSG_TYPE_STRING },
31         [VLANDEV_ATTR_IFNAME] = { "ifname", BLOBMSG_TYPE_STRING },
32         [VLANDEV_ATTR_VID] = { "vid", BLOBMSG_TYPE_INT32 },
33 };
34
35 static const struct uci_blob_param_list vlandev_attr_list = {
36         .n_params = __VLANDEV_ATTR_MAX,
37         .params = vlandev_attrs,
38
39         .n_next = 1,
40         .next = { &device_attr_list },
41 };
42
43 struct vlandev_device {
44         struct device dev;
45         struct device_user parent;
46
47         device_state_cb set_state;
48
49         struct blob_attr *config_data;
50         struct blob_attr *ifname;
51         struct vlandev_config config;
52 };
53
54 static void
55 vlandev_base_cb(struct device_user *dev, enum device_event ev)
56 {
57         struct vlandev_device *mvdev = container_of(dev, struct vlandev_device, parent);
58
59         switch (ev) {
60         case DEV_EVENT_ADD:
61                 device_set_present(&mvdev->dev, true);
62                 break;
63         case DEV_EVENT_REMOVE:
64                 device_set_present(&mvdev->dev, false);
65                 break;
66         default:
67                 return;
68         }
69 }
70
71 static int
72 vlandev_set_down(struct vlandev_device *mvdev)
73 {
74         mvdev->set_state(&mvdev->dev, false);
75         system_vlandev_del(&mvdev->dev);
76         device_release(&mvdev->parent);
77
78         return 0;
79 }
80
81 static int
82 vlandev_set_up(struct vlandev_device *mvdev)
83 {
84         int ret;
85
86         ret = device_claim(&mvdev->parent);
87         if (ret < 0)
88                 return ret;
89
90         ret = system_vlandev_add(&mvdev->dev, mvdev->parent.dev, &mvdev->config);
91         if (ret < 0)
92                 goto release;
93
94         ret = mvdev->set_state(&mvdev->dev, true);
95         if (ret)
96                 goto delete;
97
98         return 0;
99
100 delete:
101         system_vlandev_del(&mvdev->dev);
102 release:
103         device_release(&mvdev->parent);
104         return ret;
105 }
106
107 static int
108 vlandev_set_state(struct device *dev, bool up)
109 {
110         struct vlandev_device *mvdev;
111
112         D(SYSTEM, "vlandev_set_state(%s, %u)\n", dev->ifname, up);
113
114         mvdev = container_of(dev, struct vlandev_device, dev);
115         if (up)
116                 return vlandev_set_up(mvdev);
117         else
118                 return vlandev_set_down(mvdev);
119 }
120
121 static void
122 vlandev_free(struct device *dev)
123 {
124         struct vlandev_device *mvdev;
125
126         mvdev = container_of(dev, struct vlandev_device, dev);
127         device_remove_user(&mvdev->parent);
128         free(mvdev->config_data);
129         free(mvdev);
130 }
131
132 static void
133 vlandev_dump_info(struct device *dev, struct blob_buf *b)
134 {
135         struct vlandev_device *mvdev;
136
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);
140 }
141
142 static void
143 vlandev_config_init(struct device *dev)
144 {
145         struct vlandev_device *mvdev;
146         struct device *basedev = NULL;
147
148         mvdev = container_of(dev, struct vlandev_device, dev);
149         if (mvdev->ifname)
150                 basedev = device_get(blobmsg_data(mvdev->ifname), true);
151
152         device_add_user(&mvdev->parent, basedev);
153 }
154
155 static void
156 vlandev_apply_settings(struct vlandev_device *mvdev, struct blob_attr **tb)
157 {
158         struct vlandev_config *cfg = &mvdev->config;
159         struct blob_attr *cur;
160
161         cfg->proto = VLAN_PROTO_8021Q;
162         cfg->vid = 1;
163
164         if ((cur = tb[VLANDEV_ATTR_TYPE]))
165         {
166                 if(!strcmp(blobmsg_data(cur), "8021ad"))
167                         cfg->proto = VLAN_PROTO_8021AD;
168         }
169
170         if ((cur = tb[VLANDEV_ATTR_VID]))
171                 cfg->vid = (uint16_t) blobmsg_get_u32(cur);
172 }
173
174 static enum dev_change_type
175 vlandev_reload(struct device *dev, struct blob_attr *attr)
176 {
177         struct blob_attr *tb_dev[__DEV_ATTR_MAX];
178         struct blob_attr *tb_mv[__VLANDEV_ATTR_MAX];
179         enum dev_change_type ret = DEV_CONFIG_APPLIED;
180         struct vlandev_device *mvdev;
181
182         mvdev = container_of(dev, struct vlandev_device, dev);
183         attr = blob_memdup(attr);
184
185         blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, tb_dev,
186                 blob_data(attr), blob_len(attr));
187         blobmsg_parse(vlandev_attrs, __VLANDEV_ATTR_MAX, tb_mv,
188                 blob_data(attr), blob_len(attr));
189
190         device_init_settings(dev, tb_dev);
191         vlandev_apply_settings(mvdev, tb_mv);
192         mvdev->ifname = tb_mv[VLANDEV_ATTR_IFNAME];
193
194         if (mvdev->config_data) {
195                 struct blob_attr *otb_dev[__DEV_ATTR_MAX];
196                 struct blob_attr *otb_mv[__VLANDEV_ATTR_MAX];
197
198                 blobmsg_parse(device_attr_list.params, __DEV_ATTR_MAX, otb_dev,
199                         blob_data(mvdev->config_data), blob_len(mvdev->config_data));
200
201                 if (uci_blob_diff(tb_dev, otb_dev, &device_attr_list, NULL))
202                     ret = DEV_CONFIG_RESTART;
203
204                 blobmsg_parse(vlandev_attrs, __VLANDEV_ATTR_MAX, otb_mv,
205                         blob_data(mvdev->config_data), blob_len(mvdev->config_data));
206
207                 if (uci_blob_diff(tb_mv, otb_mv, &vlandev_attr_list, NULL))
208                     ret = DEV_CONFIG_RESTART;
209
210                 vlandev_config_init(dev);
211         }
212
213         free(mvdev->config_data);
214         mvdev->config_data = attr;
215         return ret;
216 }
217
218 static struct device *
219 vlandev_create(const char *name, struct blob_attr *attr)
220 {
221         struct vlandev_device *mvdev;
222         struct device *dev = NULL;
223
224         mvdev = calloc(1, sizeof(*mvdev));
225         if (!mvdev)
226                 return NULL;
227
228         dev = &mvdev->dev;
229         device_init(dev, &vlandev_device_type, name);
230         dev->config_pending = true;
231
232         mvdev->set_state = dev->set_state;
233         dev->set_state = vlandev_set_state;
234
235         dev->hotplug_ops = NULL;
236         mvdev->parent.cb = vlandev_base_cb;
237
238         vlandev_reload(dev, attr);
239
240         return dev;
241 }
242
243 const struct device_type vlandev_device_type = {
244         .name = "VLANDEV",
245         .config_params = &vlandev_attr_list,
246         .create = vlandev_create,
247         .config_init = vlandev_config_init,
248         .reload = vlandev_reload,
249         .free = vlandev_free,
250         .dump_info = vlandev_dump_info,
251 };