Blame ip/iproute_lwtunnel.c

Packit d3f73b
/*
Packit d3f73b
 * iproute_lwtunnel.c
Packit d3f73b
 *
Packit d3f73b
 *		This program is free software; you can redistribute it and/or
Packit d3f73b
 *		modify it under the terms of the GNU General Public License
Packit d3f73b
 *		as published by the Free Software Foundation; either version
Packit d3f73b
 *		2 of the License, or (at your option) any later version.
Packit d3f73b
 *
Packit d3f73b
 * Authors:	Roopa Prabhu, <roopa@cumulusnetworks.com>
Packit d3f73b
 *		Thomas Graf <tgraf@suug.ch>
Packit d3f73b
 *
Packit d3f73b
 */
Packit d3f73b
Packit d3f73b
#include <stdio.h>
Packit d3f73b
#include <stdlib.h>
Packit d3f73b
#include <unistd.h>
Packit d3f73b
#include <fcntl.h>
Packit d3f73b
#include <string.h>
Packit d3f73b
#include <linux/ila.h>
Packit d3f73b
#include <linux/lwtunnel.h>
Packit d3f73b
#include <linux/mpls_iptunnel.h>
Packit d3f73b
#include <errno.h>
Packit d3f73b
Packit d3f73b
#include "rt_names.h"
Packit d3f73b
#include "bpf_util.h"
Packit d3f73b
#include "utils.h"
Packit d3f73b
#include "ip_common.h"
Packit d3f73b
#include "ila_common.h"
Packit d3f73b
Packit d3f73b
#include <linux/seg6.h>
Packit d3f73b
#include <linux/seg6_iptunnel.h>
Packit d3f73b
#include <linux/seg6_hmac.h>
Packit d3f73b
#include <linux/seg6_local.h>
Packit d3f73b
#include <linux/if_tunnel.h>
Packit d3f73b
Packit d3f73b
static const char *format_encap_type(int type)
Packit d3f73b
{
Packit d3f73b
	switch (type) {
Packit d3f73b
	case LWTUNNEL_ENCAP_MPLS:
Packit d3f73b
		return "mpls";
Packit d3f73b
	case LWTUNNEL_ENCAP_IP:
Packit d3f73b
		return "ip";
Packit d3f73b
	case LWTUNNEL_ENCAP_IP6:
Packit d3f73b
		return "ip6";
Packit d3f73b
	case LWTUNNEL_ENCAP_ILA:
Packit d3f73b
		return "ila";
Packit d3f73b
	case LWTUNNEL_ENCAP_BPF:
Packit d3f73b
		return "bpf";
Packit d3f73b
	case LWTUNNEL_ENCAP_SEG6:
Packit d3f73b
		return "seg6";
Packit d3f73b
	case LWTUNNEL_ENCAP_SEG6_LOCAL:
Packit d3f73b
		return "seg6local";
Packit d3f73b
	default:
Packit d3f73b
		return "unknown";
Packit d3f73b
	}
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static void encap_type_usage(void)
Packit d3f73b
{
Packit d3f73b
	int i;
Packit d3f73b
Packit d3f73b
	fprintf(stderr, "Usage: ip route ... encap TYPE [ OPTIONS ] [...]\n");
Packit d3f73b
Packit d3f73b
	for (i = 1; i <= LWTUNNEL_ENCAP_MAX; i++)
Packit d3f73b
		fprintf(stderr, "%s %s\n", format_encap_type(i),
Packit d3f73b
			i == 1 ? "TYPE := " : "      ");
Packit d3f73b
Packit d3f73b
	exit(-1);
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static int read_encap_type(const char *name)
Packit d3f73b
{
Packit d3f73b
	if (strcmp(name, "mpls") == 0)
Packit d3f73b
		return LWTUNNEL_ENCAP_MPLS;
Packit d3f73b
	else if (strcmp(name, "ip") == 0)
Packit d3f73b
		return LWTUNNEL_ENCAP_IP;
Packit d3f73b
	else if (strcmp(name, "ip6") == 0)
Packit d3f73b
		return LWTUNNEL_ENCAP_IP6;
Packit d3f73b
	else if (strcmp(name, "ila") == 0)
Packit d3f73b
		return LWTUNNEL_ENCAP_ILA;
Packit d3f73b
	else if (strcmp(name, "bpf") == 0)
Packit d3f73b
		return LWTUNNEL_ENCAP_BPF;
Packit d3f73b
	else if (strcmp(name, "seg6") == 0)
Packit d3f73b
		return LWTUNNEL_ENCAP_SEG6;
Packit d3f73b
	else if (strcmp(name, "seg6local") == 0)
Packit d3f73b
		return LWTUNNEL_ENCAP_SEG6_LOCAL;
Packit d3f73b
	else if (strcmp(name, "help") == 0)
Packit d3f73b
		encap_type_usage();
Packit d3f73b
Packit d3f73b
	return LWTUNNEL_ENCAP_NONE;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static void print_srh(FILE *fp, struct ipv6_sr_hdr *srh)
Packit d3f73b
{
Packit d3f73b
	int i;
Packit d3f73b
Packit d3f73b
	if (is_json_context())
Packit d3f73b
		open_json_array(PRINT_JSON, "segs");
Packit d3f73b
	else
Packit d3f73b
		fprintf(fp, "segs %d [ ", srh->first_segment + 1);
Packit d3f73b
Packit d3f73b
	for (i = srh->first_segment; i >= 0; i--)
Packit d3f73b
		print_color_string(PRINT_ANY, COLOR_INET6,
Packit d3f73b
				   NULL, "%s ",
Packit d3f73b
				   rt_addr_n2a(AF_INET6, 16, &srh->segments[i]));
Packit d3f73b
Packit d3f73b
	if (is_json_context())
Packit d3f73b
		close_json_array(PRINT_JSON, NULL);
Packit d3f73b
	else
Packit d3f73b
		fprintf(fp, "] ");
Packit d3f73b
Packit d3f73b
	if (sr_has_hmac(srh)) {
Packit d3f73b
		unsigned int offset = ((srh->hdrlen + 1) << 3) - 40;
Packit d3f73b
		struct sr6_tlv_hmac *tlv;
Packit d3f73b
Packit d3f73b
		tlv = (struct sr6_tlv_hmac *)((char *)srh + offset);
Packit d3f73b
		print_0xhex(PRINT_ANY, "hmac",
Packit d3f73b
			    "hmac %llX ", ntohl(tlv->hmackeyid));
Packit d3f73b
	}
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static const char *seg6_mode_types[] = {
Packit d3f73b
	[SEG6_IPTUN_MODE_INLINE]	= "inline",
Packit d3f73b
	[SEG6_IPTUN_MODE_ENCAP]		= "encap",
Packit d3f73b
	[SEG6_IPTUN_MODE_L2ENCAP]	= "l2encap",
Packit d3f73b
};
Packit d3f73b
Packit d3f73b
static const char *format_seg6mode_type(int mode)
Packit d3f73b
{
Packit d3f73b
	if (mode < 0 || mode > ARRAY_SIZE(seg6_mode_types))
Packit d3f73b
		return "<unknown>";
Packit d3f73b
Packit d3f73b
	return seg6_mode_types[mode];
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static int read_seg6mode_type(const char *mode)
Packit d3f73b
{
Packit d3f73b
	int i;
Packit d3f73b
Packit d3f73b
	for (i = 0; i < ARRAY_SIZE(seg6_mode_types); i++) {
Packit d3f73b
		if (strcmp(mode, seg6_mode_types[i]) == 0)
Packit d3f73b
			return i;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	return -1;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static void print_encap_seg6(FILE *fp, struct rtattr *encap)
Packit d3f73b
{
Packit d3f73b
	struct rtattr *tb[SEG6_IPTUNNEL_MAX+1];
Packit d3f73b
	struct seg6_iptunnel_encap *tuninfo;
Packit d3f73b
Packit d3f73b
	parse_rtattr_nested(tb, SEG6_IPTUNNEL_MAX, encap);
Packit d3f73b
Packit d3f73b
	if (!tb[SEG6_IPTUNNEL_SRH])
Packit d3f73b
		return;
Packit d3f73b
Packit d3f73b
	tuninfo = RTA_DATA(tb[SEG6_IPTUNNEL_SRH]);
Packit d3f73b
	print_string(PRINT_ANY, "mode",
Packit d3f73b
		     "mode %s ", format_seg6mode_type(tuninfo->mode));
Packit d3f73b
Packit d3f73b
	print_srh(fp, tuninfo->srh);
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static const char *seg6_action_names[SEG6_LOCAL_ACTION_MAX + 1] = {
Packit d3f73b
	[SEG6_LOCAL_ACTION_END]			= "End",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_X]		= "End.X",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_T]		= "End.T",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_DX2]		= "End.DX2",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_DX6]		= "End.DX6",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_DX4]		= "End.DX4",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_DT6]		= "End.DT6",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_DT4]		= "End.DT4",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_B6]		= "End.B6",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_B6_ENCAP]	= "End.B6.Encaps",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_BM]		= "End.BM",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_S]		= "End.S",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_AS]		= "End.AS",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_AM]		= "End.AM",
Packit d3f73b
	[SEG6_LOCAL_ACTION_END_BPF]		= "End.BPF",
