X-Git-Url: http://git.archive.openwrt.org/?p=project%2Fnetifd.git;a=blobdiff_plain;f=interface.c;h=3820050eff038616e454250b47efecc30fe30700;hp=d45f2d5120d0ed93b1e7d51b4a5e4a379e7c69c3;hb=2152229c45f470a14dee33507b331ac38055e062;hpb=5d1fff7af6f77c9bf0d46572c7af563cd9fc55b3

diff --git a/interface.c b/interface.c
index d45f2d5..3820050 100644
--- a/interface.c
+++ b/interface.c
@@ -3,44 +3,131 @@
 #include <stdio.h>
 
 #include "netifd.h"
+#include "device.h"
+#include "interface.h"
+#include "interface-ip.h"
+#include "proto.h"
 #include "ubus.h"
+#include "config.h"
 
-LIST_HEAD(interfaces);
+struct vlist_tree interfaces;
 
-static int interface_event(struct interface *iface, enum interface_event ev)
+enum {
+	IFACE_ATTR_IFNAME,
+	IFACE_ATTR_PROTO,
+	IFACE_ATTR_AUTO,
+	IFACE_ATTR_MAX
+};
+
+static const struct blobmsg_policy iface_attrs[IFACE_ATTR_MAX] = {
+	[IFACE_ATTR_PROTO] = { .name = "proto", .type = BLOBMSG_TYPE_STRING },
+	[IFACE_ATTR_IFNAME] = { .name = "ifname", .type = BLOBMSG_TYPE_STRING },
+	[IFACE_ATTR_AUTO] = { .name = "auto", .type = BLOBMSG_TYPE_BOOL },
+};
+
+const struct config_param_list interface_attr_list = {
+	.n_params = IFACE_ATTR_MAX,
+	.params = iface_attrs,
+};
+
+static void
+interface_clear_errors(struct interface *iface)
 {
-	if (!iface->state || !iface->state->event)
-		return 0;
+	struct interface_error *error, *tmp;
 
-	return iface->state->event(iface, iface->state, ev);
+	list_for_each_entry_safe(error, tmp, &iface->errors, list) {
+		list_del(&error->list);
+		free(error);
+	}
 }
 
-static void
-__set_interface_up(struct interface *iface)
+void interface_add_error(struct interface *iface, const char *subsystem,
+			 const char *code, const char **data, int n_data)
 {
-	if (iface->up)
-		return;
+	struct interface_error *error;
+	int i, len = 0;
+	int *datalen = NULL;
+	char *dest;
+
+	if (n_data) {
+		len = n_data * sizeof(char *);
+		datalen = alloca(len);
+		for (i = 0; i < n_data; i++) {
+			datalen[i] = strlen(data[i]) + 1;
+			len += datalen[i];
+		}
+	}
 
-	if (claim_device(iface->main_dev.dev) < 0)
+	error = calloc(1, sizeof(*error) + sizeof(char *) + len);
+	if (!error)
 		return;
 
-	if (interface_event(iface, IFEV_UP) < 0) {
-		release_device(iface->main_dev.dev);
-		return;
+	list_add_tail(&error->list, &iface->errors);
+	error->subsystem = subsystem;
+	error->code = code;
+
+	dest = (char *) &error->data[n_data + 1];
+	for (i = 0; i < n_data; i++) {
+		error->data[i] = dest;
+		memcpy(dest, data[i], datalen[i]);
+		dest += datalen[i];
 	}
+	error->data[n_data] = NULL;
+}
 
-	iface->up = true;
+static void
+interface_event(struct interface *iface, enum interface_event ev)
+{
+	interface_queue_event(iface, ev);
 }
 
 static void
-__set_interface_down(struct interface *iface)
+mark_interface_down(struct interface *iface)
 {
-	if (!iface->up)
+	vlist_flush_all(&iface->proto_addr);
+	vlist_flush_all(&iface->proto_route);
+	if (iface->main_dev.dev)
+		device_release(&iface->main_dev);
+	iface->state = IFS_DOWN;
+}
+
+static int
+__interface_set_up(struct interface *iface)
+{
+	int ret;
+
+	if (iface->state != IFS_DOWN)
+		return 0;
+
+	if (iface->main_dev.dev) {
+		ret = device_claim(&iface->main_dev);
+		if (ret)
+			return ret;
+	}
+
+	iface->state = IFS_SETUP;
+	ret = interface_proto_event(iface->proto, PROTO_CMD_SETUP, false);
+	if (ret) {
+		mark_interface_down(iface);
+		return ret;
+	}
+
+	return 0;
+
+}
+
+static void
+__interface_set_down(struct interface *iface, bool force)
+{
+	interface_clear_errors(iface);
+
+	if (iface->state == IFS_DOWN ||
+		iface->state == IFS_TEARDOWN)
 		return;
 
-	iface->up = false;
+	iface->state = IFS_TEARDOWN;
 	interface_event(iface, IFEV_DOWN);
-	release_device(iface->main_dev.dev);
+	interface_proto_event(iface->proto, PROTO_CMD_TEARDOWN, force);
 }
 
 static void
@@ -61,109 +148,326 @@ interface_cb(struct device_user *dep, enum device_event ev)
 		return;
 	}
 
