1 /*-
2 * Copyright (c) 1996 - 2001 Brian Somers <brian@Awfulhak.org>
3 * based on work by Toshiharu OHNO <tony-o@iij.ad.jp>
4 * Internet Initiative Japan, Inc (IIJ)
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 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 *
28 * $FreeBSD: stable/9/usr.sbin/ppp/route.c 191316 2009-04-20 14:38:48Z bz $
29 */
30
31 #include <sys/param.h>
32 #include <sys/socket.h>
33 #include <net/if_types.h>
34 #include <net/route.h>
35 #include <net/if.h>
36 #include <netinet/in.h>
37 #include <arpa/inet.h>
38 #include <net/if_dl.h>
39 #include <netinet/in_systm.h>
40 #include <netinet/ip.h>
41 #include <sys/un.h>
42
43 #include <errno.h>
44 #include <stdarg.h>
45 #include <stdio.h>
46 #include <stdlib.h>
47 #include <string.h>
48 #include <sys/sysctl.h>
49 #include <termios.h>
50 #include <unistd.h>
51
52 #include "layer.h"
53 #include "defs.h"
54 #include "command.h"
55 #include "mbuf.h"
56 #include "log.h"
57 #include "iplist.h"
58 #include "timer.h"
59 #include "throughput.h"
60 #include "lqr.h"
61 #include "hdlc.h"
62 #include "fsm.h"
63 #include "lcp.h"
64 #include "ccp.h"
65 #include "link.h"
66 #include "slcompress.h"
67 #include "ncpaddr.h"
68 #include "ipcp.h"
69 #include "filter.h"
70 #include "descriptor.h"
71 #include "mp.h"
72 #ifndef NORADIUS
73 #include "radius.h"
74 #endif
75 #include "ipv6cp.h"
76 #include "ncp.h"
77 #include "bundle.h"
78 #include "route.h"
79 #include "prompt.h"
80 #include "iface.h"
81 #include "id.h"
82
83
84 static void
p_sockaddr(struct prompt * prompt,struct sockaddr * phost,struct sockaddr * pmask,int width)85 p_sockaddr(struct prompt *prompt, struct sockaddr *phost,
86 struct sockaddr *pmask, int width)
87 {
88 struct ncprange range;
89 char buf[29];
90 struct sockaddr_dl *dl = (struct sockaddr_dl *)phost;
91
92 if (log_IsKept(LogDEBUG)) {
93 char tmp[50];
94
95 log_Printf(LogDEBUG, "Found the following sockaddr:\n");
96 log_Printf(LogDEBUG, " Family %d, len %d\n",
97 (int)phost->sa_family, (int)phost->sa_len);
98 inet_ntop(phost->sa_family, phost->sa_data, tmp, sizeof tmp);
99 log_Printf(LogDEBUG, " Addr %s\n", tmp);
100 if (pmask) {
101 inet_ntop(pmask->sa_family, pmask->sa_data, tmp, sizeof tmp);
102 log_Printf(LogDEBUG, " Mask %s\n", tmp);
103 }
104 }
105
106 switch (phost->sa_family) {
107 case AF_INET:
108 #ifndef NOINET6
109 case AF_INET6:
110 #endif
111 ncprange_setsa(&range, phost, pmask);
112 if (ncprange_isdefault(&range))
113 prompt_Printf(prompt, "%-*s ", width - 1, "default");
114 else
115 prompt_Printf(prompt, "%-*s ", width - 1, ncprange_ntoa(&range));
116 return;
117
118 case AF_LINK:
119 if (dl->sdl_nlen)
120 snprintf(buf, sizeof buf, "%.*s", dl->sdl_nlen, dl->sdl_data);
121 else if (dl->sdl_alen) {
122 if (dl->sdl_type == IFT_ETHER) {
123 if (dl->sdl_alen < sizeof buf / 3) {
124 int f;
125 u_char *MAC;
126
127 MAC = (u_char *)dl->sdl_data + dl->sdl_nlen;
128 for (f = 0; f < dl->sdl_alen; f++)
129 sprintf(buf+f*3, "%02x:", MAC[f]);
130 buf[f*3-1] = '\0';
131 } else
132 strcpy(buf, "??:??:??:??:??:??");
133 } else
134 sprintf(buf, "<IFT type %d>", dl->sdl_type);
135 } else if (dl->sdl_slen)
136 sprintf(buf, "<slen %d?>", dl->sdl_slen);
137 else
138 sprintf(buf, "link#%d", dl->sdl_index);
139 break;
140
141 default:
142 sprintf(buf, "<AF type %d>", phost->sa_family);
143 break;
144 }
145
146 prompt_Printf(prompt, "%-*s ", width-1, buf);
147 }
148
149 static struct bits {
150 u_int32_t b_mask;
151 char b_val;
152 } bits[] = {
153 { RTF_UP, 'U' },
154 { RTF_GATEWAY, 'G' },
155 { RTF_HOST, 'H' },
156 { RTF_REJECT, 'R' },
157 { RTF_DYNAMIC, 'D' },
158 { RTF_MODIFIED, 'M' },
159 { RTF_DONE, 'd' },
160 { RTF_XRESOLVE, 'X' },
161 #ifdef RTF_CLONING
162 { RTF_CLONING, 'C' },
163 #endif
164 { RTF_STATIC, 'S' },
165 { RTF_PROTO1, '1' },
166 { RTF_PROTO2, '2' },
167 { RTF_BLACKHOLE, 'B' },
168
169 #ifdef RTF_LLINFO
170 { RTF_LLINFO, 'L' },
171 #endif
172 #ifdef RTF_CLONING
173 { RTF_CLONING, 'C' },
174 #endif
175 #ifdef RTF_WASCLONED
176 { RTF_WASCLONED, 'W' },
177 #endif
178 #ifdef RTF_PRCLONING
179 { RTF_PRCLONING, 'c' },
180 #endif
181 #ifdef RTF_PROTO3
182 { RTF_PROTO3, '3' },
183 #endif
184 #ifdef RTF_BROADCAST
185 { RTF_BROADCAST, 'b' },
186 #endif
187 { 0, '\0' }
188 };
189
190 #ifndef RTF_WASCLONED
191 #define RTF_WASCLONED (0)
192 #endif
193
194 static void
p_flags(struct prompt * prompt,u_int32_t f,unsigned max)195 p_flags(struct prompt *prompt, u_int32_t f, unsigned max)
196 {
197 char name[33], *flags;
198 register struct bits *p = bits;
199
200 if (max > sizeof name - 1)
201 max = sizeof name - 1;
202
203 for (flags = name; p->b_mask && flags - name < (int)max; p++)
204 if (p->b_mask & f)
205 *flags++ = p->b_val;
206 *flags = '\0';
207 prompt_Printf(prompt, "%-*.*s", (int)max, (int)max, name);
208 }
209
210 static int route_nifs = -1;
211
212 const char *
Index2Nam(int idx)213 Index2Nam(int idx)
214 {
215 /*
216 * XXX: Maybe we should select() on the routing socket so that we can
217 * notice interfaces that come & go (PCCARD support).
218 * Or we could even support a signal that resets these so that
219 * the PCCARD insert/remove events can signal ppp.
220 */
221 static char **ifs; /* Figure these out once */
222 static int debug_done; /* Debug once */
223
224 if (idx > route_nifs || (idx > 0 && ifs[idx-1] == NULL)) {
225 int mib[6], have, had;
226 size_t needed;
227 char *buf, *ptr, *end;
228 struct sockaddr_dl *dl;
229 struct if_msghdr *ifm;
230
231 if (ifs) {
232 free(ifs);
233 ifs = NULL;
234 route_nifs = 0;
235 }
236 debug_done = 0;
237
238 mib[0] = CTL_NET;
239 mib[1] = PF_ROUTE;
240 mib[2] = 0;
241 mib[3] = 0;
242 mib[4] = NET_RT_IFLIST;
243 mib[5] = 0;
244
245 if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) {
246 log_Printf(LogERROR, "Index2Nam: sysctl: estimate: %s\n",
247 strerror(errno));
248 return NumStr(idx, NULL, 0);
249 }
250 if ((buf = malloc(needed)) == NULL)
251 return NumStr(idx, NULL, 0);
252 if (sysctl(mib, 6, buf, &needed, NULL, 0) < 0) {
253 free(buf);
254 return NumStr(idx, NULL, 0);
255 }
256 end = buf + needed;
257
258 have = 0;
259 for (ptr = buf; ptr < end; ptr += ifm->ifm_msglen) {
260 ifm = (struct if_msghdr *)ptr;
261 if (ifm->ifm_type != RTM_IFINFO)
262 continue;
263 dl = (struct sockaddr_dl *)(ifm + 1);
264 if (ifm->ifm_index > 0) {
265 if (ifm->ifm_index > have) {
266 char **newifs;
267
268 had = have;
269 have = ifm->ifm_index + 5;
270 if (had)
271 newifs = (char **)realloc(ifs, sizeof(char *) * have);
272 else
273 newifs = (char **)malloc(sizeof(char *) * have);
274 if (!newifs) {
275 log_Printf(LogDEBUG, "Index2Nam: %s\n", strerror(errno));
276 route_nifs = 0;
277 if (ifs) {
278 free(ifs);
279 ifs = NULL;
280 }
281 free(buf);
282 return NumStr(idx, NULL, 0);
283 }
284 ifs = newifs;
285 memset(ifs + had, '\0', sizeof(char *) * (have - had));
286 }
287 if (ifs[ifm->ifm_index-1] == NULL) {
288 ifs[ifm->ifm_index-1] = (char *)malloc(dl->sdl_nlen+1);
289 if (ifs[ifm->ifm_index-1] == NULL)
290 log_Printf(LogDEBUG, "Skipping interface %d: Out of memory\n",
291 ifm->ifm_index);
292 else {
293 memcpy(ifs[ifm->ifm_index-1], dl->sdl_data, dl->sdl_nlen);
294 ifs[ifm->ifm_index-1][dl->sdl_nlen] = '\0';
295 if (route_nifs < ifm->ifm_index)
296 route_nifs = ifm->ifm_index;
297 }
298 }
299 } else if (log_IsKept(LogDEBUG))
300 log_Printf(LogDEBUG, "Skipping out-of-range interface %d!\n",
301 ifm->ifm_index);
302 }
303 free(buf);
304 }
305
306 if (log_IsKept(LogDEBUG) && !debug_done) {
307 int f;
308
309 log_Printf(LogDEBUG, "Found the following interfaces:\n");
310 for (f = 0; f < route_nifs; f++)
311 if (ifs[f] != NULL)
312 log_Printf(LogDEBUG, " Index %d, name \"%s\"\n", f+1, ifs[f]);
313 debug_done = 1;
314 }
315
316 if (idx < 1 || idx > route_nifs || ifs[idx-1] == NULL)
317 return NumStr(idx, NULL, 0);
318
319 return ifs[idx-1];
320 }
321
322 void
route_ParseHdr(struct rt_msghdr * rtm,struct sockaddr * sa[RTAX_MAX])323 route_ParseHdr(struct rt_msghdr *rtm, struct sockaddr *sa[RTAX_MAX])
324 {
325 char *wp;
326 int rtax;
327
328 wp = (char *)(rtm + 1);
329
330 for (rtax = 0; rtax < RTAX_MAX; rtax++)
331 if (rtm->rtm_addrs & (1 << rtax)) {
332 sa[rtax] = (struct sockaddr *)wp;
333 wp += ROUNDUP(sa[rtax]->sa_len);
334 if (sa[rtax]->sa_family == 0)
335 sa[rtax] = NULL; /* ??? */
336 } else
337 sa[rtax] = NULL;
338 }
339
340 int
route_Show(struct cmdargs const * arg)341 route_Show(struct cmdargs const *arg)
342 {
343 struct rt_msghdr *rtm;
344 struct sockaddr *sa[RTAX_MAX];
345 char *sp, *ep, *cp;
346 size_t needed;
347 int mib[6];
348
349 mib[0] = CTL_NET;
350 mib[1] = PF_ROUTE;
351 mib[2] = 0;
352 mib[3] = 0;
353 mib[4] = NET_RT_DUMP;
354 mib[5] = 0;
355 if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) {
356 log_Printf(LogERROR, "route_Show: sysctl: estimate: %s\n", strerror(errno));
357 return (1);
358 }
359 sp = malloc(needed);
360 if (sp == NULL)
361 return (1);
362 if (sysctl(mib, 6, sp, &needed, NULL, 0) < 0) {
363 log_Printf(LogERROR, "route_Show: sysctl: getroute: %s\n", strerror(errno));
364 free(sp);
365 return (1);
366 }
367 ep = sp + needed;
368
369 prompt_Printf(arg->prompt, "%-20s%-20sFlags Netif\n",
370 "Destination", "Gateway");
371 for (cp = sp; cp < ep; cp += rtm->rtm_msglen) {
372 rtm = (struct rt_msghdr *)cp;
373
374 route_ParseHdr(rtm, sa);
375
376 if (sa[RTAX_DST] && sa[RTAX_GATEWAY]) {
377 p_sockaddr(arg->prompt, sa[RTAX_DST], sa[RTAX_NETMASK], 20);
378 p_sockaddr(arg->prompt, sa[RTAX_GATEWAY], NULL, 20);
379
380 p_flags(arg->prompt, rtm->rtm_flags, 6);
381 prompt_Printf(arg->prompt, " %s\n", Index2Nam(rtm->rtm_index));
382 } else
383 prompt_Printf(arg->prompt, "<can't parse routing entry>\n");
384 }
385 free(sp);
386 return 0;
387 }
388
389 /*
390 * Delete routes associated with our interface
391 */
392 void
route_IfDelete(struct bundle * bundle,int all)393 route_IfDelete(struct bundle *bundle, int all)
394 {
395 struct rt_msghdr *rtm;
396 struct sockaddr *sa[RTAX_MAX];
397 struct ncprange range;
398 int pass;
399 size_t needed;
400 char *sp, *cp, *ep;
401 int mib[6];
402
403 log_Printf(LogDEBUG, "route_IfDelete (%d)\n", bundle->iface->index);
404
405 mib[0] = CTL_NET;
406 mib[1] = PF_ROUTE;
407 mib[2] = 0;
408 mib[3] = 0;
409 mib[4] = NET_RT_DUMP;
410 mib[5] = 0;
411 if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) {
412 log_Printf(LogERROR, "route_IfDelete: sysctl: estimate: %s\n",
413 strerror(errno));
414 return;
415 }
416
417 sp = malloc(needed);
418 if (sp == NULL)
419 return;
420
421 if (sysctl(mib, 6, sp, &needed, NULL, 0) < 0) {
422 log_Printf(LogERROR, "route_IfDelete: sysctl: getroute: %s\n",
423 strerror(errno));
424 free(sp);
425 return;
426 }
427 ep = sp + needed;
428
429 for (pass = 0; pass < 2; pass++) {
430 /*
431 * We do 2 passes. The first deletes all cloned routes. The second
432 * deletes all non-cloned routes. This is done to avoid
433 * potential errors from trying to delete route X after route Y where
434 * route X was cloned from route Y (and is no longer there 'cos it
435 * may have gone with route Y).
436 */
437 if (RTF_WASCLONED == 0 && pass == 0)
438 /* So we can't tell ! */
439 continue;
440 for (cp = sp; cp < ep; cp += rtm->rtm_msglen) {
441 rtm = (struct rt_msghdr *)cp;
442 route_ParseHdr(rtm, sa);
443 if (rtm->rtm_index == bundle->iface->index &&
444 sa[RTAX_DST] && sa[RTAX_GATEWAY] &&
445 (sa[RTAX_DST]->sa_family == AF_INET
446 #ifndef NOINET6
447 || sa[RTAX_DST]->sa_family == AF_INET6
448 #endif
449 ) &&
450 (all || (rtm->rtm_flags & RTF_GATEWAY))) {
451 if (log_IsKept(LogDEBUG)) {
452 char gwstr[41];
453 struct ncpaddr gw;
454 ncprange_setsa(&range, sa[RTAX_DST], sa[RTAX_NETMASK]);
455 ncpaddr_setsa(&gw, sa[RTAX_GATEWAY]);
456 snprintf(gwstr, sizeof gwstr, "%s", ncpaddr_ntoa(&gw));
457 log_Printf(LogDEBUG, "Found %s %s\n", ncprange_ntoa(&range), gwstr);
458 }
459 if (sa[RTAX_GATEWAY]->sa_family == AF_INET ||
460 #ifndef NOINET6
461 sa[RTAX_GATEWAY]->sa_family == AF_INET6 ||
462 #endif
463 sa[RTAX_GATEWAY]->sa_family == AF_LINK) {
464 if ((pass == 0 && (rtm->rtm_flags & RTF_WASCLONED)) ||
465 (pass == 1 && !(rtm->rtm_flags & RTF_WASCLONED))) {
466 ncprange_setsa(&range, sa[RTAX_DST], sa[RTAX_NETMASK]);
467 rt_Set(bundle, RTM_DELETE, &range, NULL, 0, 0);
468 } else
469 log_Printf(LogDEBUG, "route_IfDelete: Skip it (pass %d)\n", pass);
470 } else
471 log_Printf(LogDEBUG,
472 "route_IfDelete: Can't remove routes for family %d\n",
473 sa[RTAX_GATEWAY]->sa_family);
474 }
475 }
476 }
477 free(sp);
478 }
479
480
481 /*
482 * Update the MTU on all routes for the given interface
483 */
484 void
route_UpdateMTU(struct bundle * bundle)485 route_UpdateMTU(struct bundle *bundle)
486 {
487 struct rt_msghdr *rtm;
488 struct sockaddr *sa[RTAX_MAX];
489 struct ncprange dst;
490 size_t needed;
491 char *sp, *cp, *ep;
492 int mib[6];
493
494 log_Printf(LogDEBUG, "route_UpdateMTU (%d)\n", bundle->iface->index);
495
496 mib[0] = CTL_NET;
497 mib[1] = PF_ROUTE;
498 mib[2] = 0;
499 mib[3] = 0;
500 mib[4] = NET_RT_DUMP;
501 mib[5] = 0;
502 if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) {
503 log_Printf(LogERROR, "route_IfDelete: sysctl: estimate: %s\n",
504 strerror(errno));
505 return;
506 }
507
508 sp = malloc(needed);
509 if (sp == NULL)
510 return;
511
512 if (sysctl(mib, 6, sp, &needed, NULL, 0) < 0) {
513 log_Printf(LogERROR, "route_IfDelete: sysctl: getroute: %s\n",
514 strerror(errno));
515 free(sp);
516 return;
517 }
518 ep = sp + needed;
519
520 for (cp = sp; cp < ep; cp += rtm->rtm_msglen) {
521 rtm = (struct rt_msghdr *)cp;
522 route_ParseHdr(rtm, sa);
523 if (sa[RTAX_DST] && (sa[RTAX_DST]->sa_family == AF_INET
524 #ifndef NOINET6
525 || sa[RTAX_DST]->sa_family == AF_INET6
526 #endif
527 ) &&
528 sa[RTAX_GATEWAY] && rtm->rtm_index == bundle->iface->index) {
529 if (log_IsKept(LogTCPIP)) {
530 ncprange_setsa(&dst, sa[RTAX_DST], sa[RTAX_NETMASK]);
531 log_Printf(LogTCPIP, "route_UpdateMTU: Netif: %d (%s), dst %s,"
532 " mtu %lu\n", rtm->rtm_index, Index2Nam(rtm->rtm_index),
533 ncprange_ntoa(&dst), bundle->iface->mtu);
534 }
535 rt_Update(bundle, sa[RTAX_DST], sa[RTAX_GATEWAY], sa[RTAX_NETMASK],
536 sa[RTAX_IFP], sa[RTAX_IFA]);
537 }
538 }
539
540 free(sp);
541 }
542
543 int
GetIfIndex(char * name)544 GetIfIndex(char *name)
545 {
546 int idx;
547
548 idx = 1;
549 while (route_nifs == -1 || idx < route_nifs)
550 if (strcmp(Index2Nam(idx), name) == 0)
551 return idx;
552 else
553 idx++;
554 return -1;
555 }
556
557 void
route_Change(struct bundle * bundle,struct sticky_route * r,const struct ncpaddr * me,const struct ncpaddr * peer)558 route_Change(struct bundle *bundle, struct sticky_route *r,
559 const struct ncpaddr *me, const struct ncpaddr *peer)
560 {
561 struct ncpaddr dst;
562
563 for (; r; r = r->next) {
564 ncprange_getaddr(&r->dst, &dst);
565 if (ncpaddr_family(me) == AF_INET) {
566 if ((r->type & ROUTE_DSTMYADDR) && !ncpaddr_equal(&dst, me)) {
567 rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
568 ncprange_sethost(&r->dst, me);
569 if (r->type & ROUTE_GWHISADDR)
570 ncpaddr_copy(&r->gw, peer);
571 } else if ((r->type & ROUTE_DSTHISADDR) && !ncpaddr_equal(&dst, peer)) {
572 rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
573 ncprange_sethost(&r->dst, peer);
574 if (r->type & ROUTE_GWHISADDR)
575 ncpaddr_copy(&r->gw, peer);
576 } else if ((r->type & ROUTE_DSTDNS0) && !ncpaddr_equal(&dst, peer)) {
577 if (bundle->ncp.ipcp.ns.dns[0].s_addr == INADDR_NONE)
578 continue;
579 rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
580 if (r->type & ROUTE_GWHISADDR)
581 ncpaddr_copy(&r->gw, peer);
582 } else if ((r->type & ROUTE_DSTDNS1) && !ncpaddr_equal(&dst, peer)) {
583 if (bundle->ncp.ipcp.ns.dns[1].s_addr == INADDR_NONE)
584 continue;
585 rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
586 if (r->type & ROUTE_GWHISADDR)
587 ncpaddr_copy(&r->gw, peer);
588 } else if ((r->type & ROUTE_GWHISADDR) && !ncpaddr_equal(&r->gw, peer))
589 ncpaddr_copy(&r->gw, peer);
590 #ifndef NOINET6
591 } else if (ncpaddr_family(me) == AF_INET6) {
592 if ((r->type & ROUTE_DSTMYADDR6) && !ncpaddr_equal(&dst, me)) {
593 rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
594 ncprange_sethost(&r->dst, me);
595 if (r->type & ROUTE_GWHISADDR)
596 ncpaddr_copy(&r->gw, peer);
597 } else if ((r->type & ROUTE_DSTHISADDR6) && !ncpaddr_equal(&dst, peer)) {
598 rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0);
599 ncprange_sethost(&r->dst, peer);
600 if (r->type & ROUTE_GWHISADDR)
601 ncpaddr_copy(&r->gw, peer);
602 } else if ((r->type & ROUTE_GWHISADDR6) && !ncpaddr_equal(&r->gw, peer))
603 ncpaddr_copy(&r->gw, peer);
604 #endif
605 }
606 rt_Set(bundle, RTM_ADD, &r->dst, &r->gw, 1, 0);
607 }
608 }
609
610 void
route_Add(struct sticky_route ** rp,int type,const struct ncprange * dst,const struct ncpaddr * gw)611 route_Add(struct sticky_route **rp, int type, const struct ncprange *dst,
612 const struct ncpaddr *gw)
613 {
614 struct sticky_route *r;
615 int dsttype = type & ROUTE_DSTANY;
616
617 r = NULL;
618 while (*rp) {
619 if ((dsttype && dsttype == ((*rp)->type & ROUTE_DSTANY)) ||
620 (!dsttype && ncprange_equal(&(*rp)->dst, dst))) {
621 /* Oops, we already have this route - unlink it */
622 free(r); /* impossible really */
623 r = *rp;
624 *rp = r->next;
625 } else
626 rp = &(*rp)->next;
627 }
628
629 if (r == NULL) {
630 r = (struct sticky_route *)malloc(sizeof(struct sticky_route));
631 if (r == NULL) {
632 log_Printf(LogERROR, "route_Add: Out of memory!\n");
633 return;
634 }
635 }
636 r->type = type;
637 r->next = NULL;
638 ncprange_copy(&r->dst, dst);
639 ncpaddr_copy(&r->gw, gw);
640 *rp = r;
641 }
642
643 void
route_Delete(struct sticky_route ** rp,int type,const struct ncprange * dst)644 route_Delete(struct sticky_route **rp, int type, const struct ncprange *dst)
645 {
646 struct sticky_route *r;
647 int dsttype = type & ROUTE_DSTANY;
648
649 for (; *rp; rp = &(*rp)->next) {
650 if ((dsttype && dsttype == ((*rp)->type & ROUTE_DSTANY)) ||
651 (!dsttype && ncprange_equal(dst, &(*rp)->dst))) {
652 r = *rp;
653 *rp = r->next;
654 free(r);
655 break;
656 }
657 }
658 }
659
660 void
route_DeleteAll(struct sticky_route ** rp)661 route_DeleteAll(struct sticky_route **rp)
662 {
663 struct sticky_route *r, *rn;
664
665 for (r = *rp; r; r = rn) {
666 rn = r->next;
667 free(r);
668 }
669 *rp = NULL;
670 }
671
672 void
route_ShowSticky(struct prompt * p,struct sticky_route * r,const char * tag,int indent)673 route_ShowSticky(struct prompt *p, struct sticky_route *r, const char *tag,
674 int indent)
675 {
676 int tlen = strlen(tag);
677
678 if (tlen + 2 > indent)
679 prompt_Printf(p, "%s:\n%*s", tag, indent, "");
680 else
681 prompt_Printf(p, "%s:%*s", tag, indent - tlen - 1, "");
682
683 for (; r; r = r->next) {
684 prompt_Printf(p, "%*sadd ", tlen ? 0 : indent, "");
685 tlen = 0;
686 if (r->type & ROUTE_DSTMYADDR)
687 prompt_Printf(p, "MYADDR");
688 else if (r->type & ROUTE_DSTMYADDR6)
689 prompt_Printf(p, "MYADDR6");
690 else if (r->type & ROUTE_DSTHISADDR)
691 prompt_Printf(p, "HISADDR");
692 else if (r->type & ROUTE_DSTHISADDR6)
693 prompt_Printf(p, "HISADDR6");
694 else if (r->type & ROUTE_DSTDNS0)
695 prompt_Printf(p, "DNS0");
696 else if (r->type & ROUTE_DSTDNS1)
697 prompt_Printf(p, "DNS1");
698 else if (ncprange_isdefault(&r->dst))
699 prompt_Printf(p, "default");
700 else
701 prompt_Printf(p, "%s", ncprange_ntoa(&r->dst));
702
703 if (r->type & ROUTE_GWHISADDR)
704 prompt_Printf(p, " HISADDR\n");
705 else if (r->type & ROUTE_GWHISADDR6)
706 prompt_Printf(p, " HISADDR6\n");
707 else
708 prompt_Printf(p, " %s\n", ncpaddr_ntoa(&r->gw));
709 }
710 }
711
712 struct rtmsg {
713 struct rt_msghdr m_rtm;
714 char m_space[256];
715 };
716
717 static size_t
memcpy_roundup(char * cp,const void * data,size_t len)718 memcpy_roundup(char *cp, const void *data, size_t len)
719 {
720 size_t padlen;
721
722 padlen = ROUNDUP(len);
723 memcpy(cp, data, len);
724 if (padlen > len)
725 memset(cp + len, '\0', padlen - len);
726
727 return padlen;
728 }
729
730 #if defined(__KAME__) && !defined(NOINET6)
731 static void
add_scope(struct sockaddr * sa,int ifindex)732 add_scope(struct sockaddr *sa, int ifindex)
733 {
734 struct sockaddr_in6 *sa6;
735
736 if (sa->sa_family != AF_INET6)
737 return;
738 sa6 = (struct sockaddr_in6 *)sa;
739 if (!IN6_IS_ADDR_LINKLOCAL(&sa6->sin6_addr) &&
740 !IN6_IS_ADDR_MC_LINKLOCAL(&sa6->sin6_addr))
741 return;
742 if (*(u_int16_t *)&sa6->sin6_addr.s6_addr[2] != 0)
743 return;
744 *(u_int16_t *)&sa6->sin6_addr.s6_addr[2] = htons(ifindex);
745 }
746 #endif
747
748 int
rt_Set(struct bundle * bundle,int cmd,const struct ncprange * dst,const struct ncpaddr * gw,int bang,int quiet)749 rt_Set(struct bundle *bundle, int cmd, const struct ncprange *dst,
750 const struct ncpaddr *gw, int bang, int quiet)
751 {
752 struct rtmsg rtmes;
753 int s, nb, wb;
754 char *cp;
755 const char *cmdstr;
756 struct sockaddr_storage sadst, samask, sagw;
757 int result = 1;
758
759 if (bang)
760 cmdstr = (cmd == RTM_ADD ? "Add!" : "Delete!");
761 else
762 cmdstr = (cmd == RTM_ADD ? "Add" : "Delete");
763 s = ID0socket(PF_ROUTE, SOCK_RAW, 0);
764 if (s < 0) {
765 log_Printf(LogERROR, "rt_Set: socket(): %s\n", strerror(errno));
766 return result;
767 }
768 memset(&rtmes, '\0', sizeof rtmes);
769 rtmes.m_rtm.rtm_version = RTM_VERSION;
770 rtmes.m_rtm.rtm_type = cmd;
771 rtmes.m_rtm.rtm_addrs = RTA_DST;
772 rtmes.m_rtm.rtm_seq = ++bundle->routing_seq;
773 rtmes.m_rtm.rtm_pid = getpid();
774 rtmes.m_rtm.rtm_flags = RTF_UP | RTF_GATEWAY | RTF_STATIC;
775
776 if (cmd == RTM_ADD) {
777 if (bundle->ncp.cfg.sendpipe > 0) {
778 rtmes.m_rtm.rtm_rmx.rmx_sendpipe = bundle->ncp.cfg.sendpipe;
779 rtmes.m_rtm.rtm_inits |= RTV_SPIPE;
780 }
781 if (bundle->ncp.cfg.recvpipe > 0) {
782 rtmes.m_rtm.rtm_rmx.rmx_recvpipe = bundle->ncp.cfg.recvpipe;
783 rtmes.m_rtm.rtm_inits |= RTV_RPIPE;
784 }
785 }
786
787 ncprange_getsa(dst, &sadst, &samask);
788 #if defined(__KAME__) && !defined(NOINET6)
789 add_scope((struct sockaddr *)&sadst, bundle->iface->index);
790 #endif
791
792 cp = rtmes.m_space;
793 cp += memcpy_roundup(cp, &sadst, sadst.ss_len);
794 if (cmd == RTM_ADD) {
795 if (gw == NULL) {
796 log_Printf(LogERROR, "rt_Set: Program error\n");
797 close(s);
798 return result;
799 }
800 ncpaddr_getsa(gw, &sagw);
801 #if defined(__KAME__) && !defined(NOINET6)
802 add_scope((struct sockaddr *)&sagw, bundle->iface->index);
803 #endif
804 if (ncpaddr_isdefault(gw)) {
805 if (!quiet)
806 log_Printf(LogERROR, "rt_Set: Cannot add a route with"
807 " gateway 0.0.0.0\n");
808 close(s);
809 return result;
810 } else {
811 cp += memcpy_roundup(cp, &sagw, sagw.ss_len);
812 rtmes.m_rtm.rtm_addrs |= RTA_GATEWAY;
813 }
814 }
815
816 if (!ncprange_ishost(dst)) {
817 cp += memcpy_roundup(cp, &samask, samask.ss_len);
818 rtmes.m_rtm.rtm_addrs |= RTA_NETMASK;
819 }
820
821 nb = cp - (char *)&rtmes;
822 rtmes.m_rtm.rtm_msglen = nb;
823 wb = ID0write(s, &rtmes, nb);
824 if (wb < 0) {
825 log_Printf(LogTCPIP, "rt_Set failure:\n");
826 log_Printf(LogTCPIP, "rt_Set: Cmd = %s\n", cmdstr);
827 log_Printf(LogTCPIP, "rt_Set: Dst = %s\n", ncprange_ntoa(dst));
828 if (gw != NULL)
829 log_Printf(LogTCPIP, "rt_Set: Gateway = %s\n", ncpaddr_ntoa(gw));
830 failed:
831 if (cmd == RTM_ADD && (rtmes.m_rtm.rtm_errno == EEXIST ||
832 (rtmes.m_rtm.rtm_errno == 0 && errno == EEXIST))) {
833 if (!bang) {
834 log_Printf(LogWARN, "Add route failed: %s already exists\n",
835 ncprange_ntoa(dst));
836 result = 0; /* Don't add to our dynamic list */
837 } else {
838 rtmes.m_rtm.rtm_type = cmd = RTM_CHANGE;
839 if ((wb = ID0write(s, &rtmes, nb)) < 0)
840 goto failed;
841 }
842 } else if (cmd == RTM_DELETE &&
843 (rtmes.m_rtm.rtm_errno == ESRCH ||
844 (rtmes.m_rtm.rtm_errno == 0 && errno == ESRCH))) {
845 if (!bang)
846 log_Printf(LogWARN, "Del route failed: %s: Non-existent\n",
847 ncprange_ntoa(dst));
848 } else if (rtmes.m_rtm.rtm_errno == 0) {
849 if (!quiet || errno != ENETUNREACH)
850 log_Printf(LogWARN, "%s route failed: %s: errno: %s\n", cmdstr,
851 ncprange_ntoa(dst), strerror(errno));
852 } else
853 log_Printf(LogWARN, "%s route failed: %s: %s\n",
854 cmdstr, ncprange_ntoa(dst), strerror(rtmes.m_rtm.rtm_errno));
855 }
856
857 if (log_IsKept(LogDEBUG)) {
858 char gwstr[40];
859
860 if (gw)
861 snprintf(gwstr, sizeof gwstr, "%s", ncpaddr_ntoa(gw));
862 else
863 snprintf(gwstr, sizeof gwstr, "<none>");
864 log_Printf(LogDEBUG, "wrote %d: cmd = %s, dst = %s, gateway = %s\n",
865 wb, cmdstr, ncprange_ntoa(dst), gwstr);
866 }
867 close(s);
868
869 return result;
870 }
871
872 void
rt_Update(struct bundle * bundle,const struct sockaddr * dst,const struct sockaddr * gw,const struct sockaddr * mask,const struct sockaddr * ifp,const struct sockaddr * ifa)873 rt_Update(struct bundle *bundle, const struct sockaddr *dst,
874 const struct sockaddr *gw, const struct sockaddr *mask,
875 const struct sockaddr *ifp, const struct sockaddr *ifa)
876 {
877 struct ncprange ncpdst;
878 struct rtmsg rtmes;
879 char *p;
880 int s, wb;
881
882 s = ID0socket(PF_ROUTE, SOCK_RAW, 0);
883 if (s < 0) {
884 log_Printf(LogERROR, "rt_Update: socket(): %s\n", strerror(errno));
885 return;
886 }
887
888 memset(&rtmes, '\0', sizeof rtmes);
889 rtmes.m_rtm.rtm_version = RTM_VERSION;
890 rtmes.m_rtm.rtm_type = RTM_CHANGE;
891 rtmes.m_rtm.rtm_addrs = 0;
892 rtmes.m_rtm.rtm_seq = ++bundle->routing_seq;
893 rtmes.m_rtm.rtm_pid = getpid();
894 rtmes.m_rtm.rtm_flags = RTF_UP | RTF_STATIC;
895
896 if (bundle->ncp.cfg.sendpipe > 0) {
897 rtmes.m_rtm.rtm_rmx.rmx_sendpipe = bundle->ncp.cfg.sendpipe;
898 rtmes.m_rtm.rtm_inits |= RTV_SPIPE;
899 }
900
901 if (bundle->ncp.cfg.recvpipe > 0) {
902 rtmes.m_rtm.rtm_rmx.rmx_recvpipe = bundle->ncp.cfg.recvpipe;
903 rtmes.m_rtm.rtm_inits |= RTV_RPIPE;
904 }
905
906 rtmes.m_rtm.rtm_rmx.rmx_mtu = bundle->iface->mtu;
907 rtmes.m_rtm.rtm_inits |= RTV_MTU;
908 p = rtmes.m_space;
909
910 if (dst) {
911 rtmes.m_rtm.rtm_addrs |= RTA_DST;
912 p += memcpy_roundup(p, dst, dst->sa_len);
913 }
914
915 if (gw) {
916 rtmes.m_rtm.rtm_addrs |= RTA_GATEWAY;
917 p += memcpy_roundup(p, gw, gw->sa_len);
918 }
919
920 if (mask) {
921 rtmes.m_rtm.rtm_addrs |= RTA_NETMASK;
922 p += memcpy_roundup(p, mask, mask->sa_len);
923 }
924
925 if (ifa && ifp && ifp->sa_family == AF_LINK) {
926 rtmes.m_rtm.rtm_addrs |= RTA_IFP;
927 p += memcpy_roundup(p, ifp, ifp->sa_len);
928 rtmes.m_rtm.rtm_addrs |= RTA_IFA;
929 p += memcpy_roundup(p, ifa, ifa->sa_len);
930 }
931
932 rtmes.m_rtm.rtm_msglen = p - (char *)&rtmes;
933
934 wb = ID0write(s, &rtmes, rtmes.m_rtm.rtm_msglen);
935 if (wb < 0) {
936 ncprange_setsa(&ncpdst, dst, mask);
937
938 log_Printf(LogTCPIP, "rt_Update failure:\n");
939 log_Printf(LogTCPIP, "rt_Update: Dst = %s\n", ncprange_ntoa(&ncpdst));
940
941 if (rtmes.m_rtm.rtm_errno == 0)
942 log_Printf(LogWARN, "%s: Change route failed: errno: %s\n",
943 ncprange_ntoa(&ncpdst), strerror(errno));
944 else
945 log_Printf(LogWARN, "%s: Change route failed: %s\n",
946 ncprange_ntoa(&ncpdst), strerror(rtmes.m_rtm.rtm_errno));
947 }
948 close(s);
949 }
950