Packit d3f73b
};
Packit d3f73b
Packit d3f73b
static const char *format_action_type(int action)
Packit d3f73b
{
Packit d3f73b
	if (action < 0 || action > SEG6_LOCAL_ACTION_MAX)
Packit d3f73b
		return "<invalid>";
Packit d3f73b
Packit d3f73b
	return seg6_action_names[action] ?: "<unknown>";
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static int read_action_type(const char *name)
Packit d3f73b
{
Packit d3f73b
	int i;
Packit d3f73b
Packit d3f73b
	for (i = 0; i < SEG6_LOCAL_ACTION_MAX + 1; i++) {
Packit d3f73b
		if (!seg6_action_names[i])
Packit d3f73b
			continue;
Packit d3f73b
Packit d3f73b
		if (strcmp(seg6_action_names[i], name) == 0)
Packit d3f73b
			return i;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	return SEG6_LOCAL_ACTION_UNSPEC;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static void print_encap_bpf_prog(FILE *fp, struct rtattr *encap,
Packit d3f73b
				 const char *str)
Packit d3f73b
{
Packit d3f73b
	struct rtattr *tb[LWT_BPF_PROG_MAX+1];
Packit d3f73b
	const char *progname = NULL;
Packit d3f73b
Packit d3f73b
	parse_rtattr_nested(tb, LWT_BPF_PROG_MAX, encap);
Packit d3f73b
Packit d3f73b
	if (tb[LWT_BPF_PROG_NAME])
Packit d3f73b
		progname = rta_getattr_str(tb[LWT_BPF_PROG_NAME]);
Packit d3f73b
Packit d3f73b
	if (is_json_context())
Packit d3f73b
		print_string(PRINT_JSON, str, NULL,
Packit d3f73b
			     progname ? : "<unknown>");
Packit d3f73b
	else {
Packit d3f73b
		fprintf(fp, "%s ", str);
Packit d3f73b
		if (progname)
Packit d3f73b
			fprintf(fp, "%s ", progname);
Packit d3f73b
	}
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static void print_encap_seg6local(FILE *fp, struct rtattr *encap)
Packit d3f73b
{
Packit d3f73b
	struct rtattr *tb[SEG6_LOCAL_MAX + 1];
Packit d3f73b
	int action;
Packit d3f73b
Packit d3f73b
	parse_rtattr_nested(tb, SEG6_LOCAL_MAX, encap);
Packit d3f73b
Packit d3f73b
	if (!tb[SEG6_LOCAL_ACTION])
Packit d3f73b
		return;
Packit d3f73b
Packit d3f73b
	action = rta_getattr_u32(tb[SEG6_LOCAL_ACTION]);
Packit d3f73b
Packit d3f73b
	print_string(PRINT_ANY, "action",
Packit d3f73b
		     "action %s ", format_action_type(action));
Packit d3f73b
Packit d3f73b
	if (tb[SEG6_LOCAL_SRH]) {
Packit d3f73b
		open_json_object("srh");
Packit d3f73b
		print_srh(fp, RTA_DATA(tb[SEG6_LOCAL_SRH]));
Packit d3f73b
		close_json_object();
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (tb[SEG6_LOCAL_TABLE])
Packit d3f73b
		print_uint(PRINT_ANY, "table",
Packit d3f73b
			   "table %u ", rta_getattr_u32(tb[SEG6_LOCAL_TABLE]));
Packit d3f73b
Packit d3f73b
	if (tb[SEG6_LOCAL_NH4]) {
Packit d3f73b
		print_string(PRINT_ANY, "nh4",
Packit d3f73b
			     "nh4 %s ", rt_addr_n2a_rta(AF_INET, tb[SEG6_LOCAL_NH4]));
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (tb[SEG6_LOCAL_NH6]) {
Packit d3f73b
		print_string(PRINT_ANY, "nh6",
Packit d3f73b
			     "nh6 %s ", rt_addr_n2a_rta(AF_INET6, tb[SEG6_LOCAL_NH6]));
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (tb[SEG6_LOCAL_IIF]) {
Packit d3f73b
		int iif = rta_getattr_u32(tb[SEG6_LOCAL_IIF]);
Packit d3f73b
Packit d3f73b
		print_string(PRINT_ANY, "iif",
Packit d3f73b
			     "iif %s ", ll_index_to_name(iif));
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (tb[SEG6_LOCAL_OIF]) {
Packit d3f73b
		int oif = rta_getattr_u32(tb[SEG6_LOCAL_OIF]);
Packit d3f73b
Packit d3f73b
		print_string(PRINT_ANY, "oif",
Packit d3f73b
			     "oif %s ", ll_index_to_name(oif));
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (tb[SEG6_LOCAL_BPF])
Packit d3f73b
		print_encap_bpf_prog(fp, tb[SEG6_LOCAL_BPF], "endpoint");
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static void print_encap_mpls(FILE *fp, struct rtattr *encap)
Packit d3f73b
{
Packit d3f73b
	struct rtattr *tb[MPLS_IPTUNNEL_MAX+1];
Packit d3f73b
Packit d3f73b
	parse_rtattr_nested(tb, MPLS_IPTUNNEL_MAX, encap);
Packit d3f73b
Packit d3f73b
	if (tb[MPLS_IPTUNNEL_DST])
Packit d3f73b
		print_string(PRINT_ANY, "dst", " %s ",
Packit d3f73b
			format_host_rta(AF_MPLS, tb[MPLS_IPTUNNEL_DST]));
Packit d3f73b
	if (tb[MPLS_IPTUNNEL_TTL])
Packit d3f73b
		print_uint(PRINT_ANY, "ttl", "ttl %u ",
Packit d3f73b
			rta_getattr_u8(tb[MPLS_IPTUNNEL_TTL]));
Packit d3f73b
}
Packit d3f73b
Packit Service 14c19c
static void lwtunnel_print_geneve_opts(struct rtattr *attr)
Packit Service 14c19c
{
Packit Service 14c19c
	struct rtattr *tb[LWTUNNEL_IP_OPT_GENEVE_MAX + 1];
Packit Service 14c19c
	struct rtattr *i = RTA_DATA(attr);
Packit Service 14c19c
	int rem = RTA_PAYLOAD(attr);
Packit Service 14c19c
	char *name = "geneve_opts";
Packit Service 14c19c
	int data_len, offset = 0;
Packit Service 14c19c
	char data[rem * 2 + 1];
Packit Service 14c19c
	__u16 class;
Packit Service 14c19c
	__u8 type;
Packit Service 14c19c
Packit Service 14c19c
	print_nl();
Packit Service 14c19c
	print_string(PRINT_FP, name, "\t%s ", name);
Packit Service 14c19c
	open_json_array(PRINT_JSON, name);
Packit Service 14c19c
Packit Service 14c19c
	while (rem) {
Packit Service 14c19c
		parse_rtattr(tb, LWTUNNEL_IP_OPT_GENEVE_MAX, i, rem);
Packit Service 14c19c
		class = rta_getattr_be16(tb[LWTUNNEL_IP_OPT_GENEVE_CLASS]);
Packit Service 14c19c
		type = rta_getattr_u8(tb[LWTUNNEL_IP_OPT_GENEVE_TYPE]);
Packit Service 14c19c
		data_len = RTA_PAYLOAD(tb[LWTUNNEL_IP_OPT_GENEVE_DATA]);
Packit Service 14c19c
		hexstring_n2a(RTA_DATA(tb[LWTUNNEL_IP_OPT_GENEVE_DATA]),
Packit Service 14c19c
			      data_len, data, sizeof(data));
Packit Service 14c19c
		offset += data_len + 20;
Packit Service 14c19c
		rem -= data_len + 20;
Packit Service 14c19c
		i = RTA_DATA(attr) + offset;
Packit Service 14c19c
Packit Service 14c19c
		open_json_object(NULL);
Packit Service 14c19c
		print_uint(PRINT_ANY, "class", "%u", class);
Packit Service 14c19c
		print_uint(PRINT_ANY, "type", ":%u", type);
Packit Service 14c19c
		if (rem)
Packit Service 14c19c
			print_string(PRINT_ANY, "data", ":%s,", data);
Packit Service 14c19c
		else
Packit Service 14c19c
			print_string(PRINT_ANY, "data", ":%s ", data);
Packit Service 14c19c
		close_json_object();
Packit Service 14c19c
	}
Packit Service 14c19c
Packit Service 14c19c
	close_json_array(PRINT_JSON, name);
Packit Service 14c19c
}
Packit Service 14c19c
Packit Service aad4f7
static void lwtunnel_print_vxlan_opts(struct rtattr *attr)
Packit Service aad4f7
{
Packit Service aad4f7
	struct rtattr *tb[LWTUNNEL_IP_OPT_VXLAN_MAX + 1];
Packit Service aad4f7
	struct rtattr *i = RTA_DATA(attr);
Packit Service aad4f7
	int rem = RTA_PAYLOAD(attr);
Packit Service aad4f7
	char *name = "vxlan_opts";
Packit Service aad4f7
	__u32 gbp;
Packit Service aad4f7
Packit Service aad4f7
	parse_rtattr(tb, LWTUNNEL_IP_OPT_VXLAN_MAX, i, rem);
Packit Service aad4f7
	gbp = rta_getattr_u32(tb[LWTUNNEL_IP_OPT_VXLAN_GBP]);
Packit Service aad4f7
Packit Service aad4f7
	print_nl();
Packit Service aad4f7
	print_string(PRINT_FP, name, "\t%s ", name);
Packit Service aad4f7
	open_json_array(PRINT_JSON, name);
Packit Service aad4f7
	open_json_object(NULL);
Packit Service aad4f7
	print_uint(PRINT_ANY, "gbp", "%u ", gbp);
Packit Service aad4f7
	close_json_object();
Packit Service aad4f7
	close_json_array(PRINT_JSON, name);
Packit Service aad4f7
}
Packit Service aad4f7
Packit Service cfda42
static void lwtunnel_print_erspan_opts(struct rtattr *attr)
Packit Service cfda42
{
Packit Service cfda42
	struct rtattr *tb[LWTUNNEL_IP_OPT_ERSPAN_MAX + 1];
Packit Service cfda42
	struct rtattr *i = RTA_DATA(attr);
Packit Service cfda42
	char *name = "erspan_opts";
Packit Service cfda42
	__u8 ver, hwid, dir;
Packit Service cfda42
	__u32 idx;
Packit Service cfda42
Packit Service cfda42
	parse_rtattr(tb, LWTUNNEL_IP_OPT_ERSPAN_MAX, i, RTA_PAYLOAD(attr));
Packit Service cfda42
	ver = rta_getattr_u8(tb[LWTUNNEL_IP_OPT_ERSPAN_VER]);
Packit Service cfda42
	if (ver == 1) {
Packit Service cfda42
		idx = rta_getattr_be32(tb[LWTUNNEL_IP_OPT_ERSPAN_INDEX]);
Packit Service cfda42
		dir = 0;
Packit Service cfda42
		hwid = 0;
Packit Service cfda42
	} else {
Packit Service cfda42
		idx = 0;
Packit Service cfda42
		dir = rta_getattr_u8(tb[LWTUNNEL_IP_OPT_ERSPAN_DIR]);
Packit Service cfda42
		hwid = rta_getattr_u8(tb[LWTUNNEL_IP_OPT_ERSPAN_HWID]);
Packit Service cfda42
	}
Packit Service cfda42
Packit Service cfda42
	print_nl();
Packit Service cfda42
	print_string(PRINT_FP, name, "\t%s ", name);
Packit Service cfda42
	open_json_array(PRINT_JSON, name);
Packit Service cfda42
	open_json_object(NULL);
Packit Service cfda42
	print_uint(PRINT_ANY, "ver", "%u", ver);
Packit Service cfda42
	print_uint(PRINT_ANY, "index", ":%u", idx);
Packit Service cfda42
	print_uint(PRINT_ANY, "dir", ":%u", dir);
Packit Service cfda42
	print_uint(PRINT_ANY, "hwid", ":%u ", hwid);
Packit Service cfda42
	close_json_object();
Packit Service cfda42
	close_json_array(PRINT_JSON, name);
Packit Service cfda42
}
Packit Service cfda42
Packit Service 14c19c
static void lwtunnel_print_opts(struct rtattr *attr)
Packit Service 14c19c
{
Packit Service 14c19c
	struct rtattr *tb_opt[LWTUNNEL_IP_OPTS_MAX + 1];
Packit Service 14c19c
Packit Service 14c19c
	parse_rtattr_nested(tb_opt, LWTUNNEL_IP_OPTS_MAX, attr);
Packit Service 14c19c
	if (tb_opt[LWTUNNEL_IP_OPTS_GENEVE])
Packit Service 14c19c
		lwtunnel_print_geneve_opts(tb_opt[LWTUNNEL_IP_OPTS_GENEVE]);
Packit Service aad4f7
	else if (tb_opt[LWTUNNEL_IP_OPTS_VXLAN])
Packit Service aad4f7
		lwtunnel_print_vxlan_opts(tb_opt[LWTUNNEL_IP_OPTS_VXLAN]);
Packit Service cfda42
	else if (tb_opt[LWTUNNEL_IP_OPTS_ERSPAN])
Packit Service cfda42
		lwtunnel_print_erspan_opts(tb_opt[LWTUNNEL_IP_OPTS_ERSPAN]);
Packit Service 14c19c
}
Packit Service 14c19c
Packit d3f73b
static void print_encap_ip(FILE *fp, struct rtattr *encap)
Packit d3f73b
{
Packit d3f73b
	struct rtattr *tb[LWTUNNEL_IP_MAX+1];
Packit d3f73b
	__u16 flags;
Packit d3f73b
Packit d3f73b
	parse_rtattr_nested(tb, LWTUNNEL_IP_MAX, encap);
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP_ID])
Packit d3f73b
		print_u64(PRINT_ANY, "id", "id %llu ",
Packit d3f73b
			   ntohll(rta_getattr_u64(tb[LWTUNNEL_IP_ID])));
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP_SRC])
Packit d3f73b
		print_color_string(PRINT_ANY, COLOR_INET,
Packit d3f73b
				   "src", "src %s ",
Packit d3f73b
				   rt_addr_n2a_rta(AF_INET, tb[LWTUNNEL_IP_SRC]));
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP_DST])
Packit d3f73b
		print_color_string(PRINT_ANY, COLOR_INET,
Packit d3f73b
				   "dst", "dst %s ",
Packit d3f73b
				   rt_addr_n2a_rta(AF_INET, tb[LWTUNNEL_IP_DST]));
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP_TTL])
Packit d3f73b
		print_uint(PRINT_ANY, "ttl",
Packit d3f73b
			   "ttl %u ", rta_getattr_u8(tb[LWTUNNEL_IP_TTL]));
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP_TOS])
Packit d3f73b
		print_uint(PRINT_ANY, "tos",
Packit d3f73b
			   "tos %d ", rta_getattr_u8(tb[LWTUNNEL_IP_TOS]));
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP_FLAGS]) {
Packit d3f73b
		flags = rta_getattr_u16(tb[LWTUNNEL_IP_FLAGS]);
Packit d3f73b
		if (flags & TUNNEL_KEY)
Packit d3f73b
			print_bool(PRINT_ANY, "key", "key ", true);
Packit d3f73b
		if (flags & TUNNEL_CSUM)
Packit d3f73b
			print_bool(PRINT_ANY, "csum", "csum ", true);
Packit d3f73b
		if (flags & TUNNEL_SEQ)
Packit d3f73b
			print_bool(PRINT_ANY, "seq", "seq ", true);
Packit d3f73b
	}
