/*

 * link_vti.c	VTI driver module

 *

 *		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, or (at your option) any later version.

 *

 * Authors:	Herbert Xu <herbert@gondor.apana.org.au>

 *          Saurabh Mohan <saurabh.mohan@vyatta.com> Modified link_gre.c for VTI

 */

#include <string.h>

#include <net/if.h>

#include <sys/types.h>

#include <sys/socket.h>

#include <arpa/inet.h>

#include <linux/ip.h>

#include <linux/if_tunnel.h>

#include "rt_names.h"

#include "utils.h"

#include "ip_common.h"

#include "tunnel.h"

static void vti_print_help(struct link_util *lu, int argc, char **argv, FILE *f)

{

	fprintf(f,

		"Usage: ... %-4s	[ remote ADDR ]\n"

		"		[ local ADDR ]\n"

		"		[ [i|o]key KEY ]\n"

		"		[ dev PHYS_DEV ]\n"

		"		[ fwmark MARK ]\n"

		"\n"

		"Where:	ADDR := { IP_ADDRESS }\n"

		"	KEY  := { DOTTED_QUAD | NUMBER }\n"

		"	MARK := { 0x0..0xffffffff }\n",

		lu->id);

}

static int vti_parse_opt(struct link_util *lu, int argc, char **argv,

			 struct nlmsghdr *n)

{

	struct ifinfomsg *ifi = NLMSG_DATA(n);

	struct {

		struct nlmsghdr n;

		struct ifinfomsg i;

	} req = {

		.n.nlmsg_len = NLMSG_LENGTH(sizeof(*ifi)),

		.n.nlmsg_flags = NLM_F_REQUEST,

		.n.nlmsg_type = RTM_GETLINK,

		.i.ifi_family = preferred_family,

		.i.ifi_index = ifi->ifi_index,

	};

	struct nlmsghdr *answer;

	struct rtattr *tb[IFLA_MAX + 1];

	struct rtattr *linkinfo[IFLA_INFO_MAX+1];

	struct rtattr *vtiinfo[IFLA_VTI_MAX + 1];

	__be32 ikey = 0;

	__be32 okey = 0;

	inet_prefix saddr, daddr;

	unsigned int link = 0;

	__u32 fwmark = 0;

	int len;

	inet_prefix_reset(&saddr);

	inet_prefix_reset(&daddr);

	if (!(n->nlmsg_flags & NLM_F_CREATE)) {

		const struct rtattr *rta;

		if (rtnl_talk(&rth, &req.n, &answer) < 0) {

get_failed:

			fprintf(stderr,

				"Failed to get existing tunnel info.\n");

			return -1;

		}

		len = answer->nlmsg_len;

		len -= NLMSG_LENGTH(sizeof(*ifi));

		if (len < 0)

			goto get_failed;

		parse_rtattr(tb, IFLA_MAX, IFLA_RTA(NLMSG_DATA(answer)), len);

		if (!tb[IFLA_LINKINFO])

			goto get_failed;

		parse_rtattr_nested(linkinfo, IFLA_INFO_MAX, tb[IFLA_LINKINFO]);

		if (!linkinfo[IFLA_INFO_DATA])

			goto get_failed;

		parse_rtattr_nested(vtiinfo, IFLA_VTI_MAX,

				    linkinfo[IFLA_INFO_DATA]);

		rta = vtiinfo[IFLA_VTI_LOCAL];

		if (rta && get_addr_rta(&saddr, rta, AF_INET))

			goto get_failed;

		rta = vtiinfo[IFLA_VTI_REMOTE];

		if (rta && get_addr_rta(&daddr, rta, AF_INET))

			goto get_failed;

		if (vtiinfo[IFLA_VTI_IKEY])

			ikey = rta_getattr_u32(vtiinfo[IFLA_VTI_IKEY]);

		if (vtiinfo[IFLA_VTI_OKEY])

			okey = rta_getattr_u32(vtiinfo[IFLA_VTI_OKEY]);

		if (vtiinfo[IFLA_VTI_LINK])

			link = rta_getattr_u8(vtiinfo[IFLA_VTI_LINK]);

		if (vtiinfo[IFLA_VTI_FWMARK])

			fwmark = rta_getattr_u32(vtiinfo[IFLA_VTI_FWMARK]);

		free(answer);

	}

