Removed superfluous maxplen config var
[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 <assert.h>
45 #include <errno.h>
46 #include <linux/types.h>
47 #include <linux/rtnetlink.h>
48
49 struct olsr_rtreq {
50   struct nlmsghdr n;
51   struct rtmsg    r;
52   char            buf[512];
53 };
54
55 static void olsr_netlink_addreq(struct olsr_rtreq *req, int type, const void *data, int len)
56 {
57   struct rtattr *rta = (struct rtattr*)(((char*)req) + NLMSG_ALIGN(req->n.nlmsg_len));
58   req->n.nlmsg_len = NLMSG_ALIGN(req->n.nlmsg_len) + RTA_LENGTH(len);
59   assert(req->n.nlmsg_len < sizeof(*req));
60   rta->rta_type = type;
61   rta->rta_len = RTA_LENGTH(len);
62   memcpy(RTA_DATA(rta), data, len);
63 }
64
65 static int olsr_netlink_route(const struct rt_entry *rt, uint8_t family, uint8_t rttable, __u16 cmd)
66 {
67   int ret = 0;
68   struct olsr_rtreq req;
69   struct iovec iov;
70   struct sockaddr_nl nladdr = { .nl_family = AF_NETLINK };
71   struct msghdr msg = {
72     .msg_name = &nladdr,
73     .msg_namelen = sizeof(nladdr),
74     .msg_iov = &iov,
75     .msg_iovlen = 1,
76     .msg_control = NULL,
77     .msg_controllen = 0,
78     .msg_flags = 0
79   };
80   uint32_t metric = FIBM_FLAT != olsr_cnf->fib_metric
81     ? (RTM_NEWROUTE == cmd
82        ? rt->rt_best->rtp_metric.hops
83        : rt->rt_metric.hops)
84     : RT_METRIC_DEFAULT;
85   const struct rt_nexthop* nexthop = RTM_NEWROUTE == cmd
86     ? &rt->rt_best->rtp_nexthop
87     : &rt->rt_nexthop;
88
89   memset(&req, 0, sizeof(req));
90   req.n.nlmsg_len = NLMSG_LENGTH(sizeof(req.r));
91   req.n.nlmsg_flags = NLM_F_REQUEST|NLM_F_CREATE|NLM_F_EXCL|NLM_F_ACK;
92   req.n.nlmsg_type = cmd;
93   req.r.rtm_family = family;
94   req.r.rtm_table = rttable;
95   req.r.rtm_protocol = olsr_cnf->rtproto > 0 ? olsr_cnf->rtproto : RTPROT_BOOT;
96   req.r.rtm_scope = RT_SCOPE_LINK;
97   req.r.rtm_type = RTN_UNICAST;
98   req.r.rtm_dst_len = rt->rt_dst.prefix_len;
99
100   if (AF_INET == family) {
101     if (!ip4equal(&rt->rt_dst.prefix.v4, &nexthop->gateway.v4)) {
102       olsr_netlink_addreq(&req, RTA_GATEWAY, &nexthop->gateway.v4, sizeof(nexthop->gateway.v4));
103       req.r.rtm_scope = RT_SCOPE_UNIVERSE;
104     }
105     olsr_netlink_addreq(&req, RTA_DST, &rt->rt_dst.prefix.v4, sizeof(rt->rt_dst.prefix.v4));
106   } else {
107     if (!ip6equal(&rt->rt_dst.prefix.v6, &nexthop->gateway.v6)) {
108       olsr_netlink_addreq(&req, RTA_GATEWAY, &nexthop->gateway.v6, sizeof(nexthop->gateway.v6));
109       req.r.rtm_scope = RT_SCOPE_UNIVERSE;
110     }
111     olsr_netlink_addreq(&req, RTA_DST, &rt->rt_dst.prefix.v6, sizeof(rt->rt_dst.prefix.v6));
112   }
113   if (FIBM_APPROX != olsr_cnf->fib_metric || RTM_NEWROUTE == cmd) {
114     olsr_netlink_addreq(&req, RTA_PRIORITY, &metric, sizeof(metric));
115   }
116   olsr_netlink_addreq(&req, RTA_OIF, &nexthop->interface->if_index,
117                       sizeof(nexthop->interface->if_index));
118   iov.iov_base = &req.n;
119   iov.iov_len = req.n.nlmsg_len;
120   ret = sendmsg(olsr_cnf->rts_linux, &msg, 0);
121   if (0 <= ret) {
122     iov.iov_base = req.buf;
123     iov.iov_len = sizeof(req.buf);
124     ret = recvmsg(olsr_cnf->rts_linux, &msg, 0);
125     if (0 < ret) {
126       struct nlmsghdr* h = (struct nlmsghdr*)req.buf;
127       while (NLMSG_OK(h, (unsigned int)ret)) {
128         if (NLMSG_DONE == h->nlmsg_type) {
129           break;
130         }
131         if (NLMSG_ERROR == h->nlmsg_type) {
132           if (NLMSG_LENGTH(sizeof(struct nlmsgerr) <= h->nlmsg_len)) {
133             const struct nlmsgerr *l_err = (struct nlmsgerr*)NLMSG_DATA(h);
134             errno = -l_err->error;
135             if (0 != errno) {
136               ret = -1;
137             }
138           }
139           break;
140         }
141         h = NLMSG_NEXT(h, ret);
142       }
143     }
144     if (0 <= ret && olsr_cnf->ipc_connections > 0) {
145       ipc_route_send_rtentry(&rt->rt_dst.prefix,
146                              &nexthop->gateway,
147                              metric,
148                              RTM_NEWROUTE == cmd,
149                              nexthop->interface->int_name);
150     }
151   }
152   return ret;
153 }
154
155 /**
156  * Insert a route in the kernel routing table
157  *
158  * @param destination the route to add
159  *
160  * @return negative on error
161  */
162 int
163 olsr_ioctl_add_route(const struct rt_entry *rt)
164 {
165   int rslt;
166   int rttable;
167
168   OLSR_PRINTF(2, "KERN: Adding %s\n", olsr_rtp_to_string(rt->rt_best));
169
170   if (0 == olsr_cnf->rttable_default && 0 == rt->rt_dst.prefix_len && 253 > olsr_cnf->rttable)
171   {
172     /*
173      * Users start whining about not having internet with policy
174      * routing activated and no static default route in table 254.
175      * We maintain a fallback defroute in the default=253 table.
176      */
177     olsr_netlink_route(rt, AF_INET, 253, RTM_NEWROUTE);
178   }
179   rttable = 0 == rt->rt_dst.prefix_len && olsr_cnf->rttable_default != 0
180     ? olsr_cnf->rttable_default
181     : olsr_cnf->rttable;
182   rslt = olsr_netlink_route(rt, AF_INET, rttable, RTM_NEWROUTE);
183
184   if (rslt >= 0) {
185     /*
186      * Send IPC route update message
187      */
188     ipc_route_send_rtentry(&rt->rt_dst.prefix, &rt->rt_best->rtp_nexthop.gateway,
189                            rt->rt_best->rtp_metric.hops, 1,
190                            rt->rt_best->rtp_nexthop.interface->int_name);
191   }
192   return rslt;
193 }
194
195
196 /**
197  *Insert a route in the kernel routing table
198  *
199  *@param destination the route to add
200  *
201  *@return negative on error
202  */
203 int
204 olsr_ioctl_add_route6(const struct rt_entry *rt)
205 {
206   int rslt;
207   int rttable;
208
209   OLSR_PRINTF(2, "KERN: Adding %s\n", olsr_rtp_to_string(rt->rt_best));
210
211   rttable = 0 == rt->rt_dst.prefix_len && olsr_cnf->rttable_default != 0
212     ? olsr_cnf->rttable_default
213     : olsr_cnf->rttable;
214   rslt = olsr_netlink_route(rt, AF_INET6, rttable, RTM_NEWROUTE);
215
216   if (rslt >= 0) {
217     /*
218      * Send IPC route update message
219      */
220     ipc_route_send_rtentry(&rt->rt_dst.prefix, &rt->rt_best->rtp_nexthop.gateway,
221                            rt->rt_best->rtp_metric.hops, 1,
222                            rt->rt_best->rtp_nexthop.interface->int_name);
223   }
224
225   return rslt;
226 }
227
228
229 /**
230  *Remove a route from the kernel
231  *
232  *@param destination the route to remove
233  *
234  *@return negative on error
235  */
236 int
237 olsr_ioctl_del_route(const struct rt_entry *rt)
238 {
239   int rslt;
240   int rttable;
241
242   OLSR_PRINTF(2, "KERN: Deleting %s\n", olsr_rt_to_string(rt));
243
244   if (0 == olsr_cnf->rttable_default && 0 == rt->rt_dst.prefix_len && 253 > olsr_cnf->rttable)
245   {
246     /*
247      * Also remove the fallback default route
248      */
249     olsr_netlink_route(rt, AF_INET, 253, RTM_DELROUTE);
250   }
251   rttable = 0 == rt->rt_dst.prefix_len && olsr_cnf->rttable_default != 0
252     ? olsr_cnf->rttable_default
253     : olsr_cnf->rttable;
254   rslt = olsr_netlink_route(rt, AF_INET, rttable, RTM_DELROUTE);
255   if (rslt >= 0) {
256
257     /*
258      * Send IPC route update message
259      */
260     ipc_route_send_rtentry(&rt->rt_dst.prefix, NULL, 0, 0, NULL);
261   }
262
263   return rslt;
264 }
265
266
267 /**
268  *Remove a route from the kernel
269  *
270  *@param destination the route to remove
271  *
272  *@return negative on error
273  */
274 int
275 olsr_ioctl_del_route6(const struct rt_entry *rt)
276 {
277   int rslt;
278   int rttable;
279
280   OLSR_PRINTF(2, "KERN: Deleting %s\n", olsr_rt_to_string(rt));
281
282   rttable = 0 == rt->rt_dst.prefix_len && olsr_cnf->rttable_default != 0
283     ? olsr_cnf->rttable_default
284     : olsr_cnf->rttable;
285   rslt = olsr_netlink_route(rt, AF_INET6, rttable, RTM_DELROUTE);
286   if (rslt >= 0) {
287
288     /*
289      * Send IPC route update message
290      */
291     ipc_route_send_rtentry(&rt->rt_dst.prefix, NULL, 0, 0, NULL);
292   }
293
294   return rslt;
295 }
296
297 /*
298  * Local Variables:
299  * c-basic-offset: 2
300  * indent-tabs-mode: nil
301  * End:
302  */