Changes for more readability.
[project/netifd.git] / device.c
1 /*
2  * netifd - network interface daemon
3  * Copyright (C) 2012 Felix Fietkau <nbd@openwrt.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 #include <string.h>
15 #include <stdlib.h>
16 #include <stdio.h>
17 #include <assert.h>
18
19 #include <sys/types.h>
20 #include <sys/socket.h>
21 #include <net/ethernet.h>
22
23 #ifdef linux
24 #include <netinet/ether.h>
25 #endif
26
27 #include "netifd.h"
28 #include "system.h"
29 #include "config.h"
30
31 static struct avl_tree devices;
32 static bool default_ps = true;
33
34 static const struct blobmsg_policy dev_attrs[__DEV_ATTR_MAX] = {
35         [DEV_ATTR_TYPE] = { .name = "type", .type = BLOBMSG_TYPE_STRING },
36         [DEV_ATTR_MTU] = { .name = "mtu", .type = BLOBMSG_TYPE_INT32 },
37         [DEV_ATTR_MTU6] = { .name = "mtu6", .type = BLOBMSG_TYPE_INT32 },
38         [DEV_ATTR_MACADDR] = { .name = "macaddr", .type = BLOBMSG_TYPE_STRING },
39         [DEV_ATTR_TXQUEUELEN] = { .name = "txqueuelen", .type = BLOBMSG_TYPE_INT32 },
40         [DEV_ATTR_ENABLED] = { .name = "enabled", .type = BLOBMSG_TYPE_BOOL },
41         [DEV_ATTR_IPV6] = { .name = "ipv6", .type = BLOBMSG_TYPE_BOOL },
42         [DEV_ATTR_PROMISC] = { .name = "promisc", .type = BLOBMSG_TYPE_BOOL },
43         [DEV_ATTR_RPFILTER] = { .name = "rpfilter", .type = BLOBMSG_TYPE_STRING },
44         [DEV_ATTR_ACCEPTLOCAL] = { .name = "acceptlocal", .type = BLOBMSG_TYPE_BOOL },
45         [DEV_ATTR_IGMPVERSION] = { .name = "igmpversion", .type = BLOBMSG_TYPE_INT32 },
46         [DEV_ATTR_MLDVERSION] = { .name = "mldversion", .type = BLOBMSG_TYPE_INT32 },
47         [DEV_ATTR_NEIGHREACHABLETIME] = { .name = "neighreachabletime", .type = BLOBMSG_TYPE_INT32 },
48         [DEV_ATTR_RPS] = { .name = "rps", .type = BLOBMSG_TYPE_BOOL },
49         [DEV_ATTR_XPS] = { .name = "xps", .type = BLOBMSG_TYPE_BOOL },
50         [DEV_ATTR_DADTRANSMITS] = { .name = "dadtransmits", .type = BLOBMSG_TYPE_INT32 },
51 };
52
53 const struct uci_blob_param_list device_attr_list = {
54         .n_params = __DEV_ATTR_MAX,
55         .params = dev_attrs,
56 };
57
58 static int __devlock = 0;
59
60 void device_lock(void)
61 {
62         __devlock++;
63 }
64
65 void device_unlock(void)
66 {
67         __devlock--;
68         if (!__devlock)
69                 device_free_unused(NULL);
70 }
71
72 static int set_device_state(struct device *dev, bool state)
73 {
74         if (state) {
75                 /* Set ifindex for all devices being enabled so a valid  */
76                 /* ifindex is in place avoiding possible race conditions */
77                 device_set_ifindex(dev, system_if_resolve(dev));
78                 if (!dev->ifindex)
79                         return -1;
80         }
81
82         if (dev->external)
83                 return 0;
84
85         if (state)
86                 system_if_up(dev);
87         else
88                 system_if_down(dev);
89
90         return 0;
91 }
92
93 static int
94 simple_device_set_state(struct device *dev, bool state)
95 {
96         struct device *pdev;
97         int ret = 0;
98
99         pdev = dev->parent.dev;
100         if (state && !pdev) {
101                 pdev = system_if_get_parent(dev);
102                 if (pdev)
103                         device_add_user(&dev->parent, pdev);
104         }
105
106         if (pdev) {
107                 if (state)
108                         ret = device_claim(&dev->parent);
109                 else
110                         device_release(&dev->parent);
111
112                 if (ret < 0)
113                         return ret;
114         }
115         return set_device_state(dev, state);
116 }
117
118 static struct device *
119 simple_device_create(const char *name, struct blob_attr *attr)
120 {
121         struct blob_attr *tb[__DEV_ATTR_MAX];
122         struct device *dev = NULL;
123
124         blobmsg_parse(dev_attrs, __DEV_ATTR_MAX, tb, blob_data(attr), blob_len(attr));
125         dev = device_get(name, true);
126         if (!dev)
127                 return NULL;
128
129         dev->set_state = simple_device_set_state;
130         device_init_settings(dev, tb);
131
132         return dev;
133 }
134
135 static void simple_device_free(struct device *dev)
136 {
137         if (dev->parent.dev)
138                 device_remove_user(&dev->parent);
139         free(dev);
140 }
141
142 const struct device_type simple_device_type = {
143         .name = "Network device",
144         .config_params = &device_attr_list,
145
146         .create = simple_device_create,
147         .check_state = system_if_check,
148         .free = simple_device_free,
149 };
150
151 static void
152 device_merge_settings(struct device *dev, struct device_settings *n)
153 {
154         struct device_settings *os = &dev->orig_settings;
155         struct device_settings *s = &dev->settings;
156
157         memset(n, 0, sizeof(*n));
158         n->mtu = s->flags & DEV_OPT_MTU ? s->mtu : os->mtu;
159         n->mtu6 = s->flags & DEV_OPT_MTU6 ? s->mtu6 : os->mtu6;
160         n->txqueuelen = s->flags & DEV_OPT_TXQUEUELEN ?
161                 s->txqueuelen : os->txqueuelen;
162         memcpy(n->macaddr,
163                 (s->flags & DEV_OPT_MACADDR ? s->macaddr : os->macaddr),
164                 sizeof(n->macaddr));
165         n->ipv6 = s->flags & DEV_OPT_IPV6 ? s->ipv6 : os->ipv6;
166         n->promisc = s->flags & DEV_OPT_PROMISC ? s->promisc : os->promisc;
167         n->rpfilter = s->flags & DEV_OPT_RPFILTER ? s->rpfilter : os->rpfilter;
168         n->acceptlocal = s->flags & DEV_OPT_ACCEPTLOCAL ? s->acceptlocal : os->acceptlocal;
169         n->igmpversion = s->flags & DEV_OPT_IGMPVERSION ? s->igmpversion : os->igmpversion;
170         n->mldversion = s->flags & DEV_OPT_MLDVERSION ? s->mldversion : os->mldversion;
171         n->neigh4reachabletime = s->flags & DEV_OPT_NEIGHREACHABLETIME ?
172                 s->neigh4reachabletime : os->neigh4reachabletime;
173         n->neigh6reachabletime = s->flags & DEV_OPT_NEIGHREACHABLETIME ?
174                 s->neigh6reachabletime : os->neigh6reachabletime;
175         n->dadtransmits = s->flags & DEV_OPT_DADTRANSMITS ?
176                 s->dadtransmits : os->dadtransmits;
177         n->flags = s->flags | os->flags;
178 }
179
180 void
181 device_init_settings(struct device *dev, struct blob_attr **tb)
182 {
183         struct device_settings *s = &dev->settings;
184         struct blob_attr *cur;
185         struct ether_addr *ea;
186         bool disabled = false;
187
188         s->flags = 0;
189         if ((cur = tb[DEV_ATTR_ENABLED]))
190                 disabled = !blobmsg_get_bool(cur);
191
192         if ((cur = tb[DEV_ATTR_MTU])) {
193                 s->mtu = blobmsg_get_u32(cur);
194                 s->flags |= DEV_OPT_MTU;
195         }
196
197         if ((cur = tb[DEV_ATTR_MTU6])) {
198                 s->mtu6 = blobmsg_get_u32(cur);
199                 s->flags |= DEV_OPT_MTU6;
200         }
201
202         if ((cur = tb[DEV_ATTR_TXQUEUELEN])) {
203                 s->txqueuelen = blobmsg_get_u32(cur);
204                 s->flags |= DEV_OPT_TXQUEUELEN;
205         }
206
207         if ((cur = tb[DEV_ATTR_MACADDR])) {
208                 ea = ether_aton(blobmsg_data(cur));
209                 if (ea) {
210                         memcpy(s->macaddr, ea, 6);
211                         s->flags |= DEV_OPT_MACADDR;
212                 }
213         }
214
215         if ((cur = tb[DEV_ATTR_IPV6])) {
216                 s->ipv6 = blobmsg_get_bool(cur);
217                 s->flags |= DEV_OPT_IPV6;
218         }
219
220         if ((cur = tb[DEV_ATTR_PROMISC])) {
221                 s->promisc = blobmsg_get_bool(cur);
222                 s->flags |= DEV_OPT_PROMISC;
223         }
224
225         if ((cur = tb[DEV_ATTR_RPFILTER])) {
226                 if (system_resolve_rpfilter(blobmsg_data(cur), &s->rpfilter))
227                         s->flags |= DEV_OPT_RPFILTER;
228                 else
229                         DPRINTF("Failed to resolve rpfilter: %s\n", (char *) blobmsg_data(cur));
230         }
231
232         if ((cur = tb[DEV_ATTR_ACCEPTLOCAL])) {
233                 s->acceptlocal = blobmsg_get_bool(cur);
234                 s->flags |= DEV_OPT_ACCEPTLOCAL;
235         }
236
237         if ((cur = tb[DEV_ATTR_IGMPVERSION])) {
238                 s->igmpversion = blobmsg_get_u32(cur);
239                 if (s->igmpversion >= 1 && s->igmpversion <= 3)
240                         s->flags |= DEV_OPT_IGMPVERSION;
241                 else
242                         DPRINTF("Failed to resolve igmpversion: %d\n", blobmsg_get_u32(cur));
243         }
244
245         if ((cur = tb[DEV_ATTR_MLDVERSION])) {
246                 s->mldversion = blobmsg_get_u32(cur);
247                 if (s->mldversion >= 1 && s->mldversion <= 2)
248                         s->flags |= DEV_OPT_MLDVERSION;
249                 else
250                         DPRINTF("Failed to resolve mldversion: %d\n", blobmsg_get_u32(cur));
251         }
252
253         if ((cur = tb[DEV_ATTR_NEIGHREACHABLETIME])) {
254                 s->neigh6reachabletime = s->neigh4reachabletime = blobmsg_get_u32(cur);
255                 s->flags |= DEV_OPT_NEIGHREACHABLETIME;
256         }
257
258         if ((cur = tb[DEV_ATTR_RPS])) {
259                 s->rps = blobmsg_get_bool(cur);
260                 s->flags |= DEV_OPT_RPS;
261         }
262         else
263                 s->rps = default_ps;
264
265         if ((cur = tb[DEV_ATTR_XPS])) {
266                 s->xps = blobmsg_get_bool(cur);
267                 s->flags |= DEV_OPT_XPS;
268         }
269         else
270                 s->xps = default_ps;
271
272         if ((cur = tb[DEV_ATTR_DADTRANSMITS])) {
273                 s->dadtransmits = blobmsg_get_u32(cur);
274                 s->flags |= DEV_OPT_DADTRANSMITS;
275         }
276
277         device_set_disabled(dev, disabled);
278 }
279
280 static void __init dev_init(void)
281 {
282         avl_init(&devices, avl_strcmp, true, NULL);
283 }
284
285 static int device_broadcast_cb(void *ctx, struct safe_list *list)
286 {
287         struct device_user *dep = container_of(list, struct device_user, list);
288         int *ev = ctx;
289
290         /* device might have been removed by an earlier callback */
291         if (!dep->dev)
292                 return 0;
293
294         if (dep->cb)
295                 dep->cb(dep, *ev);
296         return 0;
297 }
298
299 void device_broadcast_event(struct device *dev, enum device_event ev)
300 {
301         int dev_ev = ev;
302
303         safe_list_for_each(&dev->aliases, device_broadcast_cb, &dev_ev);
304         safe_list_for_each(&dev->users, device_broadcast_cb, &dev_ev);
305 }
306
307 int device_claim(struct device_user *dep)
308 {
309         struct device *dev = dep->dev;
310         int ret;
311
312         if (dep->claimed)
313                 return 0;
314
315         dep->claimed = true;
316         D(DEVICE, "Claim %s %s, new active count: %d\n", dev->type->name, dev->ifname, dev->active + 1);
317         if (++dev->active != 1)
318                 return 0;
319
320         device_broadcast_event(dev, DEV_EVENT_SETUP);
321         ret = dev->set_state(dev, true);
322         if (ret == 0)
323                 device_broadcast_event(dev, DEV_EVENT_UP);
324         else {
325                 D(DEVICE, "claim %s %s failed: %d\n", dev->type->name, dev->ifname, ret);
326                 dev->active = 0;
327                 dep->claimed = false;
328         }
329
330         return ret;
331 }
332
333 void device_release(struct device_user *dep)
334 {
335         struct device *dev = dep->dev;
336
337         if (!dep->claimed)
338                 return;
339
340         dep->claimed = false;
341         dev->active--;
342         D(DEVICE, "Release %s %s, new active count: %d\n", dev->type->name, dev->ifname, dev->active);
343         assert(dev->active >= 0);
344
345         if (dev->active)
346                 return;
347
348         device_broadcast_event(dev, DEV_EVENT_TEARDOWN);
349         if (!dev->external)
350                 dev->set_state(dev, false);
351         device_broadcast_event(dev, DEV_EVENT_DOWN);
352 }
353
354 int device_check_state(struct device *dev)
355 {
356         if (!dev->type->check_state)
357                 return simple_device_type.check_state(dev);
358
359         return dev->type->check_state(dev);
360 }
361
362 void device_init_virtual(struct device *dev, const struct device_type *type, const char *name)
363 {
364         assert(dev);
365         assert(type);
366
367         if (name)
368                 strncpy(dev->ifname, name, IFNAMSIZ);
369
370         D(DEVICE, "Initialize device '%s'\n", dev->ifname);
371         INIT_SAFE_LIST(&dev->users);
372         INIT_SAFE_LIST(&dev->aliases);
373         dev->type = type;
374
375         if (!dev->set_state)
376                 dev->set_state = set_device_state;
377 }
378
379 int device_init(struct device *dev, const struct device_type *type, const char *ifname)
380 {
381         int ret;
382
383         device_init_virtual(dev, type, ifname);
384
385         dev->avl.key = dev->ifname;
386
387         ret = avl_insert(&devices, &dev->avl);
388         if (ret < 0)
389                 return ret;
390
391         system_if_clear_state(dev);
392         device_check_state(dev);
393         dev->settings.rps = default_ps;
394         dev->settings.xps = default_ps;
395
396         return 0;
397 }
398
399 static struct device *
400 device_create_default(const char *name, bool external)
401 {
402         struct device *dev;
403
404         if (!external && system_if_force_external(name))
405                 return NULL;
406
407         D(DEVICE, "Create simple device '%s'\n", name);
408         dev = calloc(1, sizeof(*dev));
409         dev->external = external;
410         dev->set_state = simple_device_set_state;
411         device_init(dev, &simple_device_type, name);
412         dev->default_config = true;
413         if (external)
414                 system_if_apply_settings(dev, &dev->settings, dev->settings.flags);
415         return dev;
416 }
417
418 struct device *
419 device_get(const char *name, int create)
420 {
421         struct device *dev;
422
423         if (strchr(name, '.'))
424                 return get_vlan_device_chain(name, create);
425
426         if (name[0] == '@')
427                 return device_alias_get(name + 1);
428
429         dev = avl_find_element(&devices, name, dev, avl);
430         if (dev) {
431                 if (create > 1 && !dev->external) {
432                         dev->external = true;
433                         device_set_present(dev, true);
434                 }
435                 return dev;
436         }
437
438         if (!create)
439                 return NULL;
440
441         return device_create_default(name, create > 1);
442 }
443
444 static void
445 device_delete(struct device *dev)
446 {
447         if (!dev->avl.key)
448                 return;
449
450         D(DEVICE, "Delete device '%s' from list\n", dev->ifname);
451         avl_delete(&devices, &dev->avl);
452         dev->avl.key = NULL;
453 }
454
455 static int device_cleanup_cb(void *ctx, struct safe_list *list)
456 {
457         struct device_user *dep = container_of(list, struct device_user, list);
458         if (dep->cb)
459                 dep->cb(dep, DEV_EVENT_REMOVE);
460
461         device_release(dep);
462         return 0;
463 }
464
465 void device_cleanup(struct device *dev)
466 {
467         D(DEVICE, "Clean up device '%s'\n", dev->ifname);
468         safe_list_for_each(&dev->users, device_cleanup_cb, NULL);
469         safe_list_for_each(&dev->aliases, device_cleanup_cb, NULL);
470         device_delete(dev);
471 }
472
473 static void __device_set_present(struct device *dev, bool state)
474 {
475         if (dev->present == state)
476                 return;
477
478         dev->present = state;
479         device_broadcast_event(dev, state ? DEV_EVENT_ADD : DEV_EVENT_REMOVE);
480 }
481
482 void
483 device_refresh_present(struct device *dev)
484 {
485         bool state = dev->sys_present;
486
487         if (dev->disabled || dev->deferred)
488                 state = false;
489
490         __device_set_present(dev, state);
491 }
492
493 void device_set_present(struct device *dev, bool state)
494 {
495         if (dev->sys_present == state)
496                 return;
497
498         D(DEVICE, "%s '%s' %s present\n", dev->type->name, dev->ifname, state ? "is now" : "is no longer" );
499         dev->sys_present = state;
500         device_refresh_present(dev);
501 }
502
503 void device_set_link(struct device *dev, bool state)
504 {
505         if (dev->link_active == state)
506                 return;
507
508         netifd_log_message(L_NOTICE, "%s '%s' link is %s\n", dev->type->name, dev->ifname, state ? "up" : "down" );
509
510         dev->link_active = state;
511         device_broadcast_event(dev, state ? DEV_EVENT_LINK_UP : DEV_EVENT_LINK_DOWN);
512 }
513
514 void device_set_ifindex(struct device *dev, int ifindex)
515 {
516         if (dev->ifindex == ifindex)
517                 return;
518
519         dev->ifindex = ifindex;
520         device_broadcast_event(dev, DEV_EVENT_UPDATE_IFINDEX);
521 }
522
523 static int device_refcount(struct device *dev)
524 {
525         struct list_head *list;
526         int count = 0;
527
528         list_for_each(list, &dev->users.list)
529                 count++;
530
531         list_for_each(list, &dev->aliases.list)
532                 count++;
533
534         return count;
535 }
536
537 static void
538 __device_add_user(struct device_user *dep, struct device *dev)
539 {
540         struct safe_list *head;
541
542         dep->dev = dev;
543
544         if (dep->alias)
545                 head = &dev->aliases;
546         else
547                 head = &dev->users;
548
549         safe_list_add(&dep->list, head);
550         D(DEVICE, "Add user for device '%s', refcount=%d\n", dev->ifname, device_refcount(dev));
551
552         if (dep->cb && dev->present) {
553                 dep->cb(dep, DEV_EVENT_ADD);
554                 if (dev->active)
555                         dep->cb(dep, DEV_EVENT_UP);
556
557                 if (dev->link_active)
558                         dep->cb(dep, DEV_EVENT_LINK_UP);
559         }
560 }
561
562 void device_add_user(struct device_user *dep, struct device *dev)
563 {
564         if (dep->dev == dev)
565                 return;
566
567         if (dep->dev)
568                 device_remove_user(dep);
569
570         if (!dev)
571                 return;
572
573         __device_add_user(dep, dev);
574 }
575
576 void
577 device_free(struct device *dev)
578 {
579         __devlock++;
580         free(dev->config);
581         device_cleanup(dev);
582         dev->type->free(dev);
583         __devlock--;
584 }
585
586 static void
587 __device_free_unused(struct device *dev)
588 {
589         if (!safe_list_empty(&dev->users) ||
590                 !safe_list_empty(&dev->aliases) ||
591             dev->current_config || __devlock)
592                 return;
593
594         device_free(dev);
595 }
596
597 void device_remove_user(struct device_user *dep)
598 {
599         struct device *dev = dep->dev;
600
601         if (!dep->dev)
602                 return;
603
604         dep->hotplug = false;
605         if (dep->claimed)
606                 device_release(dep);
607
608         safe_list_del(&dep->list);
609         dep->dev = NULL;
610         D(DEVICE, "Remove user for device '%s', refcount=%d\n", dev->ifname, device_refcount(dev));
611         __device_free_unused(dev);
612 }
613
614 void
615 device_free_unused(struct device *dev)
616 {
617         struct device *tmp;
618
619         if (dev)
620                 return __device_free_unused(dev);
621
622         avl_for_each_element_safe(&devices, dev, avl, tmp)
623                 __device_free_unused(dev);
624 }
625
626 void
627 device_init_pending(void)
628 {
629         struct device *dev, *tmp;
630
631         avl_for_each_element_safe(&devices, dev, avl, tmp) {
632                 if (!dev->config_pending)
633                         continue;
634
635                 dev->type->config_init(dev);
636                 dev->config_pending = false;
637         }
638 }
639
640 static enum dev_change_type
641 device_set_config(struct device *dev, const struct device_type *type,
642                   struct blob_attr *attr)
643 {
644         struct blob_attr *tb[__DEV_ATTR_MAX];
645         const struct uci_blob_param_list *cfg = type->config_params;
646
647         if (type != dev->type)
648                 return DEV_CONFIG_RECREATE;
649
650         if (dev->type->reload)
651                 return dev->type->reload(dev, attr);
652
653         if (uci_blob_check_equal(dev->config, attr, cfg))
654                 return DEV_CONFIG_NO_CHANGE;
655
656         if (cfg == &device_attr_list) {
657                 memset(tb, 0, sizeof(tb));
658
659                 if (attr)
660                         blobmsg_parse(dev_attrs, __DEV_ATTR_MAX, tb,
661                                 blob_data(attr), blob_len(attr));
662
663                 device_init_settings(dev, tb);
664                 return DEV_CONFIG_RESTART;
665         } else
666                 return DEV_CONFIG_RECREATE;
667 }
668
669 enum dev_change_type
670 device_apply_config(struct device *dev, const struct device_type *type,
671                     struct blob_attr *config)
672 {
673         enum dev_change_type change;
674
675         change = device_set_config(dev, type, config);
676         if (dev->external) {
677                 system_if_apply_settings(dev, &dev->settings, dev->settings.flags);
678                 change = DEV_CONFIG_APPLIED;
679         }
680
681         switch (change) {
682                 case DEV_CONFIG_RESTART:
683                 case DEV_CONFIG_APPLIED:
684                         D(DEVICE, "Device '%s': config applied\n", dev->ifname);
685                         config = blob_memdup(config);
686                         free(dev->config);
687                         dev->config = config;
688                         if (change == DEV_CONFIG_RESTART && dev->present) {
689                                 device_set_present(dev, false);
690                                 if (dev->active && !dev->external) {
691                                         dev->set_state(dev, false);
692                                         dev->set_state(dev, true);
693                                 }
694                                 device_set_present(dev, true);
695                         }
696                         break;
697                 case DEV_CONFIG_NO_CHANGE:
698                         D(DEVICE, "Device '%s': no configuration change\n", dev->ifname);
699                         break;
700                 case DEV_CONFIG_RECREATE:
701                         break;
702         }
703
704         return change;
705 }
706
707 static void
708 device_replace(struct device *dev, struct device *odev)
709 {
710         struct device_user *dep, *tmp;
711
712         __devlock++;
713         if (odev->present)
714                 device_set_present(odev, false);
715
716         list_for_each_entry_safe(dep, tmp, &odev->users.list, list.list) {
717                 device_release(dep);
718                 safe_list_del(&dep->list);
719                 __device_add_user(dep, dev);
720         }
721         __devlock--;
722
723         device_free(odev);
724 }
725
726 void
727 device_reset_config(void)
728 {
729         struct device *dev;
730
731         avl_for_each_element(&devices, dev, avl)
732                 dev->current_config = false;
733 }
734
735 void
736 device_reset_old(void)
737 {
738         struct device *dev, *tmp, *ndev;
739
740         avl_for_each_element_safe(&devices, dev, avl, tmp) {
741                 if (dev->current_config || dev->default_config)
742                         continue;
743
744                 if (dev->type != &simple_device_type)
745                         continue;
746
747                 ndev = device_create_default(dev->ifname, dev->external);
748                 if (!ndev)
749                         continue;
750
751                 device_replace(ndev, dev);
752         }
753 }
754
755 void
756 device_set_default_ps(bool state)
757 {
758         struct device *dev;
759
760         if (state == default_ps)
761                 return;
762
763         default_ps = state;
764
765         avl_for_each_element(&devices, dev, avl) {
766                 struct device_settings *s = &dev->settings;
767                 unsigned int apply_mask = 0;
768
769                 if (!(s->flags & DEV_OPT_RPS)) {
770                         s->rps = default_ps;
771                         apply_mask |= DEV_OPT_RPS;
772                 }
773
774                 if (!(s->flags & DEV_OPT_XPS)) {
775                         s->xps = default_ps;
776                         apply_mask |= DEV_OPT_XPS;
777                 }
778
779                 if (!apply_mask)
780                         continue;
781
782                 if (!(dev->external || (dev->present && dev->active)) ||
783                                 dev->config_pending)
784                         continue;
785
786                 system_if_apply_settings(dev, s, apply_mask);
787         }
788 }
789
790 struct device *
791 device_create(const char *name, const struct device_type *type,
792               struct blob_attr *config)
793 {
794         struct device *odev = NULL, *dev;
795         enum dev_change_type change;
796
797         odev = device_get(name, false);
798         if (odev) {
799                 odev->current_config = true;
800                 change = device_apply_config(odev, type, config);
801                 switch (change) {
802                 case DEV_CONFIG_RECREATE:
803                         D(DEVICE, "Device '%s': recreate device\n", odev->ifname);
804                         device_delete(odev);
805                         break;
806                 default:
807                         return odev;
808                 }
809         } else
810                 D(DEVICE, "Create new device '%s' (%s)\n", name, type->name);
811
812         config = blob_memdup(config);
813         if (!config)
814                 return NULL;
815
816         dev = type->create(name, config);
817         if (!dev)
818                 return NULL;
819
820         dev->current_config = true;
821         dev->config = config;
822         if (odev)
823                 device_replace(dev, odev);
824
825         if (!config_init && dev->config_pending) {
826                 type->config_init(dev);
827                 dev->config_pending = false;
828         }
829
830         return dev;
831 }
832
833 void
834 device_dump_status(struct blob_buf *b, struct device *dev)
835 {
836         struct device_settings st;
837         void *c, *s;
838
839         if (!dev) {
840                 avl_for_each_element(&devices, dev, avl) {
841                         if (!dev->present)
842                                 continue;
843                         c = blobmsg_open_table(b, dev->ifname);
844                         device_dump_status(b, dev);
845                         blobmsg_close_table(b, c);
846                 }
847
848                 return;
849         }
850
851         blobmsg_add_u8(b, "external", dev->external);
852         blobmsg_add_u8(b, "present", dev->present);
853         blobmsg_add_string(b, "type", dev->type->name);
854
855         if (!dev->present)
856                 return;
857
858         blobmsg_add_u8(b, "up", !!dev->active);
859         blobmsg_add_u8(b, "carrier", !!dev->link_active);
860
861         if (dev->type->dump_info)
862                 dev->type->dump_info(dev, b);
863         else
864                 system_if_dump_info(dev, b);
865
866         if (dev->active) {
867                 device_merge_settings(dev, &st);
868                 if (st.flags & DEV_OPT_MTU)
869                         blobmsg_add_u32(b, "mtu", st.mtu);
870                 if (st.flags & DEV_OPT_MTU6)
871                         blobmsg_add_u32(b, "mtu6", st.mtu6);
872                 if (st.flags & DEV_OPT_MACADDR)
873                         blobmsg_add_string(b, "macaddr", format_macaddr(st.macaddr));
874                 if (st.flags & DEV_OPT_TXQUEUELEN)
875                         blobmsg_add_u32(b, "txqueuelen", st.txqueuelen);
876                 if (st.flags & DEV_OPT_IPV6)
877                         blobmsg_add_u8(b, "ipv6", st.ipv6);
878                 if (st.flags & DEV_OPT_PROMISC)
879                         blobmsg_add_u8(b, "promisc", st.promisc);
880                 if (st.flags & DEV_OPT_RPFILTER)
881                         blobmsg_add_u32(b, "rpfilter", st.rpfilter);
882                 if (st.flags & DEV_OPT_ACCEPTLOCAL)
883                         blobmsg_add_u8(b, "acceptlocal", st.acceptlocal);
884                 if (st.flags & DEV_OPT_IGMPVERSION)
885                         blobmsg_add_u32(b, "igmpversion", st.igmpversion);
886                 if (st.flags & DEV_OPT_MLDVERSION)
887                         blobmsg_add_u32(b, "mldversion", st.mldversion);
888                 if (st.flags & DEV_OPT_NEIGHREACHABLETIME) {
889                         blobmsg_add_u32(b, "neigh4reachabletime", st.neigh4reachabletime);
890                         blobmsg_add_u32(b, "neigh6reachabletime", st.neigh6reachabletime);
891                 }
892                 if (st.flags & DEV_OPT_DADTRANSMITS)
893                         blobmsg_add_u32(b, "dadtransmits", st.dadtransmits);
894         }
895
896         s = blobmsg_open_table(b, "statistics");
897         if (dev->type->dump_stats)
898                 dev->type->dump_stats(dev, b);
899         else
900                 system_if_dump_stats(dev, b);
901         blobmsg_close_table(b, s);
902 }