bde1e1919ca8dd72006f3cc0d04b88fd70a06ca7
[olsrd.git] / src / linux / kernel_routes.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_routes.h"
43 #include "ipc_frontend.h"
44 #include "log.h"
45
46 /* values for control flag to handle recursive route corrections 
47  *  currently only requires in linux specific kernel_routes.c */
48
49 #define RT_ORIG_REQUEST 0
50 #define RT_RETRY_AFTER_ADD_GATEWAY 1
51 #define RT_RETRY_AFTER_DELETE_SIMILAR 2
52 #define RT_DELETE_SIMILAR_ROUTE 3
53 #define RT_AUTO_ADD_GATEWAY_ROUTE 4
54 #define RT_DELETE_SIMILAR_AUTO_ROUTE 5
55
56 #if !LINUX_POLICY_ROUTING
57
58 static int delete_all_inet_gws(void);
59
60 #else /* !LINUX_POLICY_ROUTING */
61
62 #include <assert.h>
63 #include <linux/types.h>
64 #include <linux/rtnetlink.h>
65
66 struct olsr_rtreq {
67   struct nlmsghdr n;
68   struct rtmsg r;
69   char buf[512];
70 };
71
72 static void
73 olsr_netlink_addreq(struct olsr_rtreq *req, int type, const void *data, int len)
74 {
75   struct rtattr *rta = (struct rtattr *)(((char *)req) + NLMSG_ALIGN(req->n.nlmsg_len));
76   req->n.nlmsg_len = NLMSG_ALIGN(req->n.nlmsg_len) + RTA_LENGTH(len);
77   assert(req->n.nlmsg_len < sizeof(struct olsr_rtreq));
78   rta->rta_type = type;
79   rta->rta_len = RTA_LENGTH(len);
80   memcpy(RTA_DATA(rta), data, len);
81 }
82
83 /* returns
84  * -1 on unrecoverable error (calling function will have to handle it)
85  *  0 on unexpected but recoverable rtnetlink behaviour
86  *    but some of the implemented recovery methods only cure symptoms, 
87  *    not the cause, like unintelligent ordering of inserted routes.
88  *  1 on success */
89 static int
90 olsr_netlink_route_int(const struct rt_entry *rt, uint8_t family, uint8_t rttable, __u16 cmd, uint8_t flag)
91 {
92   int ret = 1; /* helper variable for rtnetlink_message processing */
93   int rt_ret = -2;  /* if no response from rtnetlink it must be considered as failed! */
94   struct olsr_rtreq req;
95   struct iovec iov;
96   struct sockaddr_nl nladdr;
97   struct msghdr msg = {
98     &nladdr,
99     sizeof(nladdr),
100     &iov,
101     1,
102     NULL,
103     0,
104     0
105   };
106
107   uint32_t metric = 0;
108   struct rt_nexthop *nexthop = NULL;
109   if ( ( cmd != RTM_NEWRULE ) || ( cmd != RTM_DELRULE ) ) {
110
111     if (FIBM_FLAT != olsr_cnf->fib_metric) metric = RT_METRIC_DEFAULT;
112     else metric = (RTM_NEWROUTE == cmd) ? rt->rt_best->rtp_metric.hops : rt->rt_metric.hops;
113
114     if ( ( RTM_NEWROUTE == cmd ) || (( RT_DELETE_SIMILAR_ROUTE == flag || RT_DELETE_SIMILAR_AUTO_ROUTE == flag ) && ( RTM_DELROUTE == cmd )) )
115       nexthop = &rt->rt_best->rtp_nexthop;
116     else nexthop = &rt->rt_nexthop;
117   }
118
119   memset(&req, 0, sizeof(req));
120
121   req.n.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg));
122   req.n.nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE | NLM_F_EXCL | NLM_F_ACK;
123   req.n.nlmsg_type = cmd;
124   req.r.rtm_family = family;
125   req.r.rtm_table = rttable;
126   /* RTN_UNSPEC would be the wildcard, but blackhole broadcast or nat roules should usually not conflict */
127   req.r.rtm_type = RTN_UNICAST; /* -> olsr only adds deletes unicast routes */
128   req.r.rtm_protocol = RTPROT_UNSPEC; /* wildcard to delete routes of all protos if no simlar-delete correct proto will get set below */
129   req.r.rtm_scope = RT_SCOPE_NOWHERE; /* as wildcard for deletion */
130
131   if (( cmd != RTM_NEWRULE ) && ( cmd != RTM_DELRULE ) ) {
132     req.r.rtm_dst_len = rt->rt_dst.prefix_len;
133
134     /* do not specify much as we wanna delete similar/conflicting routes */
135     if ( ( flag != RT_DELETE_SIMILAR_ROUTE ) && ( flag != RT_DELETE_SIMILAR_AUTO_ROUTE )) {
136       /* 0 gets replaced by OS-specifc default (3)
137        * 1 is reserved so we take 0 instead (this really makes some sense)
138        * other numbers are used 1:1 */
139       req.r.rtm_protocol = ( (olsr_cnf->rtproto<1) ? RTPROT_BOOT : ( (olsr_cnf->rtproto==1) ? 0 : olsr_cnf->rtproto) );
140       req.r.rtm_scope = RT_SCOPE_LINK;
141
142       /*add interface*/
143       olsr_netlink_addreq(&req, RTA_OIF, &nexthop->iif_index, sizeof(nexthop->iif_index));
144
145       #if SOURCE_IP_ROUTES
146       /* source ip here is based on now static olsr_cnf->main_addr in this olsr-0.5.6-r4, should be based on orignator-id in newer olsrds */
147       if (AF_INET == family) olsr_netlink_addreq(&req, RTA_PREFSRC, &olsr_cnf->main_addr.v4.s_addr, sizeof(olsr_cnf->main_addr.v4.s_addr));
148       else olsr_netlink_addreq(&req, RTA_PREFSRC, &olsr_cnf->main_addr.v6.s6_addr, sizeof(olsr_cnf->main_addr.v6.s6_addr));
149       #endif
150     }
151
152     /* metric is specified always as we can only delete one route per iteration, and wanna hit the correct one first */
153     if (FIBM_APPROX != olsr_cnf->fib_metric || (RTM_NEWROUTE == cmd) ) {
154       olsr_netlink_addreq(&req, RTA_PRIORITY, &metric, sizeof(metric));
155     }
156
157     /* make sure that netmask = /32 as this is an autogenarated route */
158     if (( flag == RT_AUTO_ADD_GATEWAY_ROUTE ) || (flag == RT_DELETE_SIMILAR_AUTO_ROUTE) ) req.r.rtm_dst_len = 32;
159
160     /* for ipv4 or ipv6 we add gateway if one is specified, 
161     * or leave gateway away if we want to delete similar routes aswell, 
162     * or even use the gateway as target if we add a auto-generated route, 
163     * or if delete-similar to make insertion of auto-generated route possible */
164     if (AF_INET == family) {
165       if ( ( flag != RT_AUTO_ADD_GATEWAY_ROUTE ) && (flag != RT_DELETE_SIMILAR_ROUTE) && 
166            ( flag != RT_DELETE_SIMILAR_AUTO_ROUTE) && (rt->rt_dst.prefix.v4.s_addr != nexthop->gateway.v4.s_addr) ) {
167         olsr_netlink_addreq(&req, RTA_GATEWAY, &nexthop->gateway.v4, sizeof(nexthop->gateway.v4));
168         req.r.rtm_scope = RT_SCOPE_UNIVERSE;
169       }
170       olsr_netlink_addreq(&req, RTA_DST, ( (flag == RT_AUTO_ADD_GATEWAY_ROUTE) || (flag == RT_DELETE_SIMILAR_AUTO_ROUTE) ) ? 
171                           &nexthop->gateway.v4 : &rt->rt_dst.prefix.v4, sizeof(rt->rt_dst.prefix.v4));
172     } else {
173       if ( ( flag != RT_AUTO_ADD_GATEWAY_ROUTE ) && (flag != RT_DELETE_SIMILAR_ROUTE ) && ( flag != RT_DELETE_SIMILAR_AUTO_ROUTE) 
174           && (0 != memcmp(&rt->rt_dst.prefix.v6, &nexthop->gateway.v6, sizeof(nexthop->gateway.v6))) ) {
175         olsr_netlink_addreq(&req, RTA_GATEWAY, &nexthop->gateway.v6, sizeof(nexthop->gateway.v6));
176         req.r.rtm_scope = RT_SCOPE_UNIVERSE;
177       }
178       olsr_netlink_addreq(&req, RTA_DST, ( (flag == RT_AUTO_ADD_GATEWAY_ROUTE) || (flag == RT_DELETE_SIMILAR_AUTO_ROUTE) ) ? 
179                           &nexthop->gateway.v6 : &rt->rt_dst.prefix.v6, sizeof(rt->rt_dst.prefix.v6));
180     }
181   } else {//add or delete a rule
182     static uint32_t priority = 65535;
183     req.r.rtm_scope = RT_SCOPE_UNIVERSE;
184     olsr_netlink_addreq(&req, RTA_PRIORITY, &priority, sizeof(priority));
185   }
186
187   iov.iov_base = &req.n;
188   iov.iov_len = req.n.nlmsg_len;
189   memset(&nladdr, 0, sizeof(nladdr));
190   nladdr.nl_family = AF_NETLINK;
191   if (0 <= (ret = sendmsg(olsr_cnf->rtnl_s, &msg, 0))) {
192     iov.iov_base = req.buf;
193     iov.iov_len = sizeof(req.buf);
194     if (0 < (ret = recvmsg(olsr_cnf->rtnl_s, &msg, 0))) {
195       struct nlmsghdr *h = (struct nlmsghdr *)req.buf;
196       while (NLMSG_OK(h, (unsigned int)ret)) {
197         if (NLMSG_DONE == h->nlmsg_type) {
198           //seems to reached never
199           olsr_syslog(OLSR_LOG_INFO, "_received NLMSG_DONE");
200           break;
201         }
202         if (NLMSG_ERROR == h->nlmsg_type) {
203           if (NLMSG_LENGTH(sizeof(struct nlmsgerr) <= h->nlmsg_len)) {
204             struct ipaddr_str ibuf;
205             struct ipaddr_str gbuf;
206             struct nlmsgerr *l_err = (struct nlmsgerr *)NLMSG_DATA(h);
207             errno = -l_err->error;
208             if (0 != errno) {
209             const char *const err_msg = strerror(errno);
210               struct ipaddr_str buf;
211               rt_ret = -1;
212               /* syslog debug output for various situations */
213               if ( cmd == RTM_NEWRULE ) {
214                 olsr_syslog(OLSR_LOG_ERR,"Error '%s' (%d) on inserting empty policy rule aimed to activate RtTable %u!", err_msg, errno, rttable);
215               }
216               else if ( cmd == RTM_DELRULE ) {
217                 olsr_syslog(OLSR_LOG_ERR,"Error '%s' (%d) on deleting empty policy rule aimed to activate rtTable %u!", err_msg, errno, rttable);
218               }
219               else if ( flag <= RT_RETRY_AFTER_DELETE_SIMILAR ) {
220                 if (rt->rt_dst.prefix.v4.s_addr!=nexthop->gateway.v4.s_addr)
221                   olsr_syslog(OLSR_LOG_ERR, "error '%s' (%d) %s route to %s/%d via %s dev %s", err_msg, errno, (cmd == RTM_NEWROUTE) ? "add" : "del",
222                               olsr_ip_to_string(&ibuf,&rt->rt_dst.prefix), req.r.rtm_dst_len,
223                               olsr_ip_to_string(&gbuf,&nexthop->gateway), if_ifwithindex_name(nexthop->iif_index));
224                 else olsr_syslog(OLSR_LOG_ERR, "error '%s' (%d) %s route to %s/%d dev %s", err_msg, errno, (cmd == RTM_NEWROUTE) ? "add" : "del",
225                                  olsr_ip_to_string(&ibuf,&rt->rt_dst.prefix), req.r.rtm_dst_len, if_ifwithindex_name(nexthop->iif_index));
226               }
227               else if (flag == RT_AUTO_ADD_GATEWAY_ROUTE) 
228                        olsr_syslog(OLSR_LOG_ERR, ". error '%s' (%d) auto-add route to %s dev %s", err_msg, errno,
229                                    olsr_ip_to_string(&ibuf,&nexthop->gateway), if_ifwithindex_name(nexthop->iif_index));
230               else if (flag == RT_DELETE_SIMILAR_ROUTE) 
231                        olsr_syslog(OLSR_LOG_ERR, ". error '%s' (%d) auto-delete route to %s dev %s", err_msg, errno,
232                                    olsr_ip_to_string(&ibuf,&rt->rt_dst.prefix), if_ifwithindex_name(nexthop->iif_index));
233               else if (flag == RT_DELETE_SIMILAR_AUTO_ROUTE) 
234                        olsr_syslog(OLSR_LOG_ERR, ". . error '%s' (%d) auto-delete similar route to %s dev %s", err_msg, errno,
235                                    olsr_ip_to_string(&ibuf,&nexthop->gateway), if_ifwithindex_name(nexthop->iif_index));
236               else { /* should never happen */
237                 olsr_syslog(OLSR_LOG_ERR, "# invalid internal route delete/add flag (%d) used!", flag);
238               }
239             }
240             else { /* netlink acks requests with an errno=0 NLMSG_ERROR response! */
241               rt_ret = 1;
242             }
243
244             /* resolve "File exist" (17) propblems (on orig and autogen routes)*/       
245             if ((errno == 17) && ((flag == RT_ORIG_REQUEST) || (flag == RT_AUTO_ADD_GATEWAY_ROUTE)) && (cmd == RTM_NEWROUTE)) {
246               /* a similar route going over another gateway may be present, which has to be deleted! */
247               olsr_syslog(OLSR_LOG_ERR, ". auto-deleting similar routes to resolve 'File exists' (17) while adding route!");
248               rt_ret = RT_DELETE_SIMILAR_ROUTE; /* processing will contiune after this loop */
249             }
250             /* report success on "No such process" (3) */
251             else if ((errno == 3) && (cmd == RTM_DELROUTE) && (flag == RT_ORIG_REQUEST)) {
252               /* another similar (but slightly different) route may be present at this point
253               * , if so this will get solved when adding new route to this destination */
254               olsr_syslog(OLSR_LOG_ERR, ". ignoring 'No such process' (3) while deleting route!");
255               rt_ret = 0;
256             }
257             /* insert route to gateway on the fly if "Network unreachable" (128) on 2.4 kernels
258              * or on 2.6 kernel No such process (3) or Network unreachable (101) is reported in rtnetlink response
259              * do this only with flat metric, as using metric values inherited from 
260              * a target behind the gateway is really strange, and could lead to multiple routes!
261              * anyways if invalid gateway ips may happen we are f*cked up!!
262              * but if not, these on the fly generated routes are no problem, and will only get used when needed */
263             else if ( ( (errno == 3) || (errno == 101) || (errno == 128) ) && (flag == RT_ORIG_REQUEST) && (FIBM_FLAT == olsr_cnf->fib_metric) 
264                      && (cmd == RTM_NEWROUTE) && (rt->rt_dst.prefix.v4.s_addr!=nexthop->gateway.v4.s_addr)) {
265               if (errno == 128) olsr_syslog(OLSR_LOG_ERR, ". autogenerating route to handle 'Network unreachable' (128) while adding route!");
266               else if (errno == 101) olsr_syslog(OLSR_LOG_ERR, ". autogenerating route to handle 'Network unreachable' (101) while adding route!");
267               else olsr_syslog(OLSR_LOG_ERR, ". autogenerating route to handle 'No such process' (3) while adding route!");
268
269               rt_ret = RT_AUTO_ADD_GATEWAY_ROUTE; /* processing will contiune after this loop */
270             }
271           }
272           /* report invalid message size */
273           else olsr_syslog(OLSR_LOG_INFO,"_received invalid netlink message size %lu != %u",(unsigned long int)sizeof(struct nlmsgerr), h->nlmsg_len);
274         }
275         /* log all other messages */
276         else olsr_syslog(OLSR_LOG_INFO,"_received %u Byte rtnetlink response of type %u with seqnr %u and flags %u from %u (%u)",
277                          h->nlmsg_len, h->nlmsg_type, h->nlmsg_seq, h->nlmsg_flags, h->nlmsg_pid, NLMSG_ERROR);
278         h = NLMSG_NEXT(h, ret);
279       }
280     }
281   }
282   if ( rt_ret == RT_DELETE_SIMILAR_ROUTE ) {//delete all routes that may collide
283     /* recursive call to delete simlar routes, using flag 2 to invoke deletion of similar, not only exact matches*/
284     rt_ret = olsr_netlink_route_int(rt, family, rttable, RTM_DELROUTE, 
285                                     flag == RT_AUTO_ADD_GATEWAY_ROUTE ? RT_DELETE_SIMILAR_AUTO_ROUTE : RT_DELETE_SIMILAR_ROUTE);
286
287     /* retry insert original route, if deleting similar succeeded, using flag=1 to prevent recursions */
288     if (rt_ret > 0) rt_ret = olsr_netlink_route_int(rt, family, rttable, RTM_NEWROUTE, RT_RETRY_AFTER_DELETE_SIMILAR);
289     else olsr_syslog(OLSR_LOG_ERR, ". failed on auto-deleting similar route conflicting with above route!");
290
291     /* set appropriate return code for original request, while returning simple -1/1 if called recursive */
292     if (flag != RT_AUTO_ADD_GATEWAY_ROUTE) {
293       if (rt_ret > 0) rt_ret = 0; /* successful recovery */
294       else rt_ret = -1; /* unrecoverable error */
295     }
296   }
297   if ( rt_ret == RT_AUTO_ADD_GATEWAY_ROUTE ) { /* autoadd route via gateway */
298     /* recursive call to invoke creation of a route to the gateway */
299     rt_ret = olsr_netlink_route_int(rt, family, rttable, RTM_NEWROUTE, RT_AUTO_ADD_GATEWAY_ROUTE);
300
301     /* retry insert original route, if above succeeded without problems */
302     if (rt_ret > 0) rt_ret = olsr_netlink_route_int(rt, family, rttable, RTM_NEWROUTE, RT_RETRY_AFTER_ADD_GATEWAY);
303     else olsr_syslog(OLSR_LOG_ERR, ". failed on inserting auto-generated route to gateway of above route!");
304
305     /* set appropriate return code for original request*/
306     if (rt_ret > 0) rt_ret = 0; /* successful recovery */
307     else rt_ret = -1; /* unrecoverable error */
308   }
309   //send ipc update on success
310   if ( ( cmd != RTM_NEWRULE ) && ( cmd != RTM_DELRULE ) && (flag = RT_ORIG_REQUEST) && (0 <= rt_ret && olsr_cnf->ipc_connections > 0) ) {
311     ipc_route_send_rtentry(&rt->rt_dst.prefix, &nexthop->gateway, metric, RTM_NEWROUTE == cmd,
312                              if_ifwithindex_name(nexthop->iif_index));
313   }
314   if (rt_ret == -2) olsr_syslog(OLSR_LOG_ERR,"no rtnetlink response! (no system ressources left?, everything may happen now ...)");
315   return rt_ret;
316 }
317
318 /*external wrapper function for above patched multi purpose rtnetlink function*/
319 int
320 olsr_netlink_rule(uint8_t family, uint8_t rttable, uint16_t cmd)
321 {
322   struct rt_entry rt;
323   return olsr_netlink_route_int(&rt, family, rttable, cmd, RT_ORIG_REQUEST);
324 }
325
326 /*internal wrapper function for above patched function*/
327 static int
328 olsr_netlink_route(const struct rt_entry *rt, uint8_t family, uint8_t rttable, __u16 cmd)
329 {
330   return olsr_netlink_route_int(rt, family, rttable, cmd, RT_ORIG_REQUEST);
331 }
332
333 #endif /* LINUX_POLICY_ROUTING */
334
335 /**
336  * Insert a route in the kernel routing table
337  *
338  * @param destination the route to add
339  *
340  * @return negative on error
341  */
342 int
343 olsr_ioctl_add_route(const struct rt_entry *rt)
344 {
345 #if !LINUX_POLICY_ROUTING
346   struct rtentry kernel_route;
347   union olsr_ip_addr mask;
348   int rslt;
349 #endif /* LINUX_POLICY_ROUTING */
350
351   OLSR_PRINTF(2, "KERN: Adding %s\n", olsr_rtp_to_string(rt->rt_best));
352
353 #if !LINUX_POLICY_ROUTING
354   memset(&kernel_route, 0, sizeof(struct rtentry));
355
356   ((struct sockaddr_in *)&kernel_route.rt_dst)->sin_family = AF_INET;
357   ((struct sockaddr_in *)&kernel_route.rt_gateway)->sin_family = AF_INET;
358   ((struct sockaddr_in *)&kernel_route.rt_genmask)->sin_family = AF_INET;
359
360   ((struct sockaddr_in *)&kernel_route.rt_dst)->sin_addr = rt->rt_dst.prefix.v4;
361
362   if (!olsr_prefix_to_netmask(&mask, rt->rt_dst.prefix_len)) {
363     return -1;
364   }
365   ((struct sockaddr_in *)&kernel_route.rt_genmask)->sin_addr = mask.v4;
366
367   if (rt->rt_dst.prefix.v4.s_addr != rt->rt_best->rtp_nexthop.gateway.v4.s_addr) {
368     ((struct sockaddr_in *)&kernel_route.rt_gateway)->sin_addr = rt->rt_best->rtp_nexthop.gateway.v4;
369   }
370
371   kernel_route.rt_flags = olsr_rt_flags(rt);
372   kernel_route.rt_metric = olsr_fib_metric(&rt->rt_best->rtp_metric.hops);
373
374   /*
375    * Set interface
376    */
377   kernel_route.rt_dev = if_ifwithindex_name(rt->rt_best->rtp_nexthop.iif_index);
378
379   /* delete existing default route before ? */
380   if ((olsr_cnf->del_gws) && (rt->rt_dst.prefix.v4.s_addr == INADDR_ANY) && (rt->rt_dst.prefix_len == INADDR_ANY)) {
381     delete_all_inet_gws();
382     olsr_cnf->del_gws = false;
383   }
384
385   if ((rslt = ioctl(olsr_cnf->ioctl_s, SIOCADDRT, &kernel_route)) >= 0) {
386
387     /*
388      * Send IPC route update message
389      */
390     ipc_route_send_rtentry(&rt->rt_dst.prefix, &rt->rt_best->rtp_nexthop.gateway, rt->rt_best->rtp_metric.hops, 1,
391                            if_ifwithindex_name(rt->rt_best->rtp_nexthop.iif_index));
392   }
393
394   return rslt;
395 #else /* !LINUX_POLICY_ROUTING */
396   if (0 == olsr_cnf->rttable_default && 0 == rt->rt_dst.prefix_len && 253 > olsr_cnf->rttable) {
397     /*
398      * Users start whining about not having internet with policy
399      * routing activated and no static default route in table 254.
400      * We maintain a fallback defroute in the default=253 table.
401      */
402     olsr_netlink_route(rt, AF_INET, 253, RTM_NEWROUTE);
403   }
404   if (0 == rt->rt_dst.prefix_len && olsr_cnf->rttable_default != 0)
405     return olsr_netlink_route(rt, AF_INET, olsr_cnf->rttable_default, RTM_NEWROUTE);
406   else
407     return olsr_netlink_route(rt, AF_INET, olsr_cnf->rttable, RTM_NEWROUTE);
408 #endif /* LINUX_POLICY_ROUTING */
409 }
410
411 /**
412  *Insert a route in the kernel routing table
413  *
414  *@param destination the route to add
415  *
416  *@return negative on error
417  */
418 int
419 olsr_ioctl_add_route6(const struct rt_entry *rt)
420 {
421 #if !LINUX_POLICY_ROUTING
422   struct in6_rtmsg kernel_route;
423   int rslt;
424
425   OLSR_PRINTF(2, "KERN: Adding %s\n", olsr_rtp_to_string(rt->rt_best));
426
427   memset(&kernel_route, 0, sizeof(struct in6_rtmsg));
428
429   kernel_route.rtmsg_dst = rt->rt_dst.prefix.v6;
430   kernel_route.rtmsg_dst_len = rt->rt_dst.prefix_len;
431
432   kernel_route.rtmsg_gateway = rt->rt_best->rtp_nexthop.gateway.v6;
433
434   kernel_route.rtmsg_flags = olsr_rt_flags(rt);
435   kernel_route.rtmsg_metric = olsr_fib_metric(&rt->rt_best->rtp_metric.hops);
436
437   /*
438    * set interface
439    */
440   kernel_route.rtmsg_ifindex = rt->rt_best->rtp_nexthop.iif_index;
441
442   /* XXX delete 0/0 route before ? */
443
444   if ((rslt = ioctl(olsr_cnf->ioctl_s, SIOCADDRT, &kernel_route)) >= 0) {
445
446     /*
447      * Send IPC route update message
448      */
449     ipc_route_send_rtentry(&rt->rt_dst.prefix, &rt->rt_best->rtp_nexthop.gateway, rt->rt_best->rtp_metric.hops, 1,
450                            if_ifwithindex_name(rt->rt_best->rtp_nexthop.iif_index));
451   }
452   return rslt;
453 #else /* !LINUX_POLICY_ROUTING */
454   if (0 == rt->rt_dst.prefix_len && olsr_cnf->rttable_default != 0)
455     return olsr_netlink_route(rt, AF_INET6, olsr_cnf->rttable_default, RTM_NEWROUTE);
456   else
457     return olsr_netlink_route(rt, AF_INET6, olsr_cnf->rttable, RTM_NEWROUTE);
458 #endif /* LINUX_POLICY_ROUTING */
459 }
460
461 /**
462  *Remove a route from the kernel
463  *
464  *@param destination the route to remove
465  *
466  *@return negative on error
467  */
468 int
469 olsr_ioctl_del_route(const struct rt_entry *rt)
470 {
471 #if !LINUX_POLICY_ROUTING
472   struct rtentry kernel_route;
473   union olsr_ip_addr mask;
474   int rslt;
475 #endif /* LINUX_POLICY_ROUTING */
476
477   OLSR_PRINTF(2, "KERN: Deleting %s\n", olsr_rt_to_string(rt));
478
479 #if !LINUX_POLICY_ROUTING
480   memset(&kernel_route, 0, sizeof(struct rtentry));
481
482   ((struct sockaddr_in *)&kernel_route.rt_dst)->sin_family = AF_INET;
483   ((struct sockaddr_in *)&kernel_route.rt_gateway)->sin_family = AF_INET;
484   ((struct sockaddr_in *)&kernel_route.rt_genmask)->sin_family = AF_INET;
485
486   ((struct sockaddr_in *)&kernel_route.rt_dst)->sin_addr = rt->rt_dst.prefix.v4;
487
488   if (rt->rt_dst.prefix.v4.s_addr != rt->rt_nexthop.gateway.v4.s_addr) {
489     ((struct sockaddr_in *)&kernel_route.rt_gateway)->sin_addr = rt->rt_nexthop.gateway.v4;
490   }
491
492   if (!olsr_prefix_to_netmask(&mask, rt->rt_dst.prefix_len)) {
493     return -1;
494   } else {
495     ((struct sockaddr_in *)&kernel_route.rt_genmask)->sin_addr = mask.v4;
496   }
497
498   kernel_route.rt_flags = olsr_rt_flags(rt);
499   kernel_route.rt_metric = olsr_fib_metric(&rt->rt_metric.hops);
500
501   /*
502    * Set interface
503    */
504   kernel_route.rt_dev = NULL;
505
506   if ((rslt = ioctl(olsr_cnf->ioctl_s, SIOCDELRT, &kernel_route)) >= 0) {
507
508     /*
509      * Send IPC route update message
510      */
511     ipc_route_send_rtentry(&rt->rt_dst.prefix, NULL, 0, 0, NULL);
512   }
513
514   return rslt;
515 #else /* !LINUX_POLICY_ROUTING */
516   if (0 == olsr_cnf->rttable_default && 0 == rt->rt_dst.prefix_len && 253 > olsr_cnf->rttable) {
517     /*
518      * Also remove the fallback default route
519      */
520     olsr_netlink_route(rt, AF_INET, 253, RTM_DELROUTE);
521   }
522   if (0 == rt->rt_dst.prefix_len && olsr_cnf->rttable_default != 0)
523     return olsr_netlink_route(rt, AF_INET, olsr_cnf->rttable_default, RTM_DELROUTE);
524   else
525     return olsr_netlink_route(rt, AF_INET, olsr_cnf->rttable, RTM_DELROUTE);
526 #endif /* LINUX_POLICY_ROUTING */
527 }
528
529 /**
530  *Remove a route from the kernel
531  *
532  *@param destination the route to remove
533  *
534  *@return negative on error
535  */
536 int
537 olsr_ioctl_del_route6(const struct rt_entry *rt)
538 {
539 #if !LINUX_POLICY_ROUTING
540   struct in6_rtmsg kernel_route;
541   int rslt;
542 #endif /* LINUX_POLICY_ROUTING */
543
544   OLSR_PRINTF(2, "KERN: Deleting %s\n", olsr_rt_to_string(rt));
545
546 #if !LINUX_POLICY_ROUTING
547   memset(&kernel_route, 0, sizeof(struct in6_rtmsg));
548
549   kernel_route.rtmsg_dst = rt->rt_dst.prefix.v6;
550   kernel_route.rtmsg_dst_len = rt->rt_dst.prefix_len;
551
552   kernel_route.rtmsg_gateway = rt->rt_best->rtp_nexthop.gateway.v6;
553
554   kernel_route.rtmsg_flags = olsr_rt_flags(rt);
555   kernel_route.rtmsg_metric = olsr_fib_metric(&rt->rt_best->rtp_metric.hops);
556
557   if ((rslt = ioctl(olsr_cnf->ioctl_s, SIOCDELRT, &kernel_route) >= 0)) {
558
559     /*
560      * Send IPC route update message
561      */
562     ipc_route_send_rtentry(&rt->rt_dst.prefix, NULL, 0, 0, NULL);
563   }
564
565   return rslt;
566 #else /* !LINUX_POLICY_ROUTING */
567   if (0 == rt->rt_dst.prefix_len && olsr_cnf->rttable_default != 0)
568     return olsr_netlink_route(rt, AF_INET6, olsr_cnf->rttable_default, RTM_DELROUTE);
569   else
570     return olsr_netlink_route(rt, AF_INET6, olsr_cnf->rttable, RTM_DELROUTE);
571 #endif /* LINUX_POLICY_ROUTING */
572 }
573
574 #if !LINUX_POLICY_ROUTING
575 static int
576 delete_all_inet_gws(void)
577 {
578   int s;
579   char buf[BUFSIZ], *cp, *cplim;
580   struct ifconf ifc;
581   struct ifreq *ifr;
582
583   OLSR_PRINTF(1, "Internet gateway detected...\nTrying to delete default gateways\n");
584
585   /* Get a socket */
586   if ((s = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
587     olsr_syslog(OLSR_LOG_ERR, "socket: %m");
588     return -1;
589   }
590
591   ifc.ifc_len = sizeof(buf);
592   ifc.ifc_buf = buf;
593   if (ioctl(s, SIOCGIFCONF, (char *)&ifc) < 0) {
594     olsr_syslog(OLSR_LOG_ERR, "ioctl (get interface configuration)");
595     close(s);
596     return -1;
597   }
598
599   ifr = ifc.ifc_req;
600   cplim = buf + ifc.ifc_len;    /*skip over if's with big ifr_addr's */
601   for (cp = buf; cp < cplim; cp += sizeof(ifr->ifr_name) + sizeof(ifr->ifr_addr)) {
602     struct rtentry kernel_route;
603     ifr = (struct ifreq *)cp;
604
605     if (strcmp(ifr->ifr_ifrn.ifrn_name, "lo") == 0) {
606       OLSR_PRINTF(1, "Skipping loopback...\n");
607       continue;
608     }
609
610     OLSR_PRINTF(1, "Trying 0.0.0.0/0 %s...", ifr->ifr_ifrn.ifrn_name);
611
612     memset(&kernel_route, 0, sizeof(struct rtentry));
613
614     ((struct sockaddr_in *)&kernel_route.rt_dst)->sin_addr.s_addr = 0;
615     ((struct sockaddr_in *)&kernel_route.rt_dst)->sin_family = AF_INET;
616     ((struct sockaddr_in *)&kernel_route.rt_genmask)->sin_addr.s_addr = 0;
617     ((struct sockaddr_in *)&kernel_route.rt_genmask)->sin_family = AF_INET;
618
619     ((struct sockaddr_in *)&kernel_route.rt_gateway)->sin_addr.s_addr = INADDR_ANY;
620     ((struct sockaddr_in *)&kernel_route.rt_gateway)->sin_family = AF_INET;
621
622     kernel_route.rt_flags = RTF_UP | RTF_GATEWAY;
623
624     kernel_route.rt_dev = ifr->ifr_ifrn.ifrn_name;
625
626     if ((ioctl(s, SIOCDELRT, &kernel_route)) < 0)
627       OLSR_PRINTF(1, "NO\n");
628     else
629       OLSR_PRINTF(1, "YES\n");
630   }
631   close(s);
632   return 0;
633 }
634 #endif /* LINUX_POLICY_ROUTING */
635
636 /*
637  * Local Variables:
638  * c-basic-offset: 2
639  * indent-tabs-mode: nil
640  * End:
641  */