netifd: wireless: add support for tracking wifi-vlan sections
[project/netifd.git] / wireless.c
1 /*
2 * netifd - network interface daemon
3 * Copyright (C) 2013 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 <signal.h>
15 #include "netifd.h"
16 #include "wireless.h"
17 #include "handler.h"
18 #include "ubus.h"
19
20 #define WIRELESS_SETUP_RETRY 3
21
22 struct vlist_tree wireless_devices;
23 struct avl_tree wireless_drivers;
24 static struct blob_buf b;
25 static int drv_fd;
26 static LIST_HEAD(handlers);
27 static bool handler_pending;
28
29 enum {
30 WDEV_ATTR_DISABLED,
31 WDEV_ATTR_RECONF,
32 WDEV_ATTR_SERIALIZE,
33 __WDEV_ATTR_MAX,
34 };
35
36 static const struct blobmsg_policy wdev_policy[__WDEV_ATTR_MAX] = {
37 [WDEV_ATTR_DISABLED] = { .name = "disabled", .type = BLOBMSG_TYPE_BOOL },
38 [WDEV_ATTR_RECONF] = { .name = "reconf", .type = BLOBMSG_TYPE_BOOL },
39 [WDEV_ATTR_SERIALIZE] = { .name = "serialize", .type = BLOBMSG_TYPE_BOOL },
40 };
41
42 static const struct uci_blob_param_list wdev_param = {
43 .n_params = ARRAY_SIZE(wdev_policy),
44 .params = wdev_policy,
45 };
46
47 enum {
48 VIF_ATTR_DISABLED,
49 VIF_ATTR_NETWORK,
50 VIF_ATTR_ISOLATE,
51 VIF_ATTR_MODE,
52 __VIF_ATTR_MAX,
53 };
54
55 static const struct blobmsg_policy vif_policy[__VIF_ATTR_MAX] = {
56 [VIF_ATTR_DISABLED] = { .name = "disabled", .type = BLOBMSG_TYPE_BOOL },
57 [VIF_ATTR_NETWORK] = { .name = "network", .type = BLOBMSG_TYPE_ARRAY },
58 [VIF_ATTR_ISOLATE] = { .name = "isolate", .type = BLOBMSG_TYPE_BOOL },
59 [VIF_ATTR_MODE] = { .name = "mode", .type = BLOBMSG_TYPE_STRING },
60 };
61
62 static const struct uci_blob_param_list vif_param = {
63 .n_params = ARRAY_SIZE(vif_policy),
64 .params = vif_policy,
65 };
66
67 enum {
68 VLAN_ATTR_DISABLED,
69 VLAN_ATTR_NETWORK,
70 VLAN_ATTR_ISOLATE,
71 __VLAN_ATTR_MAX,
72 };
73
74 static const struct blobmsg_policy vlan_policy[__VLAN_ATTR_MAX] = {
75 [VLAN_ATTR_DISABLED] = { .name = "disabled", .type = BLOBMSG_TYPE_BOOL },
76 [VLAN_ATTR_NETWORK] = { .name = "network", .type = BLOBMSG_TYPE_ARRAY },
77 [VLAN_ATTR_ISOLATE] = { .name = "isolate", .type = BLOBMSG_TYPE_BOOL },
78 };
79
80 static const struct uci_blob_param_list vlan_param = {
81 .n_params = ARRAY_SIZE(vlan_policy),
82 .params = vlan_policy,
83 };
84
85 static void
86 wireless_handler_stop(struct wireless_device *wdev)
87 {
88 if (wdev->handler_pending) {
89 wdev->handler_pending = false;
90 list_del(&wdev->handler);
91 }
92 }
93
94 static void
95 put_container(struct blob_buf *buf, struct blob_attr *attr, const char *name)
96 {
97 void *c = blobmsg_open_table(buf, name);
98 blob_put_raw(buf, blob_data(attr), blob_len(attr));
99 blobmsg_close_table(buf, c);
100 }
101
102 static void
103 vif_config_add_bridge(struct blob_buf *buf, struct blob_attr *networks, bool prepare)
104 {
105 struct interface *iface;
106 struct device *dev = NULL;
107 struct blob_attr *cur;
108 const char *network;
109 int rem;
110
111 if (!networks)
112 return;
113
114 blobmsg_for_each_attr(cur, networks, rem) {
115 network = blobmsg_data(cur);
116
117 iface = vlist_find(&interfaces, network, iface, node);
118 if (!iface)
119 continue;
120
121 dev = iface->main_dev.dev;
122 if (!dev)
123 return;
124
125 if (!dev->type->bridge_capability)
126 return;
127 }
128
129 if (!dev)
130 return;
131
132 if (dev->hotplug_ops && dev->hotplug_ops->prepare)
133 dev->hotplug_ops->prepare(dev);
134
135 blobmsg_add_string(buf, "bridge", dev->ifname);
136
137 if (dev->settings.flags & DEV_OPT_MULTICAST_TO_UNICAST)
138 blobmsg_add_u8(buf, "multicast_to_unicast",
139 dev->settings.multicast_to_unicast);
140 }
141
142 static void
143 prepare_config(struct wireless_device *wdev, struct blob_buf *buf, bool up)
144 {
145 struct wireless_interface *vif;
146 struct wireless_vlan *vlan;
147 void *l, *i, *j, *k;
148
149 blob_buf_init(&b, 0);
150 put_container(&b, wdev->config, "config");
151 if (wdev->data)
152 blobmsg_add_blob(&b, wdev->data);
153
154 l = blobmsg_open_table(&b, "interfaces");
155 vlist_for_each_element(&wdev->interfaces, vif, node) {
156 i = blobmsg_open_table(&b, vif->name);
157 vif_config_add_bridge(&b, vif->network, up);
158 put_container(&b, vif->config, "config");
159 if (vif->data)
160 blobmsg_add_blob(&b, vif->data);
161
162 j = blobmsg_open_table(&b, "vlans");
163 vlist_for_each_element(&wdev->vlans, vlan, node) {
164 if (strcmp(vlan->vif, vif->name))
165 continue;
166 k = blobmsg_open_table(&b, vlan->name);
167 vif_config_add_bridge(&b, vlan->network, up);
168 put_container(&b, vlan->config, "config");
169 if (vlan->data)
170 blobmsg_add_blob(&b, vlan->data);
171 blobmsg_close_table(&b, k);
172 }
173 blobmsg_close_table(&b, j);
174 blobmsg_close_table(&b, i);
175 }
176 blobmsg_close_table(&b, l);
177
178 }
179
180 static bool
181 wireless_process_check(struct wireless_process *proc)
182 {
183 return check_pid_path(proc->pid, proc->exe);
184 }
185
186 static void
187 wireless_complete_kill_request(struct wireless_device *wdev)
188 {
189 if (!wdev->kill_request)
190 return;
191
192 ubus_complete_deferred_request(ubus_ctx, wdev->kill_request, 0);
193 free(wdev->kill_request);
194 wdev->kill_request = NULL;
195 }
196
197 static void
198 wireless_process_free(struct wireless_device *wdev, struct wireless_process *proc)
199 {
200 D(WIRELESS, "Wireless device '%s' free pid %d\n", wdev->name, proc->pid);
201 list_del(&proc->list);
202 free(proc);
203
204 if (list_empty(&wdev->script_proc))
205 wireless_complete_kill_request(wdev);
206 }
207
208 static void
209 wireless_close_script_proc_fd(struct wireless_device *wdev)
210 {
211 if (wdev->script_proc_fd.fd < 0)
212 return;
213
214 uloop_fd_delete(&wdev->script_proc_fd);
215 close(wdev->script_proc_fd.fd);
216 wdev->script_proc_fd.fd = -1;
217 }
218
219 static void
220 wireless_process_kill_all(struct wireless_device *wdev, int signal, bool free)
221 {
222 struct wireless_process *proc, *tmp;
223
224 list_for_each_entry_safe(proc, tmp, &wdev->script_proc, list) {
225 bool check = wireless_process_check(proc);
226
227 if (check) {
228 D(WIRELESS, "Wireless device '%s' kill pid %d\n", wdev->name, proc->pid);
229 kill(proc->pid, signal);
230 }
231
232 if (free || !check)
233 wireless_process_free(wdev, proc);
234 }
235
236 if (free)
237 wireless_close_script_proc_fd(wdev);
238 }
239
240 static void
241 wireless_device_free_state(struct wireless_device *wdev)
242 {
243 struct wireless_interface *vif;
244 struct wireless_vlan *vlan;
245
246 wireless_handler_stop(wdev);
247 uloop_timeout_cancel(&wdev->script_check);
248 uloop_timeout_cancel(&wdev->timeout);
249 wireless_complete_kill_request(wdev);
250 free(wdev->data);
251 wdev->data = NULL;
252 vlist_for_each_element(&wdev->interfaces, vif, node) {
253 free(vif->data);
254 vif->data = NULL;
255 vif->ifname = NULL;
256 }
257 vlist_for_each_element(&wdev->vlans, vlan, node) {
258 free(vlan->data);
259 vlan->data = NULL;
260 vlan->ifname = NULL;
261 }
262 }
263
264 static void wireless_interface_handle_link(struct wireless_interface *vif, bool up)
265 {
266 struct interface *iface;
267 struct blob_attr *cur;
268 const char *network;
269 int rem;
270
271 if (!vif->network || !vif->ifname)
272 return;
273
274 if (up) {
275 struct device *dev = device_get(vif->ifname, 2);
276 if (dev) {
277 dev->wireless_isolate = vif->isolate;
278 dev->wireless = true;
279 dev->wireless_ap = vif->ap_mode;
280 }
281 }
282
283 blobmsg_for_each_attr(cur, vif->network, rem) {
284 network = blobmsg_data(cur);
285
286 iface = vlist_find(&interfaces, network, iface, node);
287 if (!iface)
288 continue;
289
290 interface_handle_link(iface, vif->ifname, up, true);
291 }
292 }
293
294 static void wireless_vlan_handle_link(struct wireless_vlan *vlan, bool up)
295 {
296 struct interface *iface;
297 struct blob_attr *cur;
298 const char *network;
299 int rem;
300
301 if (!vlan->network || !vlan->ifname)
302 return;
303
304 if (up) {
305 struct device *dev = device_get(vlan->ifname, 2);
306 if (dev) {
307 dev->wireless_isolate = vlan->isolate;
308 dev->wireless = true;
309 dev->wireless_ap = true;
310 }
311 }
312
313 blobmsg_for_each_attr(cur, vlan->network, rem) {
314 network = blobmsg_data(cur);
315
316 iface = vlist_find(&interfaces, network, iface, node);
317 if (!iface)
318 continue;
319
320 interface_handle_link(iface, vlan->ifname, up, true);
321 }
322 }
323
324 static void
325 wireless_device_setup_cancel(struct wireless_device *wdev)
326 {
327 if (wdev->cancel)
328 return;
329
330 wireless_handler_stop(wdev);
331 D(WIRELESS, "Cancel wireless device '%s' setup\n", wdev->name);
332 wdev->cancel = true;
333 uloop_timeout_set(&wdev->timeout, 10 * 1000);
334 }
335
336 static void
337 wireless_device_run_handler(struct wireless_device *wdev, bool up)
338 {
339 const char *action = up ? "setup" : "teardown";
340 const char *argv[6];
341 char *config;
342 int i = 0;
343 int fds[2] = { -1, -1 };
344
345 wireless_handler_stop(wdev);
346
347 if (handler_pending && wdev->serialize) {
348 wdev->handler_action = up;
349 wdev->handler_pending = true;
350 list_add_tail(&wdev->handler, &handlers);
351 return;
352 }
353 if (wdev->serialize)
354 handler_pending = true;
355
356 D(WIRELESS, "Wireless device '%s' run %s handler\n", wdev->name, action);
357 if (!up && wdev->prev_config) {
358 config = blobmsg_format_json(wdev->prev_config, true);
359 free(wdev->prev_config);
360 wdev->prev_config = NULL;
361 } else {
362 prepare_config(wdev, &b, up);
363 config = blobmsg_format_json(b.head, true);
364 }
365
366 argv[i++] = wdev->drv->script;
367 argv[i++] = wdev->drv->name;
368 argv[i++] = action;
369 argv[i++] = wdev->name;
370 argv[i++] = config;
371 argv[i] = NULL;
372
373 if (up && pipe(fds) == 0) {
374 wdev->script_proc_fd.fd = fds[0];
375 uloop_fd_add(&wdev->script_proc_fd,
376 ULOOP_READ | ULOOP_EDGE_TRIGGER);
377 }
378
379 netifd_start_process(argv, NULL, &wdev->script_task);
380
381 if (fds[1] >= 0)
382 close(fds[1]);
383
384 free(config);
385 }
386
387 static void
388 wireless_handler_next(void)
389 {
390 struct wireless_device *wdev;
391
392 if (handler_pending)
393 return;
394 if (list_empty(&handlers))
395 return;
396 wdev = list_first_entry(&handlers, struct wireless_device, handler);
397 list_del(&wdev->handler);
398 wdev->handler_pending = false;
399 wireless_device_run_handler(wdev, wdev->handler_action);
400 }
401
402 static void
403 __wireless_device_set_up(struct wireless_device *wdev, int force)
404 {
405 if (wdev->disabled)
406 return;
407
408 if (wdev->retry_setup_failed)
409 return;
410
411 if (!wdev->autostart)
412 return;
413
414 if (!force && (wdev->state != IFS_DOWN || config_init))
415 return;
416
417 free(wdev->prev_config);
418 wdev->prev_config = NULL;
419 wdev->state = IFS_SETUP;
420 wireless_device_run_handler(wdev, true);
421 }
422
423 static void
424 wireless_device_free(struct wireless_device *wdev)
425 {
426 wireless_handler_stop(wdev);
427 vlist_flush_all(&wdev->interfaces);
428 vlist_flush_all(&wdev->vlans);
429 avl_delete(&wireless_devices.avl, &wdev->node.avl);
430 free(wdev->config);
431 free(wdev->prev_config);
432 free(wdev);
433 }
434
435 static void
436 wdev_handle_config_change(struct wireless_device *wdev)
437 {
438 enum interface_config_state state = wdev->config_state;
439
440 switch(state) {
441 case IFC_NORMAL:
442 case IFC_RELOAD:
443 __wireless_device_set_up(wdev, 0);
444
445 wdev->config_state = IFC_NORMAL;
446 break;
447 case IFC_REMOVE:
448 wireless_device_free(wdev);
449 break;
450 }
451 }
452
453 static void
454 wireless_device_mark_down(struct wireless_device *wdev)
455 {
456 struct wireless_interface *vif;
457 struct wireless_vlan *vlan;
458
459 D(WIRELESS, "Wireless device '%s' is now down\n", wdev->name);
460
461 vlist_for_each_element(&wdev->vlans, vlan, node)
462 wireless_vlan_handle_link(vlan, false);
463
464 vlist_for_each_element(&wdev->interfaces, vif, node)
465 wireless_interface_handle_link(vif, false);
466
467 wireless_process_kill_all(wdev, SIGTERM, true);
468
469 wdev->cancel = false;
470 wdev->state = IFS_DOWN;
471 wireless_device_free_state(wdev);
472 wdev_handle_config_change(wdev);
473 }
474
475 static void
476 wireless_device_setup_timeout(struct uloop_timeout *timeout)
477 {
478 struct wireless_device *wdev = container_of(timeout, struct wireless_device, timeout);
479
480 if (wdev->handler_pending) {
481 wdev->handler_pending = false;
482 list_del(&wdev->handler);
483 }
484 netifd_kill_process(&wdev->script_task);
485 wdev->script_task.cb(&wdev->script_task, -1);
486 wireless_device_mark_down(wdev);
487 }
488
489 void
490 wireless_device_set_up(struct wireless_device *wdev)
491 {
492 wdev->retry = WIRELESS_SETUP_RETRY;
493 wdev->autostart = true;
494 __wireless_device_set_up(wdev, 0);
495 }
496
497 void
498 wireless_device_reconf(struct wireless_device *wdev)
499 {
500 wdev->retry = WIRELESS_SETUP_RETRY;
501 wdev->autostart = true;
502 __wireless_device_set_up(wdev, wdev->reconf && (wdev->state == IFS_UP));
503 }
504
505 static void
506 __wireless_device_set_down(struct wireless_device *wdev)
507 {
508 if (wdev->state == IFS_TEARDOWN || wdev->state == IFS_DOWN)
509 return;
510
511 if (wdev->script_task.uloop.pending) {
512 wireless_device_setup_cancel(wdev);
513 return;
514 }
515
516 wdev->state = IFS_TEARDOWN;
517 wireless_device_run_handler(wdev, false);
518 }
519
520 static void
521 wireless_device_mark_up(struct wireless_device *wdev)
522 {
523 struct wireless_interface *vif;
524 struct wireless_vlan *vlan;
525
526 if (wdev->cancel) {
527 wdev->cancel = false;
528 __wireless_device_set_down(wdev);
529 return;
530 }
531
532 D(WIRELESS, "Wireless device '%s' is now up\n", wdev->name);
533 wdev->state = IFS_UP;
534 vlist_for_each_element(&wdev->interfaces, vif, node)
535 wireless_interface_handle_link(vif, true);
536 vlist_for_each_element(&wdev->vlans, vlan, node)
537 wireless_vlan_handle_link(vlan, true);
538 }
539
540 static void
541 wireless_device_retry_setup(struct wireless_device *wdev)
542 {
543 if (wdev->state == IFS_TEARDOWN || wdev->state == IFS_DOWN || wdev->cancel)
544 return;
545
546 if (--wdev->retry < 0)
547 wdev->retry_setup_failed = true;
548
549 __wireless_device_set_down(wdev);
550 }
551
552 static void
553 wireless_device_script_task_cb(struct netifd_process *proc, int ret)
554 {
555 struct wireless_device *wdev = container_of(proc, struct wireless_device, script_task);
556
557 switch (wdev->state) {
558 case IFS_SETUP:
559 wireless_device_retry_setup(wdev);
560 break;
561 case IFS_TEARDOWN:
562 wireless_device_mark_down(wdev);
563 break;
564 default:
565 break;
566 }
567
568 if (wdev->serialize) {
569 handler_pending = false;
570 wireless_handler_next();
571 }
572 }
573
574 void
575 wireless_device_set_down(struct wireless_device *wdev)
576 {
577 wdev->retry_setup_failed = false;
578 wdev->autostart = false;
579 __wireless_device_set_down(wdev);
580 }
581
582 static void
583 wdev_set_config_state(struct wireless_device *wdev, enum interface_config_state s)
584 {
585 if (wdev->config_state != IFC_NORMAL)
586 return;
587
588 wdev->config_state = s;
589 if (wdev->state == IFS_DOWN)
590 wdev_handle_config_change(wdev);
591 else if (!wdev->reconf || wdev->state != IFS_UP)
592 __wireless_device_set_down(wdev);
593 }
594
595 static void
596 wdev_prepare_prev_config(struct wireless_device *wdev)
597 {
598 if (wdev->prev_config)
599 return;
600
601 prepare_config(wdev, &b, false);
602 wdev->prev_config = blob_memdup(b.head);
603 }
604
605 static void
606 wdev_change_config(struct wireless_device *wdev, struct wireless_device *wd_new)
607 {
608 struct blob_attr *new_config = wd_new->config;
609 bool disabled = wd_new->disabled;
610
611 free(wd_new);
612
613 wdev_prepare_prev_config(wdev);
614 if (blob_attr_equal(wdev->config, new_config) && wdev->disabled == disabled)
615 return;
616
617 D(WIRELESS, "Update configuration of wireless device '%s'\n", wdev->name);
618 free(wdev->config);
619 wdev->config = blob_memdup(new_config);
620 wdev->disabled = disabled;
621 wdev->retry_setup_failed = false;
622 wdev_set_config_state(wdev, IFC_RELOAD);
623 }
624
625 static void
626 wdev_create(struct wireless_device *wdev)
627 {
628 wdev->retry = WIRELESS_SETUP_RETRY;
629 wdev->config = blob_memdup(wdev->config);
630 }
631
632 static void
633 wdev_update(struct vlist_tree *tree, struct vlist_node *node_new,
634 struct vlist_node *node_old)
635 {
636 struct wireless_device *wd_old = container_of(node_old, struct wireless_device, node);
637 struct wireless_device *wd_new = container_of(node_new, struct wireless_device, node);
638
639 if (wd_old && wd_new) {
640 D(WIRELESS, "Update wireless device '%s'\n", wd_old->name);
641 wdev_change_config(wd_old, wd_new);
642 } else if (wd_old) {
643 D(WIRELESS, "Delete wireless device '%s'\n", wd_old->name);
644 wdev_set_config_state(wd_old, IFC_REMOVE);
645 } else if (wd_new) {
646 D(WIRELESS, "Create wireless device '%s'\n", wd_new->name);
647 wdev_create(wd_new);
648 }
649 }
650
651 static void
652 wireless_add_handler(const char *script, const char *name, json_object *obj)
653 {
654 struct wireless_driver *drv;
655 char *name_str, *script_str;
656 json_object *dev_config_obj, *iface_config_obj, *vlan_config_obj;
657 struct uci_blob_param_list *dev_config, *iface_config, *vlan_config;
658
659 dev_config_obj = json_get_field(obj, "device", json_type_array);
660 iface_config_obj = json_get_field(obj, "iface", json_type_array);
661 vlan_config_obj = json_get_field(obj, "vlan", json_type_array);
662
663 if (!dev_config_obj || !iface_config_obj || !vlan_config_obj)
664 return;
665
666 drv = calloc_a(sizeof(*drv),
667 &dev_config, sizeof(*dev_config) + sizeof(void *),
668 &iface_config, sizeof(*iface_config) + sizeof(void *),
669 &vlan_config, sizeof(*vlan_config) + sizeof(void *),
670 &name_str, strlen(name) + 1,
671 &script_str, strlen(script) + 1);
672
673 drv->name = strcpy(name_str, name);
674 drv->script = strcpy(script_str, script);
675
676 dev_config->n_next = 1;
677 dev_config->next[0] = &wdev_param;
678 drv->device.config = dev_config;
679
680 iface_config->n_next = 1;
681 iface_config->next[0] = &vif_param;
682 drv->interface.config = iface_config;
683
684 vlan_config->n_next = 1;
685 vlan_config->next[0] = &vlan_param;
686 drv->vlan.config = vlan_config;
687
688 drv->device.buf = netifd_handler_parse_config(drv->device.config, dev_config_obj);
689 drv->interface.buf = netifd_handler_parse_config(drv->interface.config, iface_config_obj);
690 drv->vlan.buf = netifd_handler_parse_config(drv->vlan.config, vlan_config_obj);
691
692 drv->node.key = drv->name;
693 avl_insert(&wireless_drivers, &drv->node);
694 D(WIRELESS, "Add handler for script %s: %s\n", script, name);
695 }
696
697 void wireless_init(void)
698 {
699 vlist_init(&wireless_devices, avl_strcmp, wdev_update);
700 wireless_devices.keep_old = true;
701 wireless_devices.no_delete = true;
702
703 avl_init(&wireless_drivers, avl_strcmp, false, NULL);
704 drv_fd = netifd_open_subdir("wireless");
705 if (drv_fd < 0)
706 return;
707
708 netifd_init_script_handlers(drv_fd, wireless_add_handler);
709 }
710
711 static void
712 wireless_interface_init_config(struct wireless_interface *vif)
713 {
714 struct blob_attr *tb[__VIF_ATTR_MAX];
715 struct blob_attr *cur;
716
717 vif->network = NULL;
718 blobmsg_parse(vif_policy, __VIF_ATTR_MAX, tb, blob_data(vif->config), blob_len(vif->config));
719
720 if ((cur = tb[VIF_ATTR_NETWORK]))
721 vif->network = cur;
722
723 cur = tb[VIF_ATTR_ISOLATE];
724 if (cur)
725 vif->isolate = blobmsg_get_bool(cur);
726
727 cur = tb[VIF_ATTR_MODE];
728 if (cur)
729 vif->ap_mode = !strcmp(blobmsg_get_string(cur), "ap");
730 }
731
732 static void
733 vif_update(struct vlist_tree *tree, struct vlist_node *node_new,
734 struct vlist_node *node_old)
735 {
736 struct wireless_interface *vif_old = container_of(node_old, struct wireless_interface, node);
737 struct wireless_interface *vif_new = container_of(node_new, struct wireless_interface, node);
738 struct wireless_device *wdev;
739
740 if (vif_old)
741 wdev = vif_old->wdev;
742 else
743 wdev = vif_new->wdev;
744
745 if (vif_old && vif_new) {
746 free((void *) vif_old->section);
747 vif_old->section = strdup(vif_new->section);
748 if (blob_attr_equal(vif_old->config, vif_new->config)) {
749 free(vif_new);
750 return;
751 }
752
753 D(WIRELESS, "Update wireless interface %s on device %s\n", vif_new->name, wdev->name);
754 wireless_interface_handle_link(vif_old, false);
755 free(vif_old->config);
756 vif_old->config = blob_memdup(vif_new->config);
757 vif_old->isolate = vif_new->isolate;
758 vif_old->ap_mode = vif_new->ap_mode;
759 wireless_interface_init_config(vif_old);
760 free(vif_new);
761 } else if (vif_new) {
762 D(WIRELESS, "Create new wireless interface %s on device %s\n", vif_new->name, wdev->name);
763 vif_new->section = strdup(vif_new->section);
764 vif_new->config = blob_memdup(vif_new->config);
765 wireless_interface_init_config(vif_new);
766 } else if (vif_old) {
767 D(WIRELESS, "Delete wireless interface %s on device %s\n", vif_old->name, wdev->name);
768 wireless_interface_handle_link(vif_old, false);
769 free((void *) vif_old->section);
770 free(vif_old->config);
771 free(vif_old);
772 }
773
774 wdev_set_config_state(wdev, IFC_RELOAD);
775 }
776
777 static void
778 wireless_vlan_init_config(struct wireless_vlan *vlan)
779 {
780 struct blob_attr *tb[__VLAN_ATTR_MAX];
781 struct blob_attr *cur;
782
783 vlan->network = NULL;
784 blobmsg_parse(vlan_policy, __VLAN_ATTR_MAX, tb, blob_data(vlan->config), blob_len(vlan->config));
785
786 if ((cur = tb[VLAN_ATTR_NETWORK]))
787 vlan->network = cur;
788
789 cur = tb[VLAN_ATTR_ISOLATE];
790 if (cur)
791 vlan->isolate = blobmsg_get_bool(cur);
792 }
793
794 static void
795 vlan_update(struct vlist_tree *tree, struct vlist_node *node_new,
796 struct vlist_node *node_old)
797 {
798 struct wireless_vlan *vlan_old = container_of(node_old, struct wireless_vlan, node);
799 struct wireless_vlan *vlan_new = container_of(node_new, struct wireless_vlan, node);
800 struct wireless_device *wdev;
801
802 if (vlan_old)
803 wdev = vlan_old->wdev;
804 else
805 wdev = vlan_new->wdev;
806
807 if (vlan_old && vlan_new) {
808 free((void *) vlan_old->section);
809 vlan_old->section = strdup(vlan_new->section);
810 if (blob_attr_equal(vlan_old->config, vlan_new->config)) {
811 free(vlan_new);
812 return;
813 }
814
815 D(WIRELESS, "Update wireless vlan %s on device %s\n", vlan_new->name, wdev->name);
816 wireless_vlan_handle_link(vlan_old, false);
817 free(vlan_old->config);
818 vlan_old->config = blob_memdup(vlan_new->config);
819 vlan_old->isolate = vlan_new->isolate;
820 wireless_vlan_init_config(vlan_old);
821 free(vlan_new);
822 } else if (vlan_new) {
823 D(WIRELESS, "Create new wireless vlan %s on device %s\n", vlan_new->name, wdev->name);
824 vlan_new->section = strdup(vlan_new->section);
825 vlan_new->config = blob_memdup(vlan_new->config);
826 wireless_vlan_init_config(vlan_new);
827 } else if (vlan_old) {
828 D(WIRELESS, "Delete wireless interface %s on device %s\n", vlan_old->name, wdev->name);
829 wireless_vlan_handle_link(vlan_old, false);
830 free((void *) vlan_old->section);
831 free(vlan_old->config);
832 free(vlan_old);
833 }
834
835 wdev_set_config_state(wdev, IFC_RELOAD);
836 }
837
838 static void
839 wireless_proc_poll_fd(struct uloop_fd *fd, unsigned int events)
840 {
841 struct wireless_device *wdev = container_of(fd, struct wireless_device, script_proc_fd);
842 char buf[128];
843
844 while (1) {
845 int b = read(fd->fd, buf, sizeof(buf));
846 if (b < 0) {
847 if (errno == EINTR)
848 continue;
849
850 if (errno == EAGAIN)
851 return;
852
853 goto done;
854 }
855
856 if (!b)
857 goto done;
858 }
859
860 done:
861 uloop_timeout_set(&wdev->script_check, 0);
862 wireless_close_script_proc_fd(wdev);
863 }
864
865 static void
866 wireless_device_check_script_tasks(struct uloop_timeout *timeout)
867 {
868 struct wireless_device *wdev = container_of(timeout, struct wireless_device, script_check);
869 struct wireless_process *proc, *tmp;
870 bool restart = false;
871
872 list_for_each_entry_safe(proc, tmp, &wdev->script_proc, list) {
873 if (wireless_process_check(proc))
874 continue;
875
876 D(WIRELESS, "Wireless device '%s' pid %d has terminated\n", wdev->name, proc->pid);
877 if (proc->required)
878 restart = true;
879
880 wireless_process_free(wdev, proc);
881 }
882
883 if (restart)
884 wireless_device_retry_setup(wdev);
885 else
886 uloop_timeout_set(&wdev->script_check, 1000);
887 }
888
889 void
890 wireless_device_create(struct wireless_driver *drv, const char *name, struct blob_attr *data)
891 {
892 struct wireless_device *wdev;
893 char *name_buf;
894 struct blob_attr *tb[__WDEV_ATTR_MAX];
895 struct blob_attr *cur;
896
897 blobmsg_parse(wdev_policy, __WDEV_ATTR_MAX, tb, blob_data(data), blob_len(data));
898
899 wdev = calloc_a(sizeof(*wdev), &name_buf, strlen(name) + 1);
900
901 cur = tb[WDEV_ATTR_DISABLED];
902 wdev->disabled = cur && blobmsg_get_bool(cur);
903
904 wdev->drv = drv;
905 wdev->state = IFS_DOWN;
906 wdev->config_state = IFC_NORMAL;
907 wdev->name = strcpy(name_buf, name);
908 wdev->config = data;
909 wdev->handler_pending = false;
910
911 cur = tb[WDEV_ATTR_SERIALIZE];
912 wdev->serialize = cur && blobmsg_get_bool(cur);
913
914 cur = tb[WDEV_ATTR_RECONF];
915 wdev->reconf = cur && blobmsg_get_bool(cur);
916
917 wdev->retry_setup_failed = false;
918 wdev->autostart = true;
919 INIT_LIST_HEAD(&wdev->script_proc);
920 vlist_init(&wdev->interfaces, avl_strcmp, vif_update);
921 wdev->interfaces.keep_old = true;
922 vlist_init(&wdev->vlans, avl_strcmp, vlan_update);
923 wdev->vlans.keep_old = true;
924
925 wdev->timeout.cb = wireless_device_setup_timeout;
926 wdev->script_task.cb = wireless_device_script_task_cb;
927 wdev->script_task.dir_fd = drv_fd;
928 wdev->script_task.log_prefix = wdev->name;
929
930 wdev->script_proc_fd.fd = -1;
931 wdev->script_proc_fd.cb = wireless_proc_poll_fd;
932
933 wdev->script_check.cb = wireless_device_check_script_tasks;
934
935 vlist_add(&wireless_devices, &wdev->node, wdev->name);
936 }
937
938 void
939 wireless_vlan_create(struct wireless_device *wdev, char *vif, struct blob_attr *data, const char *section)
940 {
941 struct wireless_vlan *vlan;
942 struct blob_attr *tb[__VLAN_ATTR_MAX];
943 struct blob_attr *cur;
944 char *name_buf, *vif_buf;
945 char name[8];
946
947 blobmsg_parse(vlan_policy, __VLAN_ATTR_MAX, tb, blob_data(data), blob_len(data));
948
949 cur = tb[VLAN_ATTR_DISABLED];
950 if (cur && blobmsg_get_bool(cur))
951 return;
952
953 sprintf(name, "%d", wdev->vlan_idx++);
954
955 vlan = calloc_a(sizeof(*vlan),
956 &name_buf, strlen(name) + 1,
957 &vif_buf, strlen(vif) + 1);
958 vlan->name = strcpy(name_buf, name);
959 vlan->vif = strcpy(vif_buf, vif);
960 vlan->wdev = wdev;
961 vlan->config = data;
962 vlan->section = section;
963 vlan->isolate = false;
964
965 vlist_add(&wdev->vlans, &vlan->node, vlan->name);
966 }
967
968 static void
969 wireless_vlan_status(struct wireless_vlan *vlan, struct blob_buf *b)
970 {
971 void *i;
972
973 i = blobmsg_open_table(b, NULL);
974 if (vlan->section)
975 blobmsg_add_string(b, "section", vlan->section);
976 if (vlan->ifname)
977 blobmsg_add_string(b, "ifname", vlan->ifname);
978 put_container(b, vlan->config, "config");
979 blobmsg_close_table(b, i);
980 }
981
982 struct wireless_interface* wireless_interface_create(struct wireless_device *wdev, struct blob_attr *data, const char *section)
983 {
984 struct wireless_interface *vif;
985 struct blob_attr *tb[__VIF_ATTR_MAX];
986 struct blob_attr *cur;
987 char *name_buf;
988 char name[8];
989
990 blobmsg_parse(vif_policy, __VIF_ATTR_MAX, tb, blob_data(data), blob_len(data));
991
992 cur = tb[VIF_ATTR_DISABLED];
993 if (cur && blobmsg_get_bool(cur))
994 return NULL;
995
996 sprintf(name, "%d", wdev->vif_idx++);
997
998 vif = calloc_a(sizeof(*vif),
999 &name_buf, strlen(name) + 1);
1000 vif->name = strcpy(name_buf, name);
1001 vif->wdev = wdev;
1002 vif->config = data;
1003 vif->section = section;
1004 vif->isolate = false;
1005
1006 vlist_add(&wdev->interfaces, &vif->node, vif->name);
1007 return vif;
1008 }
1009
1010 static void
1011 wireless_interface_status(struct wireless_interface *iface, struct blob_buf *b)
1012 {
1013 struct wireless_vlan *vlan;
1014 void *i, *j;
1015
1016 i = blobmsg_open_table(b, NULL);
1017 if (iface->section)
1018 blobmsg_add_string(b, "section", iface->section);
1019 if (iface->ifname)
1020 blobmsg_add_string(b, "ifname", iface->ifname);
1021 put_container(b, iface->config, "config");
1022 j = blobmsg_open_array(b, "vlans");
1023 vlist_for_each_element(&iface->wdev->vlans, vlan, node)
1024 if (!strcmp(iface->name, vlan->vif))
1025 wireless_vlan_status(vlan, b);
1026 blobmsg_close_array(b, j);
1027 blobmsg_close_table(b, i);
1028 }
1029
1030 void
1031 wireless_device_status(struct wireless_device *wdev, struct blob_buf *b)
1032 {
1033 struct wireless_interface *iface;
1034 void *c, *i;
1035
1036 c = blobmsg_open_table(b, wdev->name);
1037 blobmsg_add_u8(b, "up", wdev->state == IFS_UP);
1038 blobmsg_add_u8(b, "pending", wdev->state == IFS_SETUP || wdev->state == IFS_TEARDOWN);
1039 blobmsg_add_u8(b, "autostart", wdev->autostart);
1040 blobmsg_add_u8(b, "disabled", wdev->disabled);
1041 blobmsg_add_u8(b, "retry_setup_failed", wdev->retry_setup_failed);
1042 put_container(b, wdev->config, "config");
1043
1044 i = blobmsg_open_array(b, "interfaces");
1045 vlist_for_each_element(&wdev->interfaces, iface, node)
1046 wireless_interface_status(iface, b);
1047 blobmsg_close_array(b, i);
1048 blobmsg_close_table(b, c);
1049 }
1050
1051 void
1052 wireless_device_get_validate(struct wireless_device *wdev, struct blob_buf *b)
1053 {
1054 struct uci_blob_param_list *p;
1055 void *c, *d;
1056 int i;
1057
1058 c = blobmsg_open_table(b, wdev->name);
1059
1060 d = blobmsg_open_table(b, "device");
1061 p = wdev->drv->device.config;
1062 for (i = 0; i < p->n_params; i++)
1063 blobmsg_add_string(b, p->params[i].name, uci_get_validate_string(p, i));
1064 blobmsg_close_table(b, d);
1065
1066 d = blobmsg_open_table(b, "interface");
1067 p = wdev->drv->interface.config;
1068 for (i = 0; i < p->n_params; i++)
1069 blobmsg_add_string(b, p->params[i].name, uci_get_validate_string(p, i));
1070 blobmsg_close_table(b, d);
1071
1072 blobmsg_close_table(b, c);
1073 }
1074
1075 static void
1076 wireless_interface_set_data(struct wireless_interface *vif)
1077 {
1078 enum {
1079 VIF_DATA_IFNAME,
1080 __VIF_DATA_MAX,
1081 };
1082 static const struct blobmsg_policy data_policy[__VIF_DATA_MAX] = {
1083 [VIF_DATA_IFNAME] = { .name = "ifname", .type = BLOBMSG_TYPE_STRING },
1084 };
1085 struct blob_attr *tb[__VIF_DATA_MAX];
1086 struct blob_attr *cur;
1087
1088 blobmsg_parse(data_policy, __VIF_DATA_MAX, tb,
1089 blobmsg_data(vif->data), blobmsg_data_len(vif->data));
1090
1091 if ((cur = tb[VIF_DATA_IFNAME]))
1092 vif->ifname = blobmsg_data(cur);
1093 }
1094
1095 static void
1096 wireless_vlan_set_data(struct wireless_vlan *vlan)
1097 {
1098 enum {
1099 VLAN_DATA_IFNAME,
1100 __VLAN_DATA_MAX,
1101 };
1102 static const struct blobmsg_policy data_policy[__VLAN_DATA_MAX] = {
1103 [VLAN_DATA_IFNAME] = { .name = "ifname", .type = BLOBMSG_TYPE_STRING },
1104 };
1105 struct blob_attr *tb[__VLAN_DATA_MAX];
1106 struct blob_attr *cur;
1107
1108 blobmsg_parse(data_policy, __VLAN_DATA_MAX, tb,
1109 blobmsg_data(vlan->data), blobmsg_data_len(vlan->data));
1110
1111 if ((cur = tb[VLAN_DATA_IFNAME]))
1112 vlan->ifname = blobmsg_data(cur);
1113 }
1114
1115 static int
1116 wireless_device_add_process(struct wireless_device *wdev, struct blob_attr *data)
1117 {
1118 enum {
1119 PROC_ATTR_PID,
1120 PROC_ATTR_EXE,
1121 PROC_ATTR_REQUIRED,
1122 __PROC_ATTR_MAX
1123 };
1124 static const struct blobmsg_policy proc_policy[__PROC_ATTR_MAX] = {
1125 [PROC_ATTR_PID] = { .name = "pid", .type = BLOBMSG_TYPE_INT32 },
1126 [PROC_ATTR_EXE] = { .name = "exe", .type = BLOBMSG_TYPE_STRING },
1127 [PROC_ATTR_REQUIRED] = { .name = "required", .type = BLOBMSG_TYPE_BOOL },
1128 };
1129 struct blob_attr *tb[__PROC_ATTR_MAX];
1130 struct wireless_process *proc;
1131 char *name;
1132 int pid;
1133
1134 if (!data)
1135 return UBUS_STATUS_INVALID_ARGUMENT;
1136
1137 blobmsg_parse(proc_policy, __PROC_ATTR_MAX, tb, blobmsg_data(data), blobmsg_data_len(data));
1138 if (!tb[PROC_ATTR_PID] || !tb[PROC_ATTR_EXE])
1139 return UBUS_STATUS_INVALID_ARGUMENT;
1140
1141 pid = blobmsg_get_u32(tb[PROC_ATTR_PID]);
1142 if (pid < 2)
1143 return UBUS_STATUS_INVALID_ARGUMENT;
1144
1145 proc = calloc_a(sizeof(*proc),
1146 &name, strlen(blobmsg_data(tb[PROC_ATTR_EXE])) + 1);
1147
1148 proc->pid = pid;
1149 proc->exe = strcpy(name, blobmsg_data(tb[PROC_ATTR_EXE]));
1150
1151 if (tb[PROC_ATTR_REQUIRED])
1152 proc->required = blobmsg_get_bool(tb[PROC_ATTR_REQUIRED]);
1153
1154 D(WIRELESS, "Wireless device '%s' add pid %d\n", wdev->name, proc->pid);
1155 list_add(&proc->list, &wdev->script_proc);
1156 uloop_timeout_set(&wdev->script_check, 0);
1157
1158 return 0;
1159 }
1160
1161 static int
1162 wireless_device_process_kill_all(struct wireless_device *wdev, struct blob_attr *data,
1163 struct ubus_request_data *req)
1164 {
1165 enum {
1166 KILL_ATTR_SIGNAL,
1167 KILL_ATTR_IMMEDIATE,
1168 __KILL_ATTR_MAX
1169 };
1170 static const struct blobmsg_policy kill_policy[__KILL_ATTR_MAX] = {
1171 [KILL_ATTR_SIGNAL] = { .name = "signal", .type = BLOBMSG_TYPE_INT32 },
1172 [KILL_ATTR_IMMEDIATE] = { .name = "immediate", .type = BLOBMSG_TYPE_BOOL },
1173 };
1174 struct blob_attr *tb[__KILL_ATTR_MAX];
1175 struct blob_attr *cur;
1176 bool immediate = false;
1177 int signal = SIGTERM;
1178
1179 blobmsg_parse(kill_policy, __KILL_ATTR_MAX, tb, blobmsg_data(data), blobmsg_data_len(data));
1180
1181 if ((cur = tb[KILL_ATTR_SIGNAL]))
1182 signal = blobmsg_get_u32(cur);
1183
1184 if ((cur = tb[KILL_ATTR_IMMEDIATE]))
1185 immediate = blobmsg_get_bool(cur);
1186
1187 if (wdev->state != IFS_TEARDOWN || wdev->kill_request)
1188 return UBUS_STATUS_PERMISSION_DENIED;
1189
1190 wireless_process_kill_all(wdev, signal, immediate);
1191
1192 if (list_empty(&wdev->script_proc))
1193 return 0;
1194
1195 wdev->kill_request = calloc(1, sizeof(*wdev->kill_request));
1196 ubus_defer_request(ubus_ctx, req, wdev->kill_request);
1197
1198 return 0;
1199 }
1200
1201 static int
1202 wireless_device_set_retry(struct wireless_device *wdev, struct blob_attr *data)
1203 {
1204 static const struct blobmsg_policy retry_policy = {
1205 .name = "retry", .type = BLOBMSG_TYPE_INT32
1206 };
1207 struct blob_attr *val;
1208
1209 blobmsg_parse(&retry_policy, 1, &val, blobmsg_data(data), blobmsg_data_len(data));
1210 if (!val)
1211 return UBUS_STATUS_INVALID_ARGUMENT;
1212
1213 wdev->retry = blobmsg_get_u32(val);
1214 return 0;
1215 }
1216
1217 enum {
1218 NOTIFY_CMD_UP = 0,
1219 NOTIFY_CMD_SET_DATA = 1,
1220 NOTIFY_CMD_PROCESS_ADD = 2,
1221 NOTIFY_CMD_PROCESS_KILL_ALL = 3,
1222 NOTIFY_CMD_SET_RETRY = 4,
1223 };
1224
1225 int
1226 wireless_device_notify(struct wireless_device *wdev, struct blob_attr *data,
1227 struct ubus_request_data *req)
1228 {
1229 enum {
1230 NOTIFY_ATTR_COMMAND,
1231 NOTIFY_ATTR_VIF,
1232 NOTIFY_ATTR_VLAN,
1233 NOTIFY_ATTR_DATA,
1234 __NOTIFY_MAX,
1235 };
1236 static const struct blobmsg_policy notify_policy[__NOTIFY_MAX] = {
1237 [NOTIFY_ATTR_COMMAND] = { .name = "command", .type = BLOBMSG_TYPE_INT32 },
1238 [NOTIFY_ATTR_VIF] = { .name = "interface", .type = BLOBMSG_TYPE_STRING },
1239 [NOTIFY_ATTR_VLAN] = { .name = "vlan", .type = BLOBMSG_TYPE_STRING },
1240 [NOTIFY_ATTR_DATA] = { .name = "data", .type = BLOBMSG_TYPE_TABLE },
1241 };
1242 struct wireless_interface *vif = NULL;
1243 struct wireless_vlan *vlan = NULL;
1244 struct blob_attr *tb[__NOTIFY_MAX];
1245 struct blob_attr *cur, **pdata;
1246
1247 blobmsg_parse(notify_policy, __NOTIFY_MAX, tb, blob_data(data), blob_len(data));
1248
1249 if (!tb[NOTIFY_ATTR_COMMAND])
1250 return UBUS_STATUS_INVALID_ARGUMENT;
1251
1252 if ((cur = tb[NOTIFY_ATTR_VIF]) != NULL) {
1253 vif = vlist_find(&wdev->interfaces, blobmsg_data(cur), vif, node);
1254 if (!vif)
1255 return UBUS_STATUS_NOT_FOUND;
1256 }
1257
1258 if ((cur = tb[NOTIFY_ATTR_VLAN]) != NULL) {
1259 vlan = vlist_find(&wdev->vlans, blobmsg_data(cur), vlan, node);
1260 if (!vlan)
1261 return UBUS_STATUS_NOT_FOUND;
1262 }
1263
1264 cur = tb[NOTIFY_ATTR_DATA];
1265 if (!cur)
1266 return UBUS_STATUS_INVALID_ARGUMENT;
1267
1268 switch (blobmsg_get_u32(tb[NOTIFY_ATTR_COMMAND])) {
1269 case NOTIFY_CMD_UP:
1270 if (vif || vlan)
1271 return UBUS_STATUS_INVALID_ARGUMENT;
1272
1273 if (wdev->state != IFS_SETUP)
1274 return UBUS_STATUS_PERMISSION_DENIED;
1275
1276 wireless_device_mark_up(wdev);
1277 break;
1278 case NOTIFY_CMD_SET_DATA:
1279 if (vif)
1280 pdata = &vif->data;
1281 else if (vlan)
1282 pdata = &vlan->data;
1283 else
1284 pdata = &wdev->data;
1285
1286 if (*pdata)
1287 return UBUS_STATUS_INVALID_ARGUMENT;
1288
1289 *pdata = blob_memdup(cur);
1290 if (vif)
1291 wireless_interface_set_data(vif);
1292 else if (vlan)
1293 wireless_vlan_set_data(vlan);
1294 break;
1295 case NOTIFY_CMD_PROCESS_ADD:
1296 return wireless_device_add_process(wdev, cur);
1297 case NOTIFY_CMD_PROCESS_KILL_ALL:
1298 return wireless_device_process_kill_all(wdev, cur, req);
1299 case NOTIFY_CMD_SET_RETRY:
1300 return wireless_device_set_retry(wdev, cur);
1301 default:
1302 return UBUS_STATUS_INVALID_ARGUMENT;
1303 }
1304
1305 return 0;
1306 }
1307
1308 void
1309 wireless_start_pending(void)
1310 {
1311 struct wireless_device *wdev;
1312
1313 vlist_for_each_element(&wireless_devices, wdev, node)
1314 __wireless_device_set_up(wdev, 0);
1315 }