xfrmi: introduce XFRM interfaces support

XFRM interfaces were introduced in kernel 4.19.
This commit adds link support for these interfaces.

Signed-off-by: Eyal Birger <eyal.birger@gmail.com>

1 files changed, 312 insertions, 0 deletions

diff --git a/lib/route/link/xfrmi.c b/lib/route/link/xfrmi.c
new file mode 100644
index 0000000..65533a6
--- /dev/null
+++ b/lib/route/link/xfrmi.c
@@ -0,0 +1,312 @@
+/*
+ * lib/route/link/xfrmi.c	 XFRMI Link Info
+ *
+ *	This library is free software; you can redistribute it and/or
+ *	modify it under the terms of the GNU Lesser General Public
+ *	License as published by the Free Software Foundation version 2.1
+ *	of the License.
+ *
+ * Copyright (c) 2019 Eyal Birger <eyal.birger@gmail.com>
+ *
+ * Based on lib/route/link/ipvti.c
+ */
+
+/**
+ * @ingroup link
+ * @defgroup xfrmi XFRMI
+ * xfrmi link module
+ *
+ * @details
+ * \b Link Type Name: "xfrmi"
+ *
+ * @route_doc{link_xfrmi, XFRMI Documentation}
+ *
+ * @{
+ */
+
+#include <netlink-private/netlink.h>
+#include <netlink/netlink.h>
+#include <netlink/attr.h>
+#include <netlink/utils.h>
+#include <netlink/object.h>
+#include <netlink/route/rtnl.h>
+#include <netlink/route/link/xfrmi.h>
+#include <netlink-private/route/link/api.h>
+
+#define XFRMI_ATTR_LINK  (1 << 0)
+#define XFRMI_ATTR_IF_ID (1 << 1)
+
+#define XFRMI_LINK_TYPE_NAME "xfrm"
+
+struct xfrmi_info {
+	uint32_t link;
+	uint32_t if_id;
+	uint32_t xfrmi_mask;
+};
+
+static	struct nla_policy xfrmi_policy[IFLA_XFRM_MAX + 1] = {
+	[IFLA_XFRM_LINK]  = { .type = NLA_U32 },
+	[IFLA_XFRM_IF_ID] = { .type = NLA_U32 },
+};
+
+static int xfrmi_alloc(struct rtnl_link *link)
+{
+	struct xfrmi_info *xfrmi;
+
+	if (link->l_info)
+		memset(link->l_info, 0, sizeof(*xfrmi));
+	else {
+		xfrmi = calloc(1, sizeof(*xfrmi));
+		if (!xfrmi)
+			return -NLE_NOMEM;
+
+		link->l_info = xfrmi;
+	}
+
+	return 0;
+}
+
+static int xfrmi_parse(struct rtnl_link *link, struct nlattr *data,
+		       struct nlattr *xstats)
+{
+	struct nlattr *tb[IFLA_XFRM_MAX + 1];
+	struct xfrmi_info *xfrmi;
+	int err;
+
+	NL_DBG(3, "Parsing XFRMI link info\n");
+
+	err = nla_parse_nested(tb, IFLA_XFRM_MAX, data, xfrmi_policy);
+	if (err < 0)
+		goto errout;
+
+	err = xfrmi_alloc(link);
+	if (err < 0)
+		goto errout;
+
+	xfrmi = link->l_info;
+
+	if (tb[IFLA_XFRM_LINK]) {
+		xfrmi->link = nla_get_u32(tb[IFLA_XFRM_LINK]);
+		xfrmi->xfrmi_mask |= XFRMI_ATTR_LINK;
+	}
+
+	if (tb[IFLA_XFRM_IF_ID]) {
+		xfrmi->if_id = nla_get_u32(tb[IFLA_XFRM_IF_ID]);
+		xfrmi->xfrmi_mask |= XFRMI_ATTR_IF_ID;
+	}
+
+	err = 0;
+
+errout:
+	return err;
+}
+
+static int xfrmi_put_attrs(struct nl_msg *msg, struct rtnl_link *link)
+{
+	struct xfrmi_info *xfrmi = link->l_info;
+	struct nlattr *data;
+
+	data = nla_nest_start(msg, IFLA_INFO_DATA);
+	if (!data)
+		return -NLE_MSGSIZE;
+
+	if (xfrmi->xfrmi_mask & XFRMI_ATTR_LINK)
+		NLA_PUT_U32(msg, IFLA_XFRM_LINK, xfrmi->link);
+
+	if (xfrmi->xfrmi_mask & XFRMI_ATTR_IF_ID)
+		NLA_PUT_U32(msg, IFLA_XFRM_IF_ID, xfrmi->if_id);
+
+	nla_nest_end(msg, data);
+
+nla_put_failure:
+	return 0;
+}
+
+static void xfrmi_free(struct rtnl_link *link)
+{
+	struct xfrmi_info *xfrmi = link->l_info;
+
+	free(xfrmi);
+	link->l_info = NULL;
+}
+
+static void xfrmi_dump_line(struct rtnl_link *link, struct nl_dump_params *p)
+{
+	nl_dump(p, "xfrmi : %s", link->l_name);
+}
+
+static void xfrmi_dump_details(struct rtnl_link *link, struct nl_dump_params *p)
+{
+	struct xfrmi_info *xfrmi = link->l_info;
+
+	if (xfrmi->xfrmi_mask & XFRMI_ATTR_LINK) {
+		struct rtnl_link *parent;
+		char *name;
+
+		nl_dump(p, "      link ");
+
+		name = NULL;
+		parent = link_lookup(link->ce_cache, xfrmi->link);
+		if (parent)
+			name = rtnl_link_get_name(parent);
+
+		if (name)
+			nl_dump_line(p, "%s\n", name);
+		else
+			nl_dump_line(p, "%u\n", xfrmi->link);
+	}
+
+	if (xfrmi->xfrmi_mask & XFRMI_ATTR_IF_ID) {
+		nl_dump(p, "      if_id   ");
+		nl_dump_line(p, "%x\n", xfrmi->if_id);
+	}
+}
+
+static int xfrmi_clone(struct rtnl_link *dst, struct rtnl_link *src)
+{
+	struct xfrmi_info *xfrmi_dst, *xfrmi_src = src->l_info;
+	int err;
+
+	dst->l_info = NULL;
+
+	err = rtnl_link_set_type(dst, XFRMI_LINK_TYPE_NAME);
+	if (err < 0)
+		return err;
+
+	xfrmi_dst = dst->l_info;
+
+	if (!xfrmi_dst || !xfrmi_src)
+		BUG();
+
+	memcpy(xfrmi_dst, xfrmi_src, sizeof(struct xfrmi_info));
+
+	return 0;
+}
+
+static struct rtnl_link_info_ops xfrmi_info_ops = {
+	.io_name                = XFRMI_LINK_TYPE_NAME,
+	.io_alloc               = xfrmi_alloc,
+	.io_parse               = xfrmi_parse,
+	.io_dump = {
+		[NL_DUMP_LINE]  = xfrmi_dump_line,
+		[NL_DUMP_DETAILS] = xfrmi_dump_details,
+	},
+	.io_clone               = xfrmi_clone,
+	.io_put_attrs           = xfrmi_put_attrs,
+	.io_free                = xfrmi_free,
+};
+
+#define IS_XFRMI_LINK_ASSERT(link) do { \
+		if ((link)->l_info_ops != &xfrmi_info_ops) { \
+			APPBUG("Link is not a xfrmi link. set type \"xfrmi\" first."); \
+			return -NLE_OPNOTSUPP; \
+		} \
+	} while(0)
+
+struct rtnl_link *rtnl_link_xfrmi_alloc(void)
+{
+	struct rtnl_link *link;
+	int err;
+
+	link = rtnl_link_alloc();
+	if (!link)
+		return NULL;
+
+	err = rtnl_link_set_type(link, XFRMI_LINK_TYPE_NAME);
+	if (err < 0) {
+		rtnl_link_put(link);
+		return NULL;
+	}
+
+	return link;
+}
+
+/**
+ * Check if link is a XFRMI link
+ * @arg link            Link object
+ *
+ * @return True if link is a IXFRMI link, otherwise 0 is returned.
+ */
+int rtnl_link_is_xfrmi(struct rtnl_link *link)
+{
+	return link->l_info_ops && !strcmp(link->l_info_ops->io_name,
+					   XFRMI_LINK_TYPE_NAME);
+}
+
+/**
+ * Set XFRMI link interface index
+ * @arg link            Link object
+ * @arg index           interface index
+ *
+ * @return 0 on success or a negative error code
+ */
+int rtnl_link_xfrmi_set_link(struct rtnl_link *link, uint32_t index)
+{
+	struct xfrmi_info *xfrmi = link->l_info;
+
+	IS_XFRMI_LINK_ASSERT(link);
+
+	xfrmi->link = index;
+	xfrmi->xfrmi_mask |= XFRMI_ATTR_LINK;
+
+	return 0;
+}
+
+/**
+ * Get XFRMI link interface index
+ * @arg link            Link object
+ *
+ * @return interface index
+ */
+uint32_t rtnl_link_xfrmi_get_link(struct rtnl_link *link)
+{
+	struct xfrmi_info *xfrmi = link->l_info;
+
+	IS_XFRMI_LINK_ASSERT(link);
+
+	return xfrmi->link;
+}
+
+/**
+ * Set XFRMI if_id
+ * @arg link            Link object
+ * @arg if_id            xfrm if_id
+ *
+ * @return 0 on success or a negative error code
+ */
+int rtnl_link_xfrmi_set_if_id(struct rtnl_link *link, uint32_t if_id)
+{
+	struct xfrmi_info *xfrmi = link->l_info;
+
+	IS_XFRMI_LINK_ASSERT(link);
+
+	xfrmi->if_id = if_id;
+	xfrmi->xfrmi_mask |= XFRMI_ATTR_IF_ID;
+
+	return 0;
+}
+
+/**
+ * Get XFRMI if_id
+ * @arg link            Link object
+ *
+ * @return if_id
+ */
+uint32_t rtnl_link_xfrmi_get_if_id(struct rtnl_link *link)
+{
+	struct xfrmi_info *xfrmi = link->l_info;
+
+	IS_XFRMI_LINK_ASSERT(link);
+
+	return xfrmi->if_id;
+}
+
+static void __init xfrmi_init(void)
+{
+	rtnl_link_register_info(&xfrmi_info_ops);
+}
+
+static void __exit xfrmi_exit(void)
+{
+	rtnl_link_unregister_info(&xfrmi_info_ops);
+}