[mirror_iproute2.git] / ip / ip6tunnel.c

/*
 * Copyright (C)2006 USAGI/WIDE Project
 *
 * 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.
 *
 * 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
 */
/*
 * Author:
 *	Masahide NAKAMURA @USAGI
 */

#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <unistd.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <arpa/inet.h>
#include <sys/ioctl.h>
#include <linux/ip.h>
#include <linux/if.h>
#include <linux/if_arp.h>
#include <linux/if_tunnel.h>
#include <linux/ip6_tunnel.h>

#include "utils.h"
#include "tunnel.h"
#include "ip_common.h"

#define IP6_FLOWINFO_TCLASS	htonl(0x0FF00000)
#define IP6_FLOWINFO_FLOWLABEL	htonl(0x000FFFFF)

#define DEFAULT_TNL_HOP_LIMIT	(64)

static void usage(void) __attribute__((noreturn));

static void usage(void)
{
	fprintf(stderr, "Usage: ip -f inet6 tunnel { add | change | del | show } [ NAME ]\n");
	fprintf(stderr, "          [ mode { ip6ip6 | ipip6 | any } ]\n");
	fprintf(stderr, "          [ remote ADDR local ADDR ] [ dev PHYS_DEV ]\n");
	fprintf(stderr, "          [ encaplimit ELIM ]\n");
	fprintf(stderr ,"          [ hoplimit TTL ] [ tclass TCLASS ] [ flowlabel FLOWLABEL ]\n");
	fprintf(stderr, "          [ dscp inherit ]\n");
	fprintf(stderr, "\n");
	fprintf(stderr, "Where: NAME      := STRING\n");
	fprintf(stderr, "       ADDR      := IPV6_ADDRESS\n");
	fprintf(stderr, "       ELIM      := { none | 0..255 }(default=%d)\n",
		IPV6_DEFAULT_TNL_ENCAP_LIMIT);
	fprintf(stderr, "       TTL       := 0..255 (default=%d)\n",
		DEFAULT_TNL_HOP_LIMIT);
	fprintf(stderr, "       TCLASS    := { 0x0..0xff | inherit }\n");
	fprintf(stderr, "       FLOWLABEL := { 0x0..0xfffff | inherit }\n");
	exit(-1);
}

static void print_tunnel(struct ip6_tnl_parm *p)
{
	char remote[64];
	char local[64];

	inet_ntop(AF_INET6, &p->raddr, remote, sizeof(remote));
	inet_ntop(AF_INET6, &p->laddr, local, sizeof(local));

	printf("%s: %s/ipv6 remote %s local %s",
	       p->name, tnl_strproto(p->proto), remote, local);
	if (p->link) {
		const char *n = ll_index_to_name(p->link);
		if (n)
			printf(" dev %s", n);
	}

	if (p->flags & IP6_TNL_F_IGN_ENCAP_LIMIT)
		printf(" encaplimit none");
	else
		printf(" encaplimit %u", p->encap_limit);

	printf(" hoplimit %u", p->hop_limit);

	if (p->flags & IP6_TNL_F_USE_ORIG_TCLASS)
		printf(" tclass inherit");
	else {
		__u32 val = ntohl(p->flowinfo & IP6_FLOWINFO_TCLASS);
		printf(" tclass 0x%02x", (__u8)(val >> 20));
	}

	if (p->flags & IP6_TNL_F_USE_ORIG_FLOWLABEL)
		printf(" flowlabel inherit");
	else
		printf(" flowlabel 0x%05x", ntohl(p->flowinfo & IP6_FLOWINFO_FLOWLABEL));

	printf(" (flowinfo 0x%08x)", ntohl(p->flowinfo));

	if (p->flags & IP6_TNL_F_RCV_DSCP_COPY)
		printf(" dscp inherit");
}

