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