	while (argc > 0) {

		if (!matches(*argv, "key")) {

			NEXT_ARG();

			ikey = okey = tnl_parse_key("key", *argv);

		} else if (!matches(*argv, "ikey")) {

			NEXT_ARG();

			ikey = tnl_parse_key("ikey", *argv);

		} else if (!matches(*argv, "okey")) {

			NEXT_ARG();

			okey = tnl_parse_key("okey", *argv);

		} else if (!matches(*argv, "remote")) {

			NEXT_ARG();

			get_addr(&daddr, *argv, AF_INET);

		} else if (!matches(*argv, "local")) {

			NEXT_ARG();

			get_addr(&saddr, *argv, AF_INET);

		} else if (!matches(*argv, "dev")) {

			NEXT_ARG();

			link = ll_name_to_index(*argv);

			if (!link)

				exit(nodev(*argv));

		} else if (strcmp(*argv, "fwmark") == 0) {

			NEXT_ARG();

			if (get_u32(&fwmark, *argv, 0))

				invarg("invalid fwmark\n", *argv);

		} else {

			vti_print_help(lu, argc, argv, stderr);

			return -1;

		}

		argc--; argv++;

	}

	addattr32(n, 1024, IFLA_VTI_IKEY, ikey);

	addattr32(n, 1024, IFLA_VTI_OKEY, okey);

	if (is_addrtype_inet_not_unspec(&saddr))

		addattr_l(n, 1024, IFLA_VTI_LOCAL, saddr.data, saddr.bytelen);

	if (is_addrtype_inet_not_unspec(&daddr))

		addattr_l(n, 1024, IFLA_VTI_REMOTE, daddr.data, daddr.bytelen);

	addattr32(n, 1024, IFLA_VTI_FWMARK, fwmark);

	if (link)

		addattr32(n, 1024, IFLA_VTI_LINK, link);

	return 0;

}

static void vti_print_opt(struct link_util *lu, FILE *f, struct rtattr *tb[])

{

	char s2[64];

	if (!tb)

		return;

	tnl_print_endpoint("remote", tb[IFLA_VTI_REMOTE], AF_INET);

	tnl_print_endpoint("local", tb[IFLA_VTI_LOCAL], AF_INET);

	if (tb[IFLA_VTI_LINK]) {

		__u32 link = rta_getattr_u32(tb[IFLA_VTI_LINK]);

		if (link) {

			print_string(PRINT_ANY, "link", "dev %s ",

				     ll_index_to_name(link));

		}

	}

	if (tb[IFLA_VTI_IKEY]) {

		struct rtattr *rta = tb[IFLA_VTI_IKEY];

		__u32 key = rta_getattr_u32(rta);

		if (key && inet_ntop(AF_INET, RTA_DATA(rta), s2, sizeof(s2)))

			print_string(PRINT_ANY, "ikey", "ikey %s ", s2);

	}

	if (tb[IFLA_VTI_OKEY]) {

		struct rtattr *rta = tb[IFLA_VTI_OKEY];

		__u32 key = rta_getattr_u32(rta);

		if (key && inet_ntop(AF_INET, RTA_DATA(rta), s2, sizeof(s2)))

			print_string(PRINT_ANY, "okey", "okey %s ", s2);

	}

	if (tb[IFLA_VTI_FWMARK]) {

		__u32 fwmark = rta_getattr_u32(tb[IFLA_VTI_FWMARK]);

		if (fwmark) {

			print_0xhex(PRINT_ANY,

				    "fwmark", "fwmark %#llx ", fwmark);

		}

	}

}

struct link_util vti_link_util = {

	.id = "vti",

	.maxattr = IFLA_VTI_MAX,

	.parse_opt = vti_parse_opt,

	.print_opt = vti_print_opt,

	.print_help = vti_print_help,

};