static int parse_args(int argc, char **argv, int cmd, struct ip6_tnl_parm *p)
{
	int count = 0;
	char medium[IFNAMSIZ];

	memset(medium, 0, sizeof(medium));

	while (argc > 0) {
		if (strcmp(*argv, "mode") == 0) {
			NEXT_ARG();
			if (strcmp(*argv, "ipv6/ipv6") == 0 ||
			    strcmp(*argv, "ip6ip6") == 0)
				p->proto = IPPROTO_IPV6;
			else if (strcmp(*argv, "ip/ipv6") == 0 ||
				 strcmp(*argv, "ipv4/ipv6") == 0 ||
				 strcmp(*argv, "ipip6") == 0 ||
				 strcmp(*argv, "ip4ip6") == 0)
				p->proto = IPPROTO_IPIP;
			else if (strcmp(*argv, "any/ipv6") == 0 ||
				 strcmp(*argv, "any") == 0)
				p->proto = 0;
			else {
                                fprintf(stderr,"Cannot guess tunnel mode.\n");
                                exit(-1);
                        }
                } else if (strcmp(*argv, "remote") == 0) {
			inet_prefix raddr;
			NEXT_ARG();
			get_prefix(&raddr, *argv, preferred_family);
			if (raddr.family == AF_UNSPEC)
				invarg("\"remote\" address family is AF_UNSPEC", *argv);
			memcpy(&p->raddr, &raddr.data, sizeof(p->raddr));
		} else if (strcmp(*argv, "local") == 0) {
			inet_prefix laddr;
			NEXT_ARG();
			get_prefix(&laddr, *argv, preferred_family);
			if (laddr.family == AF_UNSPEC)
				invarg("\"local\" address family is AF_UNSPEC", *argv);
			memcpy(&p->laddr, &laddr.data, sizeof(p->laddr));
		} else if (strcmp(*argv, "dev") == 0) {
			NEXT_ARG();
			strncpy(medium, *argv, IFNAMSIZ - 1);
		} else if (strcmp(*argv, "encaplimit") == 0) {
			NEXT_ARG();
			if (strcmp(*argv, "none") == 0) {
				p->flags |= IP6_TNL_F_IGN_ENCAP_LIMIT;
			} else {
				__u8 uval;
				if (get_u8(&uval, *argv, 0) < -1)
					invarg("invalid ELIM", *argv);
				p->encap_limit = uval;
				p->flags &= ~IP6_TNL_F_IGN_ENCAP_LIMIT;
			}
		} else if (strcmp(*argv, "hoplimit") == 0 ||
			   strcmp(*argv, "ttl") == 0 ||
			   strcmp(*argv, "hlim") == 0) {
			__u8 uval;
			NEXT_ARG();
			if (get_u8(&uval, *argv, 0))
				invarg("invalid TTL", *argv);
			p->hop_limit = uval;
		} else if (strcmp(*argv, "tclass") == 0 ||
			   strcmp(*argv, "tc") == 0 ||
			   strcmp(*argv, "tos") == 0 ||
			   matches(*argv, "dsfield") == 0) {
			__u8 uval;
			NEXT_ARG();
			p->flowinfo &= ~IP6_FLOWINFO_TCLASS;
			if (strcmp(*argv, "inherit") == 0)
				p->flags |= IP6_TNL_F_USE_ORIG_TCLASS;
			else {
				if (get_u8(&uval, *argv, 16))
					invarg("invalid TClass", *argv);
				p->flowinfo |= htonl((__u32)uval << 20) & IP6_FLOWINFO_TCLASS;
				p->flags &= ~IP6_TNL_F_USE_ORIG_TCLASS;
			}
		} else if (strcmp(*argv, "flowlabel") == 0 ||
			   strcmp(*argv, "fl") == 0) {
			__u32 uval;
			NEXT_ARG();
			p->flowinfo &= ~IP6_FLOWINFO_FLOWLABEL;
			if (strcmp(*argv, "inherit") == 0)
				p->flags |= IP6_TNL_F_USE_ORIG_FLOWLABEL;
			else {
				if (get_u32(&uval, *argv, 16))
					invarg("invalid Flowlabel", *argv);
				if (uval > 0xFFFFF)
					invarg("invalid Flowlabel", *argv);
				p->flowinfo |= htonl(uval) & IP6_FLOWINFO_FLOWLABEL;
				p->flags &= ~IP6_TNL_F_USE_ORIG_FLOWLABEL;
			}
		} else if (strcmp(*argv, "dscp") == 0) {
			NEXT_ARG();
			if (strcmp(*argv, "inherit") != 0)
				invarg("not inherit", *argv);
			p->flags |= IP6_TNL_F_RCV_DSCP_COPY;
		} else {
			if (strcmp(*argv, "name") == 0) {
				NEXT_ARG();
			}
			if (matches(*argv, "help") == 0)
				usage();
			if (p->name[0])
				duparg2("name", *argv);
			strncpy(p->name, *argv, IFNAMSIZ - 1);
			if (cmd == SIOCCHGTUNNEL && count == 0) {
				struct ip6_tnl_parm old_p;
				memset(&old_p, 0, sizeof(old_p));
				if (tnl_get_ioctl(*argv, &old_p))
					return -1;
				*p = old_p;
			}
		}
		count++;
		argc--; argv++;
	}
	if (medium[0]) {
		p->link = ll_name_to_index(medium);
		if (p->link == 0)
			return -1;
	}
	return 0;
}

static void ip6_tnl_parm_init(struct ip6_tnl_parm *p, int apply_default)
{
	memset(p, 0, sizeof(*p));
	p->proto = IPPROTO_IPV6;
	if (apply_default) {
		p->hop_limit = DEFAULT_TNL_HOP_LIMIT;
		p->encap_limit = IPV6_DEFAULT_TNL_ENCAP_LIMIT;
	}
}

/*
 * @p1: user specified parameter
 * @p2: database entry
 */