-	if (iface->active == new_state)
+	interface_set_available(iface, new_state);
+}
+
+void
+interface_set_available(struct interface *iface, bool new_state)
+{
+	if (iface->available == new_state)
 		return;
 
-	iface->active = new_state;
+	D(INTERFACE, "Interface '%s', available=%d\n", iface->name, new_state);
+	iface->available = new_state;
 
 	if (new_state) {
-		if (iface->autostart)
-			__set_interface_up(iface);
+		if (iface->autostart && !config_init)
+			interface_set_up(iface);
 	} else
-		__set_interface_down(iface);
+		__interface_set_down(iface, true);
 }
 
-struct interface *
-alloc_interface(const char *name)
+static void
+interface_claim_device(struct interface *iface)
 {
-	struct interface *iface;
+	struct device *dev;
 
-	iface = get_interface(name);
-	if (iface)
-		return iface;
+	if (iface->proto_handler &&
+		!(iface->proto_handler->flags & PROTO_FLAG_NODEV)) {
+		dev = device_get(iface->ifname, true);
+		if (dev)
+			device_add_user(&iface->main_dev, dev);
+	}
+}
 
-	iface = calloc(1, sizeof(*iface));
-	iface->main_dev.cb = interface_cb;
-	iface->l3_iface = &iface->main_dev;
-	strncpy(iface->name, name, sizeof(iface->name) - 1);
-	list_add(&iface->list, &interfaces);
-	netifd_ubus_add_interface(iface);
 
-	return iface;
+static void
+interface_cleanup(struct interface *iface)
+{
+	interface_clear_errors(iface);
+	if (iface->main_dev.dev)
+		device_remove_user(&iface->main_dev);
+	interface_set_proto_state(iface, NULL);
 }
 
-void
-free_interface(struct interface *iface)
+static void
+interface_do_free(struct interface *iface)
 {
+	interface_cleanup(iface);
+	free(iface->config);
 	netifd_ubus_remove_interface(iface);
-	list_del(&iface->list);
-	if (iface->state && iface->state->free)
-		iface->state->free(iface, iface->state);
+	avl_delete(&interfaces.avl, &iface->node.avl);
 	free(iface);
 }
 