Packit Service 14c19c
Packit Service 14c19c
	if (tb[LWTUNNEL_IP_OPTS])
Packit Service 14c19c
		lwtunnel_print_opts(tb[LWTUNNEL_IP_OPTS]);
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static void print_encap_ila(FILE *fp, struct rtattr *encap)
Packit d3f73b
{
Packit d3f73b
	struct rtattr *tb[ILA_ATTR_MAX+1];
Packit d3f73b
Packit d3f73b
	parse_rtattr_nested(tb, ILA_ATTR_MAX, encap);
Packit d3f73b
Packit d3f73b
	if (tb[ILA_ATTR_LOCATOR]) {
Packit d3f73b
		char abuf[ADDR64_BUF_SIZE];
Packit d3f73b
Packit d3f73b
		addr64_n2a(rta_getattr_u64(tb[ILA_ATTR_LOCATOR]),
Packit d3f73b
			   abuf, sizeof(abuf));
Packit d3f73b
		print_string(PRINT_ANY, "locator",
Packit d3f73b
			     " %s ", abuf);
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (tb[ILA_ATTR_CSUM_MODE])
Packit d3f73b
		print_string(PRINT_ANY, "csum_mode",
Packit d3f73b
			     " csum-mode %s ",
Packit d3f73b
			     ila_csum_mode2name(rta_getattr_u8(tb[ILA_ATTR_CSUM_MODE])));
Packit d3f73b
Packit d3f73b
	if (tb[ILA_ATTR_IDENT_TYPE])
Packit d3f73b
		print_string(PRINT_ANY, "ident_type",
Packit d3f73b
			     " ident-type %s ",
Packit d3f73b
			     ila_ident_type2name(rta_getattr_u8(tb[ILA_ATTR_IDENT_TYPE])));
Packit d3f73b
Packit d3f73b
	if (tb[ILA_ATTR_HOOK_TYPE])
Packit d3f73b
		print_string(PRINT_ANY, "hook_type",
Packit d3f73b
			     " hook-type %s ",
Packit d3f73b
			     ila_hook_type2name(rta_getattr_u8(tb[ILA_ATTR_HOOK_TYPE])));
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static void print_encap_ip6(FILE *fp, struct rtattr *encap)
Packit d3f73b
{
Packit d3f73b
	struct rtattr *tb[LWTUNNEL_IP6_MAX+1];
Packit d3f73b
	__u16 flags;
Packit d3f73b
Packit d3f73b
	parse_rtattr_nested(tb, LWTUNNEL_IP6_MAX, encap);
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP6_ID])
Packit d3f73b
		print_u64(PRINT_ANY, "id", "id %llu ",
Packit d3f73b
			    ntohll(rta_getattr_u64(tb[LWTUNNEL_IP6_ID])));
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP6_SRC])
Packit d3f73b
		print_color_string(PRINT_ANY, COLOR_INET6,
Packit d3f73b
				   "src", "src %s ",
Packit d3f73b
				   rt_addr_n2a_rta(AF_INET6, tb[LWTUNNEL_IP6_SRC]));
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP6_DST])
Packit d3f73b
		print_color_string(PRINT_ANY, COLOR_INET6,
Packit d3f73b
				   "dst", "dst %s ",
Packit d3f73b
				   rt_addr_n2a_rta(AF_INET6, tb[LWTUNNEL_IP6_DST]));
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP6_HOPLIMIT])
Packit d3f73b
		print_u64(PRINT_ANY, "hoplimit",
Packit d3f73b
			   "hoplimit %u ",
Packit d3f73b
			   rta_getattr_u8(tb[LWTUNNEL_IP6_HOPLIMIT]));
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP6_TC])
Packit d3f73b
		print_uint(PRINT_ANY, "tc",
Packit d3f73b
			   "tc %u ", rta_getattr_u8(tb[LWTUNNEL_IP6_TC]));
Packit d3f73b
Packit d3f73b
	if (tb[LWTUNNEL_IP6_FLAGS]) {
Packit d3f73b
		flags = rta_getattr_u16(tb[LWTUNNEL_IP6_FLAGS]);
Packit d3f73b
		if (flags & TUNNEL_KEY)
Packit d3f73b
			print_bool(PRINT_ANY, "key", "key ", true);
Packit d3f73b
		if (flags & TUNNEL_CSUM)
Packit d3f73b
			print_bool(PRINT_ANY, "csum", "csum ", true);
Packit d3f73b
		if (flags & TUNNEL_SEQ)
Packit d3f73b
			print_bool(PRINT_ANY, "seq", "seq ", true);
Packit d3f73b
	}
Packit Service 14c19c
Packit Service 14c19c
	if (tb[LWTUNNEL_IP6_OPTS])