static int ip6_tnl_parm_match(const struct ip6_tnl_parm *p1,
			      const struct ip6_tnl_parm *p2)
{
	return ((!p1->link || p1->link == p2->link) &&
		(!p1->name[0] || strcmp(p1->name, p2->name) == 0) &&
		(memcmp(&p1->laddr, &in6addr_any, sizeof(p1->laddr)) == 0 ||
		 memcmp(&p1->laddr, &p2->laddr, sizeof(p1->laddr)) == 0) &&
		(memcmp(&p1->raddr, &in6addr_any, sizeof(p1->raddr)) == 0 ||
		 memcmp(&p1->raddr, &p2->raddr, sizeof(p1->raddr)) == 0) &&
		(!p1->proto || !p2->proto || p1->proto == p2->proto) &&
		(!p1->encap_limit || p1->encap_limit == p2->encap_limit) &&
		(!p1->hop_limit || p1->hop_limit == p2->hop_limit) &&
		(!(p1->flowinfo & IP6_FLOWINFO_TCLASS) ||
		 !((p1->flowinfo ^ p2->flowinfo) & IP6_FLOWINFO_TCLASS)) &&
		(!(p1->flowinfo & IP6_FLOWINFO_FLOWLABEL) ||
		 !((p1->flowinfo ^ p2->flowinfo) & IP6_FLOWINFO_FLOWLABEL)) &&
		(!p1->flags || (p1->flags & p2->flags)));
}

static int do_tunnels_list(struct ip6_tnl_parm *p)
{
	char buf[512];
	int err = -1;
	FILE *fp = fopen("/proc/net/dev", "r");
	if (fp == NULL) {
		perror("fopen");
		goto end;
	}

	/* skip two lines at the begenning of the file */
	if (!fgets(buf, sizeof(buf), fp) ||
	    !fgets(buf, sizeof(buf), fp)) {
		fprintf(stderr, "/proc/net/dev read error\n");
		return -1;
	}

	while (fgets(buf, sizeof(buf), fp) != NULL) {
		char name[IFNAMSIZ];
		int index, type;
		unsigned long rx_bytes, rx_packets, rx_errs, rx_drops,
			rx_fifo, rx_frame,
			tx_bytes, tx_packets, tx_errs, tx_drops,
			tx_fifo, tx_colls, tx_carrier, rx_multi;
		struct ip6_tnl_parm p1;
		char *ptr;

		buf[sizeof(buf) - 1] = '\0';
		if ((ptr = strchr(buf, ':')) == NULL ||
		    (*ptr++ = 0, sscanf(buf, "%s", name) != 1)) {
			fprintf(stderr, "Wrong format of /proc/net/dev. Sorry.\n");
			goto end;
		}
		if (sscanf(ptr, "%ld%ld%ld%ld%ld%ld%ld%*d%ld%ld%ld%ld%ld%ld%ld",
			   &rx_bytes, &rx_packets, &rx_errs, &rx_drops,
			   &rx_fifo, &rx_frame, &rx_multi,
			   &tx_bytes, &tx_packets, &tx_errs, &tx_drops,
			   &tx_fifo, &tx_colls, &tx_carrier) != 14)
			continue;
		if (p->name[0] && strcmp(p->name, name))
			continue;
		index = ll_name_to_index(name);
		if (index == 0)
			continue;
		type = ll_index_to_type(index);
		if (type == -1) {
			fprintf(stderr, "Failed to get type of [%s]\n", name);
			continue;
		}
		if (type != ARPHRD_TUNNEL6)
			continue;
		memset(&p1, 0, sizeof(p1));
		ip6_tnl_parm_init(&p1, 0);
		strcpy(p1.name, name);
		p1.link = ll_name_to_index(p1.name);
		if (p1.link == 0)
			continue;
		if (tnl_get_ioctl(p1.name, &p1))
			continue;
		if (!ip6_tnl_parm_match(p, &p1))
			continue;
		print_tunnel(&p1);
		if (show_stats) {
			printf("%s", _SL_);
			printf("RX: Packets    Bytes        Errors CsumErrs OutOfSeq Mcasts%s", _SL_);
			printf("    %-10ld %-12ld %-6ld %-8ld %-8ld %-8ld%s",
			       rx_packets, rx_bytes, rx_errs, rx_frame, rx_fifo, rx_multi, _SL_);
			printf("TX: Packets    Bytes        Errors DeadLoop NoRoute  NoBufs%s", _SL_);
			printf("    %-10ld %-12ld %-6ld %-8ld %-8ld %-6ld",
			       tx_packets, tx_bytes, tx_errs, tx_colls, tx_carrier, tx_drops);
		}
		printf("\n");
	}
	err = 0;

 end:
	if (fp)
		fclose(fp);
	return err;
}

static int do_show(int argc, char **argv)
{
        struct ip6_tnl_parm p;

	ll_init_map(&rth);
	ip6_tnl_parm_init(&p, 0);
	p.proto = 0;  /* default to any */

        if (parse_args(argc, argv, SIOCGETTUNNEL, &p) < 0)
                return -1;

	if (!p.name[0] || show_stats)
		do_tunnels_list(&p);
	else {
		if (tnl_get_ioctl(p.name, &p))
			return -1;
		print_tunnel(&p);
		printf("\n");
	}

        return 0;
}

