recognize stacked interfaces (e.g. dsa) and handle their dependencies
[project/netifd.git] / config.c
1 #include <string.h>
2 #include <stdlib.h>
3 #include <stdio.h>
4
5 #include <uci.h>
6
7 #include "netifd.h"
8 #include "interface.h"
9 #include "interface-ip.h"
10 #include "proto.h"
11 #include "config.h"
12
13 bool config_init = false;
14
15 static struct uci_context *uci_ctx;
16 static struct uci_package *uci_network;
17 static struct blob_buf b;
18
19 static void uci_attr_to_blob(struct blob_buf *b, const char *str,
20                              const char *name, enum blobmsg_type type)
21 {
22         char *err;
23         int intval;
24
25         switch (type) {
26         case BLOBMSG_TYPE_STRING:
27                 blobmsg_add_string(b, name, str);
28                 break;
29         case BLOBMSG_TYPE_BOOL:
30                 if (!strcmp(str, "true") || !strcmp(str, "1"))
31                         intval = 1;
32                 else if (!strcmp(str, "false") || !strcmp(str, "0"))
33                         intval = 0;
34                 else
35                         return;
36
37                 blobmsg_add_u8(b, name, intval);
38                 break;
39         case BLOBMSG_TYPE_INT32:
40                 intval = strtol(str, &err, 0);
41                 if (*err)
42                         return;
43
44                 blobmsg_add_u32(b, name, intval);
45                 break;
46         default:
47                 break;
48         }
49 }
50
51 static void uci_array_to_blob(struct blob_buf *b, struct uci_option *o,
52                               enum blobmsg_type type)
53 {
54         struct uci_element *e;
55         char *str, *next, *word;
56
57         if (o->type == UCI_TYPE_LIST) {
58                 uci_foreach_element(&o->v.list, e) {
59                         uci_attr_to_blob(b, e->name, NULL, type);
60                 }
61                 return;
62         }
63
64         str = strdup(o->v.string);
65         next = str;
66
67         while ((word = strsep(&next, " \t")) != NULL) {
68                 if (!*word)
69                         continue;
70
71                 uci_attr_to_blob(b, word, NULL, type);
72         }
73
74         free(str);
75 }
76
77 static void __uci_to_blob(struct blob_buf *b, struct uci_section *s,
78                           const struct config_param_list *p)
79 {
80         const struct blobmsg_policy *attr = NULL;
81         struct uci_element *e;
82         struct uci_option *o;
83         void *array;
84         int i;
85
86         uci_foreach_element(&s->options, e) {
87                 for (i = 0; i < p->n_params; i++) {
88                         attr = &p->params[i];
89                         if (!strcmp(attr->name, e->name))
90                                 break;
91                 }
92
93                 if (i == p->n_params)
94                         continue;
95
96                 o = uci_to_option(e);
97
98                 if (attr->type == BLOBMSG_TYPE_ARRAY) {
99                         if (!p->info)
100                                 continue;
101
102                         array = blobmsg_open_array(b, attr->name);
103                         uci_array_to_blob(b, o, p->info[i].type);
104                         blobmsg_close_array(b, array);
105                         continue;
106                 }
107
108                 if (o->type == UCI_TYPE_LIST)
109                         continue;
110
111                 uci_attr_to_blob(b, o->v.string, attr->name, attr->type);
112         }
113 }
114
115 static void uci_to_blob(struct blob_buf *b, struct uci_section *s,
116                         const struct config_param_list *p)
117 {
118         int i;
119
120         __uci_to_blob(b, s, p);
121         for (i = 0; i < p->n_next; i++)
122                 uci_to_blob(b, s, p->next[i]);
123 }
124
125 static int
126 config_parse_bridge_interface(struct uci_section *s)
127 {
128         char *name;
129
130         name = alloca(strlen(s->e.name) + 4);
131         sprintf(name, "br-%s", s->e.name);
132         blobmsg_add_string(&b, "name", name);
133
134         uci_to_blob(&b, s, bridge_device_type.config_params);
135         if (!device_create(name, &bridge_device_type, b.head)) {
136                 D(INTERFACE, "Failed to create bridge for interface '%s'\n", s->e.name);
137                 return -EINVAL;
138         }
139
140         blob_buf_init(&b, 0);
141         blobmsg_add_string(&b, "ifname", name);
142         return 0;
143 }
144
145 static void
146 config_parse_interface(struct uci_section *s)
147 {
148         struct interface *iface;
149         const char *type;
150         struct blob_attr *config;
151         struct device *dev;
152
153         blob_buf_init(&b, 0);
154
155         type = uci_lookup_option_string(uci_ctx, s, "type");
156         if (type && !strcmp(type, "bridge"))
157                 if (config_parse_bridge_interface(s))
158                         return;
159
160         uci_to_blob(&b, s, &interface_attr_list);
161         iface = calloc(1, sizeof(*iface));
162         if (!iface)
163                 return;
164
165         interface_init(iface, s->e.name, b.head);
166
167         if (iface->proto_handler && iface->proto_handler->config_params)
168                 uci_to_blob(&b, s, iface->proto_handler->config_params);
169
170         config = malloc(blob_pad_len(b.head));
171         if (!config) {
172                 free(iface);
173                 return;
174         }
175
176         memcpy(config, b.head, blob_pad_len(b.head));
177         interface_add(iface, config);
178
179         dev = iface->main_dev.dev;
180         if (!dev || !dev->default_config)
181                 return;
182
183         blob_buf_init(&b, 0);
184         uci_to_blob(&b, s, dev->type->config_params);
185         if (blob_len(b.head) == 0)
186                 return;
187
188         device_set_config(dev, dev->type, b.head);
189 }
190
191 static void
192 config_parse_route(struct uci_section *s, bool v6)
193 {
194         void *route;
195
196         blob_buf_init(&b, 0);
197         route = blobmsg_open_array(&b, "route");
198         uci_to_blob(&b, s, &route_attr_list);
199         blobmsg_close_array(&b, route);
200         interface_ip_add_route(NULL, blob_data(b.head), v6);
201 }
202
203 static void
204 config_init_devices(void)
205 {
206         struct uci_element *e;
207
208         uci_foreach_element(&uci_network->sections, e) {
209                 struct uci_section *s = uci_to_section(e);
210                 const struct device_type *devtype;
211                 const char *type, *name;
212
213                 if (strcmp(s->type, "device") != 0)
214                         continue;
215
216                 name = uci_lookup_option_string(uci_ctx, s, "name");
217                 if (!name)
218                         continue;
219
220                 type = uci_lookup_option_string(uci_ctx, s, "type");
221                 if (type && !strcmp(type, "bridge"))
222                         devtype = &bridge_device_type;
223                 else
224                         devtype = &simple_device_type;
225
226                 blob_buf_init(&b, 0);
227                 uci_to_blob(&b, s, devtype->config_params);
228                 device_create(name, devtype, b.head);
229         }
230 }
231
232 bool
233 config_diff(struct blob_attr **tb1, struct blob_attr **tb2,
234             const struct config_param_list *config, unsigned long *diff)
235 {
236         bool ret = false;
237         int i;
238
239         for (i = 0; i < config->n_params; i++) {
240                 if (!tb1[i] && !tb2[i])
241                         continue;
242
243                 if (!!tb1[i] != !!tb2[i])
244                         goto mark;
245
246                 if (blob_len(tb1[i]) != blob_len(tb2[i]))
247                         goto mark;
248
249                 if (memcmp(tb1[i], tb2[i], blob_raw_len(tb1[i])) != 0)
250                         goto mark;
251
252                 continue;
253
254 mark:
255                 ret = true;
256                 if (diff)
257                         set_bit(diff, i);
258                 else
259                         return ret;
260         }
261
262         return ret;
263 }
264
265
266 static bool
267 __config_check_equal(struct blob_attr *c1, struct blob_attr *c2,
268                      const struct config_param_list *config)
269 {
270         struct blob_attr **tb1, **tb2;
271
272         if (!!c1 ^ !!c2)
273                 return false;
274
275         if (!c1 && !c2)
276                 return true;
277
278         tb1 = alloca(config->n_params * sizeof(struct blob_attr *));
279         blobmsg_parse(config->params, config->n_params, tb1,
280                 blob_data(c1), blob_len(c1));
281
282         tb2 = alloca(config->n_params * sizeof(struct blob_attr *));
283         blobmsg_parse(config->params, config->n_params, tb2,
284                 blob_data(c2), blob_len(c2));
285
286         return !config_diff(tb1, tb2, config, NULL);
287 }
288
289 bool
290 config_check_equal(struct blob_attr *c1, struct blob_attr *c2,
291                    const struct config_param_list *config)
292 {
293         int i;
294
295         if (!__config_check_equal(c1, c2, config))
296                 return false;
297
298         for (i = 0; i < config->n_next; i++) {
299                 if (!__config_check_equal(c1, c2, config->next[i]))
300                         return false;
301         }
302
303         return true;
304 }
305
306 struct blob_attr *
307 config_memdup(struct blob_attr *attr)
308 {
309         struct blob_attr *ret;
310         int size = blob_pad_len(attr);
311
312         ret = malloc(size);
313         if (!ret)
314                 return NULL;
315
316         memcpy(ret, attr, size);
317         return ret;
318 }
319
320 static struct uci_package *
321 config_init_package(const char *config)
322 {
323         struct uci_context *ctx = uci_ctx;
324         struct uci_package *p = NULL;
325
326         if (!ctx) {
327                 ctx = uci_alloc_context();
328                 uci_ctx = ctx;
329
330 #ifdef DUMMY_MODE
331                 uci_set_confdir(ctx, "./config");
332                 uci_set_savedir(ctx, "./tmp");
333 #endif
334         } else {
335                 p = uci_lookup_package(ctx, config);
336                 if (p)
337                         uci_unload(ctx, p);
338         }
339
340         if (uci_load(ctx, "network", &p))
341                 return NULL;
342
343         return p;
344 }
345
346 static void
347 config_init_interfaces(void)
348 {
349         struct uci_element *e;
350
351         uci_foreach_element(&uci_network->sections, e) {
352                 struct uci_section *s = uci_to_section(e);
353
354                 if (!strcmp(s->type, "interface"))
355                         config_parse_interface(s);
356         }
357 }
358
359 static void
360 config_init_routes(void)
361 {
362         struct interface *iface;
363         struct uci_element *e;
364
365         vlist_for_each_element(&interfaces, iface, node)
366                 interface_ip_update_start(&iface->config_ip);
367
368         uci_foreach_element(&uci_network->sections, e) {
369                 struct uci_section *s = uci_to_section(e);
370
371                 if (!strcmp(s->type, "route"))
372                         config_parse_route(s, false);
373                 else if (!strcmp(s->type, "route6"))
374                         config_parse_route(s, true);
375         }
376
377         vlist_for_each_element(&interfaces, iface, node)
378                 interface_ip_update_complete(&iface->config_ip);
379 }
380
381 void
382 config_init_all(void)
383 {
384         uci_network = config_init_package("network");
385         if (!uci_network) {
386                 fprintf(stderr, "Failed to load network config\n");
387                 return;
388         }
389
390         config_init = true;
391         device_lock();
392
393         device_reset_config();
394         config_init_devices();
395         config_init_interfaces();
396         config_init_routes();
397
398         config_init = false;
399         device_unlock();
400
401         device_reset_old();
402         device_init_pending();
403         device_free_unused(NULL);
404         interface_start_pending();
405 }