usteer: Initial import

Signed-off-by: Felix Fietkau <nbd@nbd.name>
2018-03-21 16:40:05 +01:00
commit d10731f806
23 changed files with 4512 additions and 0 deletions
--- a/netifd.c
+++ b/netifd.c
@@ -0,0 +1,154 @@
+/*
+ *   This program is free software; you can redistribute it and/or modify
+ *   it under the terms of the GNU General Public License as published by
+ *   the Free Software Foundation; either version 2 of the License.
+ *
+ *   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.
+ *
+ *   You should have received a copy of the GNU General Public License
+ *   along with this program; if not, write to the Free Software
+ *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
+ *
+ *   Copyright (C) 2020 embedd.ch 
+ *   Copyright (C) 2020 Felix Fietkau <nbd@nbd.name> 
+ *   Copyright (C) 2020 John Crispin <john@phrozen.org> 
+ */
+
+#include "usteer.h"
+#include "node.h"
+
+static struct blob_buf b;
+
+static void
+netifd_parse_interface_config(struct usteer_local_node *ln, struct blob_attr *msg)
+{
+	static const struct blobmsg_policy policy = {
+		.name = "maxassoc",
+		.type = BLOBMSG_TYPE_INT32,
+	};
+	struct blob_attr *cur;
+	int val = 0;
+
+	blobmsg_parse(&policy, 1, &cur, blobmsg_data(msg), blobmsg_data_len(msg));
+	if (cur)
+		val = blobmsg_get_u32(cur);
+
+	ln->node.max_assoc = val;
+	ln->netifd.status_complete = true;
+}
+
+static void
+netifd_parse_interface(struct usteer_local_node *ln, struct blob_attr *msg)
+{
+	enum {
+		N_IF_CONFIG,
+		N_IF_NAME,
+		__N_IF_MAX
+	};
+	static const struct blobmsg_policy policy[__N_IF_MAX] = {
+		[N_IF_CONFIG] = { .name = "config", .type = BLOBMSG_TYPE_TABLE },
+		[N_IF_NAME] = { .name = "ifname", .type = BLOBMSG_TYPE_STRING },
+	};
+	struct blob_attr *tb[__N_IF_MAX];
+
+	if (blobmsg_type(msg) != BLOBMSG_TYPE_TABLE)
+		return;
+
+	blobmsg_parse(policy, __N_IF_MAX, tb, blobmsg_data(msg), blobmsg_data_len(msg));
+	if (!tb[N_IF_CONFIG] || !tb[N_IF_NAME])
+		return;
+
+	if (strcmp(blobmsg_get_string(tb[N_IF_NAME]), ln->iface) != 0)
+		return;
+
+	netifd_parse_interface_config(ln, tb[N_IF_CONFIG]);
+}
+
+static void
+netifd_parse_radio(struct usteer_local_node *ln, struct blob_attr *msg)
+{
+	static const struct blobmsg_policy policy = {
+		.name = "interfaces",
+		.type = BLOBMSG_TYPE_ARRAY,
+	};
+	struct blob_attr *cur, *iface;
+	int rem;
+
+	if (blobmsg_type(msg) != BLOBMSG_TYPE_TABLE)
+		return;
+
+	blobmsg_parse(&policy, 1, &iface, blobmsg_data(msg), blobmsg_data_len(msg));
+	if (!iface)
+		return;
+
+	blobmsg_for_each_attr(cur, iface, rem)
+		netifd_parse_interface(ln, cur);
+}
+
+static void
+netifd_status_cb(struct ubus_request *req, int type, struct blob_attr *msg)
+{
+	struct usteer_local_node *ln;
+	struct blob_attr *cur;
+	int rem;
+
+	ln = container_of(req, struct usteer_local_node, netifd.req);
+	ln->netifd.req_pending = false;
+
+	blobmsg_for_each_attr(cur, msg, rem)
+		netifd_parse_radio(ln, cur);
+}
+
+static void netifd_update_node(struct usteer_node *node)
+{
+	struct usteer_local_node *ln;
+	uint32_t id;
+
+	ln = container_of(node, struct usteer_local_node, node);
+	if (ln->netifd.status_complete)
+		return;
+
+	if (ln->netifd.req_pending)
+		ubus_abort_request(ubus_ctx, &ln->netifd.req);
+
+	if (ubus_lookup_id(ubus_ctx, "network.wireless", &id))
+		return;
+
+	blob_buf_init(&b, 0);
+	ubus_invoke_async(ubus_ctx, id, "status", b.head, &ln->netifd.req);
+	ln->netifd.req.data_cb = netifd_status_cb;
+	ubus_complete_request_async(ubus_ctx, &ln->netifd.req);
+	ln->netifd.req_pending = true;
+}
+
+static void netifd_init_node(struct usteer_node *node)
+{
+	struct usteer_local_node *ln;
+
+	ln = container_of(node, struct usteer_local_node, node);
+	ln->netifd.status_complete = false;
+	netifd_update_node(node);
+}
+
+static void netifd_free_node(struct usteer_node *node)
+{
+	struct usteer_local_node *ln;
+
+	ln = container_of(node, struct usteer_local_node, node);
+	if (ln->netifd.req_pending)
+		ubus_abort_request(ubus_ctx, &ln->netifd.req);
+}
+
+static struct usteer_node_handler netifd_handler = {
+	.init_node = netifd_init_node,
+	.update_node = netifd_update_node,
+	.free_node = netifd_free_node,
+};
+
+static void __usteer_init usteer_netifd_init(void)
+{
+	list_add(&netifd_handler.list, &node_handlers);
+}