static int do_add(int cmd, int argc, char **argv)
{
	struct ip6_tnl_parm p;

	ip6_tnl_parm_init(&p, 1);

	if (parse_args(argc, argv, cmd, &p) < 0)
		return -1;

	return tnl_add_ioctl(cmd,
			     cmd == SIOCCHGTUNNEL && p.name[0] ?
			     p.name : "ip6tnl0", p.name, &p);
}

static int do_del(int argc, char **argv)
{
	struct ip6_tnl_parm p;

	ip6_tnl_parm_init(&p, 1);

	if (parse_args(argc, argv, SIOCDELTUNNEL, &p) < 0)
		return -1;

	return tnl_del_ioctl(p.name[0] ? p.name : "ip6tnl0", p.name, &p);
}

int do_ip6tunnel(int argc, char **argv)
{
	switch (preferred_family) {
	case AF_UNSPEC:
		preferred_family = AF_INET6;
		break;
	case AF_INET6:
		break;
	default:
		fprintf(stderr, "Unsupported family:%d\n", preferred_family);
		exit(-1);
	}

	if (argc > 0) {
		if (matches(*argv, "add") == 0)
			return do_add(SIOCADDTUNNEL, argc - 1, argv + 1);
		if (matches(*argv, "change") == 0)
			return do_add(SIOCCHGTUNNEL, argc - 1, argv + 1);
		if (matches(*argv, "delete") == 0)
			return do_del(argc - 1, argv + 1);
		if (matches(*argv, "show") == 0 ||
		    matches(*argv, "lst") == 0 ||
		    matches(*argv, "list") == 0)
			return do_show(argc - 1, argv + 1);
		if (matches(*argv, "help") == 0)
			usage();
	} else
		return do_show(0, NULL);

	fprintf(stderr, "Command \"%s\" is unknown, try \"ip -f inet6 tunnel help\".\n", *argv);
	exit(-1);
}
Commit	Line	Data
9447a0d3 MN	1	/*
9447a0d3 MN	2	* Copyright (C)2006 USAGI/WIDE Project
ae665a52	3	*
9447a0d3 MN	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License as published by
	6	* the Free Software Foundation; either version 2 of the License, or
	7	* (at your option) any later version.
ae665a52	8	*
9447a0d3 MN	9	* This program is distributed in the hope that it will be useful,
	10	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	11	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	12	* GNU General Public License for more details.
ae665a52	13	*
9447a0d3 MN	14	* You should have received a copy of the GNU General Public License
	15	* along with this program; if not, write to the Free Software
	16	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	17	*/
9447a0d3 MN	18	/*
	19	* Author:
	20	* Masahide NAKAMURA @USAGI
	21	*/
ae665a52	22
9447a0d3 MN	23	#include <stdio.h>
	24	#include <string.h>
	25	#include <stdlib.h>
9447a0d3	26	#include <unistd.h>
288384f2 MN	27	#include <sys/types.h>
288384f2 MN	28	#include <sys/socket.h>
9447a0d3	29	#include <arpa/inet.h>
288384f2	30	#include <sys/ioctl.h>
9447a0d3	31	#include <linux/ip.h>
288384f2 MN	32	#include <linux/if.h>
288384f2 MN	33	#include <linux/if_arp.h>
9447a0d3	34	#include <linux/if_tunnel.h>
288384f2	35	#include <linux/ip6_tunnel.h>
9447a0d3	36
288384f2 MN	37	#include "utils.h"
288384f2 MN	38	#include "tunnel.h"
ea71beac	39	#include "ip_common.h"
9447a0d3	40
288384f2 MN	41	#define IP6_FLOWINFO_TCLASS htonl(0x0FF00000)
288384f2 MN	42	#define IP6_FLOWINFO_FLOWLABEL htonl(0x000FFFFF)
9447a0d3	43
288384f2 MN	44	#define DEFAULT_TNL_HOP_LIMIT (64)
	45
	46	static void usage(void) __attribute__((noreturn));
9447a0d3 MN	47
	48	static void usage(void)
	49	{
288384f2	50	fprintf(stderr, "Usage: ip -f inet6 tunnel { add \| change \| del \| show } [ NAME ]\n");
0b959b0f	51	fprintf(stderr, " [ mode { ip6ip6 \| ipip6 \| any } ]\n");
288384f2 MN	52	fprintf(stderr, " [ remote ADDR local ADDR ] [ dev PHYS_DEV ]\n");
288384f2 MN	53	fprintf(stderr, " [ encaplimit ELIM ]\n");
eddde110	54	fprintf(stderr ," [ hoplimit TTL ] [ tclass TCLASS ] [ flowlabel FLOWLABEL ]\n");
288384f2 MN	55	fprintf(stderr, " [ dscp inherit ]\n");
288384f2 MN	56	fprintf(stderr, "\n");
eddde110 YH	57	fprintf(stderr, "Where: NAME := STRING\n");
	58	fprintf(stderr, " ADDR := IPV6_ADDRESS\n");
	59	fprintf(stderr, " ELIM := { none \| 0..255 }(default=%d)\n",
288384f2	60	IPV6_DEFAULT_TNL_ENCAP_LIMIT);
eddde110	61	fprintf(stderr, " TTL := 0..255 (default=%d)\n",
288384f2	62	DEFAULT_TNL_HOP_LIMIT);
d0c8420c	63	fprintf(stderr, " TCLASS := { 0x0..0xff \| inherit }\n");
eddde110	64	fprintf(stderr, " FLOWLABEL := { 0x0..0xfffff \| inherit }\n");
9447a0d3 MN	65	exit(-1);
	66	}
	67
