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