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
  15 /* The wireless configuration is projected on the following objects
  16  *
  17  * 1. wireless device
  18  * 2. wireless interface
  19  * 3. wireless vlan
  20  * 4. wireless station
  21  *
  22  * A wireless device is a phy or simplified a wireless card.
  23  * A wireless interface is a SSID on a phy.
  24  * A wireless vlan can be assigned to a wireless interface. A wireless interface can
  25  *   have multiple vlans.
  26  * A wireless station is a client connected to an wireless interface.
  27  */
  28
  29 #include <signal.h>
  30 #include "netifd.h"
  31 #include "wireless.h"
  32 #include "handler.h"
  33 #include "ubus.h"
  34
  35 #define WIRELESS_SETUP_RETRY    3
  36
  37 struct vlist_tree wireless_devices;
  38 struct avl_tree wireless_drivers;
  39 static struct blob_buf b;
  40 static int drv_fd;
  41 static LIST_HEAD(handlers);
  42 static bool handler_pending;
  43
  44 enum {
  45         WDEV_ATTR_DISABLED,
  46         WDEV_ATTR_RECONF,
  47         WDEV_ATTR_SERIALIZE,
  48         __WDEV_ATTR_MAX,
  49 };
  50
  51 static const struct blobmsg_policy wdev_policy[__WDEV_ATTR_MAX] = {
  52         [WDEV_ATTR_DISABLED] = { .name = "disabled", .type = BLOBMSG_TYPE_BOOL },
  53         [WDEV_ATTR_RECONF] = { .name = "reconf", .type = BLOBMSG_TYPE_BOOL },
  54         [WDEV_ATTR_SERIALIZE] = { .name = "serialize", .type = BLOBMSG_TYPE_BOOL },
  55 };
  56
  57 static const struct uci_blob_param_list wdev_param = {
  58         .n_params = ARRAY_SIZE(wdev_policy),
  59         .params = wdev_policy,
  60 };
  61
  62 enum {
  63         VIF_ATTR_DISABLED,
  64         VIF_ATTR_NETWORK,
  65         VIF_ATTR_NETWORK_VLAN,
  66         VIF_ATTR_ISOLATE,
  67         VIF_ATTR_MODE,
  68         VIF_ATTR_PROXYARP,
  69         VIF_ATTR_MCAST_TO_UCAST,
  70         __VIF_ATTR_MAX,
  71 };
  72
  73 static const struct blobmsg_policy vif_policy[__VIF_ATTR_MAX] = {
  74         [VIF_ATTR_DISABLED] = { .name = "disabled", .type = BLOBMSG_TYPE_BOOL },
  75         [VIF_ATTR_NETWORK] = { .name = "network", .type = BLOBMSG_TYPE_ARRAY },
  76         [VIF_ATTR_NETWORK_VLAN] = { .name = "network_vlan", .type = BLOBMSG_TYPE_ARRAY },
  77         [VIF_ATTR_ISOLATE] = { .name = "isolate", .type = BLOBMSG_TYPE_BOOL },
  78         [VIF_ATTR_MODE] = { .name = "mode", .type = BLOBMSG_TYPE_STRING },
  79         [VIF_ATTR_PROXYARP] = { .name = "proxy_arp", .type = BLOBMSG_TYPE_BOOL },
  80         [VIF_ATTR_MCAST_TO_UCAST] = { .name = "multicast_to_unicast", .type = BLOBMSG_TYPE_BOOL },
  81 };
  82
  83 static const struct uci_blob_param_list vif_param = {
  84         .n_params = ARRAY_SIZE(vif_policy),
  85         .params = vif_policy,
  86 };
  87
  88 enum {
  89         VLAN_ATTR_DISABLED,
  90         VLAN_ATTR_NETWORK,
  91         VLAN_ATTR_NETWORK_VLAN,
  92         VLAN_ATTR_ISOLATE,
  93         VLAN_ATTR_MCAST_TO_UCAST,
  94         __VLAN_ATTR_MAX,
  95 };
  96
  97 static const struct blobmsg_policy vlan_policy[__VLAN_ATTR_MAX] = {
  98         [VLAN_ATTR_DISABLED] = { .name = "disabled", .type = BLOBMSG_TYPE_BOOL },
  99         [VLAN_ATTR_NETWORK] = { .name = "network", .type = BLOBMSG_TYPE_ARRAY },
 100         [VLAN_ATTR_NETWORK_VLAN] = { .name = "network_vlan", .type = BLOBMSG_TYPE_ARRAY },
 101         [VLAN_ATTR_ISOLATE] = { .name = "isolate", .type = BLOBMSG_TYPE_BOOL },
 102         [VLAN_ATTR_MCAST_TO_UCAST] = { .name = "multicast_to_unicast", .type = BLOBMSG_TYPE_BOOL },
 103 };
 104
 105 static const struct uci_blob_param_list vlan_param = {
 106         .n_params = ARRAY_SIZE(vlan_policy),
 107         .params = vlan_policy,
 108 };
 109
 110 enum {
 111         STA_ATTR_DISABLED,
 112         __STA_ATTR_MAX,
 113 };
 114
 115 static const struct blobmsg_policy sta_policy[__STA_ATTR_MAX] = {
 116         [STA_ATTR_DISABLED] = { .name = "disabled", .type = BLOBMSG_TYPE_BOOL },
 117 };
 118
 119 static const struct uci_blob_param_list station_param = {
 120         .n_params = ARRAY_SIZE(sta_policy),
 121         .params = sta_policy,
 122 };
 123
 124 static void
 125 wireless_handler_stop(struct wireless_device *wdev)
 126 {
 127         if (wdev->handler_pending) {
 128                 wdev->handler_pending = false;
 129                 list_del(&wdev->handler);
 130         }
 131 }
 132
 133 static void
 134 put_container(struct blob_buf *buf, struct blob_attr *attr, const char *name)
 135 {
 136         void *c = blobmsg_open_table(buf, name);
 137         blob_put_raw(buf, blob_data(attr), blob_len(attr));
 138         blobmsg_close_table(buf, c);
 139 }
 140
 141 static void
 142 vif_config_add_bridge(struct blob_buf *buf, struct blob_attr *networks, bool prepare)
 143 {
 144         struct interface *iface;
 145         struct device *dev = NULL, *orig_dev;
 146         struct blob_attr *cur;
 147         const char *network;
 148         size_t rem;
 149
 150         if (!networks)
 151                 return;
 152
 153         blobmsg_for_each_attr(cur, networks, rem) {
 154                 network = blobmsg_data(cur);
 155
 156                 iface = vlist_find(&interfaces, network, iface, node);
 157                 if (!iface)
 158                         continue;
 159
 160                 dev = iface->main_dev.dev;
 161                 if (!dev)
 162                         return;
 163
 164                 if (!dev->hotplug_ops)
 165                         return;
 166         }
 167
 168         if (!dev)
 169                 return;
 170
 171         orig_dev = dev;
 172         if (dev->hotplug_ops && dev->hotplug_ops->prepare)
 173                 dev->hotplug_ops->prepare(dev, &dev);
 174
 175         if (!dev || !dev->type->bridge_capability)
 176                 return;
 177
 178         blobmsg_add_string(buf, "bridge", dev->ifname);
 179         blobmsg_add_string(buf, "bridge-ifname", orig_dev->ifname);
 180
 181         if (dev->settings.flags & DEV_OPT_MULTICAST_TO_UNICAST)
 182                 blobmsg_add_u8(buf, "multicast_to_unicast",
 183                                dev->settings.multicast_to_unicast);
 184 }
 185
 186 static void
 187 prepare_config(struct wireless_device *wdev, struct blob_buf *buf, bool up)
 188 {
 189         struct wireless_interface *vif;
 190         struct wireless_vlan *vlan;
 191         struct wireless_station *sta;
 192         void *l, *i, *j, *k;
 193
 194         blob_buf_init(&b, 0);
 195         put_container(&b, wdev->config, "config");
 196         if (wdev->data)
 197                 blobmsg_add_blob(&b, wdev->data);
 198
 199         l = blobmsg_open_table(&b, "interfaces");
 200         vlist_for_each_element(&wdev->interfaces, vif, node) {
 201                 if (vif->disabled)
 202                         continue;
 203
 204                 i = blobmsg_open_table(&b, vif->name);
 205                 vif_config_add_bridge(&b, vif->network, up);
 206                 put_container(&b, vif->config, "config");
 207                 if (vif->data)
 208                         blobmsg_add_blob(&b, vif->data);
 209
 210                 j = blobmsg_open_table(&b, "vlans");
 211                 vlist_for_each_element(&vif->vlans, vlan, node) {
 212                         k = blobmsg_open_table(&b, vlan->name);
 213                         vif_config_add_bridge(&b, vlan->network, up);
 214                         put_container(&b, vlan->config, "config");
 215                         if (vlan->data)
 216                                 blobmsg_add_blob(&b, vlan->data);
 217                         blobmsg_close_table(&b, k);
 218                 }
 219                 blobmsg_close_table(&b, j);
 220
 221                 j = blobmsg_open_table(&b, "stas");
 222                 vlist_for_each_element(&vif->stations, sta, node) {
 223                         k = blobmsg_open_table(&b, sta->name);
 224                         put_container(&b, sta->config, "config");
 225                         if (sta->data)
 226                                 blobmsg_add_blob(&b, sta->data);
 227                         blobmsg_close_table(&b, k);
 228                 }
 229                 blobmsg_close_table(&b, j);
 230                 blobmsg_close_table(&b, i);
 231         }
 232         blobmsg_close_table(&b, l);
 233
 234 }
 235
 236 static bool
 237 wireless_process_check(struct wireless_process *proc)
 238 {
 239         return check_pid_path(proc->pid, proc->exe);
 240 }
 241
 242 static void
 243 wireless_complete_kill_request(struct wireless_device *wdev)
 244 {
 245         if (!wdev->kill_request)
 246                 return;
 247
 248         ubus_complete_deferred_request(ubus_ctx, wdev->kill_request, 0);
 249         free(wdev->kill_request);
 250         wdev->kill_request = NULL;
 251 }
 252
 253 static void
 254 wireless_process_free(struct wireless_device *wdev, struct wireless_process *proc)
 255 {
 256         D(WIRELESS, "Wireless device '%s' free pid %d\n", wdev->name, proc->pid);
 257         list_del(&proc->list);
 258         free(proc);
 259
 260         if (list_empty(&wdev->script_proc))
 261                 wireless_complete_kill_request(wdev);
 262 }
 263
 264 static void
 265 wireless_close_script_proc_fd(struct wireless_device *wdev)
 266 {
 267         if (wdev->script_proc_fd.fd < 0)
 268                 return;
 269
 270         uloop_fd_delete(&wdev->script_proc_fd);
 271         close(wdev->script_proc_fd.fd);
 272         wdev->script_proc_fd.fd = -1;
 273 }
 274
 275 static void
 276 wireless_process_kill_all(struct wireless_device *wdev, int signal, bool free)
 277 {
 278         struct wireless_process *proc, *tmp;
 279
 280         list_for_each_entry_safe(proc, tmp, &wdev->script_proc, list) {
 281                 bool check = wireless_process_check(proc);
 282
 283                 if (check && !proc->keep) {
 284                         D(WIRELESS, "Wireless device '%s' kill pid %d\n", wdev->name, proc->pid);
 285                         kill(proc->pid, signal);
 286                 }
 287
 288                 if (free || !check)
 289                         wireless_process_free(wdev, proc);
 290         }
 291
 292         if (free)
 293                 wireless_close_script_proc_fd(wdev);
 294 }
 295
 296 static void
 297 wireless_device_free_state(struct wireless_device *wdev)
 298 {
 299         struct wireless_interface *vif;
 300         struct wireless_vlan *vlan;
 301         struct wireless_station *sta;
 302
 303         wireless_handler_stop(wdev);
 304         uloop_timeout_cancel(&wdev->script_check);
 305         uloop_timeout_cancel(&wdev->timeout);
 306         wireless_complete_kill_request(wdev);
 307         free(wdev->data);
 308         wdev->data = NULL;
 309         vlist_for_each_element(&wdev->interfaces, vif, node) {
 310                 free(vif->data);
 311                 vif->data = NULL;
 312                 vif->ifname = NULL;
 313                 vlist_for_each_element(&vif->vlans, vlan, node) {
 314                         free(vlan->data);
 315                         vlan->data = NULL;
 316                         vlan->ifname = NULL;
 317                 }
 318                 vlist_for_each_element(&vif->stations, sta, node) {
 319                         free(sta->data);
 320                         sta->data = NULL;
 321                 }
 322         }
 323 }
 324
 325 static void wireless_device_set_mcast_to_unicast(struct device *dev, int val)
 326 {
 327         if (val < 0) {
 328                 dev->settings.flags &= ~DEV_OPT_MULTICAST_TO_UNICAST;
 329                 return;
 330         }
 331
 332         dev->settings.multicast_to_unicast = !!val;
 333         dev->settings.flags |= DEV_OPT_MULTICAST_TO_UNICAST;
 334 }
 335
 336 static void wireless_interface_handle_link(struct wireless_interface *vif, const char *ifname, bool up)
 337 {
 338         struct interface *iface;
 339         struct blob_attr *cur;
 340         const char *network;
 341         size_t rem;
 342
 343         if (!vif->network || !vif->ifname)
 344                 return;
 345
 346         if (!ifname)
 347                 ifname = vif->ifname;
 348
 349         if (up) {
 350                 struct device *dev = __device_get(ifname, 2, false);
 351
 352                 if (dev && !strcmp(ifname, vif->ifname)) {
 353                         dev->wireless_isolate = vif->isolate;
 354                         dev->wireless_proxyarp = vif->proxyarp;
 355                         dev->wireless = true;
 356                         dev->wireless_ap = vif->ap_mode;
 357                         wireless_device_set_mcast_to_unicast(dev, vif->multicast_to_unicast);
 358                         dev->bpdu_filter = dev->wireless_ap;
 359                 }
 360         }
 361
 362         blobmsg_for_each_attr(cur, vif->network, rem) {
 363                 network = blobmsg_data(cur);
 364
 365                 iface = vlist_find(&interfaces, network, iface, node);
 366                 if (!iface)
 367                         continue;
 368
 369                 interface_handle_link(iface, ifname, vif->network_vlan, up, true);
 370         }
 371 }
 372
 373 static void wireless_vlan_handle_link(struct wireless_vlan *vlan, bool up)
 374 {
 375         struct interface *iface;
 376         struct blob_attr *cur;
 377         const char *network;
 378         size_t rem;
 379
 380         if (!vlan->network || !vlan->ifname)
 381                 return;
 382
 383         if (up) {
 384                 struct device *dev = device_get(vlan->ifname, 2);
 385                 if (dev) {
 386                         dev->wireless_isolate = vlan->isolate;
 387                         dev->wireless = true;
 388                         dev->wireless_ap = true;
 389                         dev->bpdu_filter = true;
 390                         wireless_device_set_mcast_to_unicast(dev, vlan->multicast_to_unicast);
 391                 }
 392         }
 393
 394         blobmsg_for_each_attr(cur, vlan->network, rem) {
 395                 network = blobmsg_data(cur);
 396
 397                 iface = vlist_find(&interfaces, network, iface, node);
 398                 if (!iface)
 399                         continue;
 400
 401                 interface_handle_link(iface, vlan->ifname, vlan->network_vlan, up, true);
 402         }
 403 }
 404
 405 static void
 406 wireless_device_setup_cancel(struct wireless_device *wdev)
 407 {
 408         if (wdev->cancel)
 409                 return;
 410
 411         wireless_handler_stop(wdev);
 412         D(WIRELESS, "Cancel wireless device '%s' setup\n", wdev->name);
 413         wdev->cancel = true;
 414         uloop_timeout_set(&wdev->timeout, 10 * 1000);
 415 }
 416
 417 static void
 418 wireless_device_run_handler(struct wireless_device *wdev, bool up)
 419 {
 420         const char *action = up ? "setup" : "teardown";
 421         const char *argv[6];
 422         char *config;
 423         int i = 0;
 424         int fds[2] = { -1, -1 };
 425
 426         wireless_handler_stop(wdev);
 427
 428         if (handler_pending && wdev->serialize) {
 429                 wdev->handler_action = up;
 430                 wdev->handler_pending = true;
 431                 list_add_tail(&wdev->handler, &handlers);
 432                 return;
 433         }
 434         if (wdev->serialize)
 435                 handler_pending = true;
 436
 437         D(WIRELESS, "Wireless device '%s' run %s handler\n", wdev->name, action);
 438         if (!up && wdev->prev_config) {
 439                 config = blobmsg_format_json(wdev->prev_config, true);
 440                 free(wdev->prev_config);
 441                 wdev->prev_config = NULL;
 442         } else {
 443                 prepare_config(wdev, &b, up);
 444                 free(wdev->prev_config);
 445                 wdev->prev_config = up ? blob_memdup(b.head) : NULL;
 446                 config = blobmsg_format_json(b.head, true);
 447         }
 448
 449         argv[i++] = wdev->drv->script;
 450         argv[i++] = wdev->drv->name;
 451         argv[i++] = action;
 452         argv[i++] = wdev->name;
 453         argv[i++] = config;
 454         argv[i] = NULL;
 455
 456         if (up && pipe(fds) == 0) {
 457                 if (wdev->script_proc_fd.fd >= 0)
 458                         wireless_close_script_proc_fd(wdev);
 459
 460                 wdev->script_proc_fd.fd = fds[0];
 461                 uloop_fd_add(&wdev->script_proc_fd,
 462                              ULOOP_READ | ULOOP_EDGE_TRIGGER);
 463         }
 464
 465         netifd_start_process(argv, NULL, &wdev->script_task);
 466
 467         if (fds[1] >= 0)
 468                 close(fds[1]);
 469
 470         free(config);
 471 }
 472
 473 static void
 474 wireless_handler_next(void)
 475 {
 476         struct wireless_device *wdev;
 477
 478         if (handler_pending)
 479                 return;
 480         if (list_empty(&handlers))
 481                 return;
 482         wdev = list_first_entry(&handlers, struct wireless_device, handler);
 483         list_del(&wdev->handler);
 484         wdev->handler_pending = false;
 485         wireless_device_run_handler(wdev, wdev->handler_action);
 486 }
 487
 488 static void
 489 __wireless_device_set_up(struct wireless_device *wdev, int force)
 490 {
 491         if (wdev->disabled)
 492                 return;
 493
 494         if (wdev->retry_setup_failed)
 495                 return;
 496
 497         if (!wdev->autostart)
 498                 return;
 499
 500         if ((!force && wdev->state != IFS_DOWN) || config_init)
 501                 return;
 502
 503         wdev->state = IFS_SETUP;
 504         wireless_device_run_handler(wdev, true);
 505 }
 506
 507 static void
 508 wireless_device_free(struct wireless_device *wdev)
 509 {
 510         wireless_handler_stop(wdev);
 511         vlist_flush_all(&wdev->interfaces);
 512         avl_delete(&wireless_devices.avl, &wdev->node.avl);
 513         free(wdev->config);
 514         free(wdev->prev_config);
 515         free(wdev);
 516 }
 517
 518 static void
 519 wdev_handle_config_change(struct wireless_device *wdev)
 520 {
 521         enum interface_config_state state = wdev->config_state;
 522
 523         switch(state) {
 524         case IFC_RELOAD:
 525                 wdev->retry = WIRELESS_SETUP_RETRY;
 526                 wdev->retry_setup_failed = false;
 527                 fallthrough;
 528         case IFC_NORMAL:
 529                 __wireless_device_set_up(wdev, 0);
 530
 531                 wdev->config_state = IFC_NORMAL;
 532                 break;
 533         case IFC_REMOVE:
 534                 wireless_device_free(wdev);
 535                 break;
 536         }
 537 }
 538
 539 static void
 540 wireless_device_mark_down(struct wireless_device *wdev)
 541 {
 542         struct wireless_interface *vif;
 543         struct wireless_vlan *vlan;
 544
 545         netifd_log_message(L_NOTICE, "Wireless device '%s' is now down\n", wdev->name);
 546
 547
 548         vlist_for_each_element(&wdev->interfaces, vif, node) {
 549                 wireless_interface_handle_link(vif, NULL, false);
 550                 vlist_for_each_element(&vif->vlans, vlan, node)
 551                         wireless_vlan_handle_link(vlan, false);
 552         }
 553
 554         wireless_process_kill_all(wdev, SIGTERM, true);
 555
 556         wdev->cancel = false;
 557         wdev->state = IFS_DOWN;
 558         wireless_device_free_state(wdev);
 559         wdev_handle_config_change(wdev);
 560 }
 561
 562 /* timeout callback to protect the tear down */
 563 static void
 564 wireless_device_setup_timeout(struct uloop_timeout *timeout)
 565 {
 566         struct wireless_device *wdev = container_of(timeout, struct wireless_device, timeout);
 567
 568         if (wdev->handler_pending) {
 569                 wdev->handler_pending = false;
 570                 list_del(&wdev->handler);
 571         }
 572         netifd_kill_process(&wdev->script_task);
 573         wdev->script_task.cb(&wdev->script_task, -1);
 574         wireless_device_mark_down(wdev);
 575 }
 576
 577 void
 578 wireless_device_set_up(struct wireless_device *wdev)
 579 {
 580         wdev->retry = WIRELESS_SETUP_RETRY;
 581         wdev->autostart = true;
 582         __wireless_device_set_up(wdev, 0);
 583 }
 584
 585 void
 586 wireless_device_reconf(struct wireless_device *wdev)
 587 {
 588         wdev->retry = WIRELESS_SETUP_RETRY;
 589         wdev->autostart = true;
 590         __wireless_device_set_up(wdev, wdev->reconf && (wdev->state == IFS_UP));
 591 }
 592
 593 static void
 594 __wireless_device_set_down(struct wireless_device *wdev)
 595 {
 596         if (wdev->state == IFS_TEARDOWN || wdev->state == IFS_DOWN)
 597                 return;
 598
 599         if (wdev->script_task.uloop.pending) {
 600                 wireless_device_setup_cancel(wdev);
 601                 return;
 602         }
 603
 604         wdev->state = IFS_TEARDOWN;
 605         wireless_device_run_handler(wdev, false);
 606 }
 607
 608 /* ubus callback network.wireless.notify, command = up */
 609 static void
 610 wireless_device_mark_up(struct wireless_device *wdev)
 611 {
 612         struct wireless_interface *vif;
 613         struct wireless_vlan *vlan;
 614
 615         if (wdev->cancel) {
 616                 wdev->cancel = false;
 617                 __wireless_device_set_down(wdev);
 618                 return;
 619         }
 620
 621         netifd_log_message(L_NOTICE, "Wireless device '%s' is now up\n", wdev->name);
 622         wdev->retry = WIRELESS_SETUP_RETRY;
 623         wdev->state = IFS_UP;
 624         vlist_for_each_element(&wdev->interfaces, vif, node) {
 625                 wireless_interface_handle_link(vif, NULL, true);
 626                 vlist_for_each_element(&vif->vlans, vlan, node)
 627                         wireless_vlan_handle_link(vlan, true);
 628         }
 629 }
 630
 631 static void
 632 wireless_device_retry_setup(struct wireless_device *wdev)
 633 {
 634         if (wdev->state == IFS_TEARDOWN || wdev->state == IFS_DOWN || wdev->cancel)
 635                 return;
 636
 637         netifd_log_message(wdev->retry ? L_WARNING : L_CRIT,
 638                            "Wireless device '%s' setup failed, retry=%d\n",
 639                            wdev->name, wdev->retry);
 640         if (--wdev->retry < 0)
 641                 wdev->retry_setup_failed = true;
 642
 643         __wireless_device_set_down(wdev);
 644 }
 645
 646 static void
 647 wireless_device_script_task_cb(struct netifd_process *proc, int ret)
 648 {
 649         struct wireless_device *wdev = container_of(proc, struct wireless_device, script_task);
 650
 651         switch (wdev->state) {
 652         case IFS_SETUP:
 653                 wireless_device_retry_setup(wdev);
 654                 break;
 655         case IFS_TEARDOWN:
 656                 wireless_device_mark_down(wdev);
 657                 break;
 658         default:
 659                 break;
 660         }
 661
 662         if (wdev->serialize) {
 663                 handler_pending = false;
 664                 wireless_handler_next();
 665         }
 666 }
 667
 668 void
 669 wireless_device_set_down(struct wireless_device *wdev)
 670 {
 671         wdev->retry_setup_failed = false;
 672         wdev->autostart = false;
 673         __wireless_device_set_down(wdev);
 674 }
 675
 676 static void
 677 wdev_set_config_state(struct wireless_device *wdev, enum interface_config_state s)
 678 {
 679         if (wdev->config_state != IFC_NORMAL)
 680                 return;
 681
 682         wdev->config_update = false;
 683         if (!wdev->disabled && s == IFC_RELOAD && wdev->reconf && wdev->state == IFS_UP) {
 684                 wireless_device_reconf(wdev);
 685                 return;
 686         }
 687
 688         wdev->config_state = s;
 689         if (wdev->state == IFS_DOWN)
 690                 wdev_handle_config_change(wdev);
 691         else
 692                 __wireless_device_set_down(wdev);
 693 }
 694
 695 static void
 696 wdev_prepare_prev_config(struct wireless_device *wdev)
 697 {
 698         prepare_config(wdev, &b, false);
 699         free(wdev->prev_config);
 700         wdev->prev_config = blob_memdup(b.head);
 701 }
 702
 703 static void
 704 wdev_change_config(struct wireless_device *wdev, struct wireless_device *wd_new)
 705 {
 706         struct blob_attr *new_config = wd_new->config;
 707         bool disabled = wd_new->disabled;
 708
 709         wdev->reconf = wd_new->reconf;
 710         wdev->serialize = wd_new->serialize;
 711         free(wd_new);
 712
 713         if (blob_attr_equal(wdev->config, new_config) && wdev->disabled == disabled)
 714                 return;
 715
 716         D(WIRELESS, "Update configuration of wireless device '%s'\n", wdev->name);
 717         free(wdev->config);
 718         wdev->config = blob_memdup(new_config);
 719         wdev->disabled = disabled;
 720         wdev->config_update = true;
 721 }
 722
 723 static void
 724 wdev_create(struct wireless_device *wdev)
 725 {
 726         wdev->retry = WIRELESS_SETUP_RETRY;
 727         wdev->config = blob_memdup(wdev->config);
 728 }
 729
 730 /* vlist update call for wireless device list */
 731 static void
 732 wdev_update(struct vlist_tree *tree, struct vlist_node *node_new,
 733             struct vlist_node *node_old)
 734 {
 735         struct wireless_device *wd_old = container_of(node_old, struct wireless_device, node);
 736         struct wireless_device *wd_new = container_of(node_new, struct wireless_device, node);
 737
 738         if (wd_old && wd_new) {
 739                 D(WIRELESS, "Update wireless device '%s'\n", wd_old->name);
 740                 wdev_change_config(wd_old, wd_new);
 741         } else if (wd_old) {
 742                 D(WIRELESS, "Delete wireless device '%s'\n", wd_old->name);
 743                 wdev_set_config_state(wd_old, IFC_REMOVE);
 744         } else if (wd_new) {
 745                 D(WIRELESS, "Create wireless device '%s'\n", wd_new->name);
 746                 wdev_create(wd_new);
 747         }
 748 }
 749
 750 /* wireless netifd script handler */
 751 static void
 752 wireless_add_handler(const char *script, const char *name, json_object *obj)
 753 {
 754         struct wireless_driver *drv;
 755         char *name_str, *script_str;
 756         json_object *dev_config_obj, *iface_config_obj, *vlan_config_obj, *station_config_obj;
 757         struct uci_blob_param_list *dev_config, *iface_config, *vlan_config, *station_config;
 758
 759         dev_config_obj = json_get_field(obj, "device", json_type_array);
 760         iface_config_obj = json_get_field(obj, "iface", json_type_array);
 761         vlan_config_obj = json_get_field(obj, "vlan", json_type_array);
 762         station_config_obj = json_get_field(obj, "station", json_type_array);
 763
 764         if (!dev_config_obj || !iface_config_obj || !vlan_config_obj || !station_config_obj)
 765                 return;
 766
 767         drv = calloc_a(sizeof(*drv),
 768                 &dev_config, sizeof(*dev_config) + sizeof(void *),
 769                 &iface_config, sizeof(*iface_config) + sizeof(void *),
 770                 &vlan_config, sizeof(*vlan_config) + sizeof(void *),
 771                 &station_config, sizeof(*station_config) + sizeof(void *),
 772                 &name_str, strlen(name) + 1,
 773                 &script_str, strlen(script) + 1);
 774
 775         drv->name = strcpy(name_str, name);
 776         drv->script = strcpy(script_str, script);
 777
 778         dev_config->n_next = 1;
 779         dev_config->next[0] = &wdev_param;
 780         drv->device.config = dev_config;
 781
 782         iface_config->n_next = 1;
 783         iface_config->next[0] = &vif_param;
 784         drv->interface.config = iface_config;
 785
 786         vlan_config->n_next = 1;
 787         vlan_config->next[0] = &vlan_param;
 788         drv->vlan.config = vlan_config;
 789
 790         station_config->n_next = 1;
 791         station_config->next[0] = &station_param;
 792         drv->station.config = station_config;
 793
 794         drv->device.buf = netifd_handler_parse_config(drv->device.config, dev_config_obj);
 795         drv->interface.buf = netifd_handler_parse_config(drv->interface.config, iface_config_obj);
 796         drv->vlan.buf = netifd_handler_parse_config(drv->vlan.config, vlan_config_obj);
 797         drv->station.buf = netifd_handler_parse_config(drv->station.config, station_config_obj);
 798
 799         drv->node.key = drv->name;
 800         avl_insert(&wireless_drivers, &drv->node);
 801         D(WIRELESS, "Add handler for script %s: %s\n", script, name);
 802 }
 803
 804 void wireless_init(void)
 805 {
 806         vlist_init(&wireless_devices, avl_strcmp, wdev_update);
 807         wireless_devices.keep_old = true;
 808         wireless_devices.no_delete = true;
 809
 810         avl_init(&wireless_drivers, avl_strcmp, false, NULL);
 811         drv_fd = netifd_open_subdir("wireless");
 812         if (drv_fd < 0)
 813                 return;
 814
 815         netifd_init_script_handlers(drv_fd, wireless_add_handler);
 816 }
 817
 818 /* parse blob config into the wireless interface object */
 819 static void
 820 wireless_interface_init_config(struct wireless_interface *vif)
 821 {
 822         struct blob_attr *tb[__VIF_ATTR_MAX];
 823         struct blob_attr *cur;
 824
 825         vif->network = NULL;
 826         blobmsg_parse(vif_policy, __VIF_ATTR_MAX, tb, blob_data(vif->config), blob_len(vif->config));
 827
 828         if ((cur = tb[VIF_ATTR_NETWORK]))
 829                 vif->network = cur;
 830
 831         if ((cur = tb[VIF_ATTR_NETWORK_VLAN]))
 832                 vif->network_vlan = cur;
 833
 834         cur = tb[VIF_ATTR_MODE];
 835         vif->ap_mode = cur && !strcmp(blobmsg_get_string(cur), "ap");
 836
 837         cur = tb[VIF_ATTR_ISOLATE];
 838         vif->isolate = vif->ap_mode && cur && blobmsg_get_bool(cur);
 839
 840         cur = tb[VIF_ATTR_PROXYARP];
 841         vif->proxyarp = vif->ap_mode && cur && blobmsg_get_bool(cur);
 842
 843         cur = tb[VIF_ATTR_MCAST_TO_UCAST];
 844         vif->multicast_to_unicast = cur ? blobmsg_get_bool(cur) : -1;
 845 }
 846
 847 static void
 848 vif_free(struct wireless_interface *vif)
 849 {
 850         vlist_flush_all(&vif->vlans);
 851         vlist_flush_all(&vif->stations);
 852         free((void *) vif->section);
 853         free(vif->config);
 854         free(vif);
 855 }
 856
 857 /* vlist update call for wireless interface list */
 858 static void
 859 vif_update(struct vlist_tree *tree, struct vlist_node *node_new,
 860            struct vlist_node *node_old)
 861 {
 862         struct wireless_interface *vif_old = container_of(node_old, struct wireless_interface, node);
 863         struct wireless_interface *vif_new = container_of(node_new, struct wireless_interface, node);
 864         struct wireless_device *wdev;
 865
 866         if (vif_old)
 867                 wdev = vif_old->wdev;
 868         else
 869                 wdev = vif_new->wdev;
 870
 871         if (vif_old && vif_new) {
 872                 free((void *) vif_old->section);
 873                 vif_old->section = strdup(vif_new->section);
 874                 if (blob_attr_equal(vif_old->config, vif_new->config)) {
 875                         free(vif_new);
 876                         return;
 877                 }
 878
 879                 D(WIRELESS, "Update wireless interface %s on device %s\n", vif_new->name, wdev->name);
 880                 wireless_interface_handle_link(vif_old, NULL, false);
 881                 free(vif_old->config);
 882                 vif_old->config = blob_memdup(vif_new->config);
 883                 wireless_interface_init_config(vif_old);
 884                 free(vif_new);
 885         } else if (vif_new) {
 886                 D(WIRELESS, "Create new wireless interface %s on device %s\n", vif_new->name, wdev->name);
 887                 vif_new->section = strdup(vif_new->section);
 888                 vif_new->config = blob_memdup(vif_new->config);
 889                 wireless_interface_init_config(vif_new);
 890         } else if (vif_old) {
 891                 D(WIRELESS, "Delete wireless interface %s on device %s\n", vif_old->name, wdev->name);
 892                 wireless_interface_handle_link(vif_old, NULL, false);
 893                 vif_free(vif_old);
 894         }
 895
 896         wdev->config_update = true;
 897 }
 898
 899 /* parse blob config into the vlan object */
 900 static void
 901 wireless_vlan_init_config(struct wireless_vlan *vlan)
 902 {
 903         struct blob_attr *tb[__VLAN_ATTR_MAX];
 904         struct blob_attr *cur;
 905
 906         vlan->network = NULL;
 907         blobmsg_parse(vlan_policy, __VLAN_ATTR_MAX, tb, blob_data(vlan->config), blob_len(vlan->config));
 908
 909         if ((cur = tb[VLAN_ATTR_NETWORK]))
 910                 vlan->network = cur;
 911
 912         if ((cur = tb[VLAN_ATTR_NETWORK_VLAN]))
 913                 vlan->network_vlan = cur;
 914
 915         cur = tb[VLAN_ATTR_ISOLATE];
 916         if (cur)
 917                 vlan->isolate = blobmsg_get_bool(cur);
 918
 919         cur = tb[VLAN_ATTR_MCAST_TO_UCAST];
 920         vlan->multicast_to_unicast = cur ? blobmsg_get_bool(cur) : -1;
 921 }
 922
 923 /* vlist update call for vlan list */
 924 static void
 925 vlan_update(struct vlist_tree *tree, struct vlist_node *node_new,
 926             struct vlist_node *node_old)
 927 {
 928         struct wireless_vlan *vlan_old = container_of_safe(node_old, struct wireless_vlan, node);
 929         struct wireless_vlan *vlan_new = container_of_safe(node_new, struct wireless_vlan, node);
 930         struct wireless_interface *vif = container_of(tree, struct wireless_interface, vlans);
 931         struct wireless_device *wdev = vif->wdev;
 932
 933         if (vlan_old && vlan_new) {
 934                 free((void *) vlan_old->section);
 935                 vlan_old->section = strdup(vlan_new->section);
 936                 if (blob_attr_equal(vlan_old->config, vlan_new->config)) {
 937                         free(vlan_new);
 938                         return;
 939                 }
 940
 941                 D(WIRELESS, "Update wireless vlan %s on device %s\n", vlan_new->name, wdev->name);
 942                 wireless_vlan_handle_link(vlan_old, false);
 943                 free(vlan_old->config);
 944                 vlan_old->config = blob_memdup(vlan_new->config);
 945                 vlan_old->isolate = vlan_new->isolate;
 946                 wireless_vlan_init_config(vlan_old);
 947                 free(vlan_new);
 948         } else if (vlan_new) {
 949                 D(WIRELESS, "Create new wireless vlan %s on device %s\n", vlan_new->name, wdev->name);
 950                 vlan_new->section = strdup(vlan_new->section);
 951                 vlan_new->config = blob_memdup(vlan_new->config);
 952                 wireless_vlan_init_config(vlan_new);
 953         } else if (vlan_old) {
 954                 D(WIRELESS, "Delete wireless vlan %s on device %s\n", vlan_old->name, wdev->name);
 955                 wireless_vlan_handle_link(vlan_old, false);
 956                 free((void *) vlan_old->section);
 957                 free(vlan_old->config);
 958                 free(vlan_old);
 959         }
 960
 961         wdev->config_update = true;
 962 }
 963
 964 /* vlist update call for station list */
 965 static void
 966 station_update(struct vlist_tree *tree, struct vlist_node *node_new,
 967                struct vlist_node *node_old)
 968 {
 969         struct wireless_station *sta_old = container_of_safe(node_old, struct wireless_station, node);
 970         struct wireless_station *sta_new = container_of_safe(node_new, struct wireless_station, node);
 971         struct wireless_interface *vif = container_of(tree, struct wireless_interface, stations);
 972         struct wireless_device *wdev = vif->wdev;
 973
 974         if (sta_old && sta_new) {
 975                 free((void *) sta_old->section);
 976                 sta_old->section = strdup(sta_new->section);
 977                 if (blob_attr_equal(sta_old->config, sta_new->config)) {
 978                         free(sta_new);
 979                         return;
 980                 }
 981
 982                 D(WIRELESS, "Update wireless station %s on device %s\n", sta_new->name, wdev->name);
 983                 free(sta_old->config);
 984                 sta_old->config = blob_memdup(sta_new->config);
 985                 free(sta_new);
 986         } else if (sta_new) {
 987                 D(WIRELESS, "Create new wireless station %s on device %s\n", sta_new->name, wdev->name);
 988                 sta_new->section = strdup(sta_new->section);
 989                 sta_new->config = blob_memdup(sta_new->config);
 990         } else if (sta_old) {
 991                 D(WIRELESS, "Delete wireless station %s on device %s\n", sta_old->name, wdev->name);
 992                 free((void *) sta_old->section);
 993                 free(sta_old->config);
 994                 free(sta_old);
 995         }
 996
 997         wdev->config_update = true;
 998 }
 999