288384f2	68	static void print_tunnel(struct ip6_tnl_parm *p)
9447a0d3 MN	69	{
	70	char remote[64];
	71	char local[64];
ae665a52	72
9447a0d3 MN	73	inet_ntop(AF_INET6, &p->raddr, remote, sizeof(remote));
	74	inet_ntop(AF_INET6, &p->laddr, local, sizeof(local));
	75
288384f2 MN	76	printf("%s: %s/ipv6 remote %s local %s",
288384f2 MN	77	p->name, tnl_strproto(p->proto), remote, local);
9447a0d3	78	if (p->link) {
ea71beac	79	const char *n = ll_index_to_name(p->link);
9447a0d3 MN	80	if (n)
	81	printf(" dev %s", n);
	82	}
9447a0d3	83
288384f2 MN	84	if (p->flags & IP6_TNL_F_IGN_ENCAP_LIMIT)
	85	printf(" encaplimit none");
	86	else
	87	printf(" encaplimit %u", p->encap_limit);
9447a0d3	88
288384f2	89	printf(" hoplimit %u", p->hop_limit);
9447a0d3	90
288384f2	91	if (p->flags & IP6_TNL_F_USE_ORIG_TCLASS)
eddde110	92	printf(" tclass inherit");
288384f2 MN	93	else {
288384f2 MN	94	__u32 val = ntohl(p->flowinfo & IP6_FLOWINFO_TCLASS);
eddde110	95	printf(" tclass 0x%02x", (__u8)(val >> 20));
9447a0d3	96	}
9447a0d3	97
288384f2	98	if (p->flags & IP6_TNL_F_USE_ORIG_FLOWLABEL)
eddde110	99	printf(" flowlabel inherit");
288384f2	100	else
eddde110	101	printf(" flowlabel 0x%05x", ntohl(p->flowinfo & IP6_FLOWINFO_FLOWLABEL));
9447a0d3	102
288384f2	103	printf(" (flowinfo 0x%08x)", ntohl(p->flowinfo));
9447a0d3	104
288384f2 MN	105	if (p->flags & IP6_TNL_F_RCV_DSCP_COPY)
288384f2 MN	106	printf(" dscp inherit");
9447a0d3 MN	107	}
9447a0d3 MN	108
21a5a6b3	109	static int parse_args(int argc, char *argv, int cmd, struct ip6_tnl_parm p)
9447a0d3	110	{
21a5a6b3	111	int count = 0;
9447a0d3 MN	112	char medium[IFNAMSIZ];
9447a0d3 MN	113
288384f2	114	memset(medium, 0, sizeof(medium));
9447a0d3 MN	115
9447a0d3 MN	116	while (argc > 0) {
0b959b0f YH	117	if (strcmp(*argv, "mode") == 0) {
	118	NEXT_ARG();
	119	if (strcmp(*argv, "ipv6/ipv6") == 0 \|\|
	120	strcmp(*argv, "ip6ip6") == 0)
	121	p->proto = IPPROTO_IPV6;
	122	else if (strcmp(*argv, "ip/ipv6") == 0 \|\|
	123	strcmp(*argv, "ipv4/ipv6") == 0 \|\|
	124	strcmp(*argv, "ipip6") == 0 \|\|
	125	strcmp(*argv, "ip4ip6") == 0)
	126	p->proto = IPPROTO_IPIP;
	127	else if (strcmp(*argv, "any/ipv6") == 0 \|\|
	128	strcmp(*argv, "any") == 0)
	129	p->proto = 0;
	130	else {
	131	fprintf(stderr,"Cannot guess tunnel mode.\n");
	132	exit(-1);
	133	}
	134	} else if (strcmp(*argv, "remote") == 0) {
288384f2 MN	135	inet_prefix raddr;
	136	NEXT_ARG();
	137	get_prefix(&raddr, *argv, preferred_family);
	138	if (raddr.family == AF_UNSPEC)
	139	invarg("\"remote\" address family is AF_UNSPEC", *argv);
	140	memcpy(&p->raddr, &raddr.data, sizeof(p->raddr));
	141	} else if (strcmp(*argv, "local") == 0) {
	142	inet_prefix laddr;
	143	NEXT_ARG();
	144	get_prefix(&laddr, *argv, preferred_family);
	145	if (laddr.family == AF_UNSPEC)
	146	invarg("\"local\" address family is AF_UNSPEC", *argv);
	147	memcpy(&p->laddr, &laddr.data, sizeof(p->laddr));
	148	} else if (strcmp(*argv, "dev") == 0) {
	149	NEXT_ARG();
9447a0d3	150	strncpy(medium, *argv, IFNAMSIZ - 1);
288384f2 MN	151	} else if (strcmp(*argv, "encaplimit") == 0) {
	152	NEXT_ARG();
	153	if (strcmp(*argv, "none") == 0) {
	154	p->flags \|= IP6_TNL_F_IGN_ENCAP_LIMIT;
9447a0d3 MN	155	} else {
9447a0d3 MN	156	__u8 uval;
288384f2 MN	157	if (get_u8(&uval, *argv, 0) < -1)
288384f2 MN	158	invarg("invalid ELIM", *argv);
9447a0d3	159	p->encap_limit = uval;
3f83dce5	160	p->flags &= ~IP6_TNL_F_IGN_ENCAP_LIMIT;
9447a0d3	161	}
eddde110 YH	162	} else if (strcmp(*argv, "hoplimit") == 0 \|\|
	163	strcmp(*argv, "ttl") == 0 \|\|
	164	strcmp(*argv, "hlim") == 0) {
288384f2 MN	165	__u8 uval;
	166	NEXT_ARG();
	167	if (get_u8(&uval, *argv, 0))
eddde110	168	invarg("invalid TTL", *argv);
288384f2	169	p->hop_limit = uval;
eddde110 YH	170	} else if (strcmp(*argv, "tclass") == 0 \|\|
	171	strcmp(*argv, "tc") == 0 \|\|
	172	strcmp(*argv, "tos") == 0 \|\|
	173	matches(*argv, "dsfield") == 0) {
288384f2 MN	174	__u8 uval;
288384f2 MN	175	NEXT_ARG();
df5574d0	176	p->flowinfo &= ~IP6_FLOWINFO_TCLASS;
288384f2 MN	177	if (strcmp(*argv, "inherit") == 0)
	178	p->flags \|= IP6_TNL_F_USE_ORIG_TCLASS;
	179	else {
	180	if (get_u8(&uval, *argv, 16))
eddde110	181	invarg("invalid TClass", *argv);
288384f2 MN	182	p->flowinfo \|= htonl((__u32)uval << 20) & IP6_FLOWINFO_TCLASS;
	183	p->flags &= ~IP6_TNL_F_USE_ORIG_TCLASS;
	184	}
eddde110 YH	185	} else if (strcmp(*argv, "flowlabel") == 0 \|\|
eddde110 YH	186	strcmp(*argv, "fl") == 0) {
288384f2 MN	187	__u32 uval;
288384f2 MN	188	NEXT_ARG();
df5574d0	189	p->flowinfo &= ~IP6_FLOWINFO_FLOWLABEL;
288384f2 MN	190	if (strcmp(*argv, "inherit") == 0)
	191	p->flags \|= IP6_TNL_F_USE_ORIG_FLOWLABEL;
	192	else {
	193	if (get_u32(&uval, *argv, 16))
eddde110	194	invarg("invalid Flowlabel", *argv);
288384f2	195	if (uval > 0xFFFFF)
eddde110	196	invarg("invalid Flowlabel", *argv);
288384f2 MN	197	p->flowinfo \|= htonl(uval) & IP6_FLOWINFO_FLOWLABEL;
	198	p->flags &= ~IP6_TNL_F_USE_ORIG_FLOWLABEL;
	199	}
	200	} else if (strcmp(*argv, "dscp") == 0) {
	201	NEXT_ARG();
	202	if (strcmp(*argv, "inherit") != 0)
	203	invarg("not inherit", *argv);
	204	p->flags \|= IP6_TNL_F_RCV_DSCP_COPY;
9447a0d3	205	} else {
288384f2 MN	206	if (strcmp(*argv, "name") == 0) {
	207	NEXT_ARG();
	208	}
	209	if (matches(*argv, "help") == 0)
9447a0d3	210	usage();
288384f2 MN	211	if (p->name[0])
288384f2 MN	212	duparg2("name", *argv);
9447a0d3	213	strncpy(p->name, *argv, IFNAMSIZ - 1);
21a5a6b3 JB	214	if (cmd == SIOCCHGTUNNEL && count == 0) {
	215	struct ip6_tnl_parm old_p;
	216	memset(&old_p, 0, sizeof(old_p));
	217	if (tnl_get_ioctl(*argv, &old_p))
	218	return -1;
	219	*p = old_p;
	220	}
9447a0d3	221	}
21a5a6b3	222	count++;
9447a0d3 MN	223	argc--; argv++;
	224	}
	225	if (medium[0]) {
ea71beac	226	p->link = ll_name_to_index(medium);
9447a0d3 MN	227	if (p->link == 0)
	228	return -1;
	229	}
	230	return 0;
	231	}
	232