Packit Service 14c19c
		lwtunnel_print_opts(tb[LWTUNNEL_IP6_OPTS]);
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static void print_encap_bpf(FILE *fp, struct rtattr *encap)
Packit d3f73b
{
Packit d3f73b
	struct rtattr *tb[LWT_BPF_MAX+1];
Packit d3f73b
Packit d3f73b
	parse_rtattr_nested(tb, LWT_BPF_MAX, encap);
Packit d3f73b
Packit d3f73b
	if (tb[LWT_BPF_IN])
Packit d3f73b
		print_encap_bpf_prog(fp, tb[LWT_BPF_IN], "in");
Packit d3f73b
	if (tb[LWT_BPF_OUT])
Packit d3f73b
		print_encap_bpf_prog(fp, tb[LWT_BPF_OUT], "out");
Packit d3f73b
	if (tb[LWT_BPF_XMIT])
Packit d3f73b
		print_encap_bpf_prog(fp, tb[LWT_BPF_XMIT], "xmit");
Packit d3f73b
	if (tb[LWT_BPF_XMIT_HEADROOM])
Packit d3f73b
		print_uint(PRINT_ANY, "headroom",
Packit d3f73b
			   " %u ", rta_getattr_u32(tb[LWT_BPF_XMIT_HEADROOM]));
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
void lwt_print_encap(FILE *fp, struct rtattr *encap_type,
Packit d3f73b
			  struct rtattr *encap)
Packit d3f73b
{
Packit d3f73b
	int et;
Packit d3f73b
Packit d3f73b
	if (!encap_type)
Packit d3f73b
		return;
Packit d3f73b
Packit d3f73b
	et = rta_getattr_u16(encap_type);
Packit d3f73b
Packit d3f73b
	print_string(PRINT_ANY, "encap", " encap %s ", format_encap_type(et));
Packit d3f73b
Packit d3f73b
	switch (et) {
Packit d3f73b
	case LWTUNNEL_ENCAP_MPLS:
Packit d3f73b
		print_encap_mpls(fp, encap);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_IP:
Packit d3f73b
		print_encap_ip(fp, encap);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_ILA:
Packit d3f73b
		print_encap_ila(fp, encap);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_IP6:
Packit d3f73b
		print_encap_ip6(fp, encap);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_BPF:
Packit d3f73b
		print_encap_bpf(fp, encap);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_SEG6:
Packit d3f73b
		print_encap_seg6(fp, encap);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_SEG6_LOCAL:
Packit d3f73b
		print_encap_seg6local(fp, encap);
Packit d3f73b
		break;
Packit d3f73b
	}
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static struct ipv6_sr_hdr *parse_srh(char *segbuf, int hmac, bool encap)
Packit d3f73b
{
Packit d3f73b
	struct ipv6_sr_hdr *srh;
Packit d3f73b
	int nsegs = 0;
Packit d3f73b
	int srhlen;
Packit d3f73b
	char *s;
Packit d3f73b
	int i;
Packit d3f73b
Packit d3f73b
	s = segbuf;
Packit d3f73b
	for (i = 0; *s; *s++ == ',' ? i++ : *s);
Packit d3f73b
	nsegs = i + 1;
Packit d3f73b
Packit d3f73b
	if (!encap)
Packit d3f73b
		nsegs++;
Packit d3f73b
Packit d3f73b
	srhlen = 8 + 16*nsegs;
Packit d3f73b
Packit d3f73b
	if (hmac)
Packit d3f73b
		srhlen += 40;
Packit d3f73b
Packit d3f73b
	srh = malloc(srhlen);
Packit d3f73b
	memset(srh, 0, srhlen);
Packit d3f73b
Packit d3f73b
	srh->hdrlen = (srhlen >> 3) - 1;
Packit d3f73b
	srh->type = 4;
Packit d3f73b
	srh->segments_left = nsegs - 1;
Packit d3f73b
	srh->first_segment = nsegs - 1;
Packit d3f73b
Packit d3f73b
	if (hmac)
Packit d3f73b
		srh->flags |= SR6_FLAG1_HMAC;
Packit d3f73b
Packit d3f73b
	i = srh->first_segment;
Packit d3f73b
	for (s = strtok(segbuf, ","); s; s = strtok(NULL, ",")) {
Packit d3f73b
		inet_prefix addr;
Packit d3f73b
Packit d3f73b
		get_addr(&addr, s, AF_INET6);
Packit d3f73b
		memcpy(&srh->segments[i], addr.data, sizeof(struct in6_addr));
Packit d3f73b
		i--;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (hmac) {
Packit d3f73b
		struct sr6_tlv_hmac *tlv;
Packit d3f73b
Packit d3f73b
		tlv = (struct sr6_tlv_hmac *)((char *)srh + srhlen - 40);
Packit d3f73b
		tlv->tlvhdr.type = SR6_TLV_HMAC;
Packit d3f73b
		tlv->tlvhdr.len = 38;
Packit d3f73b
		tlv->hmackeyid = htonl(hmac);
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	return srh;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static int parse_encap_seg6(struct rtattr *rta, size_t len, int *argcp,
Packit d3f73b
			    char ***argvp)
Packit d3f73b
{
Packit d3f73b
	int mode_ok = 0, segs_ok = 0, hmac_ok = 0;
Packit d3f73b
	struct seg6_iptunnel_encap *tuninfo;
Packit d3f73b
	struct ipv6_sr_hdr *srh;
Packit d3f73b
	char **argv = *argvp;
Packit d3f73b
	char segbuf[1024] = "";
Packit d3f73b
	int argc = *argcp;
Packit d3f73b
	int encap = -1;
Packit d3f73b
	__u32 hmac = 0;
Packit d3f73b
	int ret = 0;
Packit d3f73b
	int srhlen;
Packit d3f73b
Packit d3f73b
	while (argc > 0) {
Packit d3f73b
		if (strcmp(*argv, "mode") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (mode_ok++)
Packit d3f73b
				duparg2("mode", *argv);
Packit d3f73b
			encap = read_seg6mode_type(*argv);
Packit d3f73b
			if (encap < 0)
Packit d3f73b
				invarg("\"mode\" value is invalid\n", *argv);
Packit d3f73b
		} else if (strcmp(*argv, "segs") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (segs_ok++)
Packit d3f73b
				duparg2("segs", *argv);
Packit d3f73b
			if (encap == -1)
Packit d3f73b
				invarg("\"segs\" provided before \"mode\"\n",
Packit d3f73b
				       *argv);
Packit d3f73b
Packit d3f73b
			strlcpy(segbuf, *argv, 1024);
Packit d3f73b
		} else if (strcmp(*argv, "hmac") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (hmac_ok++)
Packit d3f73b
				duparg2("hmac", *argv);
Packit d3f73b
			get_u32(&hmac, *argv, 0);
Packit d3f73b
		} else {
Packit d3f73b
			break;
Packit d3f73b
		}
Packit d3f73b
		argc--; argv++;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	srh = parse_srh(segbuf, hmac, encap);
Packit d3f73b
	srhlen = (srh->hdrlen + 1) << 3;
Packit d3f73b
Packit d3f73b
	tuninfo = malloc(sizeof(*tuninfo) + srhlen);
Packit d3f73b
	memset(tuninfo, 0, sizeof(*tuninfo) + srhlen);
Packit d3f73b
Packit d3f73b
	tuninfo->mode = encap;
Packit d3f73b
Packit d3f73b
	memcpy(tuninfo->srh, srh, srhlen);
Packit d3f73b
Packit d3f73b
	if (rta_addattr_l(rta, len, SEG6_IPTUNNEL_SRH, tuninfo,
Packit d3f73b
			  sizeof(*tuninfo) + srhlen)) {
Packit d3f73b
		ret = -1;
Packit d3f73b
		goto out;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	*argcp = argc + 1;
Packit d3f73b
	*argvp = argv - 1;
Packit d3f73b
Packit d3f73b
out:
Packit d3f73b
	free(tuninfo);
Packit d3f73b
	free(srh);
Packit d3f73b
Packit d3f73b
	return ret;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
struct lwt_x {
Packit d3f73b
	struct rtattr *rta;
Packit d3f73b
	size_t len;
Packit d3f73b
};
Packit d3f73b
Packit d3f73b
static void bpf_lwt_cb(void *lwt_ptr, int fd, const char *annotation)
Packit d3f73b
{
Packit d3f73b
	struct lwt_x *x = lwt_ptr;
Packit d3f73b
Packit d3f73b
	rta_addattr32(x->rta, x->len, LWT_BPF_PROG_FD, fd);
Packit d3f73b
	rta_addattr_l(x->rta, x->len, LWT_BPF_PROG_NAME, annotation,
Packit d3f73b
		      strlen(annotation) + 1);
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static const struct bpf_cfg_ops bpf_cb_ops = {
Packit d3f73b
	.ebpf_cb = bpf_lwt_cb,
Packit d3f73b
};
Packit d3f73b
Packit d3f73b
static int lwt_parse_bpf(struct rtattr *rta, size_t len,
Packit d3f73b
			 int *argcp, char ***argvp,
Packit d3f73b
			 int attr, const enum bpf_prog_type bpf_type)
Packit d3f73b
{
Packit d3f73b
	struct bpf_cfg_in cfg = {
Packit d3f73b
		.type = bpf_type,
Packit d3f73b
		.argc = *argcp,
Packit d3f73b
		.argv = *argvp,
Packit d3f73b
	};
Packit d3f73b
	struct lwt_x x = {
Packit d3f73b
		.rta = rta,
Packit d3f73b
		.len = len,
Packit d3f73b
	};
Packit d3f73b
	struct rtattr *nest;
Packit d3f73b
	int err;
Packit d3f73b
Packit d3f73b
	nest = rta_nest(rta, len, attr);
Packit d3f73b
	err = bpf_parse_and_load_common(&cfg, &bpf_cb_ops, &x);
Packit d3f73b
	if (err < 0) {
Packit d3f73b
		fprintf(stderr, "Failed to parse eBPF program: %s\n",
Packit d3f73b
			strerror(-err));
Packit d3f73b
		return -1;
Packit d3f73b
	}
Packit d3f73b
	rta_nest_end(rta, nest);
Packit d3f73b
Packit d3f73b
	*argcp = cfg.argc;
Packit d3f73b
	*argvp = cfg.argv;
Packit d3f73b
Packit d3f73b
	return 0;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static int parse_encap_seg6local(struct rtattr *rta, size_t len, int *argcp,
Packit d3f73b
				 char ***argvp)
Packit d3f73b
{
Packit d3f73b
	int segs_ok = 0, hmac_ok = 0, table_ok = 0, nh4_ok = 0, nh6_ok = 0;
Packit d3f73b
	int iif_ok = 0, oif_ok = 0, action_ok = 0, srh_ok = 0, bpf_ok = 0;
Packit d3f73b
	__u32 action = 0, table, iif, oif;
Packit d3f73b
	struct ipv6_sr_hdr *srh;
Packit d3f73b
	char **argv = *argvp;
Packit d3f73b
	int argc = *argcp;
Packit d3f73b
	char segbuf[1024];
Packit d3f73b
	inet_prefix addr;
Packit d3f73b
	__u32 hmac = 0;
Packit d3f73b
	int ret = 0;
Packit d3f73b
Packit d3f73b
	while (argc > 0) {
Packit d3f73b
		if (strcmp(*argv, "action") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (action_ok++)
Packit d3f73b
				duparg2("action", *argv);
Packit d3f73b
			action = read_action_type(*argv);
Packit d3f73b
			if (!action)
Packit d3f73b
				invarg("\"action\" value is invalid\n", *argv);
Packit d3f73b
			ret = rta_addattr32(rta, len, SEG6_LOCAL_ACTION,
Packit d3f73b
					    action);
Packit d3f73b
		} else if (strcmp(*argv, "table") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (table_ok++)
Packit d3f73b
				duparg2("table", *argv);
Packit d3f73b
			get_u32(&table, *argv, 0);
Packit d3f73b
			ret = rta_addattr32(rta, len, SEG6_LOCAL_TABLE, table);
Packit d3f73b
		} else if (strcmp(*argv, "nh4") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (nh4_ok++)
Packit d3f73b
				duparg2("nh4", *argv);
Packit d3f73b
			get_addr(&addr, *argv, AF_INET);
Packit d3f73b
			ret = rta_addattr_l(rta, len, SEG6_LOCAL_NH4,
Packit d3f73b
					    &addr.data, addr.bytelen);
Packit d3f73b
		} else if (strcmp(*argv, "nh6") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (nh6_ok++)
Packit d3f73b
				duparg2("nh6", *argv);
Packit d3f73b
			get_addr(&addr, *argv, AF_INET6);
Packit d3f73b
			ret = rta_addattr_l(rta, len, SEG6_LOCAL_NH6,
Packit d3f73b
					    &addr.data, addr.bytelen);
Packit d3f73b
		} else if (strcmp(*argv, "iif") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (iif_ok++)
Packit d3f73b
				duparg2("iif", *argv);
Packit d3f73b
			iif = ll_name_to_index(*argv);
Packit d3f73b
			if (!iif)
Packit d3f73b
				exit(nodev(*argv));
Packit d3f73b
			ret = rta_addattr32(rta, len, SEG6_LOCAL_IIF, iif);
Packit d3f73b
		} else if (strcmp(*argv, "oif") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (oif_ok++)
Packit d3f73b
				duparg2("oif", *argv);
Packit d3f73b
			oif = ll_name_to_index(*argv);
Packit d3f73b
			if (!oif)
Packit d3f73b
				exit(nodev(*argv));
Packit d3f73b
			ret = rta_addattr32(rta, len, SEG6_LOCAL_OIF, oif);
Packit d3f73b
		} else if (strcmp(*argv, "srh") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (srh_ok++)
Packit d3f73b
				duparg2("srh", *argv);
Packit d3f73b
			if (strcmp(*argv, "segs") != 0)
Packit d3f73b
				invarg("missing \"segs\" attribute for srh\n",
Packit d3f73b
					*argv);
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (segs_ok++)
Packit d3f73b
				duparg2("segs", *argv);
Packit d3f73b
			strncpy(segbuf, *argv, 1024);
Packit d3f73b
			segbuf[1023] = 0;
Packit d3f73b
			if (!NEXT_ARG_OK())
Packit d3f73b
				break;
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (strcmp(*argv, "hmac") == 0) {
Packit d3f73b
				NEXT_ARG();
Packit d3f73b
				if (hmac_ok++)
Packit d3f73b
					duparg2("hmac", *argv);
Packit d3f73b
				get_u32(&hmac, *argv, 0);
Packit d3f73b
			} else {
Packit d3f73b
				continue;
Packit d3f73b
			}
Packit d3f73b
		} else if (strcmp(*argv, "endpoint") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (bpf_ok++)
Packit d3f73b
				duparg2("endpoint", *argv);
Packit d3f73b
Packit d3f73b
			if (lwt_parse_bpf(rta, len, &argc, &argv, SEG6_LOCAL_BPF,
Packit d3f73b
			    BPF_PROG_TYPE_LWT_SEG6LOCAL) < 0)
Packit d3f73b
				exit(-1);
Packit d3f73b
		} else {
Packit d3f73b
			break;
Packit d3f73b
		}
Packit d3f73b
		if (ret)
Packit d3f73b
			return ret;
Packit d3f73b
		argc--; argv++;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (!action) {
Packit d3f73b
		fprintf(stderr, "Missing action type\n");
Packit d3f73b
		exit(-1);
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (srh_ok) {
Packit d3f73b
		int srhlen;
Packit d3f73b
Packit d3f73b
		srh = parse_srh(segbuf, hmac,
Packit d3f73b
				action == SEG6_LOCAL_ACTION_END_B6_ENCAP);
Packit d3f73b
		srhlen = (srh->hdrlen + 1) << 3;
Packit d3f73b
		ret = rta_addattr_l(rta, len, SEG6_LOCAL_SRH, srh, srhlen);
Packit d3f73b
		free(srh);
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	*argcp = argc + 1;
Packit d3f73b
	*argvp = argv - 1;
Packit d3f73b
Packit d3f73b
	return ret;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static int parse_encap_mpls(struct rtattr *rta, size_t len,
Packit d3f73b
			    int *argcp, char ***argvp)
Packit d3f73b
{
Packit d3f73b
	inet_prefix addr;
Packit d3f73b
	int argc = *argcp;
Packit d3f73b
	char **argv = *argvp;
Packit d3f73b
	int ttl_ok = 0;
Packit d3f73b
Packit d3f73b
	if (get_addr(&addr, *argv, AF_MPLS)) {
Packit d3f73b
		fprintf(stderr,
Packit d3f73b
			"Error: an inet address is expected rather than \"%s\".\n",
Packit d3f73b
			*argv);
Packit d3f73b
		exit(1);
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (rta_addattr_l(rta, len, MPLS_IPTUNNEL_DST,
Packit d3f73b
			  &addr.data, addr.bytelen))
Packit d3f73b
		return -1;
Packit d3f73b
Packit d3f73b
	argc--;
Packit d3f73b
	argv++;
Packit d3f73b
Packit d3f73b
	while (argc > 0) {
Packit d3f73b
		if (strcmp(*argv, "ttl") == 0) {
Packit d3f73b
			__u8 ttl;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (ttl_ok++)
Packit d3f73b
				duparg2("ttl", *argv);
Packit d3f73b
			if (get_u8(&ttl, *argv, 0))
Packit d3f73b
				invarg("\"ttl\" value is invalid\n", *argv);
Packit d3f73b
			if (rta_addattr8(rta, len, MPLS_IPTUNNEL_TTL, ttl))
Packit d3f73b
				return -1;
Packit d3f73b
		} else {
Packit d3f73b
			break;
Packit d3f73b
		}
Packit d3f73b
		argc--; argv++;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	/* argv is currently the first unparsed argument,
Packit d3f73b
	 * but the lwt_parse_encap() caller will move to the next,
Packit d3f73b
	 * so step back
Packit d3f73b
	 */
Packit d3f73b
	*argcp = argc + 1;
Packit d3f73b
	*argvp = argv - 1;
Packit d3f73b
Packit d3f73b
	return 0;
Packit d3f73b
}
Packit d3f73b
Packit Service 14c19c
static int lwtunnel_parse_geneve_opt(char *str, size_t len, struct rtattr *rta)
Packit Service 14c19c
{
Packit Service 14c19c
	struct rtattr *nest;
Packit Service 14c19c
	char *token;
Packit Service 14c19c
	int i, err;
Packit Service 14c19c
Packit Service 14c19c
	nest = rta_nest(rta, len, LWTUNNEL_IP_OPTS_GENEVE | NLA_F_NESTED);
Packit Service 14c19c
	i = 1;
Packit Service 14c19c
	token = strsep(&str, ":");
Packit Service 14c19c
	while (token) {
Packit Service 14c19c
		switch (i) {
Packit Service 14c19c
		case LWTUNNEL_IP_OPT_GENEVE_CLASS:
Packit Service 14c19c
		{
Packit Service 14c19c
			__be16 opt_class;
Packit Service 14c19c
Packit Service 14c19c
			if (!strlen(token))
Packit Service 14c19c
				break;
Packit Service 14c19c
			err = get_be16(&opt_class, token, 0);
Packit Service 14c19c
			if (err)
Packit Service 14c19c
				return err;
Packit Service 14c19c
Packit Service 14c19c
			rta_addattr16(rta, len, i, opt_class);
Packit Service 14c19c
			break;
Packit Service 14c19c
		}
Packit Service 14c19c
		case LWTUNNEL_IP_OPT_GENEVE_TYPE:
Packit Service 14c19c
		{
Packit Service 14c19c
			__u8 opt_type;
Packit Service 14c19c
Packit Service 14c19c
			if (!strlen(token))
Packit Service 14c19c
				break;
Packit Service 14c19c
			err = get_u8(&opt_type, token, 0);
Packit Service 14c19c
			if (err)
Packit Service 14c19c
				return err;
Packit Service 14c19c
Packit Service 14c19c
			rta_addattr8(rta, len, i, opt_type);
Packit Service 14c19c
			break;
Packit Service 14c19c
		}
Packit Service 14c19c
		case LWTUNNEL_IP_OPT_GENEVE_DATA:
Packit Service 14c19c
		{
Packit Service 14c19c
			size_t token_len = strlen(token);
Packit Service 14c19c
			__u8 *opts;
Packit Service 14c19c
Packit Service 14c19c
			if (!token_len)
Packit Service 14c19c
				break;
Packit Service 14c19c
			opts = malloc(token_len / 2);
Packit Service 14c19c
			if (!opts)
Packit Service 14c19c
				return -1;
Packit Service 14c19c
			if (hex2mem(token, opts, token_len / 2) < 0) {
Packit Service 14c19c
				free(opts);
Packit Service 14c19c
				return -1;
Packit Service 14c19c
			}
Packit Service 14c19c
			rta_addattr_l(rta, len, i, opts, token_len / 2);
Packit Service 14c19c
			free(opts);
Packit Service 14c19c
Packit Service 14c19c
			break;
Packit Service 14c19c
		}
Packit Service 14c19c
		default:
Packit Service 14c19c
			fprintf(stderr, "Unknown \"geneve_opts\" type\n");
Packit Service 14c19c
			return -1;
Packit Service 14c19c
		}
Packit Service 14c19c
Packit Service 14c19c
		token = strsep(&str, ":");
Packit Service 14c19c
		i++;
Packit Service 14c19c
	}
Packit Service 14c19c
	rta_nest_end(rta, nest);
Packit Service 14c19c
Packit Service 14c19c
	return 0;
Packit Service 14c19c
}
Packit Service 14c19c
Packit Service 14c19c
static int lwtunnel_parse_geneve_opts(char *str, size_t len, struct rtattr *rta)
Packit Service 14c19c
{
Packit Service 14c19c
	char *token;
Packit Service 14c19c
	int err;
Packit Service 14c19c
Packit Service 14c19c
	token = strsep(&str, ",");
Packit Service 14c19c
	while (token) {
Packit Service 14c19c
		err = lwtunnel_parse_geneve_opt(token, len, rta);
Packit Service 14c19c
		if (err)
Packit Service 14c19c
			return err;
Packit Service 14c19c
Packit Service 14c19c
		token = strsep(&str, ",");
Packit Service 14c19c
	}
Packit Service 14c19c
Packit Service 14c19c
	return 0;
Packit Service 14c19c
}
Packit Service 14c19c
Packit Service aad4f7
static int lwtunnel_parse_vxlan_opts(char *str, size_t len, struct rtattr *rta)
Packit Service aad4f7
{
Packit Service aad4f7
	struct rtattr *nest;
Packit Service aad4f7
	__u32 gbp;
Packit Service aad4f7
	int err;
Packit Service aad4f7
Packit Service aad4f7
	nest = rta_nest(rta, len, LWTUNNEL_IP_OPTS_VXLAN | NLA_F_NESTED);
Packit Service aad4f7
	err = get_u32(&gbp, str, 0);
Packit Service aad4f7
	if (err)
Packit Service aad4f7
		return err;
Packit Service aad4f7
	rta_addattr32(rta, len, LWTUNNEL_IP_OPT_VXLAN_GBP, gbp);
Packit Service aad4f7
Packit Service aad4f7
	rta_nest_end(rta, nest);
Packit Service aad4f7
	return 0;
Packit Service aad4f7
}
Packit Service aad4f7
Packit Service cfda42
static int lwtunnel_parse_erspan_opts(char *str, size_t len, struct rtattr *rta)
Packit Service cfda42
{
Packit Service cfda42
	struct rtattr *nest;
Packit Service cfda42
	char *token;
Packit Service cfda42
	int i, err;
Packit Service cfda42
Packit Service cfda42
	nest = rta_nest(rta, len, LWTUNNEL_IP_OPTS_ERSPAN | NLA_F_NESTED);
Packit Service cfda42
	i = 1;
Packit Service cfda42
	token = strsep(&str, ":");
Packit Service cfda42
	while (token) {
Packit Service cfda42
		switch (i) {
Packit Service cfda42
		case LWTUNNEL_IP_OPT_ERSPAN_VER:
Packit Service cfda42
		{
Packit Service cfda42
			__u8 opt_type;
Packit Service cfda42
Packit Service cfda42
			if (!strlen(token))
Packit Service cfda42
				break;
Packit Service cfda42
			err = get_u8(&opt_type, token, 0);
Packit Service cfda42
			if (err)
Packit Service cfda42
				return err;
Packit Service cfda42
Packit Service cfda42
			rta_addattr8(rta, len, i, opt_type);
Packit Service cfda42
			break;
Packit Service cfda42
		}
Packit Service cfda42
		case LWTUNNEL_IP_OPT_ERSPAN_INDEX:
Packit Service cfda42
		{
Packit Service cfda42
			__be32 opt_class;
Packit Service cfda42
Packit Service cfda42
			if (!strlen(token))
Packit Service cfda42
				break;
Packit Service cfda42
			err = get_be32(&opt_class, token, 0);
Packit Service cfda42
			if (err)
Packit Service cfda42
				return err;
Packit Service cfda42
Packit Service cfda42
			rta_addattr32(rta, len, i, opt_class);
Packit Service cfda42
			break;
Packit Service cfda42
		}
Packit Service cfda42
		case LWTUNNEL_IP_OPT_ERSPAN_DIR:
Packit Service cfda42
		{
Packit Service cfda42
			__u8 opt_type;
Packit Service cfda42
Packit Service cfda42
			if (!strlen(token))
Packit Service cfda42
				break;
Packit Service cfda42
			err = get_u8(&opt_type, token, 0);
Packit Service cfda42
			if (err)
Packit Service cfda42
				return err;
Packit Service cfda42
Packit Service cfda42
			rta_addattr8(rta, len, i, opt_type);
Packit Service cfda42
			break;
Packit Service cfda42
		}
Packit Service cfda42
		case LWTUNNEL_IP_OPT_ERSPAN_HWID:
Packit Service cfda42
		{
Packit Service cfda42
			__u8 opt_type;
Packit Service cfda42
Packit Service cfda42
			if (!strlen(token))
Packit Service cfda42
				break;
Packit Service cfda42
			err = get_u8(&opt_type, token, 0);
Packit Service cfda42
			if (err)
Packit Service cfda42
				return err;
Packit Service cfda42
Packit Service cfda42
			rta_addattr8(rta, len, i, opt_type);
Packit Service cfda42
			break;
Packit Service cfda42
		}
Packit Service cfda42
		default:
Packit Service cfda42
			fprintf(stderr, "Unknown \"geneve_opts\" type\n");
Packit Service cfda42
			return -1;
Packit Service cfda42
		}
Packit Service cfda42
Packit Service cfda42
		token = strsep(&str, ":");
Packit Service cfda42
		i++;
Packit Service cfda42
	}
Packit Service cfda42
Packit Service cfda42
	rta_nest_end(rta, nest);
Packit Service cfda42
	return 0;
Packit Service cfda42
}
Packit Service cfda42
Packit d3f73b
static int parse_encap_ip(struct rtattr *rta, size_t len,
Packit d3f73b
			  int *argcp, char ***argvp)
Packit d3f73b
{
Packit d3f73b
	int id_ok = 0, dst_ok = 0, src_ok = 0, tos_ok = 0, ttl_ok = 0;
Packit Service 14c19c
	int key_ok = 0, csum_ok = 0, seq_ok = 0, opts_ok = 0;
Packit d3f73b
	char **argv = *argvp;
Packit d3f73b
	int argc = *argcp;
Packit d3f73b
	int ret = 0;
Packit d3f73b
	__u16 flags = 0;
Packit d3f73b
Packit d3f73b
	while (argc > 0) {
Packit d3f73b
		if (strcmp(*argv, "id") == 0) {
Packit d3f73b
			__u64 id;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (id_ok++)
Packit d3f73b
				duparg2("id", *argv);
Packit d3f73b
			if (get_be64(&id, *argv, 0))
Packit d3f73b
				invarg("\"id\" value is invalid\n", *argv);
Packit d3f73b
			ret = rta_addattr64(rta, len, LWTUNNEL_IP_ID, id);
Packit d3f73b
		} else if (strcmp(*argv, "dst") == 0) {
Packit d3f73b
			inet_prefix addr;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (dst_ok++)
Packit d3f73b
				duparg2("dst", *argv);
Packit d3f73b
			get_addr(&addr, *argv, AF_INET);
Packit d3f73b
			ret = rta_addattr_l(rta, len, LWTUNNEL_IP_DST,
Packit d3f73b
					    &addr.data, addr.bytelen);
Packit d3f73b
		} else if (strcmp(*argv, "src") == 0) {
Packit d3f73b
			inet_prefix addr;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (src_ok++)
Packit d3f73b
				duparg2("src", *argv);
Packit d3f73b
			get_addr(&addr, *argv, AF_INET);
Packit d3f73b
			ret = rta_addattr_l(rta, len, LWTUNNEL_IP_SRC,
Packit d3f73b
					    &addr.data, addr.bytelen);
Packit d3f73b
		} else if (strcmp(*argv, "tos") == 0) {
Packit d3f73b
			__u32 tos;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (tos_ok++)
Packit d3f73b
				duparg2("tos", *argv);
Packit d3f73b
			if (rtnl_dsfield_a2n(&tos, *argv))
Packit d3f73b
				invarg("\"tos\" value is invalid\n", *argv);
Packit d3f73b
			ret = rta_addattr8(rta, len, LWTUNNEL_IP_TOS, tos);
Packit d3f73b
		} else if (strcmp(*argv, "ttl") == 0) {
Packit d3f73b
			__u8 ttl;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (ttl_ok++)
Packit d3f73b
				duparg2("ttl", *argv);
Packit d3f73b
			if (get_u8(&ttl, *argv, 0))
Packit d3f73b
				invarg("\"ttl\" value is invalid\n", *argv);
Packit d3f73b
			ret = rta_addattr8(rta, len, LWTUNNEL_IP_TTL, ttl);
Packit Service 14c19c
		} else if (strcmp(*argv, "geneve_opts") == 0) {
Packit Service 14c19c
			struct rtattr *nest;
Packit Service 14c19c
Packit Service 14c19c
			if (opts_ok++)
Packit Service 14c19c
				duparg2("opts", *argv);
Packit Service 14c19c
Packit Service 14c19c
			NEXT_ARG();
Packit Service 14c19c
Packit Service 14c19c
			nest = rta_nest(rta, len,
Packit Service 14c19c
					LWTUNNEL_IP_OPTS | NLA_F_NESTED);
Packit Service 14c19c
			ret = lwtunnel_parse_geneve_opts(*argv, len, rta);
Packit Service 14c19c
			if (ret)
Packit Service 14c19c
				invarg("\"geneve_opts\" value is invalid\n",
Packit Service 14c19c
				       *argv);
Packit Service 14c19c
			rta_nest_end(rta, nest);
Packit Service aad4f7
		} else if (strcmp(*argv, "vxlan_opts") == 0) {
Packit Service aad4f7
			struct rtattr *nest;
Packit Service aad4f7
Packit Service aad4f7
			if (opts_ok++)
Packit Service aad4f7
				duparg2("opts", *argv);
Packit Service aad4f7
Packit Service aad4f7
			NEXT_ARG();
Packit Service aad4f7
Packit Service aad4f7
			nest = rta_nest(rta, len,
Packit Service aad4f7
					LWTUNNEL_IP_OPTS | NLA_F_NESTED);
Packit Service aad4f7
			ret = lwtunnel_parse_vxlan_opts(*argv, len, rta);
Packit Service aad4f7
			if (ret)
Packit Service aad4f7
				invarg("\"vxlan_opts\" value is invalid\n",
Packit Service aad4f7
				       *argv);
Packit Service aad4f7
			rta_nest_end(rta, nest);
Packit Service cfda42
		} else if (strcmp(*argv, "erspan_opts") == 0) {
Packit Service cfda42
			struct rtattr *nest;
Packit Service cfda42
Packit Service cfda42
			if (opts_ok++)
Packit Service cfda42
				duparg2("opts", *argv);
Packit Service cfda42
Packit Service cfda42
			NEXT_ARG();
Packit Service cfda42
Packit Service cfda42
			nest = rta_nest(rta, len,
Packit Service cfda42
					LWTUNNEL_IP_OPTS | NLA_F_NESTED);
Packit Service cfda42
			ret = lwtunnel_parse_erspan_opts(*argv, len, rta);
Packit Service cfda42
			if (ret)
Packit Service cfda42
				invarg("\"erspan_opts\" value is invalid\n",
Packit Service cfda42
				       *argv);
Packit Service cfda42
			rta_nest_end(rta, nest);
Packit d3f73b
		} else if (strcmp(*argv, "key") == 0) {
Packit d3f73b
			if (key_ok++)
Packit d3f73b
				duparg2("key", *argv);
Packit d3f73b
			flags |= TUNNEL_KEY;
Packit d3f73b
		} else if (strcmp(*argv, "csum") == 0) {
Packit d3f73b
			if (csum_ok++)
Packit d3f73b
				duparg2("csum", *argv);
Packit d3f73b
			flags |= TUNNEL_CSUM;
Packit d3f73b
		} else if (strcmp(*argv, "seq") == 0) {
Packit d3f73b
			if (seq_ok++)
Packit d3f73b
				duparg2("seq", *argv);
Packit d3f73b
			flags |= TUNNEL_SEQ;
Packit d3f73b
		} else {
Packit d3f73b
			break;
Packit d3f73b
		}
Packit d3f73b
		if (ret)
Packit d3f73b
			break;
Packit d3f73b
		argc--; argv++;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (flags)
Packit d3f73b
		ret = rta_addattr16(rta, len,  LWTUNNEL_IP_FLAGS, flags);
Packit d3f73b
Packit d3f73b
	/* argv is currently the first unparsed argument,
Packit d3f73b
	 * but the lwt_parse_encap() caller will move to the next,
Packit d3f73b
	 * so step back
Packit d3f73b
	 */
Packit d3f73b
	*argcp = argc + 1;
Packit d3f73b
	*argvp = argv - 1;
Packit d3f73b
Packit d3f73b
	return ret;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static int parse_encap_ila(struct rtattr *rta, size_t len,
Packit d3f73b
			   int *argcp, char ***argvp)
Packit d3f73b
{
Packit d3f73b
	__u64 locator;
Packit d3f73b
	int argc = *argcp;
Packit d3f73b
	char **argv = *argvp;
Packit d3f73b
	int ret = 0;
Packit d3f73b
Packit d3f73b
	if (get_addr64(&locator, *argv) < 0) {
Packit d3f73b
		fprintf(stderr, "Bad locator: %s\n", *argv);
Packit d3f73b
		exit(1);
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	argc--; argv++;
Packit d3f73b
Packit d3f73b
	if (rta_addattr64(rta, len, ILA_ATTR_LOCATOR, locator))
Packit d3f73b
		return -1;
Packit d3f73b
Packit d3f73b
	while (argc > 0) {
Packit d3f73b
		if (strcmp(*argv, "csum-mode") == 0) {
Packit d3f73b
			int csum_mode;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
Packit d3f73b
			csum_mode = ila_csum_name2mode(*argv);
Packit d3f73b
			if (csum_mode < 0)
Packit d3f73b
				invarg("\"csum-mode\" value is invalid\n",
Packit d3f73b
				       *argv);
Packit d3f73b
Packit d3f73b
			ret = rta_addattr8(rta, len, ILA_ATTR_CSUM_MODE,
Packit d3f73b
					   (__u8)csum_mode);
Packit d3f73b
Packit d3f73b
			argc--; argv++;
Packit d3f73b
		} else if (strcmp(*argv, "ident-type") == 0) {
Packit d3f73b
			int ident_type;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
Packit d3f73b
			ident_type = ila_ident_name2type(*argv);
Packit d3f73b
			if (ident_type < 0)
Packit d3f73b
				invarg("\"ident-type\" value is invalid\n",
Packit d3f73b
				       *argv);
Packit d3f73b
Packit d3f73b
			ret = rta_addattr8(rta, len, ILA_ATTR_IDENT_TYPE,
Packit d3f73b
					   (__u8)ident_type);
Packit d3f73b
Packit d3f73b
			argc--; argv++;
Packit d3f73b
		} else if (strcmp(*argv, "hook-type") == 0) {
Packit d3f73b
			int hook_type;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
Packit d3f73b
			hook_type = ila_hook_name2type(*argv);
Packit d3f73b
			if (hook_type < 0)
Packit d3f73b
				invarg("\"hook-type\" value is invalid\n",
Packit d3f73b
				       *argv);
Packit d3f73b
Packit d3f73b
			ret = rta_addattr8(rta, len, ILA_ATTR_HOOK_TYPE,
Packit d3f73b
					   (__u8)hook_type);
Packit d3f73b
Packit d3f73b
			argc--; argv++;
Packit d3f73b
		} else {
Packit d3f73b
			break;
Packit d3f73b
		}
Packit d3f73b
		if (ret)
Packit d3f73b
			break;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	/* argv is currently the first unparsed argument,
Packit d3f73b
	 * but the lwt_parse_encap() caller will move to the next,
Packit d3f73b
	 * so step back
Packit d3f73b
	 */
Packit d3f73b
	*argcp = argc + 1;
Packit d3f73b
	*argvp = argv - 1;
Packit d3f73b
Packit d3f73b
	return ret;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static int parse_encap_ip6(struct rtattr *rta, size_t len,
Packit d3f73b
			   int *argcp, char ***argvp)
Packit d3f73b
{
Packit d3f73b
	int id_ok = 0, dst_ok = 0, src_ok = 0, tos_ok = 0, ttl_ok = 0;
Packit Service 14c19c
	int key_ok = 0, csum_ok = 0, seq_ok = 0, opts_ok = 0;
Packit d3f73b
	char **argv = *argvp;
Packit d3f73b
	int argc = *argcp;
Packit d3f73b
	int ret = 0;
Packit d3f73b
	__u16 flags = 0;
Packit d3f73b
Packit d3f73b
	while (argc > 0) {
Packit d3f73b
		if (strcmp(*argv, "id") == 0) {
Packit d3f73b
			__u64 id;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (id_ok++)
Packit d3f73b
				duparg2("id", *argv);
Packit d3f73b
			if (get_be64(&id, *argv, 0))
Packit d3f73b
				invarg("\"id\" value is invalid\n", *argv);
Packit d3f73b
			ret = rta_addattr64(rta, len, LWTUNNEL_IP6_ID, id);
Packit d3f73b
		} else if (strcmp(*argv, "dst") == 0) {
Packit d3f73b
			inet_prefix addr;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (dst_ok++)
Packit d3f73b
				duparg2("dst", *argv);
Packit d3f73b
			get_addr(&addr, *argv, AF_INET6);
Packit d3f73b
			ret = rta_addattr_l(rta, len, LWTUNNEL_IP6_DST,
Packit d3f73b
					    &addr.data, addr.bytelen);
Packit d3f73b
		} else if (strcmp(*argv, "src") == 0) {
Packit d3f73b
			inet_prefix addr;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (src_ok++)
Packit d3f73b
				duparg2("src", *argv);
Packit d3f73b
			get_addr(&addr, *argv, AF_INET6);
Packit d3f73b
			ret = rta_addattr_l(rta, len, LWTUNNEL_IP6_SRC,
Packit d3f73b
					    &addr.data, addr.bytelen);
Packit d3f73b
		} else if (strcmp(*argv, "tc") == 0) {
Packit d3f73b
			__u32 tc;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (tos_ok++)
Packit d3f73b
				duparg2("tc", *argv);
Packit d3f73b
			if (rtnl_dsfield_a2n(&tc, *argv))
Packit d3f73b
				invarg("\"tc\" value is invalid\n", *argv);
Packit d3f73b
			ret = rta_addattr8(rta, len, LWTUNNEL_IP6_TC, tc);
Packit d3f73b
		} else if (strcmp(*argv, "hoplimit") == 0) {
Packit d3f73b
			__u8 hoplimit;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (ttl_ok++)
Packit d3f73b
				duparg2("hoplimit", *argv);
Packit d3f73b
			if (get_u8(&hoplimit, *argv, 0))
Packit d3f73b
				invarg("\"hoplimit\" value is invalid\n",
Packit d3f73b
				       *argv);
Packit d3f73b
			ret = rta_addattr8(rta, len, LWTUNNEL_IP6_HOPLIMIT,
Packit d3f73b
					   hoplimit);
Packit Service 14c19c
		} else if (strcmp(*argv, "geneve_opts") == 0) {
Packit Service 14c19c
			struct rtattr *nest;
Packit Service 14c19c
Packit Service 14c19c
			if (opts_ok++)
Packit Service 14c19c
				duparg2("opts", *argv);
Packit Service 14c19c
Packit Service 14c19c
			NEXT_ARG();
Packit Service 14c19c
Packit Service 14c19c
			nest = rta_nest(rta, len,
Packit Service 14c19c
					LWTUNNEL_IP_OPTS | NLA_F_NESTED);
Packit Service 14c19c
			ret = lwtunnel_parse_geneve_opts(*argv, len, rta);
Packit Service 14c19c
			if (ret)
Packit Service 14c19c
				invarg("\"geneve_opts\" value is invalid\n",
Packit Service 14c19c
				       *argv);
Packit Service 14c19c
			rta_nest_end(rta, nest);
Packit Service aad4f7
		} else if (strcmp(*argv, "vxlan_opts") == 0) {
Packit Service aad4f7
			struct rtattr *nest;
Packit Service aad4f7
Packit Service aad4f7
			if (opts_ok++)
Packit Service aad4f7
				duparg2("opts", *argv);
Packit Service aad4f7
Packit Service aad4f7
			NEXT_ARG();
Packit Service aad4f7
Packit Service aad4f7
			nest = rta_nest(rta, len,
Packit Service aad4f7
					LWTUNNEL_IP_OPTS | NLA_F_NESTED);
Packit Service aad4f7
			ret = lwtunnel_parse_vxlan_opts(*argv, len, rta);
Packit Service aad4f7
			if (ret)
Packit Service aad4f7
				invarg("\"vxlan_opts\" value is invalid\n",
Packit Service aad4f7
				       *argv);
Packit Service aad4f7
			rta_nest_end(rta, nest);
Packit Service cfda42
		} else if (strcmp(*argv, "erspan_opts") == 0) {
Packit Service cfda42
			struct rtattr *nest;
Packit Service cfda42
Packit Service cfda42
			if (opts_ok++)
Packit Service cfda42
				duparg2("opts", *argv);
Packit Service cfda42
Packit Service cfda42
			NEXT_ARG();
Packit Service cfda42
Packit Service cfda42
			nest = rta_nest(rta, len,
Packit Service cfda42
					LWTUNNEL_IP_OPTS | NLA_F_NESTED);
Packit Service cfda42
			ret = lwtunnel_parse_erspan_opts(*argv, len, rta);
Packit Service cfda42
			if (ret)
Packit Service cfda42
				invarg("\"erspan_opts\" value is invalid\n",
Packit Service cfda42
				       *argv);
Packit Service cfda42
			rta_nest_end(rta, nest);
Packit d3f73b
		} else if (strcmp(*argv, "key") == 0) {
Packit d3f73b
			if (key_ok++)
Packit d3f73b
				duparg2("key", *argv);
Packit d3f73b
			flags |= TUNNEL_KEY;
Packit d3f73b
		} else if (strcmp(*argv, "csum") == 0) {
Packit d3f73b
			if (csum_ok++)
Packit d3f73b
				duparg2("csum", *argv);
Packit d3f73b
			flags |= TUNNEL_CSUM;
Packit d3f73b
		} else if (strcmp(*argv, "seq") == 0) {
Packit d3f73b
			if (seq_ok++)
Packit d3f73b
				duparg2("seq", *argv);
Packit d3f73b
			flags |= TUNNEL_SEQ;
Packit d3f73b
		} else {
Packit d3f73b
			break;
Packit d3f73b
		}
Packit d3f73b
		if (ret)
Packit d3f73b
			break;
Packit d3f73b
		argc--; argv++;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	if (flags)
Packit d3f73b
		ret = rta_addattr16(rta, len,  LWTUNNEL_IP6_FLAGS, flags);
Packit d3f73b
Packit d3f73b
	/* argv is currently the first unparsed argument,
Packit d3f73b
	 * but the lwt_parse_encap() caller will move to the next,
Packit d3f73b
	 * so step back
Packit d3f73b
	 */
Packit d3f73b
	*argcp = argc + 1;
Packit d3f73b
	*argvp = argv - 1;
Packit d3f73b
Packit d3f73b
	return ret;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static void lwt_bpf_usage(void)
Packit d3f73b
{
Packit d3f73b
	fprintf(stderr, "Usage: ip route ... encap bpf [ in BPF ] [ out BPF ] [ xmit BPF ] [...]\n");
Packit d3f73b
	fprintf(stderr, "BPF := obj FILE [ section NAME ] [ verbose ]\n");
Packit d3f73b
	exit(-1);
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static int parse_encap_bpf(struct rtattr *rta, size_t len, int *argcp,
Packit d3f73b
			   char ***argvp)
Packit d3f73b
{
Packit d3f73b
	char **argv = *argvp;
Packit d3f73b
	int argc = *argcp;
Packit d3f73b
	int headroom_set = 0;
Packit d3f73b
Packit d3f73b
	while (argc > 0) {
Packit d3f73b
		if (strcmp(*argv, "in") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (lwt_parse_bpf(rta, len, &argc, &argv, LWT_BPF_IN,
Packit d3f73b
					  BPF_PROG_TYPE_LWT_IN) < 0)
Packit d3f73b
				return -1;
Packit d3f73b
		} else if (strcmp(*argv, "out") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (lwt_parse_bpf(rta, len, &argc, &argv, LWT_BPF_OUT,
Packit d3f73b
					  BPF_PROG_TYPE_LWT_OUT) < 0)
Packit d3f73b
				return -1;
Packit d3f73b
		} else if (strcmp(*argv, "xmit") == 0) {
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (lwt_parse_bpf(rta, len, &argc, &argv, LWT_BPF_XMIT,
Packit d3f73b
					  BPF_PROG_TYPE_LWT_XMIT) < 0)
Packit d3f73b
				return -1;
Packit d3f73b
		} else if (strcmp(*argv, "headroom") == 0) {
Packit d3f73b
			unsigned int headroom;
Packit d3f73b
Packit d3f73b
			NEXT_ARG();
Packit d3f73b
			if (get_unsigned(&headroom, *argv, 0) || headroom == 0)
Packit d3f73b
				invarg("headroom is invalid\n", *argv);
Packit d3f73b
			if (!headroom_set)
Packit d3f73b
				rta_addattr32(rta, len, LWT_BPF_XMIT_HEADROOM,
Packit d3f73b
					      headroom);
Packit d3f73b
			headroom_set = 1;
Packit d3f73b
		} else if (strcmp(*argv, "help") == 0) {
Packit d3f73b
			lwt_bpf_usage();
Packit d3f73b
		} else {
Packit d3f73b
			break;
Packit d3f73b
		}
Packit d3f73b
		NEXT_ARG_FWD();
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	/* argv is currently the first unparsed argument,
Packit d3f73b
	 * but the lwt_parse_encap() caller will move to the next,
Packit d3f73b
	 * so step back
Packit d3f73b
	 */
Packit d3f73b
	*argcp = argc + 1;
Packit d3f73b
	*argvp = argv - 1;
Packit d3f73b
Packit d3f73b
	return 0;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
int lwt_parse_encap(struct rtattr *rta, size_t len, int *argcp, char ***argvp,
Packit d3f73b
		    int encap_attr, int encap_type_attr)
Packit d3f73b
{
Packit d3f73b
	struct rtattr *nest;
Packit d3f73b
	int argc = *argcp;
Packit d3f73b
	char **argv = *argvp;
Packit d3f73b
	__u16 type;
Packit d3f73b
	int ret = 0;
Packit d3f73b
Packit d3f73b
	NEXT_ARG();
Packit d3f73b
	type = read_encap_type(*argv);
Packit d3f73b
	if (!type)
Packit d3f73b
		invarg("\"encap type\" value is invalid\n", *argv);
Packit d3f73b
Packit d3f73b
	NEXT_ARG();
Packit d3f73b
	if (argc <= 1) {
Packit d3f73b
		fprintf(stderr,
Packit d3f73b
			"Error: unexpected end of line after \"encap\"\n");
Packit d3f73b
		exit(-1);
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	nest = rta_nest(rta, len, encap_attr);
Packit d3f73b
	switch (type) {
Packit d3f73b
	case LWTUNNEL_ENCAP_MPLS:
Packit d3f73b
		ret = parse_encap_mpls(rta, len, &argc, &argv);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_IP:
Packit d3f73b
		ret = parse_encap_ip(rta, len, &argc, &argv);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_ILA:
Packit d3f73b
		ret = parse_encap_ila(rta, len, &argc, &argv);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_IP6:
Packit d3f73b
		ret = parse_encap_ip6(rta, len, &argc, &argv);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_BPF:
Packit d3f73b
		if (parse_encap_bpf(rta, len, &argc, &argv) < 0)
Packit d3f73b
			exit(-1);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_SEG6:
Packit d3f73b
		ret = parse_encap_seg6(rta, len, &argc, &argv);
Packit d3f73b
		break;
Packit d3f73b
	case LWTUNNEL_ENCAP_SEG6_LOCAL:
Packit d3f73b
		ret = parse_encap_seg6local(rta, len, &argc, &argv);
Packit d3f73b
		break;
Packit d3f73b
	default:
Packit d3f73b
		fprintf(stderr, "Error: unsupported encap type\n");
Packit d3f73b
		break;
Packit d3f73b
	}
Packit d3f73b
	if (ret)
Packit d3f73b
		return ret;
Packit d3f73b
Packit d3f73b
	rta_nest_end(rta, nest);
Packit d3f73b
Packit d3f73b
	ret = rta_addattr16(rta, len, encap_type_attr, type);
Packit d3f73b
Packit d3f73b
	*argcp = argc;
Packit d3f73b
	*argvp = argv;
Packit d3f73b
Packit d3f73b
	return ret;
Packit d3f73b
}