-struct interface *
-get_interface(const char *name)
+static void
+interface_do_reload(struct interface *iface)
 {
-	struct interface *iface;
+	interface_cleanup(iface);
+
+	interface_claim_device(iface);
+	proto_init_interface(iface, iface->config);
+
+	if (iface->autostart && !config_init)
+		interface_set_up(iface);
+}
+
+static void
+interface_handle_config_change(struct interface *iface)
+{
+	switch(iface->config_state) {
+	case IFC_NORMAL:
+		break;
+	case IFC_RELOAD:
+		interface_do_reload(iface);
+		break;
+	case IFC_REMOVE:
+		interface_do_free(iface);
+		break;
+	}
+}
+
+static void
+interface_proto_cb(struct interface_proto_state *state, enum interface_proto_event ev)
+{
+	struct interface *iface = state->iface;
+
+	switch (ev) {
+	case IFPEV_UP:
+		if (iface->state != IFS_SETUP)
+			return;
 
-	list_for_each_entry(iface, &interfaces, list) {
-		if (!strcmp(iface->name, name))
-			return iface;
+		iface->state = IFS_UP;
+		interface_event(iface, IFEV_UP);
+		break;
+	case IFPEV_DOWN:
+		if (iface->state == IFS_DOWN)
+			return;
+
+		mark_interface_down(iface);
+		interface_handle_config_change(iface);
+		break;
+	case IFPEV_LINK_LOST:
+		if (iface->state != IFS_UP)
+			return;
+
+		iface->state = IFS_SETUP;
+		interface_event(iface, IFEV_DOWN);
+		break;
 	}
-	return NULL;
+}
+
+void interface_set_proto_state(struct interface *iface, struct interface_proto_state *state)
+{
+	if (iface->proto) {
+		iface->proto->free(iface->proto);
+		iface->proto = NULL;
+	}
+	iface->state = IFS_DOWN;
+	iface->proto = state;
+	if (!state)
+		return;
+
+	state->proto_event = interface_proto_cb;
+	state->iface = iface;
 }
 
 void
-interface_remove_link(struct interface *iface, struct device *llif)
+interface_init(struct interface *iface, const char *name,
+	       struct blob_attr *config)
 {
-	struct device *dev = iface->main_dev.dev;
+	struct blob_attr *tb[IFACE_ATTR_MAX];
+	struct blob_attr *cur;
+	const char *proto_name = NULL;
+
+	strncpy(iface->name, name, sizeof(iface->name) - 1);
+	INIT_LIST_HEAD(&iface->errors);
+	INIT_LIST_HEAD(&iface->hotplug_list);
+
+	iface->main_dev.cb = interface_cb;
+	iface->l3_dev = &iface->main_dev;
+
+	blobmsg_parse(iface_attrs, IFACE_ATTR_MAX, tb,
+		      blob_data(config), blob_len(config));
+
+	if ((cur = tb[IFACE_ATTR_PROTO]))
+		proto_name = blobmsg_data(cur);
 
-	if (dev && dev->hotplug_ops) {
-		dev->hotplug_ops->del(dev, llif);
+	proto_attach_interface(iface, proto_name);
+
+	if ((cur = tb[IFACE_ATTR_AUTO]))
+		iface->autostart = blobmsg_get_bool(cur);
+	else
+		iface->autostart = true;
+	iface->config_autostart = iface->autostart;
+}
+
+void
+interface_add(struct interface *iface, struct blob_attr *config)
+{
+	struct blob_attr *tb[IFACE_ATTR_MAX];
+	struct blob_attr *cur;
+
+	blobmsg_parse(iface_attrs, IFACE_ATTR_MAX, tb,
+		      blob_data(config), blob_len(config));
+
+	if ((cur = tb[IFACE_ATTR_IFNAME]))
+		iface->ifname = blobmsg_data(cur);
+
+	iface->config = config;
+	vlist_add(&interfaces, &iface->node);
+}
+
+void
+interface_remove_link(struct interface *iface, struct device *dev)
+{
+	struct device *mdev = iface->main_dev.dev;
+
+	if (mdev && mdev->hotplug_ops) {
+		mdev->hotplug_ops->del(mdev, dev);
 		return;
 	}
 
-	remove_device_user(&iface->main_dev);
+	device_remove_user(&iface->main_dev);
 }
 
 int
-interface_add_link(struct interface *iface, struct device *llif)
+interface_add_link(struct interface *iface, struct device *dev)
 {
-	struct device *dev = iface->main_dev.dev;
+	struct device *mdev = iface->main_dev.dev;
 
-	if (dev && dev->hotplug_ops)
-		return dev->hotplug_ops->add(dev, llif);
+	if (mdev && mdev->hotplug_ops)
+		return mdev->hotplug_ops->add(mdev, dev);
 
 	if (iface->main_dev.dev)
 		interface_remove_link(iface, NULL);
 
-	add_device_user(&iface->main_dev, llif);
+	device_add_user(&iface->main_dev, dev);
 
 	return 0;
 }
 
 int
-set_interface_up(struct interface *iface)
+interface_set_up(struct interface *iface)
 {
 	iface->autostart = true;
 
-	if (iface->up || !iface->active)
+	if (!iface->available) {
+		interface_add_error(iface, "interface", "NO_DEVICE", NULL, 0);
 		return -1;
+	}
 
-	__set_interface_up(iface);
-	return 0;
+	if (iface->state != IFS_DOWN)
+		return 0;
+
+	return __interface_set_up(iface);
 }
 
 int
-set_interface_down(struct interface *iface)
+interface_set_down(struct interface *iface)
 {
-	iface->autostart = false;
+	if (!iface) {
+		vlist_for_each_element(&interfaces, iface, node)
+			__interface_set_down(iface, false);
+	} else {
+		iface->autostart = false;
+		__interface_set_down(iface, false);
+	}
 
-	if (!iface->up)
-		return -1;
+	return 0;
+}
+
+void
+interface_start_pending(void)
+{
+	struct interface *iface;
 
-	__set_interface_down(iface);
+	vlist_for_each_element(&interfaces, iface, node) {
+		if (iface->available && iface->autostart)
+			interface_set_up(iface);
+	}
+}
 
-	return 0;
+static void
+set_config_state(struct interface *iface, enum interface_config_state s)
+{
+	iface->config_state = s;
+	if (iface->state == IFS_DOWN)
+		interface_handle_config_change(iface);
+	else
+		__interface_set_down(iface, false);
+}
+
+static void
+interface_change_config(struct interface *if_old, struct interface *if_new)
+{
+	struct blob_attr *old_config = if_old->config;
+	const char *old_ifname = if_old->ifname;
+	const struct proto_handler *proto = if_old->proto_handler;
+
+	interface_clear_errors(if_old);
+	if_old->config = if_new->config;
+	if (!if_old->config_autostart && if_new->config_autostart)
+		if_old->autostart = true;
+
+	if_old->config_autostart = if_new->config_autostart;
+	if_old->ifname = if_new->ifname;
+	if_old->proto_handler = if_new->proto_handler;
+
+	if (strcmp(old_ifname, if_new->ifname) != 0 ||
+		proto != if_new->proto_handler) {
+		D(INTERFACE, "Reload interface '%s' because of ifname/proto change\n",
+		  if_old->name);
+		goto reload;
+	}
+
+	if (!proto->config_params)
+		D(INTERFACE, "No config parameters for interface '%s'\n",
+		  if_old->name);
+	else if (!config_check_equal(old_config, if_new->config,
+				proto->config_params)) {
+		D(INTERFACE, "Reload interface '%s because of config changes\n",
+		  if_old->name);
+		goto reload;
+	}
+
+	goto out;
+
+reload:
+	set_config_state(if_old, IFC_RELOAD);
+out:
+	free(old_config);
+	free(if_new);
+}
+
+static void
+interface_update(struct vlist_tree *tree, struct vlist_node *node_new,
+		 struct vlist_node *node_old)
+{
+	struct interface *if_old = container_of(node_old, struct interface, node);
+	struct interface *if_new = container_of(node_new, struct interface, node);
+
+	if (node_old && node_new) {
+		D(INTERFACE, "Update interface '%s'\n", if_new->name);
+		interface_change_config(if_old, if_new);
+	} else if (node_old) {
+		D(INTERFACE, "Remove interface '%s'\n", if_old->name);
+		set_config_state(if_old, IFC_REMOVE);
+	} else if (node_new) {
+		D(INTERFACE, "Create interface '%s'\n", if_new->name);
+		interface_claim_device(if_new);
+		proto_init_interface(if_new, if_new->config);
+		interface_ip_init(if_new);
+		netifd_ubus_add_interface(if_new);
+	}
+}
+
+
+static void __init
+interface_init_list(void)
+{
+	vlist_init(&interfaces, avl_strcmp, interface_update,
+		   struct interface, node, name);
+	interfaces.keep_old = true;
+	interfaces.no_delete = true;
 }