288384f2 MN	233	static void ip6_tnl_parm_init(struct ip6_tnl_parm *p, int apply_default)
	234	{
	235	memset(p, 0, sizeof(*p));
	236	p->proto = IPPROTO_IPV6;
	237	if (apply_default) {
	238	p->hop_limit = DEFAULT_TNL_HOP_LIMIT;
	239	p->encap_limit = IPV6_DEFAULT_TNL_ENCAP_LIMIT;
	240	}
	241	}
	242
	243	/*
	244	* @p1: user specified parameter
	245	* @p2: database entry
	246	*/
	247	static int ip6_tnl_parm_match(const struct ip6_tnl_parm *p1,
	248	const struct ip6_tnl_parm *p2)
	249	{
	250	return ((!p1->link \|\| p1->link == p2->link) &&
	251	(!p1->name[0] \|\| strcmp(p1->name, p2->name) == 0) &&
	252	(memcmp(&p1->laddr, &in6addr_any, sizeof(p1->laddr)) == 0 \|\|
	253	memcmp(&p1->laddr, &p2->laddr, sizeof(p1->laddr)) == 0) &&
	254	(memcmp(&p1->raddr, &in6addr_any, sizeof(p1->raddr)) == 0 \|\|
	255	memcmp(&p1->raddr, &p2->raddr, sizeof(p1->raddr)) == 0) &&
	256	(!p1->proto \|\| !p2->proto \|\| p1->proto == p2->proto) &&
	257	(!p1->encap_limit \|\| p1->encap_limit == p2->encap_limit) &&
	258	(!p1->hop_limit \|\| p1->hop_limit == p2->hop_limit) &&
	259	(!(p1->flowinfo & IP6_FLOWINFO_TCLASS) \|\|
	260	!((p1->flowinfo ^ p2->flowinfo) & IP6_FLOWINFO_TCLASS)) &&
	261	(!(p1->flowinfo & IP6_FLOWINFO_FLOWLABEL) \|\|
	262	!((p1->flowinfo ^ p2->flowinfo) & IP6_FLOWINFO_FLOWLABEL)) &&
	263	(!p1->flags \|\| (p1->flags & p2->flags)));
	264	}
	265
	266	static int do_tunnels_list(struct ip6_tnl_parm *p)
	267	{
	268	char buf[512];
	269	int err = -1;
	270	FILE *fp = fopen("/proc/net/dev", "r");
	271	if (fp == NULL) {
	272	perror("fopen");
	273	goto end;
	274	}
	275
	276	/* skip two lines at the begenning of the file */
38c867d2 SH	277	if (!fgets(buf, sizeof(buf), fp) \|\|
	278	!fgets(buf, sizeof(buf), fp)) {
	279	fprintf(stderr, "/proc/net/dev read error\n");
	280	return -1;
	281	}
288384f2 MN	282
	283	while (fgets(buf, sizeof(buf), fp) != NULL) {
	284	char name[IFNAMSIZ];
ea71beac	285	int index, type;
288384f2 MN	286	unsigned long rx_bytes, rx_packets, rx_errs, rx_drops,
	287	rx_fifo, rx_frame,
	288	tx_bytes, tx_packets, tx_errs, tx_drops,
	289	tx_fifo, tx_colls, tx_carrier, rx_multi;
	290	struct ip6_tnl_parm p1;
	291	char *ptr;
	292
	293	buf[sizeof(buf) - 1] = '\0';
	294	if ((ptr = strchr(buf, ':')) == NULL \|\|
	295	(*ptr++ = 0, sscanf(buf, "%s", name) != 1)) {
	296	fprintf(stderr, "Wrong format of /proc/net/dev. Sorry.\n");
	297	goto end;
	298	}
	299	if (sscanf(ptr, "%ld%ld%ld%ld%ld%ld%ld%*d%ld%ld%ld%ld%ld%ld%ld",
	300	&rx_bytes, &rx_packets, &rx_errs, &rx_drops,
	301	&rx_fifo, &rx_frame, &rx_multi,
	302	&tx_bytes, &tx_packets, &tx_errs, &tx_drops,
	303	&tx_fifo, &tx_colls, &tx_carrier) != 14)
	304	continue;
	305	if (p->name[0] && strcmp(p->name, name))
	306	continue;
ea71beac SH	307	index = ll_name_to_index(name);
	308	if (index == 0)
	309	continue;
	310	type = ll_index_to_type(index);
288384f2 MN	311	if (type == -1) {
	312	fprintf(stderr, "Failed to get type of [%s]\n", name);
	313	continue;
	314	}
	315	if (type != ARPHRD_TUNNEL6)
	316	continue;
	317	memset(&p1, 0, sizeof(p1));
	318	ip6_tnl_parm_init(&p1, 0);
	319	strcpy(p1.name, name);
ea71beac	320	p1.link = ll_name_to_index(p1.name);
288384f2 MN	321	if (p1.link == 0)
	322	continue;
	323	if (tnl_get_ioctl(p1.name, &p1))
	324	continue;
	325	if (!ip6_tnl_parm_match(p, &p1))
	326	continue;
	327	print_tunnel(&p1);
	328	if (show_stats) {
	329	printf("%s", _SL_);
	330	printf("RX: Packets Bytes Errors CsumErrs OutOfSeq Mcasts%s", _SL_);
	331	printf(" %-10ld %-12ld %-6ld %-8ld %-8ld %-8ld%s",
	332	rx_packets, rx_bytes, rx_errs, rx_frame, rx_fifo, rx_multi, _SL_);
	333	printf("TX: Packets Bytes Errors DeadLoop NoRoute NoBufs%s", _SL_);
	334	printf(" %-10ld %-12ld %-6ld %-8ld %-8ld %-6ld",
	335	tx_packets, tx_bytes, tx_errs, tx_colls, tx_carrier, tx_drops);
	336	}
	337	printf("\n");
	338	}
	339	err = 0;
	340
	341	end:
	342	if (fp)
	343	fclose(fp);
	344	return err;
	345	}
	346