1000 static void
1001 wireless_proc_poll_fd(struct uloop_fd *fd, unsigned int events)
1002 {
1003         struct wireless_device *wdev = container_of(fd, struct wireless_device, script_proc_fd);
1004         char buf[128];
1005
1006         while (1) {
1007                 int b = read(fd->fd, buf, sizeof(buf));
1008                 if (b < 0) {
1009                         if (errno == EINTR)
1010                                 continue;
1011
1012                         if (errno == EAGAIN)
1013                                 return;
1014
1015                         goto done;
1016                 }
1017
1018                 if (!b)
1019                         goto done;
1020         }
1021
1022 done:
1023         uloop_timeout_set(&wdev->script_check, 0);
1024         wireless_close_script_proc_fd(wdev);
1025 }
1026
1027 /* watchdog and garbage collector for wireless processes.
1028  * It cleans up terminated processes. If a process is a requirement for the wireless device, it retries the setup */
1029 static void
1030 wireless_device_check_script_tasks(struct uloop_timeout *timeout)
1031 {
1032         struct wireless_device *wdev = container_of(timeout, struct wireless_device, script_check);
1033         struct wireless_process *proc, *tmp;
1034         bool restart = false;
1035
1036         list_for_each_entry_safe(proc, tmp, &wdev->script_proc, list) {
1037                 if (wireless_process_check(proc))
1038                         continue;
1039
1040                 D(WIRELESS, "Wireless device '%s' pid %d has terminated\n", wdev->name, proc->pid);
1041                 if (proc->required)
1042                         restart = true;
1043
1044                 wireless_process_free(wdev, proc);
1045         }
1046
1047         if (restart)
1048                 wireless_device_retry_setup(wdev);
1049         else
1050                 uloop_timeout_set(&wdev->script_check, 1000);
1051 }
1052
1053 /* creates a wireless device object. Called by config */
1054 void
1055 wireless_device_create(struct wireless_driver *drv, const char *name, struct blob_attr *data)
1056 {
1057         struct wireless_device *wdev;
1058         char *name_buf;
1059         struct blob_attr *tb[__WDEV_ATTR_MAX];
1060         struct blob_attr *cur;
1061
1062         blobmsg_parse(wdev_policy, __WDEV_ATTR_MAX, tb, blob_data(data), blob_len(data));
1063
1064         wdev = calloc_a(sizeof(*wdev), &name_buf, strlen(name) + 1);
1065
1066         cur = tb[WDEV_ATTR_DISABLED];
1067         wdev->disabled = cur && blobmsg_get_bool(cur);
1068
1069         wdev->drv = drv;
1070         wdev->state = IFS_DOWN;
1071         wdev->config_state = IFC_NORMAL;
1072         wdev->name = strcpy(name_buf, name);
1073         wdev->config = data;
1074         wdev->handler_pending = false;
1075
1076         cur = tb[WDEV_ATTR_SERIALIZE];
1077         wdev->serialize = cur && blobmsg_get_bool(cur);
1078
1079         cur = tb[WDEV_ATTR_RECONF];
1080         wdev->reconf = !cur || blobmsg_get_bool(cur);
1081
1082         wdev->retry_setup_failed = false;
1083         wdev->autostart = true;
1084         INIT_LIST_HEAD(&wdev->script_proc);
1085         vlist_init(&wdev->interfaces, avl_strcmp, vif_update);
1086         wdev->interfaces.keep_old = true;
1087
1088         wdev->timeout.cb = wireless_device_setup_timeout;
1089         wdev->script_task.cb = wireless_device_script_task_cb;
1090         wdev->script_task.dir_fd = drv_fd;
1091         wdev->script_task.log_prefix = wdev->name;
1092
1093         wdev->script_proc_fd.fd = -1;
1094         wdev->script_proc_fd.cb = wireless_proc_poll_fd;
1095
1096         wdev->script_check.cb = wireless_device_check_script_tasks;
1097
1098         vlist_add(&wireless_devices, &wdev->node, wdev->name);
1099 }
1100
1101 /* creates a wireless station object. Called by config */
1102 void
1103 wireless_station_create(struct wireless_interface *vif, struct blob_attr *data, const char *section)
1104 {
1105         struct wireless_station *sta;
1106         struct blob_attr *tb[__STA_ATTR_MAX];
1107         struct blob_attr *cur;
1108         char *name_buf;
1109         char name[8];
1110
1111         blobmsg_parse(sta_policy, __STA_ATTR_MAX, tb, blob_data(data), blob_len(data));
1112
1113         cur = tb[STA_ATTR_DISABLED];
1114         if (cur && blobmsg_get_bool(cur))
1115                 return;
1116
1117         sprintf(name, "%d", vif->sta_idx++);
1118
1119         sta = calloc_a(sizeof(*sta),
1120                        &name_buf, strlen(name) + 1);
1121         sta->name = strcpy(name_buf, name);
1122         sta->config = data;
1123         sta->section = section;
1124
1125         vlist_add(&vif->stations, &sta->node, sta->name);
1126 }
1127
1128 /* ubus callback network.wireless.status, runs for every interface, encode the station */
1129 static void
1130 wireless_station_status(struct wireless_station *sta, struct blob_buf *b)
1131 {
1132         void *i;
1133
1134         i = blobmsg_open_table(b, NULL);
1135         if (sta->section)
1136                 blobmsg_add_string(b, "section", sta->section);
1137         put_container(b, sta->config, "config");
1138         blobmsg_close_table(b, i);
1139 }
1140
1141 /* create a vlan object. Called by config */
1142 void
1143 wireless_vlan_create(struct wireless_interface *vif, struct blob_attr *data, const char *section)
1144 {
1145         struct wireless_vlan *vlan;
1146         struct blob_attr *tb[__VLAN_ATTR_MAX];
1147         struct blob_attr *cur;
1148         char *name_buf;
1149         char name[8];
1150
1151         blobmsg_parse(vlan_policy, __VLAN_ATTR_MAX, tb, blob_data(data), blob_len(data));
1152
1153         cur = tb[VLAN_ATTR_DISABLED];
1154         if (cur && blobmsg_get_bool(cur))
1155                 return;
1156
1157         sprintf(name, "%d", vif->vlan_idx++);
1158
1159         vlan = calloc_a(sizeof(*vlan), &name_buf, strlen(name) + 1);
1160         vlan->name = strcpy(name_buf, name);
1161         vlan->config = data;
1162         vlan->section = section;
1163
1164         vlist_add(&vif->vlans, &vlan->node, vlan->name);
1165 }
1166
1167 /* ubus callback network.wireless.status, runs for every interface, encode the vlan informations */
1168 static void
1169 wireless_vlan_status(struct wireless_vlan *vlan, struct blob_buf *b)
1170 {
1171         void *i;
1172
1173         i = blobmsg_open_table(b, NULL);
1174         if (vlan->section)
1175                 blobmsg_add_string(b, "section", vlan->section);
1176         if (vlan->ifname)
1177                 blobmsg_add_string(b, "ifname", vlan->ifname);
1178         put_container(b, vlan->config, "config");
1179         blobmsg_close_table(b, i);
1180 }
1181
1182 /* create a wireless interface object. Called by config */
1183 struct wireless_interface* wireless_interface_create(struct wireless_device *wdev, struct blob_attr *data, const char *section)
1184 {
1185         struct wireless_interface *vif;
1186         struct blob_attr *tb[__VIF_ATTR_MAX];
1187         struct blob_attr *cur;
1188         char *name_buf;
1189         char name[8];
1190
1191         blobmsg_parse(vif_policy, __VIF_ATTR_MAX, tb, blob_data(data), blob_len(data));
1192
1193         cur = tb[VIF_ATTR_DISABLED];
1194         if (cur && blobmsg_get_bool(cur))
1195                 return NULL;
1196
1197         sprintf(name, "%d", wdev->vif_idx++);
1198
1199         vif = calloc_a(sizeof(*vif),
1200                        &name_buf, strlen(name) + 1);
1201         vif->name = strcpy(name_buf, name);
1202         vif->wdev = wdev;
1203         vif->config = data;
1204         vif->section = section;
1205         vif->isolate = false;
1206
1207         vlist_init(&vif->vlans, avl_strcmp, vlan_update);
1208         vif->vlans.keep_old = true;
1209
1210         vlist_init(&vif->stations, avl_strcmp, station_update);
1211         vif->stations.keep_old = true;
1212
1213         vlist_add(&wdev->interfaces, &vif->node, vif->name);
1214
1215         return vlist_find(&wdev->interfaces, name, vif, node);
1216 }
1217
1218 /* ubus callback network.wireless.status, runs for every interface */
1219 static void
1220 wireless_interface_status(struct wireless_interface *iface, struct blob_buf *b)
1221 {
1222         struct wireless_vlan *vlan;
1223         struct wireless_station *sta;
1224         void *i, *j;
1225
1226         i = blobmsg_open_table(b, NULL);
1227         if (iface->section)
1228                 blobmsg_add_string(b, "section", iface->section);
1229         if (iface->ifname)
1230                 blobmsg_add_string(b, "ifname", iface->ifname);
1231         put_container(b, iface->config, "config");
1232         j = blobmsg_open_array(b, "vlans");
1233         vlist_for_each_element(&iface->vlans, vlan, node)
1234                 wireless_vlan_status(vlan, b);
1235         blobmsg_close_array(b, j);
1236         j = blobmsg_open_array(b, "stations");
1237         vlist_for_each_element(&iface->stations, sta, node)
1238                 wireless_station_status(sta, b);
1239         blobmsg_close_array(b, j);
1240         blobmsg_close_table(b, i);
1241 }
1242
1243 /* ubus callback network.wireless.status */
1244 void
1245 wireless_device_status(struct wireless_device *wdev, struct blob_buf *b)
1246 {
1247         struct wireless_interface *iface;
1248         void *c, *i;
1249
1250         c = blobmsg_open_table(b, wdev->name);
1251         blobmsg_add_u8(b, "up", wdev->state == IFS_UP);
1252         blobmsg_add_u8(b, "pending", wdev->state == IFS_SETUP || wdev->state == IFS_TEARDOWN);
1253         blobmsg_add_u8(b, "autostart", wdev->autostart);
1254         blobmsg_add_u8(b, "disabled", wdev->disabled);
1255         blobmsg_add_u8(b, "retry_setup_failed", wdev->retry_setup_failed);
1256         put_container(b, wdev->config, "config");
1257
1258         i = blobmsg_open_array(b, "interfaces");
1259         vlist_for_each_element(&wdev->interfaces, iface, node)
1260                 wireless_interface_status(iface, b);
1261         blobmsg_close_array(b, i);
1262         blobmsg_close_table(b, c);
1263 }
1264
1265 /* ubus callback network.wireless.get_validate */
1266 void
1267 wireless_device_get_validate(struct wireless_device *wdev, struct blob_buf *b)
1268 {
1269         struct uci_blob_param_list *p;
1270         void *c, *d;
1271         int i;
1272
1273         c = blobmsg_open_table(b, wdev->name);
1274
1275         d = blobmsg_open_table(b, "device");
1276         p = wdev->drv->device.config;
1277         for (i = 0; i < p->n_params; i++)
1278                 blobmsg_add_string(b, p->params[i].name, uci_get_validate_string(p, i));
1279         blobmsg_close_table(b, d);
1280
1281         d = blobmsg_open_table(b, "interface");
1282         p = wdev->drv->interface.config;
1283         for (i = 0; i < p->n_params; i++)
1284                 blobmsg_add_string(b, p->params[i].name, uci_get_validate_string(p, i));
1285         blobmsg_close_table(b, d);
1286
1287         blobmsg_close_table(b, c);
1288 }
1289
1290 /* ubus callback network.wireless.notify, command = set data, for vif */
1291 static void
1292 wireless_interface_set_data(struct wireless_interface *vif)
1293 {
1294         enum {
1295                 VIF_DATA_IFNAME,
1296                 __VIF_DATA_MAX,
1297         };
1298         static const struct blobmsg_policy data_policy[__VIF_DATA_MAX] = {
1299                 [VIF_DATA_IFNAME] = { .name = "ifname", .type = BLOBMSG_TYPE_STRING },
1300         };
1301         struct blob_attr *tb[__VIF_DATA_MAX];
1302         struct blob_attr *cur;
1303
1304         blobmsg_parse(data_policy, __VIF_DATA_MAX, tb,
1305                       blobmsg_data(vif->data), blobmsg_data_len(vif->data));
1306
1307         if ((cur = tb[VIF_DATA_IFNAME]))
1308                 vif->ifname = blobmsg_data(cur);
1309 }
1310
1311 /* ubus callback network.wireless.notify, command = set data, for vlan */
1312 static void
1313 wireless_vlan_set_data(struct wireless_vlan *vlan)
1314 {
1315         enum {
1316                 VLAN_DATA_IFNAME,
1317                 __VLAN_DATA_MAX,
1318         };
1319         static const struct blobmsg_policy data_policy[__VLAN_DATA_MAX] = {
1320                 [VLAN_DATA_IFNAME] = { .name = "ifname", .type = BLOBMSG_TYPE_STRING },
1321         };
1322         struct blob_attr *tb[__VLAN_DATA_MAX];
1323         struct blob_attr *cur;
1324
1325         blobmsg_parse(data_policy, __VLAN_DATA_MAX, tb,
1326                       blobmsg_data(vlan->data), blobmsg_data_len(vlan->data));
1327
1328         if ((cur = tb[VLAN_DATA_IFNAME]))
1329                 vlan->ifname = blobmsg_data(cur);
1330 }
1331
1332 /* ubus callback network.wireless.notify, command = process add */
1333 static int
1334 wireless_device_add_process(struct wireless_device *wdev, struct blob_attr *data)
1335 {
1336         enum {
1337                 PROC_ATTR_PID,
1338                 PROC_ATTR_EXE,
1339                 PROC_ATTR_REQUIRED,
1340                 PROC_ATTR_KEEP,
1341                 __PROC_ATTR_MAX
1342         };
1343         static const struct blobmsg_policy proc_policy[__PROC_ATTR_MAX] = {
1344                 [PROC_ATTR_PID] = { .name = "pid", .type = BLOBMSG_TYPE_INT32 },
1345                 [PROC_ATTR_EXE] = { .name = "exe", .type = BLOBMSG_TYPE_STRING },
1346                 [PROC_ATTR_REQUIRED] = { .name = "required", .type = BLOBMSG_TYPE_BOOL },
1347                 [PROC_ATTR_KEEP] = { .name = "keep", .type = BLOBMSG_TYPE_BOOL },
1348         };
1349         struct blob_attr *tb[__PROC_ATTR_MAX];
1350         struct wireless_process *proc;
1351         char *name;
1352         int pid;
1353
1354         if (!data)
1355                 return UBUS_STATUS_INVALID_ARGUMENT;
1356
1357         blobmsg_parse(proc_policy, __PROC_ATTR_MAX, tb, blobmsg_data(data), blobmsg_data_len(data));
1358         if (!tb[PROC_ATTR_PID] || !tb[PROC_ATTR_EXE])
1359                 return UBUS_STATUS_INVALID_ARGUMENT;
1360
1361         pid = blobmsg_get_u32(tb[PROC_ATTR_PID]);
1362         if (pid < 2)
1363                 return UBUS_STATUS_INVALID_ARGUMENT;
1364
1365         proc = calloc_a(sizeof(*proc),
1366                 &name, strlen(blobmsg_data(tb[PROC_ATTR_EXE])) + 1);
1367
1368         proc->pid = pid;
1369         proc->exe = strcpy(name, blobmsg_data(tb[PROC_ATTR_EXE]));
1370
1371         if (tb[PROC_ATTR_REQUIRED])
1372                 proc->required = blobmsg_get_bool(tb[PROC_ATTR_REQUIRED]);
1373
1374         if (tb[PROC_ATTR_KEEP])
1375                 proc->keep = blobmsg_get_bool(tb[PROC_ATTR_KEEP]);
1376
1377         D(WIRELESS, "Wireless device '%s' add pid %d\n", wdev->name, proc->pid);
1378         list_add(&proc->list, &wdev->script_proc);
1379         uloop_timeout_set(&wdev->script_check, 0);
1380
1381         return 0;
1382 }
1383
1384 /* ubus callback network.wireless.notify, command = process kill all */
1385 static int
1386 wireless_device_process_kill_all(struct wireless_device *wdev, struct blob_attr *data,
1387                                  struct ubus_request_data *req)
1388 {
1389         enum {
1390                 KILL_ATTR_SIGNAL,
1391                 KILL_ATTR_IMMEDIATE,
1392                 __KILL_ATTR_MAX
1393         };
1394         static const struct blobmsg_policy kill_policy[__KILL_ATTR_MAX] = {
1395                 [KILL_ATTR_SIGNAL] = { .name = "signal", .type = BLOBMSG_TYPE_INT32 },
1396                 [KILL_ATTR_IMMEDIATE] = { .name = "immediate", .type = BLOBMSG_TYPE_BOOL },
1397         };
1398         struct blob_attr *tb[__KILL_ATTR_MAX];
1399         struct blob_attr *cur;
1400         bool immediate = false;
1401         int signal = SIGTERM;
1402
1403         blobmsg_parse(kill_policy, __KILL_ATTR_MAX, tb, blobmsg_data(data), blobmsg_data_len(data));
1404
1405         if ((cur = tb[KILL_ATTR_SIGNAL]))
1406                 signal = blobmsg_get_u32(cur);
1407
1408         if ((cur = tb[KILL_ATTR_IMMEDIATE]))
1409                 immediate = blobmsg_get_bool(cur);
1410
1411         if (wdev->state != IFS_TEARDOWN || wdev->kill_request)
1412                 return UBUS_STATUS_PERMISSION_DENIED;
1413
1414         wireless_process_kill_all(wdev, signal, immediate);
1415
1416         if (list_empty(&wdev->script_proc))
1417                 return 0;
1418
1419         wdev->kill_request = calloc(1, sizeof(*wdev->kill_request));
1420         ubus_defer_request(ubus_ctx, req, wdev->kill_request);
1421
1422         return 0;
1423 }
1424
1425 /* ubus callback network.wireless.notify, command = set_retry */
1426 static int
1427 wireless_device_set_retry(struct wireless_device *wdev, struct blob_attr *data)
1428 {
1429         static const struct blobmsg_policy retry_policy = {
1430                 .name = "retry", .type = BLOBMSG_TYPE_INT32
1431         };
1432         struct blob_attr *val;
1433
1434         blobmsg_parse(&retry_policy, 1, &val, blobmsg_data(data), blobmsg_data_len(data));
1435         if (val)
1436                 wdev->retry = blobmsg_get_u32(val);
1437         else
1438                 wdev->retry = WIRELESS_SETUP_RETRY;
1439         __wireless_device_set_up(wdev, 0);
1440         netifd_log_message(L_NOTICE, "Wireless device '%s' set retry=%d\n", wdev->name, wdev->retry);
1441         return 0;
1442 }
1443
1444 enum {
1445         NOTIFY_CMD_UP = 0,
1446         NOTIFY_CMD_SET_DATA = 1,
1447         NOTIFY_CMD_PROCESS_ADD = 2,
1448         NOTIFY_CMD_PROCESS_KILL_ALL = 3,
1449         NOTIFY_CMD_SET_RETRY = 4,
1450 };
1451
1452 /* ubus callback network.wireless.notify */
1453 int
1454 wireless_device_notify(struct wireless_device *wdev, struct blob_attr *data,
1455                        struct ubus_request_data *req)
1456 {
1457         enum {
1458                 NOTIFY_ATTR_COMMAND,
1459                 NOTIFY_ATTR_VIF,
1460                 NOTIFY_ATTR_VLAN,
1461                 NOTIFY_ATTR_DATA,
1462                 __NOTIFY_MAX,
1463         };
1464         static const struct blobmsg_policy notify_policy[__NOTIFY_MAX] = {
1465                 [NOTIFY_ATTR_COMMAND] = { .name = "command", .type = BLOBMSG_TYPE_INT32 },
1466                 [NOTIFY_ATTR_VIF] = { .name = "interface", .type = BLOBMSG_TYPE_STRING },
1467                 [NOTIFY_ATTR_VLAN] = { .name = "vlan", .type = BLOBMSG_TYPE_STRING },
1468                 [NOTIFY_ATTR_DATA] = { .name = "data", .type = BLOBMSG_TYPE_TABLE },
1469         };
1470         struct wireless_interface *vif = NULL;
1471         struct wireless_vlan *vlan = NULL;
1472         struct blob_attr *tb[__NOTIFY_MAX];
1473         struct blob_attr *cur, **pdata;
1474
1475         blobmsg_parse(notify_policy, __NOTIFY_MAX, tb, blob_data(data), blob_len(data));
1476
1477         if (!tb[NOTIFY_ATTR_COMMAND])
1478                 return UBUS_STATUS_INVALID_ARGUMENT;
1479
1480         if ((cur = tb[NOTIFY_ATTR_VIF]) != NULL) {
1481                 vif = vlist_find(&wdev->interfaces, blobmsg_data(cur), vif, node);
1482                 if (!vif)
1483                         return UBUS_STATUS_NOT_FOUND;
1484         }
1485
1486         if ((cur = tb[NOTIFY_ATTR_VLAN]) != NULL) {
1487                 if (!vif)
1488                         return UBUS_STATUS_NOT_FOUND;
1489                 vlan = vlist_find(&vif->vlans, blobmsg_data(cur), vlan, node);
1490                 if (!vlan)
1491                         return UBUS_STATUS_NOT_FOUND;
1492         }
1493
1494         cur = tb[NOTIFY_ATTR_DATA];
1495         if (!cur)
1496                 return UBUS_STATUS_INVALID_ARGUMENT;
1497
1498         switch (blobmsg_get_u32(tb[NOTIFY_ATTR_COMMAND])) {
1499         case NOTIFY_CMD_UP:
1500                 if (vif || vlan)
1501                         return UBUS_STATUS_INVALID_ARGUMENT;
1502
1503                 if (wdev->state != IFS_SETUP)
1504                         return UBUS_STATUS_PERMISSION_DENIED;
1505
1506                 wireless_device_mark_up(wdev);
1507                 break;
1508         case NOTIFY_CMD_SET_DATA:
1509                 if (vlan)
1510                         pdata = &vlan->data;
1511                 else if (vif)
1512                         pdata = &vif->data;
1513                 else
1514                         pdata = &wdev->data;
1515
1516                 free(*pdata);
1517                 *pdata = blob_memdup(cur);
1518                 if (vlan)
1519                         wireless_vlan_set_data(vlan);
1520                 else if (vif)
1521                         wireless_interface_set_data(vif);
1522                 wdev_prepare_prev_config(wdev);
1523                 break;
1524         case NOTIFY_CMD_PROCESS_ADD:
1525                 return wireless_device_add_process(wdev, cur);
1526         case NOTIFY_CMD_PROCESS_KILL_ALL:
1527                 return wireless_device_process_kill_all(wdev, cur, req);
1528         case NOTIFY_CMD_SET_RETRY:
1529                 return wireless_device_set_retry(wdev, cur);
1530         default:
1531                 return UBUS_STATUS_INVALID_ARGUMENT;
1532         }
1533
1534         return 0;
1535 }
1536
1537 static void
1538 wdev_check_network_enabled(struct wireless_device *wdev)
1539 {
1540         struct wireless_interface *vif;
1541         struct interface *iface;
1542         struct blob_attr *cur;
1543         size_t rem;
1544
1545         vlist_for_each_element(&wdev->interfaces, vif, node) {
1546                 int enabled = -1;
1547
1548                 blobmsg_for_each_attr(cur, vif->network, rem) {
1549                         iface = vlist_find(&interfaces, blobmsg_get_string(cur), iface, node);
1550                         if (!iface)
1551                                 continue;
1552
1553                         if (iface->autostart) {
1554                                 enabled = 1;
1555                                 break;
1556                         }
1557                         if (enabled != 1)
1558                                 enabled = 0;
1559                 }
1560
1561                 if (vif->disabled == !enabled)
1562                         continue;
1563
1564                 vif->disabled = !enabled;
1565                 wdev->config_update = true;
1566         }
1567 }
1568
1569 static void
1570 __wireless_start_pending(struct uloop_timeout *t)
1571 {
1572         struct wireless_device *wdev;
1573
1574         vlist_for_each_element(&wireless_devices, wdev, node) {
1575                 wdev_check_network_enabled(wdev);
1576                 if (wdev->config_update)
1577                         wdev_set_config_state(wdev, IFC_RELOAD);
1578                 __wireless_device_set_up(wdev, 0);
1579         }
1580 }
1581
1582 void wireless_start_pending(int timeout)
1583 {
1584         static struct uloop_timeout timer = {
1585                 .cb = __wireless_start_pending
1586         };
1587
1588         if (timeout) {
1589                 uloop_timeout_set(&timer, timeout);
1590                 return;
1591         }
1592
1593         uloop_timeout_cancel(&timer);
1594         timer.cb(&timer);
1595 }
1596
1597 void wireless_check_network_enabled(void)
1598 {
1599         struct wireless_device *wdev;
1600
1601         vlist_for_each_element(&wireless_devices, wdev, node) {
1602                 wdev_check_network_enabled(wdev);
1603
1604                 if (wdev->config_update)
1605                         wireless_start_pending(1000);
1606         }
1607 }
1608
1609 void wireless_device_hotplug_event(const char *name, bool add)
1610 {
1611         struct wireless_interface *vif;
1612         struct wireless_device *wdev;
1613         const char *s;
1614         size_t len;
1615
1616         s = strstr(name, ".sta");
1617         if (s) {
1618                 if (strchr(s + 4, '.'))
1619                         return;
1620
1621                 len = s - name;
1622         } else if (!device_find(name)) {
1623                 len = strlen(name);
1624         } else {
1625                 return;
1626         }
1627
1628         vlist_for_each_element(&wireless_devices, wdev, node) {
1629                 vlist_for_each_element(&wdev->interfaces, vif, node) {
1630                         if (!vif->ifname)
1631                                 continue;
1632
1633                         if (strlen(vif->ifname) != len ||
1634                             strncmp(vif->ifname, name, len) != 0)
1635                                 continue;
1636
1637                         wireless_interface_handle_link(vif, name, add);
1638                 }
1639         }
1640 }