123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374 |
- /*
- * netifd - network interface daemon
- * Copyright (C) 2015 Arne Kappen <arne.kappen@hhi.fraunhofer.de>
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2
- * as published by the Free Software Foundation
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- *
- * extdev - external device handler interface
- *
- * This allows to integrate external daemons that configure network devices
- * with netifd. At startup, netifd generates device handler stubs from
- * descriptions in /lib/netifd/extdev-config and adds them to the list of
- * device handlers. A device handler is an instance of struct device_type
- * The descriptions are in JSON format and specify
- * - names of the device type and of the external device handler on ubus,
- * - whether the device is bridge-like,
- * - a prefix for device names,
- * - the UCI config options for devices of this type, and
- * - the format of calls to dump() and info()
- * These device handlers stubs act as relays forwarding calls against the
- * device handler interface to the external daemon.
- */
- #include <libubox/blobmsg.h>
- #include <libubox/list.h>
- #include <libubus.h>
- #include <assert.h>
- #include "netifd.h"
- #include "handler.h"
- #include "device.h"
- #include "ubus.h"
- #include "extdev.h"
- #include "interface.h"
- #include "system.h"
- static struct blob_buf b;
- static int confdir_fd = -1;
- struct extdev_type {
- struct device_type handler;
- const char *name;
- uint32_t peer_id;
- struct ubus_subscriber ubus_sub;
- bool subscribed;
- struct ubus_event_handler obj_wait;
- struct uci_blob_param_list *config_params;
- char *config_strbuf;
- struct uci_blob_param_list *info_params;
- char *info_strbuf;
- struct uci_blob_param_list *stats_params;
- char *stats_strbuf;
- };
- struct extdev_device {
- struct device dev;
- struct extdev_type *etype;
- const char *dep_name;
- struct uloop_timeout retry;
- };
- struct extdev_bridge {
- struct extdev_device edev;
- device_state_cb set_state;
- struct blob_attr *config;
- bool empty;
- struct blob_attr *ifnames;
- bool active;
- bool force_active;
- struct uloop_timeout retry;
- struct vlist_tree members;
- int n_present;
- int n_failed;
- };
- struct extdev_bridge_member {
- struct vlist_node node;
- struct extdev_bridge *parent_br;
- struct device_user dev_usr;
- bool present;
- char *name;
- };
- static void __bridge_config_init(struct extdev_bridge *ebr);
- static enum dev_change_type __bridge_reload(struct extdev_bridge *ebr, struct blob_attr *config);
- enum {
- METHOD_CREATE,
- METHOD_CONFIG_INIT,
- METHOD_RELOAD,
- METHOD_DUMP_INFO,
- METHOD_DUMP_STATS,
- METHOD_CHECK_STATE,
- METHOD_FREE,
- METHOD_HOTPLUG_PREPARE,
- METHOD_HOTPLUG_ADD,
- METHOD_HOTPLUG_REMOVE,
- __METHODS_MAX
- };
- static const char *__extdev_methods[__METHODS_MAX] = {
- [METHOD_CREATE] = "create",
- [METHOD_CONFIG_INIT] = "config_init",
- [METHOD_RELOAD] = "reload",
- [METHOD_DUMP_INFO] = "dump_info",
- [METHOD_DUMP_STATS] = "dump_stats",
- [METHOD_CHECK_STATE] = "check_state",
- [METHOD_FREE] = "free",
- [METHOD_HOTPLUG_PREPARE] = "prepare",
- [METHOD_HOTPLUG_ADD] = "add",
- [METHOD_HOTPLUG_REMOVE] = "remove",
- };
- static inline int
- netifd_extdev_create(struct extdev_device *edev, struct blob_attr *msg)
- {
- D(DEVICE, "create %s '%s' at external device handler\n", edev->dev.type->name,
- edev->dev.ifname);
- return netifd_extdev_invoke(edev->etype->peer_id, __extdev_methods[METHOD_CREATE], msg,
- NULL, NULL);
- }
- static inline int
- netifd_extdev_reload(struct extdev_device *edev, struct blob_attr *msg)
- {
- D(DEVICE, "reload %s '%s' at external device handler\n", edev->dev.type->name,
- edev->dev.ifname);
- return netifd_extdev_invoke(edev->etype->peer_id, __extdev_methods[METHOD_RELOAD], msg,
- NULL, NULL);
- }
- static inline int
- netifd_extdev_free(struct extdev_device *edev, struct blob_attr *msg)
- {
- D(DEVICE, "delete %s '%s' with external device handler\n", edev->dev.type->name,
- edev->dev.ifname);
- return netifd_extdev_invoke(edev->etype->peer_id, __extdev_methods[METHOD_FREE], msg,
- NULL, NULL);
- }
- static inline int
- netifd_extdev_prepare(struct extdev_bridge *ebr, struct blob_attr *msg)
- {
- D(DEVICE, "prepare %s bridge '%s' at external device handler\n", ebr->edev.dev.type->name,
- ebr->edev.dev.ifname);
- return netifd_extdev_invoke(ebr->edev.etype->peer_id,
- __extdev_methods[METHOD_HOTPLUG_PREPARE], msg, NULL, NULL);
- }
- static inline int
- netifd_extdev_add(struct extdev_bridge *ebr, struct blob_attr *msg)
- {
- D(DEVICE, "add a member to %s bridge '%s' at external device handler\n",
- ebr->edev.dev.type->name, ebr->edev.dev.ifname);
- return netifd_extdev_invoke(ebr->edev.etype->peer_id,
- __extdev_methods[METHOD_HOTPLUG_ADD], msg,NULL, NULL);
- }
- static inline int
- netifd_extdev_remove(struct extdev_bridge *ebr, struct blob_attr *msg)
- {
- D(DEVICE, "remove a member from %s bridge '%s' at external device handler\n",
- ebr->edev.dev.type->name, ebr->edev.dev.ifname);
- return netifd_extdev_invoke(ebr->edev.etype->peer_id,
- __extdev_methods[METHOD_HOTPLUG_REMOVE], msg, NULL, NULL);
- }
- static inline void
- extdev_invocation_error(int error, const char *method, const char *devname)
- {
- netifd_log_message(L_CRIT, "'%s' failed for '%s': %s\n",
- method, devname, ubus_strerror(error));
- }
- static struct ubus_method extdev_ubus_obj_methods[] = {};
- static struct ubus_object_type extdev_ubus_object_type =
- UBUS_OBJECT_TYPE("netifd_extdev", extdev_ubus_obj_methods);
- static int
- extdev_lookup_id(struct extdev_type *etype)
- {
- int ret = UBUS_STATUS_UNKNOWN_ERROR;
- if (!etype || !etype->name)
- goto error;
- ret = ubus_lookup_id(ubus_ctx, etype->name, &etype->peer_id);
- if (ret)
- goto error;
- return 0;
- error:
- netifd_log_message(L_CRIT, "Could not find '%s' ubus ID: %s\n",
- etype->name, ubus_strerror(ret));
- return ret;
- }
- static int
- extdev_ext_ubus_obj_wait(struct ubus_event_handler *h)
- {
- return ubus_register_event_handler(ubus_ctx, h, "ubus.object.add");
- }
- static int
- extdev_subscribe(struct extdev_type *etype)
- {
- int ret;
- ret = extdev_lookup_id(etype);
- if (ret) {
- etype->subscribed = false;
- return ret;
- }
- ret = ubus_subscribe(ubus_ctx, &etype->ubus_sub, etype->peer_id);
- if (ret) {
- etype->subscribed = false;
- extdev_ext_ubus_obj_wait(&etype->obj_wait);
- } else {
- netifd_log_message(L_NOTICE, "subscribed to external device handler '%s'\n",
- etype->name);
- etype->subscribed = true;
- }
- return ret;
- }
- static void
- extdev_wait_ev_cb(struct ubus_context *ctx, struct ubus_event_handler *ev_handler,
- const char *type, struct blob_attr *msg)
- {
- static const struct blobmsg_policy wait_policy = {
- "path", BLOBMSG_TYPE_STRING
- };
- struct blob_attr *attr;
- const char *path;
- struct extdev_type *etype;
- etype = container_of(ev_handler, struct extdev_type, obj_wait);
- if (strcmp(type, "ubus.object.add"))
- return;
- blobmsg_parse(&wait_policy, 1, &attr, blob_data(msg), blob_len(msg));
- if (!attr)
- return;
- path = blobmsg_data(attr);
- if (strcmp(etype->name, path))
- return;
- extdev_subscribe(etype);
- }
- static int
- extdev_bridge_disable_interface(struct extdev_bridge *ebr)
- {
- int ret;
- if (!ebr->active)
- return 0;
- blob_buf_init(&b, 0);
- blobmsg_add_string(&b, "name", ebr->edev.dev.ifname);
- ret = netifd_extdev_free(&ebr->edev, b.head);
- if (ret && ret != UBUS_STATUS_NOT_FOUND)
- goto error;
- ebr->active = false;
- return 0;
- error:
- extdev_invocation_error(ret, __extdev_methods[METHOD_FREE], ebr->edev.dev.ifname);
- return ret;
- }
- static int
- extdev_bridge_enable_interface(struct extdev_bridge *ebr)
- {
- int ret;
- if (ebr->active)
- return 0;
- ret = netifd_extdev_create(&ebr->edev, ebr->config);
- if (ret)
- goto error;
- ebr->active = true;
- return 0;
- error:
- extdev_invocation_error(ret, __extdev_methods[METHOD_CREATE], ebr->edev.dev.ifname);
- return ret;
- }
- static int
- extdev_bridge_enable_member(struct extdev_bridge_member *ubm)
- {
- int ret;
- struct extdev_bridge *ebr = ubm->parent_br;
- D(DEVICE, "%s enable member %s\n", ebr->edev.dev.ifname, ubm->name);
- if (!ubm->present)
- return 0;
- ret = extdev_bridge_enable_interface(ebr);
- if (ret)
- goto error;
- ret = device_claim(&ubm->dev_usr);
- if (ret < 0)
- goto error;
- blob_buf_init(&b, 0);
- blobmsg_add_string(&b, "bridge", ebr->edev.dev.ifname);
- blobmsg_add_string(&b, "member", ubm->dev_usr.dev->ifname);
- /* use hotplug add as addif equivalent. Maybe we need a dedicated ubus
- * method on the external handler for this sort of operation. */
- ret = netifd_extdev_add(ebr, b.head);
- if (ret) {
- extdev_invocation_error(ret, __extdev_methods[METHOD_HOTPLUG_ADD],
- ubm->dev_usr.dev->ifname);
- goto error;
- }
- device_set_present(&ebr->edev.dev, true);
- device_broadcast_event(&ebr->edev.dev, DEV_EVENT_TOPO_CHANGE);
- return 0;
- error:
- D(DEVICE, "%s: failed to enable member '%s'\n", ebr->edev.dev.ifname, ubm->name);
- ebr->n_failed++;
- ubm->present = false;
- ebr->n_present--;
- return ret;
- }
- static int
- extdev_bridge_disable_member(struct extdev_bridge_member *ubm)
- {
- int ret;
- struct extdev_bridge *ebr = ubm->parent_br;
- if (!ubm->present)
- return 0;
- D(DEVICE, "%s disable member %s\n", ubm->parent_br->edev.dev.ifname, ubm->name);
- blob_buf_init(&b, 0);
- blobmsg_add_string(&b, "bridge", ebr->edev.dev.ifname);
- blobmsg_add_string(&b, "member", ubm->dev_usr.dev->ifname);
- /* use hotplug remove as delif equivalent. Maybe we need a dedicated
- * ubus method on the external handler for this sort of operation. */
- ret = netifd_extdev_remove(ebr, b.head);
- /* continue in case of NOT FOUND since we're trying to remove anyway */
- if (ret && ret != UBUS_STATUS_NOT_FOUND)
- goto error;
- device_release(&ubm->dev_usr);
- device_broadcast_event(&ebr->edev.dev, DEV_EVENT_TOPO_CHANGE);
- return 0;
- error:
- extdev_invocation_error(ret, __extdev_methods[METHOD_HOTPLUG_REMOVE],
- ubm->dev_usr.dev->ifname);
- return ret;
- }
- static int
- extdev_bridge_set_down(struct extdev_bridge *ebr)
- {
- D(DEVICE, "set %s bridge %s down\n", ebr->edev.dev.type->name, ebr->edev.dev.ifname);
- struct extdev_bridge_member *ubm;
- ebr->set_state(&ebr->edev.dev, false);
- vlist_for_each_element(&ebr->members, ubm, node)
- extdev_bridge_disable_member(ubm);
- extdev_bridge_disable_interface(ebr);
- return 0;
- }
- static void
- extdev_bridge_check_retry(struct extdev_bridge *ebr)
- {
- if (!ebr->n_failed)
- return;
- uloop_timeout_set(&ebr->retry, 200);
- }
- static int
- extdev_bridge_set_up(struct extdev_bridge *ebr)
- {
- D(DEVICE, "set %s bridge %s up\n", ebr->edev.dev.type->name, ebr->edev.dev.ifname);
- struct extdev_bridge_member *ubm;
- int ret;
- if (!ebr->n_present) {
- if (!ebr->force_active)
- return -ENOENT;
- ret = extdev_bridge_enable_interface(ebr);
- if (ret)
- return ret;
- }
- ebr->n_failed = 0;
- vlist_for_each_element(&ebr->members, ubm, node)
- extdev_bridge_enable_member(ubm);
- extdev_bridge_check_retry(ebr);
- if (!ebr->force_active && !ebr->n_present) {
- extdev_bridge_disable_interface(ebr);
- device_set_present(&ebr->edev.dev, false);
- return -ENOENT;
- }
- return 0;
- }
- static int
- extdev_bridge_set_state(struct device *dev, bool up)
- {
- struct extdev_bridge *ebr;
- if (!dev->type->bridge_capability)
- return -1;
- ebr = container_of(dev, struct extdev_bridge, edev.dev);
- if (up)
- return extdev_bridge_set_up(ebr);
- else
- return extdev_bridge_set_down(ebr);
- }
- static void
- extdev_bridge_remove_member(struct extdev_bridge_member *member)
- {
- struct extdev_bridge *ebr = member->parent_br;
- if (!member->present)
- return;
- if (ebr->edev.dev.active)
- extdev_bridge_disable_member(member);
- member->present = false;
- ebr->n_present--;
- if (ebr->empty)
- return;
- ebr->force_active = false;
- if (ebr->n_present == 0)
- device_set_present(&ebr->edev.dev, false);
- }
- static void
- extdev_bridge_member_cb(struct device_user *usr, enum device_event event)
- {
- int ret;
- struct extdev_bridge_member *ubm;
- struct extdev_bridge *ebr;
- ubm = container_of(usr, struct extdev_bridge_member, dev_usr);
- ebr = ubm->parent_br;
- switch (event) {
- case DEV_EVENT_ADD:
- assert(!ubm->present);
- ubm->present = true;
- ebr->n_present++;
- /* if this member is the first one that is brought up,
- * create the bridge at the external device handler */
- if (ebr->n_present == 1) {
- ret = netifd_extdev_create(&ebr->edev, ebr->config);
- if (ret)
- goto error;
- ebr->active = true;
- ret = ebr->set_state(&ebr->edev.dev, true);
- if (ret < 0)
- extdev_bridge_set_down(ebr);
- device_set_present(&ebr->edev.dev, true);
- }
- extdev_bridge_enable_member(ubm);
- break;
- case DEV_EVENT_REMOVE:
- if (usr->hotplug) {
- vlist_delete(&ebr->members, &ubm->node);
- return;
- }
- if (ubm->present)
- extdev_bridge_remove_member(ubm);
- break;
- default:
- break;
- }
- return;
- error:
- netifd_log_message(L_CRIT, "Failed to create %s bridge %s: %s\n",
- ebr->edev.dev.type->name, ebr->edev.dev.ifname, ubus_strerror(ret));
- ubm->present = false;
- ebr->n_present--;
- }
- static void
- __bridge_enable_members(struct extdev_bridge *ebr)
- {
- struct extdev_bridge_member *cur;
- ebr->n_failed = 0;
- vlist_for_each_element(&ebr->members, cur, node) {
- if (cur->present)
- continue;
- if (!cur->dev_usr.dev->present)
- continue;
- cur->present = true;
- ebr->n_present++;
- extdev_bridge_enable_member(cur);
- }
- }
- static void
- extdev_bridge_retry_enable_members(struct uloop_timeout *timeout)
- {
- struct extdev_bridge *ebr = container_of(timeout, struct extdev_bridge, retry);
- D(DEVICE, "%s retry enable members\n", ebr->edev.dev.ifname);
- __bridge_enable_members(ebr);
- }
- static struct extdev_bridge_member *
- extdev_bridge_create_member(struct extdev_bridge *ebr, struct device *dev)
- {
- struct extdev_bridge_member *ubm;
- char *name;
- ubm = calloc_a(sizeof(*ubm), &name, strlen(dev->ifname) + 1);
- if (!ubm)
- return NULL;
- ubm->parent_br = ebr;
- ubm->name = name;
- strcpy(name, dev->ifname);
- ubm->dev_usr.dev = dev;
- ubm->dev_usr.cb = extdev_bridge_member_cb;
- vlist_add(&ebr->members, &ubm->node, ubm->name);
- /* Need to look up the bridge member again as the above
- * created pointer will be freed in case the bridge member
- * already existed */
- ubm = vlist_find(&ebr->members, dev->ifname, ubm, node);
- if (!ubm)
- return NULL;
- return ubm;
- }
- static void
- extdev_bridge_add_member(struct extdev_bridge *ebr, const char *name)
- {
- D(DEVICE, "%s add member %s\n", ebr->edev.dev.ifname, name);
- struct device *dev;
- dev = device_get(name, 1);
- if (!dev)
- return;
- extdev_bridge_create_member(ebr, dev);
- }
- /* TODO: how to handle vlan arg? */
- static int
- extdev_hotplug_add(struct device *ebr_dev, struct device *ebm_dev, struct blob_attr *vlan)
- {
- D(DEVICE, "%s hotplug add member %s\n", ebr_dev->ifname, ebm_dev->ifname);
- struct extdev_bridge *ebr;
- struct extdev_bridge_member *ubm;
- if (!ebr_dev->type->bridge_capability)
- return UBUS_STATUS_NOT_SUPPORTED;
- ebr = container_of(ebr_dev, struct extdev_bridge, edev.dev);
- if (!ebr->edev.etype->subscribed)
- return UBUS_STATUS_NOT_FOUND;
- ubm = extdev_bridge_create_member(ebr, ebm_dev);
- if (!ubm)
- return UBUS_STATUS_UNKNOWN_ERROR;
- device_broadcast_event(&ebr->edev.dev, DEV_EVENT_TOPO_CHANGE);
- return 0;
- }
- static int
- extdev_hotplug_remove(struct device *dev, struct device *member, struct blob_attr *vlan)
- {
- struct extdev_bridge *ebr;
- struct extdev_bridge_member *ubm;
- if (!dev->type->bridge_capability)
- return UBUS_STATUS_NOT_SUPPORTED;
- ebr = container_of(dev, struct extdev_bridge, edev.dev);
- if (!ebr->edev.etype->subscribed)
- return UBUS_STATUS_NOT_FOUND;
- ubm = vlist_find(&ebr->members, member->ifname, ubm, node);
- if (!ubm)
- return UBUS_STATUS_NOT_FOUND;
- vlist_delete(&ebr->members, &ubm->node);
- extdev_bridge_remove_member(ubm);
- return 0;
- }
- static int
- extdev_hotplug_prepare(struct device *dev, struct device **bridge_dev)
- {
- struct extdev_bridge *ebr;
- int ret;
- if (!dev->type->bridge_capability)
- return UBUS_STATUS_NOT_SUPPORTED;
- if (bridge_dev)
- *bridge_dev = dev;
- ebr = container_of(dev, struct extdev_bridge, edev.dev);
- blob_buf_init(&b, 0);
- blobmsg_add_string(&b, "name", dev->ifname);
- ret = netifd_extdev_prepare(ebr, b.head);
- if (ret)
- goto error;
- ebr->force_active = true;
- device_set_present(&ebr->edev.dev, true);
- return 0;
- error:
- extdev_invocation_error(ret, __extdev_methods[METHOD_HOTPLUG_PREPARE], dev->ifname);
- return ret;
- }
- static void
- extdev_bridge_free_member(struct extdev_bridge_member *ubm)
- {
- struct device *dev = ubm->dev_usr.dev;
- extdev_bridge_remove_member(ubm);
- device_remove_user(&ubm->dev_usr);
- if (dev->present) {
- device_set_present(dev, false);
- device_set_present(dev, true);
- }
- free(ubm);
- }
- static void
- extdev_bridge_member_update(struct vlist_tree *tree, struct vlist_node *node_new,
- struct vlist_node *node_old)
- {
- struct extdev_bridge_member *ubm;
- struct device *dev;
- if (node_new) {
- ubm = container_of(node_new, struct extdev_bridge_member, node);
- if (node_old) {
- free(ubm);
- return;
- }
- dev = ubm->dev_usr.dev;
- ubm->dev_usr.dev = NULL;
- device_add_user(&ubm->dev_usr, dev);
- }
- if (node_old) {
- ubm = container_of(node_old, struct extdev_bridge_member, node);
- extdev_bridge_free_member(ubm);
- }
- }
- static void
- bridge_dependency_retry(struct uloop_timeout *timeout)
- {
- struct extdev_bridge *ebr;
- ebr = container_of(timeout, struct extdev_bridge, edev.retry);
- __bridge_reload(ebr, NULL);
- }
- static void
- __buf_add_all(struct blob_attr *attr)
- {
- struct blob_attr *cur;
- int rem;
- blobmsg_for_each_attr(cur, attr, rem)
- blobmsg_add_field(&b, blobmsg_type(cur), blobmsg_name(cur), blobmsg_data(cur),
- blobmsg_data_len(cur));
- }
- enum {
- BRIDGE_EMPTY,
- BRIDGE_IFNAMES,
- BRIDGE_DEPENDS_ON,
- __BRIDGE_MAX
- };
- static const struct blobmsg_policy brpol[__BRIDGE_MAX] = {
- [BRIDGE_EMPTY] = { "empty", BLOBMSG_TYPE_BOOL },
- [BRIDGE_IFNAMES] = { "ifname", BLOBMSG_TYPE_ARRAY },
- [BRIDGE_DEPENDS_ON] = { "depends_on", BLOBMSG_TYPE_STRING },
- };
- static enum dev_change_type
- __do_bridge_reload(struct extdev_bridge *ebr, struct blob_attr *config)
- {
- void *cfg_table;
- int ret;
- blob_buf_init(&b, 0);
- cfg_table = blobmsg_open_table(&b, "old");
- __buf_add_all(ebr->config);
- blobmsg_close_table(&b, cfg_table);
- cfg_table = blobmsg_open_table(&b, "new");
- __buf_add_all(config);
- blobmsg_close_table(&b, cfg_table);
- ret = netifd_extdev_reload(&ebr->edev, b.head);
- if (ret) {
- netifd_log_message(L_WARNING, "%s config reload failed: %s\n",
- ebr->edev.dev.ifname, ubus_strerror(ret));
- return DEV_CONFIG_RECREATE;
- } else {
- return DEV_CONFIG_RESTART;
- }
- }
- static enum dev_change_type
- __bridge_reload(struct extdev_bridge *ebr, struct blob_attr *config)
- {
- int n_params = ebr->edev.dev.type->config_params->n_params;
- struct blob_attr *tb[__BRIDGE_MAX];
- const struct uci_blob_param_list *config_params;
- const struct blobmsg_policy *pol;
- struct blob_attr *old_tb[n_params], *brtb[n_params];
- enum dev_change_type change = DEV_CONFIG_APPLIED;
- struct device *dev;
- unsigned long diff = 0;
- if (config) {
- config = blob_memdup(config);
- blobmsg_parse(brpol, __BRIDGE_MAX, tb, blobmsg_data(config), blobmsg_len(config));
- ebr->edev.dep_name = blobmsg_get_string(tb[BRIDGE_DEPENDS_ON]);
- if (tb[BRIDGE_EMPTY] && blobmsg_get_bool(tb[BRIDGE_EMPTY]))
- ebr->empty = true;
- if (ebr->config) {
- config_params = ebr->edev.dev.type->config_params;
- pol = config_params->params;
- blobmsg_parse(pol, n_params, old_tb, blobmsg_data(ebr->config),
- blobmsg_len(ebr->config));
- blobmsg_parse(pol, n_params, brtb, blobmsg_data(config), blobmsg_len
- (config));
- diff = 0;
- uci_blob_diff(brtb, old_tb, config_params, &diff);
- if (diff) {
- if (diff & ~(1 << BRIDGE_IFNAMES)) {
- change = DEV_CONFIG_RESTART;
- } else {
- change = __do_bridge_reload(ebr, config);
- }
- free(ebr->config);
- }
- }
- ebr->ifnames = tb[BRIDGE_IFNAMES];
- ebr->config = config;
- }
- if (ebr->edev.dep_name) {
- dev = device_get(ebr->edev.dep_name, 0);
- if (!(dev && dev->current_config)) {
- D(DEVICE, "%s: cannot yet init config since dependency '%s' is not ready\n",
- ebr->edev.dev.ifname, ebr->edev.dep_name);
- ebr->edev.retry.cb = bridge_dependency_retry;
- uloop_timeout_set(&ebr->edev.retry, 200);
- return DEV_CONFIG_RESTART;
- }
- }
- __bridge_config_init(ebr);
- ebr->edev.dev.config_pending = false;
- uloop_timeout_cancel(&ebr->edev.retry);
- return change;
- }
- static enum dev_change_type
- __reload(struct extdev_device *edev, struct blob_attr *config)
- {
- unsigned long diff = 0;
- struct uci_blob_param_list *params;
- params = edev->etype->config_params;
- struct blob_attr *tb[params->n_params];
- struct blob_attr *old_tb[params->n_params];
- blobmsg_parse(params->params, params->n_params, tb, blobmsg_data(config),
- blobmsg_len(config));
- blobmsg_parse(params->params, params->n_params, old_tb, blobmsg_data(edev->dev.config),
- blobmsg_len(edev->dev.config));
- uci_blob_diff(tb, old_tb, edev->etype->config_params, &diff);
- if (!diff)
- return DEV_CONFIG_NO_CHANGE;
- // TODO: make reload ubus call with old and new config
- device_set_present(&edev->dev, false);
- device_set_present(&edev->dev, true);
- return DEV_CONFIG_APPLIED;
- }
- static enum dev_change_type
- extdev_reload(struct device *dev, struct blob_attr *config)
- {
- struct extdev_type *etype;
- struct extdev_device *edev;
- struct extdev_bridge *ebr;
- etype = container_of(dev->type, struct extdev_type, handler);
- if (!etype->subscribed)
- return DEV_CONFIG_NO_CHANGE;
- edev = container_of(dev, struct extdev_device, dev);
- if (dev->type->bridge_capability) {
- ebr = container_of(edev, struct extdev_bridge, edev);
- return __bridge_reload(ebr, config);
- } else {
- return __reload(edev, config);
- }
- }
- static struct device*
- __create(const char *name, struct device_type *type, struct blob_attr *config)
- {
- struct extdev_device *edev;
- struct extdev_type *etype;
- int ret;
- etype = container_of(type, struct extdev_type, handler);
- edev = calloc(1, sizeof(struct extdev_device));
- if (!edev)
- return NULL;
- ret = device_init(&edev->dev, type, name);
- if (ret)
- goto error;
- edev->etype = etype;
- ret = netifd_extdev_create(edev, config);
- if (ret)
- goto inv_error;
- edev->dev.config_pending = false;
- return &edev->dev;
- inv_error:
- extdev_invocation_error(ret, __extdev_methods[METHOD_CREATE], name);
- error:
- free(edev->dev.config);
- device_cleanup(&edev->dev);
- free(edev);
- netifd_log_message(L_WARNING, "Failed to create %s %s\n", type->name, name);
- return NULL;
- }
- static const struct device_hotplug_ops extdev_hotplug_ops = {
- .prepare = extdev_hotplug_prepare,
- .add = extdev_hotplug_add,
- .del = extdev_hotplug_remove
- };
- static struct device*
- __bridge_create(const char *name, struct device_type *devtype, struct blob_attr *config)
- {
- struct extdev_bridge *ebr;
- ebr = calloc(1, sizeof(*ebr));
- if (!ebr)
- return NULL;
- device_init(&ebr->edev.dev, devtype, name);
- ebr->edev.dev.config_pending = true;
- ebr->retry.cb = extdev_bridge_retry_enable_members;
- ebr->edev.etype = container_of(devtype, struct extdev_type, handler);
- ebr->set_state = ebr->edev.dev.set_state;
- ebr->edev.dev.set_state = extdev_bridge_set_state;
- ebr->edev.dev.hotplug_ops = &extdev_hotplug_ops;
- vlist_init(&ebr->members, avl_strcmp, extdev_bridge_member_update);
- ebr->members.keep_old = true;
- __bridge_reload(ebr, config);
- return &ebr->edev.dev;
- }
- /* Device creation process:
- * For bridges without dependencies:
- * 1) The bridge state is initialized in netifd. Devices for the members are
- * created and added to the members vlist by config_init automatically.
- * 2) When the first bridge member device is brought up in
- * extdev_bridge_enable_member the 'create' call to the external device
- * handler is issued.
- * 3) After successful device creation the bridge is marked "present" and a
- * new attempt at adding the member is made.
- * For bridges with dependencies:
- * 1) The bridge state is initialized in netifd. If a dependency is expressed
- * via the 'depends_on' UCI option and the dependency is not ready (i.e. it
- * does not exist or config_pending == true) the call to
- * __bridge_config_init() is postponed and a retry timer is started. Retries
- * happen until the dependency is ready. Then, __bridge_config_init() gets
- * called and the process continues as with bridges without dependencies
- * For regular devices:
- * 1) The device structure is created in netifd.
- * 2) config_init is called automatically which issues the 'create' call to the
- * external device handler.
- */
- static struct device *
- extdev_create(const char *name, struct device_type *devtype, struct blob_attr *config)
- {
- struct extdev_type *etype = container_of(devtype, struct extdev_type, handler);
- if (!etype->subscribed)
- return NULL;
- if (devtype->bridge_capability)
- return __bridge_create(name, devtype, config);
- else
- return __create(name, devtype, config);
- }
- static void
- extdev_free(struct device *dev)
- {
- struct extdev_type *etype;
- struct extdev_device *edev;
- struct extdev_bridge *ebr;
- int ret;
- etype = container_of(dev->type, struct extdev_type, handler);
- edev = container_of(dev, struct extdev_device, dev);
- if (!etype->subscribed)
- return;
- blob_buf_init(&b, 0);
- blobmsg_add_string(&b, "name", dev->ifname);
- ret = netifd_extdev_free(edev, b.head);
- if (ret && ret != UBUS_STATUS_NOT_FOUND)
- goto error;
- if (dev->type->bridge_capability) {
- ebr = container_of(dev, struct extdev_bridge, edev.dev);
- vlist_flush_all(&ebr->members);
- // vlist_flush_all(&dev->vlans); TODO: do we need this?
- free(ebr->config);
- free(ebr);
- }
- return;
- error:
- extdev_invocation_error(ret, __extdev_methods[METHOD_FREE],
- dev->ifname);
- }
- static void
- __bridge_config_init(struct extdev_bridge *ebr)
- {
- int rem, ret;
- struct blob_attr *cur;
- if (ebr->empty) {
- ebr->force_active = true;
- ret = netifd_extdev_create(&ebr->edev, ebr->config);
- if (ret)
- goto error;
- device_set_present(&ebr->edev.dev, true);
- }
- ebr->n_failed = 0;
- vlist_update(&ebr->members);
- if (ebr->ifnames) {
- blobmsg_for_each_attr(cur, ebr->ifnames, rem)
- extdev_bridge_add_member(ebr, blobmsg_data(cur));
- }
- vlist_flush(&ebr->members);
- extdev_bridge_check_retry(ebr);
- return;
- error:
- fprintf(stderr, "Failed to init config for '%s': %s\n", ebr->edev.dev.ifname,
- ubus_strerror(ret));
- }
- static void
- extdev_config_init(struct device *dev)
- {
- struct extdev_type *etype;
- struct extdev_bridge *ebr;
- etype = container_of(dev->type, struct extdev_type, handler);
- if (!etype->subscribed)
- return;
- if (dev->type->bridge_capability) {
- ebr = container_of(dev, struct extdev_bridge, edev.dev);
- __bridge_config_init(ebr);
- }
- }
- static void
- extdev_buf_add_list(struct blob_attr *attr, int len, const char *name,
- struct blob_buf *buf, bool array)
- {
- struct blob_attr *cur;
- struct blobmsg_hdr *hdr;
- void *list;
- int type;
- if (array)
- list = blobmsg_open_array(buf, name);
- else
- list = blobmsg_open_table(buf, name);
- blobmsg_for_each_attr(cur, attr, len) {
- hdr = blob_data(cur);
- type = blobmsg_type(cur);
- switch (type) {
- case BLOBMSG_TYPE_STRING:
- blobmsg_add_string(buf, (char *) hdr->name,
- blobmsg_get_string(cur));
- break;
- case BLOBMSG_TYPE_TABLE:
- case BLOBMSG_TYPE_ARRAY:
- extdev_buf_add_list(blobmsg_data(cur), blobmsg_data_len(cur),
- (char *) hdr->name, buf, type == BLOBMSG_TYPE_ARRAY);
- break;
- case BLOBMSG_TYPE_INT64:
- blobmsg_add_u64(buf, (char *) hdr->name, blobmsg_get_u64(cur));
- break;
- case BLOBMSG_TYPE_INT32:
- blobmsg_add_u32(buf, (char *) hdr->name, blobmsg_get_u32(cur));
- break;
- case BLOBMSG_TYPE_INT16:
- blobmsg_add_u16(buf, (char *) hdr->name, blobmsg_get_u16(cur));
- break;
- case BLOBMSG_TYPE_INT8:
- blobmsg_add_u8(buf, (char *) hdr->name, blobmsg_get_u8(cur));
- break;
- default:
- break;
- }
- }
- if (array)
- blobmsg_close_array(buf, list);
- else
- blobmsg_close_table(buf, list);
- }
- static void
- add_parsed_data(struct blob_attr **tb, const struct blobmsg_policy *policy, int n_params,
- struct blob_buf *buf)
- {
- for (int i = 0; i < n_params; i++) {
- if (!tb[i])
- continue;
- switch (policy[i].type) {
- case BLOBMSG_TYPE_STRING:
- blobmsg_add_string(buf, policy[i].name, blobmsg_get_string(tb[i]));
- break;
- case BLOBMSG_TYPE_ARRAY:
- case BLOBMSG_TYPE_TABLE:
- extdev_buf_add_list(blobmsg_data(tb[i]), blobmsg_data_len(tb[i]),
- policy[i].name, buf, policy[i].type == BLOBMSG_TYPE_ARRAY);
- break;
- case BLOBMSG_TYPE_INT64:
- blobmsg_add_u64(buf, policy[i].name, blobmsg_get_u64(tb[i]));
- break;
- case BLOBMSG_TYPE_INT32:
- blobmsg_add_u32(buf, policy[i].name, blobmsg_get_u32(tb[i]));
- break;
- case BLOBMSG_TYPE_INT16:
- blobmsg_add_u16(buf, policy[i].name, blobmsg_get_u16(tb[i]));
- break;
- case BLOBMSG_TYPE_INT8:
- blobmsg_add_u8(buf, policy[i].name, blobmsg_get_u8(tb[i]));
- break;
- default:
- break;
- }
- }
- }
- struct dump_data {
- const struct device *dev;
- struct blob_buf *buf;
- };
- static void
- dump_cb(struct ubus_request *req, int type, struct blob_attr *reply)
- {
- struct dump_data *data;
- struct extdev_type *etype;
- const struct blobmsg_policy *info_policy;
- int n_params;
- struct blob_buf *buf;
- data = req->priv;
- etype = container_of(data->dev->type, struct extdev_type, handler);
- info_policy = etype->info_params->params;
- n_params = etype->info_params->n_params;
- buf = data->buf;
- struct blob_attr *tb[n_params];
- blobmsg_parse(info_policy, n_params, tb, blobmsg_data(reply), blobmsg_len(reply));
- add_parsed_data(tb, info_policy, n_params, buf);
- }
- static void
- extdev_dump(const char *method, struct device *dev, struct blob_buf *buf)
- {
- static struct dump_data data;
- struct extdev_type *etype;
- etype = container_of(dev->type, struct extdev_type, handler);
- if (!etype->subscribed)
- return;
- data.dev = dev;
- data.buf = buf;
- blob_buf_init(&b, 0);
- blobmsg_add_string(&b, "name", dev->ifname);
- netifd_extdev_invoke(etype->peer_id, method, b.head, dump_cb, &data);
- }
- static void
- extdev_dump_info(struct device *dev, struct blob_buf *buf)
- {
- extdev_dump(__extdev_methods[METHOD_DUMP_INFO], dev, buf);
- }
- static void
- extdev_dump_stats(struct device *dev, struct blob_buf *buf)
- {
- extdev_dump(__extdev_methods[METHOD_DUMP_STATS], dev, buf);
- }
- static void
- extdev_ext_handler_remove_cb(struct ubus_context *ctx,
- struct ubus_subscriber *obj, uint32_t id)
- {
- struct extdev_type *etype;
- etype = container_of(obj, struct extdev_type, ubus_sub);
- netifd_log_message(L_NOTICE, "%s: external device handler "
- "'%s' disappeared. Waiting for it to re-appear.\n",
- etype->handler.name, etype->name);
- etype->peer_id = 0;
- etype->subscribed = false;
- extdev_ext_ubus_obj_wait(&etype->obj_wait);
- }
- static void
- extdev_add_devtype(const char *cfg_file, const char *tname, const char *ubus_name,
- bool bridge_capability, const char *br_prefix, json_object *cfg_obj,
- json_object *info_obj, json_object *stats_obj)
- {
- static const char *OBJ_PREFIX = "network.device.";
- struct extdev_type *etype;
- struct device_type *devtype;
- char *ubus_obj_name, *devtype_name, *ext_dev_handler_name, *name_prefix;
- struct uci_blob_param_list *config_params, *info_params, *stats_params;
- int ret;
- etype = calloc_a(sizeof(*etype),
- &ubus_obj_name, strlen(OBJ_PREFIX) + strlen(ubus_name) + 1,
- &devtype_name, strlen(tname) + 1,
- &ext_dev_handler_name, strlen(ubus_name) + 1,
- &config_params, sizeof(struct uci_blob_param_list),
- &info_params, sizeof(struct uci_blob_param_list),
- &stats_params, sizeof(struct uci_blob_param_list));
- if (!etype)
- return;
- etype->config_params = config_params;
- etype->info_params = info_params;
- etype->name = strcpy(ext_dev_handler_name, ubus_name);
- devtype = &etype->handler;
- devtype->name = strcpy(devtype_name, tname);
- devtype->create = extdev_create;
- devtype->free = extdev_free;
- devtype->config_init = extdev_config_init;
- devtype->reload = extdev_reload;
- devtype->dump_info = extdev_dump_info;
- devtype->dump_stats = extdev_dump_stats;
- devtype->bridge_capability = bridge_capability;
- devtype->config_params = etype->config_params;
- if (bridge_capability) {
- name_prefix = malloc(strlen(br_prefix) + 1);
- if (!name_prefix)
- goto error;
- strcpy(name_prefix, br_prefix);
- devtype->name_prefix = name_prefix;
- }
- /* subscribe to external device handler */
- sprintf(ubus_obj_name, "%s%s", OBJ_PREFIX, ubus_name);
- etype->ubus_sub.obj.name = ubus_obj_name;
- etype->ubus_sub.obj.type = &extdev_ubus_object_type;
- ret = ubus_register_subscriber(ubus_ctx, &etype->ubus_sub);
- if (ret) {
- fprintf(stderr, "Failed to register subscriber object '%s'\n",
- etype->ubus_sub.obj.name);
- goto error;
- }
- etype->obj_wait.cb = extdev_wait_ev_cb;
- etype->ubus_sub.remove_cb = extdev_ext_handler_remove_cb;
- extdev_subscribe(etype);
- /* parse config params from JSON object */
- etype->config_strbuf = netifd_handler_parse_config(etype->config_params, cfg_obj);
- if (!etype->config_strbuf)
- goto error;
- /* parse info dump params from JSON object */
- if (!info_obj) {
- devtype->dump_info = NULL;
- } else {
- etype->info_strbuf = netifd_handler_parse_config(etype->info_params, info_obj);
- if (!etype->info_strbuf)
- devtype->dump_info = NULL;
- }
- /* parse statistics dump params from JSON object */
- if (!stats_obj) {
- devtype->dump_stats = NULL;
- } else {
- etype->stats_strbuf = netifd_handler_parse_config(etype->stats_params, stats_obj);
- if (!etype->stats_strbuf)
- devtype->dump_stats = NULL;
- }
- ret = device_type_add(devtype);
- if (ret)
- goto config_error;
- return;
- config_error:
- free(etype->config_strbuf);
- free(etype->info_strbuf);
- free(etype->stats_strbuf);
- error:
- fprintf(stderr, "Failed to create device handler for device"
- "type '%s' from file '%s'\n", tname, cfg_file);
- free(ubus_obj_name);
- free(devtype_name);
- free(etype);
- }
- /* create extdev device handler stubs from JSON description */
- void
- extdev_init(void)
- {
- confdir_fd = netifd_open_subdir("extdev-config");
- if (confdir_fd < 0)
- return;
- netifd_init_extdev_handlers(confdir_fd, extdev_add_devtype);
- }
|