1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375 |
- /*
- * 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", 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", 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", 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", 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",
- 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",
- 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", 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'", 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", 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", 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", 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", 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", 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", 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;
- size_t 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",
- 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 ret;
- size_t rem;
- 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, size_t 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);
- }
|