Another fix for Linux-2.4
[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 #include "olsr_cookie.h"
47 #include "ipcalc.h"
48
49 #include <assert.h>
50
51 //ipip includes
52 #include <arpa/inet.h>
53 #include <netinet/in.h>
54 #include <sys/ioctl.h>
55 #include <net/if.h>
56 #include <linux/ip.h>
57 #include <linux/if_tunnel.h>
58 #include <linux/version.h>
59 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
60 #include <linux/ip6_tunnel.h>
61 #endif
62
63 //ifup includes
64 #include <sys/socket.h>
65 #include <sys/ioctl.h>
66 #include <sys/types.h>
67 #include <net/if.h>
68
69 static const char DEV_IPV4_TUNNEL[IFNAMSIZ] = "tunl0";
70 static const char DEV_IPV6_TUNNEL[IFNAMSIZ] = "ip6tnl0";
71
72 static bool store_iptunnel_state;
73 static struct olsr_cookie_info *tunnel_cookie;
74 static struct avl_tree tunnel_tree;
75
76 int olsr_os_init_iptunnel(void) {
77   const char *dev = olsr_cnf->ip_version == AF_INET ? DEV_IPV4_TUNNEL : DEV_IPV6_TUNNEL;
78
79   tunnel_cookie = olsr_alloc_cookie("iptunnel", OLSR_COOKIE_TYPE_MEMORY);
80   olsr_cookie_set_memory_size(tunnel_cookie, sizeof(struct olsr_iptunnel_entry));
81   avl_init(&tunnel_tree, avl_comp_default);
82
83   store_iptunnel_state = olsr_if_isup(dev);
84   if (store_iptunnel_state) {
85     return 0;
86   }
87   return olsr_if_set_state(dev, true);
88 }
89
90 void olsr_os_cleanup_iptunnel(void) {
91   while (tunnel_tree.count > 0) {
92     struct olsr_iptunnel_entry *t;
93
94     /* kill tunnel */
95     t = (struct olsr_iptunnel_entry *)avl_walk_first(&tunnel_tree);
96     t->usage = 1;
97
98     olsr_os_del_ipip_tunnel(t);
99   }
100   if (!store_iptunnel_state) {
101     olsr_if_set_state(olsr_cnf->ip_version == AF_INET ? DEV_IPV4_TUNNEL : DEV_IPV6_TUNNEL, false);
102   }
103
104   olsr_free_cookie(tunnel_cookie);
105 }
106
107 /**
108  * creates an ipip tunnel (for ipv4)
109  * @param name interface name
110  * @param target pointer to tunnel target IP, NULL if tunnel should be removed
111  * @return 0 if an error happened,
112  *   if_index for successful created tunnel, 1 for successful deleted tunnel
113  */
114 static int os_ip4_tunnel(const char *name, in_addr_t *target)
115 {
116   struct ifreq ifr;
117   int err;
118   struct ip_tunnel_parm p;
119
120   /* only IPIP tunnel if OLSR runs with IPv6 */
121   assert (olsr_cnf->ip_version == AF_INET);
122   memset(&p, 0, sizeof(p));
123   p.iph.version = 4;
124   p.iph.ihl = 5;
125   p.iph.protocol = IPPROTO_IPIP;
126   if (target) {
127     p.iph.daddr = *target;
128   }
129   strncpy(p.name, name, IFNAMSIZ);
130
131   memset(&ifr, 0, sizeof(ifr));
132   strncpy(ifr.ifr_name, target != NULL ? DEV_IPV4_TUNNEL : name, IFNAMSIZ);
133   ifr.ifr_ifru.ifru_data = (void *) &p;
134
135   if ((err = ioctl(olsr_cnf->ioctl_s, target != NULL ? SIOCADDTUNNEL : SIOCDELTUNNEL, &ifr))) {
136     char buffer[INET6_ADDRSTRLEN];
137
138     olsr_syslog(OLSR_LOG_ERR, "Cannot %s a tunnel %s to %s: %s (%d)\n",
139         target != NULL ? "add" : "remove", name,
140         target != NULL ? inet_ntop(olsr_cnf->ip_version, target, buffer, sizeof(buffer)) : "-",
141         strerror(errno), errno);
142     return 0;
143   }
144   return target != NULL ? if_nametoindex(name) : 1;
145 }
146
147 /**
148  * creates an ipip tunnel (for ipv6)
149  * @param name interface name
150  * @param target pointer to tunnel target IP, NULL if tunnel should be removed
151  * @return 0 if an error happened,
152  *   if_index for successful created tunnel, 1 for successful deleted tunnel
153  */
154 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
155 static int os_ip6_tunnel(const char *name, struct in6_addr *target)
156 {
157   struct ifreq ifr;
158   int err;
159   struct ip6_tnl_parm p;
160
161   /* only IP6 tunnel if OLSR runs with IPv6 */
162   assert (olsr_cnf->ip_version == AF_INET6);
163   memset(&p, 0, sizeof(p));
164   p.proto = 0; /* any protocol */
165   if (target) {
166     p.raddr = *target;
167   }
168   strncpy(p.name, name, IFNAMSIZ);
169
170   memset(&ifr, 0, sizeof(ifr));
171   strncpy(ifr.ifr_name, target != NULL ? DEV_IPV6_TUNNEL : name, IFNAMSIZ);
172   ifr.ifr_ifru.ifru_data = (void *) &p;
173
174   if ((err = ioctl(olsr_cnf->ioctl_s, target != NULL ? SIOCADDTUNNEL : SIOCDELTUNNEL, &ifr))) {
175     char buffer[INET6_ADDRSTRLEN];
176
177     olsr_syslog(OLSR_LOG_ERR, "Cannot %s a tunnel %s to %s: %s (%d)\n",
178         target != NULL ? "add" : "remove", name,
179         target != NULL ? inet_ntop(olsr_cnf->ip_version, target, buffer, sizeof(buffer)) : "-",
180         strerror(errno), errno);
181     return 0;
182   }
183   return target != NULL ? if_nametoindex(name) : 1;
184 }
185 #endif
186
187 /**
188  * Dummy for generating an interface name for an olsr ipip tunnel
189  * @param target IP destination of the tunnel
190  * @param name pointer to output buffer (length IFNAMSIZ)
191  */
192 static void generate_iptunnel_name(union olsr_ip_addr *target, char *name) {
193   static char PREFIX[] = "tnl_";
194   static uint32_t counter = 0;
195
196   snprintf(name, IFNAMSIZ, "%s%08x", PREFIX,
197       olsr_cnf->ip_version == AF_INET ? target->v4.s_addr : ++counter);
198 }
199
200 /**
201  * demands an ipip tunnel to a certain target. If no tunnel exists it will be created
202  * @param target ip address of the target
203  * @param transportV4 true if IPv4 traffic is used, false for IPv6 traffic
204  * @return NULL if an error happened, pointer to olsr_iptunnel_entry otherwise
205  */
206 struct olsr_iptunnel_entry *olsr_os_add_ipip_tunnel(union olsr_ip_addr *target, bool transportV4) {
207   struct olsr_iptunnel_entry *t;
208
209   assert(olsr_cnf->ip_version == AF_INET6 || transportV4);
210
211   t = (struct olsr_iptunnel_entry *)avl_find(&tunnel_tree, target);
212   if (t == NULL) {
213     char name[IFNAMSIZ];
214     int if_idx;
215     struct ipaddr_str buf;
216
217     memset(name, 0, sizeof(name));
218     generate_iptunnel_name(target, name);
219
220     if (olsr_cnf->ip_version == AF_INET) {
221       if_idx = os_ip4_tunnel(name, &target->v4.s_addr);
222     }
223     else {
224 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
225       if_idx = os_ip6_tunnel(name, &target->v6);
226 #else
227       if_idx = 0;
228 #endif
229     }
230
231     if (if_idx == 0) {
232       // cannot create tunnel
233 fprintf(stderr, "Cannot create tunnel %s to %s\n", name, olsr_ip_to_string(&buf, target));
234       return NULL;
235     }
236     // TODO: fehler bei setstate abfangen ?
237     olsr_if_set_state(name, true);
238
239     t = olsr_cookie_malloc(tunnel_cookie);
240     memcpy(&t->target, target, sizeof(*target));
241     t->node.key = &t->target;
242
243     strncpy(t->if_name, name, IFNAMSIZ);
244     t->if_index = if_idx;
245
246     avl_insert(&tunnel_tree, &t->node, AVL_DUP_NO);
247   }
248
249   t->usage++;
250   return t;
251 }
252
253 /**
254  * Release an olsr ipip tunnel. Tunnel will be deleted
255  * if this was the last user
256  * @param t pointer to olsr_iptunnel_entry
257  */
258 static void internal_olsr_os_del_ipip_tunnel(struct olsr_iptunnel_entry *t, bool cleanup) {
259   if (!cleanup) {
260     if (t->usage == 0) {
261       return;
262     }
263     t->usage--;
264
265     if (t->usage > 0) {
266       return;
267     }
268   }
269
270   olsr_if_set_state(t->if_name, false);
271   if (olsr_cnf->ip_version == AF_INET) {
272     os_ip4_tunnel(t->if_name, NULL);
273   }
274   else {
275 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0)
276     os_ip6_tunnel(t->if_name, NULL);
277 #endif
278   }
279
280   avl_delete(&tunnel_tree, &t->node);
281   if (!cleanup) {
282     olsr_cookie_free(tunnel_cookie, t);
283   }
284 }
285
286 void olsr_os_del_ipip_tunnel(struct olsr_iptunnel_entry *t) {
287   internal_olsr_os_del_ipip_tunnel(t, false);
288 }