0a815c3ae7b076ffb09e34450d953fd7cd044f1c
[olsrd.git] / src / linux / kernel_tunnel.c
1 /*
2  * The olsr.org Optimized Link-State Routing daemon(olsrd)
3  * Copyright (c) 2004, Andreas Tonnesen(andreto@olsr.org)
4  * Copyright (c) 2007, Sven-Ola for the policy routing stuff
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  *
11  * * Redistributions of source code must retain the above copyright
12  *   notice, this list of conditions and the following disclaimer.
13  * * Redistributions in binary form must reproduce the above copyright
14  *   notice, this list of conditions and the following disclaimer in
15  *   the documentation and/or other materials provided with the
16  *   distribution.
17  * * Neither the name of olsr.org, olsrd nor the names of its
18  *   contributors may be used to endorse or promote products derived
19  *   from this software without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
24  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
25  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
26  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
27  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
28  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
29  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
31  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32  * POSSIBILITY OF SUCH DAMAGE.
33  *
34  * Visit http://www.olsr.org for more information.
35  *
36  * If you find this software useful feel free to make a donation
37  * to the project. For more information see the website or contact
38  * the copyright holders.
39  *
40  */
41
42 #include "kernel_tunnel.h"
43 #include "log.h"
44 #include "olsr_types.h"
45 #include "net_os.h"
46
47 #include <assert.h>
48
49 //ipip includes
50 #include <netinet/in.h>
51 #include <sys/ioctl.h>
52 #include <net/if.h>
53 #include <linux/ip.h>
54 #include <linux/if_tunnel.h>
55 #include <linux/ip6_tunnel.h>
56
57 //ifup includes
58 #include <sys/socket.h>
59 #include <sys/ioctl.h>
60 #include <sys/types.h>
61 #include <net/if.h>
62
63 static const char DEV_IPV4_TUNNEL[IFNAMSIZ] = "tunl0";
64 static const char DEV_IPV6_TUNNEL[IFNAMSIZ] = "ip6tnl0";
65
66 static bool store_iptunnel_state;
67
68 int olsr_os_init_iptunnel(void) {
69   const char *dev = olsr_cnf->ip_version == AF_INET ? DEV_IPV4_TUNNEL : DEV_IPV6_TUNNEL;
70
71   store_iptunnel_state = olsr_if_isup(dev);
72 fprintf(stderr, "device %s was %s\n", dev, store_iptunnel_state ? "up" : "down");
73   if (store_iptunnel_state) {
74     return 0;
75   }
76   return olsr_if_set_state(dev, true);
77 }
78
79 void olsr_os_cleanup_iptunnel(void) {
80   if (!store_iptunnel_state) {
81 fprintf(stderr, "ifdown: %s\n", olsr_cnf->ip_version == AF_INET ? DEV_IPV4_TUNNEL : DEV_IPV6_TUNNEL);
82     olsr_if_set_state(olsr_cnf->ip_version == AF_INET ? DEV_IPV4_TUNNEL : DEV_IPV6_TUNNEL, false);
83   }
84 }
85
86 static const char *get_tunnelcmd_name(uint32_t cmd) {
87   static const char ADD[] = "add";
88   static const char CHANGE[] = "change";
89   static const char DELETE[] = "delete";
90
91   switch (cmd) {
92     case SIOCADDTUNNEL:
93       return ADD;
94     case SIOCCHGTUNNEL:
95       return CHANGE;
96     case SIOCDELTUNNEL:
97       return DELETE;
98     default:
99       return NULL;
100   }
101 }
102
103 static int os_ip4_tunnel(const char *name, in_addr_t *target, uint32_t cmd)
104 {
105   struct ifreq ifr;
106   int err;
107   struct ip_tunnel_parm p;
108
109   /* no IPIP tunnel if OLSR runs with IPv6 */
110   assert (olsr_cnf->ip_version == AF_INET);
111   memset(&p, 0, sizeof(p));
112   p.iph.version = 4;
113   p.iph.ihl = 5;
114   p.iph.protocol = IPPROTO_IPIP;
115   if (target) {
116     p.iph.daddr = *target;
117   }
118   strncpy(p.name, name, IFNAMSIZ);
119
120   memset(&ifr, 0, sizeof(ifr));
121   strncpy(ifr.ifr_name, cmd == SIOCADDTUNNEL ? DEV_IPV4_TUNNEL : name, IFNAMSIZ);
122   ifr.ifr_ifru.ifru_data = (void *) &p;
123
124   if ((err = ioctl(olsr_cnf->ioctl_s, cmd, &ifr))) {
125     olsr_syslog(OLSR_LOG_ERR, "Cannot %s a tunnel %s: %s (%d)\n",
126         get_tunnelcmd_name(cmd), name, strerror(errno), errno);
127   }
128   return err;
129 }
130
131 static int os_ip6_tunnel(const char *name, struct in6_addr *target, uint32_t cmd, uint8_t proto)
132 {
133   struct ifreq ifr;
134   int err;
135   struct ip6_tnl_parm p;
136
137   /* no IPIP tunnel if OLSR runs with IPv6 */
138   assert (olsr_cnf->ip_version == AF_INET6);
139   memset(&p, 0, sizeof(p));
140   p.proto = proto; //  ? IPPROTO_IPV6 : IPPROTO_IPIP;
141   if (target) {
142     p.raddr = *target;
143   }
144   strncpy(p.name, name, IFNAMSIZ);
145
146   memset(&ifr, 0, sizeof(ifr));
147   strncpy(ifr.ifr_name, cmd == SIOCADDTUNNEL ? DEV_IPV6_TUNNEL : name, IFNAMSIZ);
148   ifr.ifr_ifru.ifru_data = (void *) &p;
149
150   if ((err = ioctl(olsr_cnf->ioctl_s, cmd, &ifr))) {
151     olsr_syslog(OLSR_LOG_ERR, "Cannot %s a tunnel %s: %s (%d)\n",
152         get_tunnelcmd_name(cmd), name, strerror(errno), errno);
153   }
154   return err;
155 }
156
157 int olsr_os_add_ipip_tunnel(const char *name, union olsr_ip_addr *target, bool transportV4) {
158   if (olsr_cnf->ip_version == AF_INET) {
159     assert(transportV4);
160
161     return os_ip4_tunnel(name, &target->v4.s_addr, SIOCADDTUNNEL);
162   }
163   return os_ip6_tunnel(name, &target->v6, SIOCADDTUNNEL, transportV4 ? IPPROTO_IPIP : IPPROTO_IPV6);
164 }
165
166 int olsr_os_change_ipip_tunnel(const char *name, union olsr_ip_addr *target, bool transportV4) {
167   if (olsr_cnf->ip_version == AF_INET) {
168     assert(transportV4);
169
170     return os_ip4_tunnel(name, &target->v4.s_addr, SIOCCHGTUNNEL);
171   }
172   return os_ip6_tunnel(name, &target->v6, SIOCCHGTUNNEL, transportV4 ? IPPROTO_IPIP : IPPROTO_IPV6);
173 }
174
175 int olsr_os_del_ipip_tunnel(const char *name, bool transportV4) {
176   if (olsr_cnf->ip_version == AF_INET) {
177     assert(transportV4);
178
179     return os_ip4_tunnel(name, NULL, SIOCDELTUNNEL);
180   }
181   return os_ip6_tunnel(name, NULL, SIOCDELTUNNEL, transportV4 ? IPPROTO_IPIP : IPPROTO_IPV6);
182 }