9447a0d3 MN	347	static int do_show(int argc, char **argv)
9447a0d3 MN	348	{
288384f2 MN	349	struct ip6_tnl_parm p;
288384f2 MN	350
ea71beac	351	ll_init_map(&rth);
288384f2	352	ip6_tnl_parm_init(&p, 0);
c3651bf4	353	p.proto = 0; /* default to any */
9447a0d3	354
21a5a6b3	355	if (parse_args(argc, argv, SIOCGETTUNNEL, &p) < 0)
9447a0d3 MN	356	return -1;
9447a0d3 MN	357
288384f2 MN	358	if (!p.name[0] \|\| show_stats)
	359	do_tunnels_list(&p);
	360	else {
	361	if (tnl_get_ioctl(p.name, &p))
	362	return -1;
	363	print_tunnel(&p);
	364	printf("\n");
	365	}
9447a0d3	366
9447a0d3 MN	367	return 0;
	368	}
	369
9447a0d3 MN	370	static int do_add(int cmd, int argc, char **argv)
9447a0d3 MN	371	{
288384f2 MN	372	struct ip6_tnl_parm p;
	373
	374	ip6_tnl_parm_init(&p, 1);
9447a0d3	375
21a5a6b3	376	if (parse_args(argc, argv, cmd, &p) < 0)
9447a0d3	377	return -1;
288384f2 MN	378
	379	return tnl_add_ioctl(cmd,
	380	cmd == SIOCCHGTUNNEL && p.name[0] ?
	381	p.name : "ip6tnl0", p.name, &p);
9447a0d3 MN	382	}
9447a0d3 MN	383
288384f2	384	static int do_del(int argc, char **argv)
9447a0d3	385	{
288384f2 MN	386	struct ip6_tnl_parm p;
	387
	388	ip6_tnl_parm_init(&p, 1);
9447a0d3	389
21a5a6b3	390	if (parse_args(argc, argv, SIOCDELTUNNEL, &p) < 0)
9447a0d3 MN	391	return -1;
9447a0d3 MN	392
288384f2	393	return tnl_del_ioctl(p.name[0] ? p.name : "ip6tnl0", p.name, &p);
9447a0d3 MN	394	}
9447a0d3 MN	395
ae665a52 SH	396	int do_ip6tunnel(int argc, char **argv)
ae665a52 SH	397	{
288384f2 MN	398	switch (preferred_family) {
	399	case AF_UNSPEC:
	400	preferred_family = AF_INET6;
	401	break;
	402	case AF_INET6:
	403	break;
	404	default:
	405	fprintf(stderr, "Unsupported family:%d\n", preferred_family);
	406	exit(-1);
	407	}
	408
9447a0d3	409	if (argc > 0) {
288384f2	410	if (matches(*argv, "add") == 0)
9447a0d3	411	return do_add(SIOCADDTUNNEL, argc - 1, argv + 1);
288384f2	412	if (matches(*argv, "change") == 0)
9447a0d3	413	return do_add(SIOCCHGTUNNEL, argc - 1, argv + 1);
6e30461e	414	if (matches(*argv, "delete") == 0)
9447a0d3	415	return do_del(argc - 1, argv + 1);
288384f2 MN	416	if (matches(*argv, "show") == 0 \|\|
	417	matches(*argv, "lst") == 0 \|\|
	418	matches(*argv, "list") == 0)
9447a0d3	419	return do_show(argc - 1, argv + 1);
288384f2	420	if (matches(*argv, "help") == 0)
9447a0d3	421	usage();
9447a0d3 MN	422	} else
	423	return do_show(0, NULL);
	424
288384f2 MN	425	fprintf(stderr, "Command \"%s\" is unknown, try \"ip -f inet6 tunnel help\".\n", *argv);
288384f2 MN	426	exit(-1);
9447a0d3	427	}