1d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA/*
2d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * Copyright (C)2006 USAGI/WIDE Project
3ae665a522bd46bea44c5ea84c89c8b1731954170Stephen Hemminger *
4d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * This program is free software; you can redistribute it and/or modify
5d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * it under the terms of the GNU General Public License as published by
6d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * the Free Software Foundation; either version 2 of the License, or
7d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * (at your option) any later version.
8ae665a522bd46bea44c5ea84c89c8b1731954170Stephen Hemminger *
9d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * This program is distributed in the hope that it will be useful,
10d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * but WITHOUT ANY WARRANTY; without even the implied warranty of
11d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * GNU General Public License for more details.
13ae665a522bd46bea44c5ea84c89c8b1731954170Stephen Hemminger *
14d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * You should have received a copy of the GNU General Public License
15d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * along with this program; if not, write to the Free Software
16d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
17d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA */
18d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA/*
19d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * split from ip_tunnel.c
20d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA */
21d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA/*
22d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA * Author:
23d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA *	Masahide NAKAMURA @USAGI
24d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA */
25d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA
26d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include <stdio.h>
27d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include <string.h>
28d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include <unistd.h>
293979ef91de9ed17d21672aaaefd6c228485135a2Alexandre Cassen#include <errno.h>
30d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include <sys/types.h>
31d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include <sys/socket.h>
32d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include <sys/ioctl.h>
33d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include <netinet/in.h>
34d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include <linux/if.h>
35d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include <linux/ip.h>
36d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include <linux/if_tunnel.h>
37d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA
38d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include "utils.h"
39d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA#include "tunnel.h"
40d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA
41d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURAconst char *tnl_strproto(__u8 proto)
42d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA{
43d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	static char buf[16];
44d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA
45d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	switch (proto) {
46d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	case IPPROTO_IPIP:
47d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		strcpy(buf, "ip");
48d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		break;
49d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	case IPPROTO_GRE:
50d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		strcpy(buf, "gre");
51d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		break;
52d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	case IPPROTO_IPV6:
53d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		strcpy(buf, "ipv6");
54d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		break;
550b959b0f4dcb9c905fb1b7f60d39d9e284e77eeaYOSHIFUJI Hideaki / 吉藤英明	case 0:
560b959b0f4dcb9c905fb1b7f60d39d9e284e77eeaYOSHIFUJI Hideaki / 吉藤英明		strcpy(buf, "any");
570b959b0f4dcb9c905fb1b7f60d39d9e284e77eeaYOSHIFUJI Hideaki / 吉藤英明		break;
58d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	default:
59d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		strcpy(buf, "unknown");
60d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		break;
61d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	}
62d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA
63d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	return buf;
64d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA}
65d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA
66d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURAint tnl_get_ioctl(const char *basedev, void *p)
67d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA{
68d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	struct ifreq ifr;
69d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	int fd;
70d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	int err;
71d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA
72d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	strncpy(ifr.ifr_name, basedev, IFNAMSIZ);
73d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	ifr.ifr_ifru.ifru_data = (void*)p;
74d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	fd = socket(preferred_family, SOCK_DGRAM, 0);
75d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	err = ioctl(fd, SIOCGETTUNNEL, &ifr);
76d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	if (err)
77ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemminger		fprintf(stderr, "get tunnel %s failed: %s\n", basedev,
78ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemminger			strerror(errno));
79ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemminger
80d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	close(fd);
81d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	return err;
82d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA}
83d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA
84d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURAint tnl_add_ioctl(int cmd, const char *basedev, const char *name, void *p)
85d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA{
86d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	struct ifreq ifr;
87d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	int fd;
88d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	int err;
89d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA
90d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	if (cmd == SIOCCHGTUNNEL && name[0])
91d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		strncpy(ifr.ifr_name, name, IFNAMSIZ);
92d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	else
93d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		strncpy(ifr.ifr_name, basedev, IFNAMSIZ);
94d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	ifr.ifr_ifru.ifru_data = p;
95d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	fd = socket(preferred_family, SOCK_DGRAM, 0);
96d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	err = ioctl(fd, cmd, &ifr);
97d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	if (err)
98ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemminger		fprintf(stderr, "add tunnel %s failed: %s\n", ifr.ifr_name,
99ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemminger			strerror(errno));
100d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	close(fd);
101d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	return err;
102d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA}
103d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA
104d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURAint tnl_del_ioctl(const char *basedev, const char *name, void *p)
105d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA{
106d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	struct ifreq ifr;
107d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	int fd;
108d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	int err;
109d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA
110d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	if (name[0])
111d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		strncpy(ifr.ifr_name, name, IFNAMSIZ);
112d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	else
113d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA		strncpy(ifr.ifr_name, basedev, IFNAMSIZ);
114ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemminger
115d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	ifr.ifr_ifru.ifru_data = p;
116d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	fd = socket(preferred_family, SOCK_DGRAM, 0);
117d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	err = ioctl(fd, SIOCDELTUNNEL, &ifr);
118d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	if (err)
119ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemminger		fprintf(stderr, "delete tunnel %s failed: %s\n",
120ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemminger			ifr.ifr_name, strerror(errno));
121d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	close(fd);
122d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA	return err;
123d9bd1bd945b12b52e7825aa2742fa15ffa09651aMasahide NAKAMURA}
124a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak
125ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemmingerstatic int tnl_gen_ioctl(int cmd, const char *name,
126ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemminger			 void *p, int skiperr)
127a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak{
128a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak	struct ifreq ifr;
129a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak	int fd;
130a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak	int err;
131a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak
132a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak	strncpy(ifr.ifr_name, name, IFNAMSIZ);
133a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak	ifr.ifr_ifru.ifru_data = p;
134a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak	fd = socket(preferred_family, SOCK_DGRAM, 0);
135a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak	err = ioctl(fd, cmd, &ifr);
1363979ef91de9ed17d21672aaaefd6c228485135a2Alexandre Cassen	if (err && errno != skiperr)
137ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemminger		fprintf(stderr, "%s: ioctl %x failed: %s\n", name,
138ea71beacacb9ebf756bbc250c71df59ec2f46243Stephen Hemminger			cmd, strerror(errno));
139a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak	close(fd);
140a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak	return err;
141a07e9912539d4ec26c954a9b03f04af987df6246Sascha Hlusiak}
142b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassen
143b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassenint tnl_prl_ioctl(int cmd, const char *name, void *p)
144b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassen{
1453979ef91de9ed17d21672aaaefd6c228485135a2Alexandre Cassen	return tnl_gen_ioctl(cmd, name, p, -1);
146b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassen}
147b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassen
148b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassenint tnl_6rd_ioctl(int cmd, const char *name, void *p)
149b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassen{
1503979ef91de9ed17d21672aaaefd6c228485135a2Alexandre Cassen	return tnl_gen_ioctl(cmd, name, p, -1);
151b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassen}
152b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassen
153b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassenint tnl_ioctl_get_6rd(const char *name, void *p)
154b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassen{
1553979ef91de9ed17d21672aaaefd6c228485135a2Alexandre Cassen	return tnl_gen_ioctl(SIOCGET6RD, name, p, EINVAL);
156b88215c4689d94628d3aa0ac112c290b6373860aAlexandre Cassen}
157