route.c revision 139978
1139731Simp/*- 21543Srgrimes * Copyright (c) 1996 - 2001 Brian Somers <brian@Awfulhak.org> 31543Srgrimes * based on work by Toshiharu OHNO <tony-o@iij.ad.jp> 41543Srgrimes * Internet Initiative Japan, Inc (IIJ) 51543Srgrimes * All rights reserved. 61543Srgrimes * 71543Srgrimes * Redistribution and use in source and binary forms, with or without 81543Srgrimes * modification, are permitted provided that the following conditions 91543Srgrimes * are met: 101543Srgrimes * 1. Redistributions of source code must retain the above copyright 111543Srgrimes * notice, this list of conditions and the following disclaimer. 121543Srgrimes * 2. Redistributions in binary form must reproduce the above copyright 131543Srgrimes * notice, this list of conditions and the following disclaimer in the 141543Srgrimes * documentation and/or other materials provided with the distribution. 151543Srgrimes * 161543Srgrimes * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 171543Srgrimes * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 181543Srgrimes * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 191543Srgrimes * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 201543Srgrimes * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 211543Srgrimes * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 221543Srgrimes * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 231543Srgrimes * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 241543Srgrimes * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 251543Srgrimes * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 261543Srgrimes * SUCH DAMAGE. 271543Srgrimes * 281543Srgrimes * $FreeBSD: head/usr.sbin/ppp/route.c 139978 2005-01-10 11:12:36Z brian $ 291543Srgrimes */ 3050477Speter 311543Srgrimes#include <sys/param.h> 321543Srgrimes#include <sys/socket.h> 3313107Sbde#include <net/if_types.h> 3413107Sbde#include <net/route.h> 352166Spaul#include <net/if.h> 36143063Sjoerg#include <netinet/in.h> 37143063Sjoerg#include <arpa/inet.h> 38143063Sjoerg#include <net/if_dl.h> 39143063Sjoerg#include <netinet/in_systm.h> 4055205Speter#include <netinet/ip.h> 4137542Sbde#include <sys/un.h> 4213157Sbde 4322639Sbde#include <errno.h> 4422639Sbde#include <stdarg.h> 4522639Sbde#include <stdio.h> 4622639Sbde#include <stdlib.h> 4722639Sbde#include <string.h> 4822639Sbde#include <sys/sysctl.h> 4913157Sbde#include <termios.h> 5013157Sbde#include <unistd.h> 5113157Sbde 5213157Sbde#include "layer.h" 5313157Sbde#include "defs.h" 5413157Sbde#include "command.h" 551543Srgrimes#include "mbuf.h" 5617879Sbde#include "log.h" 5717879Sbde#include "iplist.h" 5817879Sbde#include "timer.h" 5917879Sbde#include "throughput.h" 60143063Sjoerg#include "lqr.h" 61129499Sbde#include "hdlc.h" 62129499Sbde#include "fsm.h" 63129499Sbde#include "lcp.h" 64163729Sbde#include "ccp.h" 65129499Sbde#include "link.h" 66129499Sbde#include "slcompress.h" 67129499Sbde#include "ncpaddr.h" 68129499Sbde#include "ipcp.h" 69129499Sbde#include "filter.h" 70129499Sbde#include "descriptor.h" 71129499Sbde#include "mp.h" 72129499Sbde#ifndef NORADIUS 73129499Sbde#include "radius.h" 74129499Sbde#endif 75129499Sbde#include "ipv6cp.h" 7617879Sbde#include "ncp.h" 77143063Sjoerg#include "bundle.h" 78143434Speter#include "route.h" 79129499Sbde#include "prompt.h" 80214346Sjhb#include "iface.h" 8128921Sfsmp#include "id.h" 8290024Sbde 83214346Sjhb 8479734Sjhbstatic void 8578908Sjhbp_sockaddr(struct prompt *prompt, struct sockaddr *phost, 8678908Sjhb struct sockaddr *pmask, int width) 87214346Sjhb{ 8828921Sfsmp struct ncprange range; 89214346Sjhb char buf[29]; 90214346Sjhb struct sockaddr_dl *dl = (struct sockaddr_dl *)phost; 9128921Sfsmp 9217879Sbde if (log_IsKept(LogDEBUG)) { 9317879Sbde char tmp[50]; 94134398Smarcel 95134398Smarcel log_Printf(LogDEBUG, "Found the following sockaddr:\n"); 96134398Smarcel log_Printf(LogDEBUG, " Family %d, len %d\n", 97134398Smarcel (int)phost->sa_family, (int)phost->sa_len); 98134398Smarcel inet_ntop(phost->sa_family, phost->sa_data, tmp, sizeof tmp); 99134398Smarcel log_Printf(LogDEBUG, " Addr %s\n", tmp); 100134398Smarcel if (pmask) { 101134398Smarcel inet_ntop(pmask->sa_family, pmask->sa_data, tmp, sizeof tmp); 102134398Smarcel log_Printf(LogDEBUG, " Mask %s\n", tmp); 103134398Smarcel } 104134398Smarcel } 105134398Smarcel 106134398Smarcel switch (phost->sa_family) { 10755205Speter case AF_INET: 10813157Sbde#ifndef NOINET6 10922639Sbde case AF_INET6: 11022639Sbde#endif 111129408Speter ncprange_setsa(&range, phost, pmask); 112132846Skan if (ncprange_isdefault(&range)) 113129408Speter prompt_Printf(prompt, "%-*s ", width - 1, "default"); 11413157Sbde else 115143434Speter prompt_Printf(prompt, "%-*s ", width - 1, ncprange_ntoa(&range)); 116129445Sbde return; 117163738Sbde 118163738Sbde case AF_LINK: 119129408Speter if (dl->sdl_nlen) 120163738Sbde snprintf(buf, sizeof buf, "%.*s", dl->sdl_nlen, dl->sdl_data); 121129408Speter else if (dl->sdl_alen) { 122129408Speter if (dl->sdl_type == IFT_ETHER) { 123129408Speter if (dl->sdl_alen < sizeof buf / 3) { 124129408Speter int f; 125129408Speter u_char *MAC; 126129408Speter 127129408Speter MAC = (u_char *)dl->sdl_data + dl->sdl_nlen; 128130321Speter for (f = 0; f < dl->sdl_alen; f++) 129163738Sbde sprintf(buf+f*3, "%02x:", MAC[f]); 130163738Sbde buf[f*3-1] = '\0'; 131129408Speter } else 132130321Speter strcpy(buf, "??:??:??:??:??:??"); 133129408Speter } else 134129408Speter sprintf(buf, "<IFT type %d>", dl->sdl_type); 135129408Speter } else if (dl->sdl_slen) 136129408Speter sprintf(buf, "<slen %d?>", dl->sdl_slen); 137129408Speter else 138129408Speter sprintf(buf, "link#%d", dl->sdl_index); 139129408Speter break; 140129408Speter 141129408Speter default: 142129408Speter sprintf(buf, "<AF type %d>", phost->sa_family); 143129408Speter break; 144129408Speter } 145129408Speter 146129408Speter prompt_Printf(prompt, "%-*s ", width-1, buf); 147129408Speter} 14895195Smarkm 14995195Smarkmstatic struct bits { 15095195Smarkm u_int32_t b_mask; 15195195Smarkm char b_val; 15295195Smarkm} bits[] = { 15395195Smarkm { RTF_UP, 'U' }, 15495195Smarkm { RTF_GATEWAY, 'G' }, 15595195Smarkm { RTF_HOST, 'H' }, 15695195Smarkm { RTF_REJECT, 'R' }, 15795195Smarkm { RTF_DYNAMIC, 'D' }, 15895195Smarkm { RTF_MODIFIED, 'M' }, 159115659Sobrien { RTF_DONE, 'd' }, 16095195Smarkm { RTF_CLONING, 'C' }, 16195195Smarkm { RTF_XRESOLVE, 'X' }, 162129445Sbde { RTF_LLINFO, 'L' }, 16395195Smarkm { RTF_STATIC, 'S' }, 16495195Smarkm { RTF_PROTO1, '1' }, 16595195Smarkm { RTF_PROTO2, '2' }, 166129408Speter { RTF_BLACKHOLE, 'B' }, 16795195Smarkm#ifdef RTF_WASCLONED 16895195Smarkm { RTF_WASCLONED, 'W' }, 1691543Srgrimes#endif 170129408Speter#ifdef RTF_PRCLONING 171143063Sjoerg { RTF_PRCLONING, 'c' }, 172163735Sbde#endif 173143063Sjoerg#ifdef RTF_PROTO3 17437542Sbde { RTF_PROTO3, '3' }, 175129445Sbde#endif 17637542Sbde#ifdef RTF_BROADCAST 17755205Speter { RTF_BROADCAST, 'b' }, 1782166Spaul#endif 17913107Sbde { 0, '\0' } 18013107Sbde}; 18113107Sbde 18213107Sbde#ifndef RTF_WASCLONED 183129446Sbde#define RTF_WASCLONED (0) 18413107Sbde#endif 18555205Speter 18619000Sbdestatic void 18792761Salfredp_flags(struct prompt *prompt, u_int32_t f, unsigned max) 18819000Sbde{ 18955205Speter char name[33], *flags; 19019000Sbde register struct bits *p = bits; 19119000Sbde 19219000Sbde if (max > sizeof name - 1) 19319000Sbde max = sizeof name - 1; 194143063Sjoerg 19592761Salfred for (flags = name; p->b_mask && flags - name < (int)max; p++) 19633047Sbde if (p->b_mask & f) 19719000Sbde *flags++ = p->b_val; 19813157Sbde *flags = '\0'; 19955205Speter prompt_Printf(prompt, "%-*.*s", (int)max, (int)max, name); 20019000Sbde} 20113157Sbde 202static int route_nifs = -1; 203 204const char * 205Index2Nam(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 if (ifs[ifm->ifm_index-1] == NULL) 282 log_Printf(LogDEBUG, "Skipping interface %d: Out of memory\n", 283 ifm->ifm_index); 284 else { 285 memcpy(ifs[ifm->ifm_index-1], dl->sdl_data, dl->sdl_nlen); 286 ifs[ifm->ifm_index-1][dl->sdl_nlen] = '\0'; 287 if (route_nifs < ifm->ifm_index) 288 route_nifs = ifm->ifm_index; 289 } 290 } 291 } else if (log_IsKept(LogDEBUG)) 292 log_Printf(LogDEBUG, "Skipping out-of-range interface %d!\n", 293 ifm->ifm_index); 294 } 295 free(buf); 296 } 297 298 if (log_IsKept(LogDEBUG) && !debug_done) { 299 int f; 300 301 log_Printf(LogDEBUG, "Found the following interfaces:\n"); 302 for (f = 0; f < route_nifs; f++) 303 if (ifs[f] != NULL) 304 log_Printf(LogDEBUG, " Index %d, name \"%s\"\n", f+1, ifs[f]); 305 debug_done = 1; 306 } 307 308 if (idx < 1 || idx > route_nifs || ifs[idx-1] == NULL) 309 return NumStr(idx, NULL, 0); 310 311 return ifs[idx-1]; 312} 313 314void 315route_ParseHdr(struct rt_msghdr *rtm, struct sockaddr *sa[RTAX_MAX]) 316{ 317 char *wp; 318 int rtax; 319 320 wp = (char *)(rtm + 1); 321 322 for (rtax = 0; rtax < RTAX_MAX; rtax++) 323 if (rtm->rtm_addrs & (1 << rtax)) { 324 sa[rtax] = (struct sockaddr *)wp; 325 wp += ROUNDUP(sa[rtax]->sa_len); 326 if (sa[rtax]->sa_family == 0) 327 sa[rtax] = NULL; /* ??? */ 328 } else 329 sa[rtax] = NULL; 330} 331 332int 333route_Show(struct cmdargs const *arg) 334{ 335 struct rt_msghdr *rtm; 336 struct sockaddr *sa[RTAX_MAX]; 337 char *sp, *ep, *cp; 338 size_t needed; 339 int mib[6]; 340 341 mib[0] = CTL_NET; 342 mib[1] = PF_ROUTE; 343 mib[2] = 0; 344 mib[3] = 0; 345 mib[4] = NET_RT_DUMP; 346 mib[5] = 0; 347 if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) { 348 log_Printf(LogERROR, "route_Show: sysctl: estimate: %s\n", strerror(errno)); 349 return (1); 350 } 351 sp = malloc(needed); 352 if (sp == NULL) 353 return (1); 354 if (sysctl(mib, 6, sp, &needed, NULL, 0) < 0) { 355 log_Printf(LogERROR, "route_Show: sysctl: getroute: %s\n", strerror(errno)); 356 free(sp); 357 return (1); 358 } 359 ep = sp + needed; 360 361 prompt_Printf(arg->prompt, "%-20s%-20sFlags Netif\n", 362 "Destination", "Gateway"); 363 for (cp = sp; cp < ep; cp += rtm->rtm_msglen) { 364 rtm = (struct rt_msghdr *)cp; 365 366 route_ParseHdr(rtm, sa); 367 368 if (sa[RTAX_DST] && sa[RTAX_GATEWAY]) { 369 p_sockaddr(arg->prompt, sa[RTAX_DST], sa[RTAX_NETMASK], 20); 370 p_sockaddr(arg->prompt, sa[RTAX_GATEWAY], NULL, 20); 371 372 p_flags(arg->prompt, rtm->rtm_flags, 6); 373 prompt_Printf(arg->prompt, " %s\n", Index2Nam(rtm->rtm_index)); 374 } else 375 prompt_Printf(arg->prompt, "<can't parse routing entry>\n"); 376 } 377 free(sp); 378 return 0; 379} 380 381/* 382 * Delete routes associated with our interface 383 */ 384void 385route_IfDelete(struct bundle *bundle, int all) 386{ 387 struct rt_msghdr *rtm; 388 struct sockaddr *sa[RTAX_MAX]; 389 struct ncprange range; 390 int pass; 391 size_t needed; 392 char *sp, *cp, *ep; 393 int mib[6]; 394 395 log_Printf(LogDEBUG, "route_IfDelete (%d)\n", bundle->iface->index); 396 397 mib[0] = CTL_NET; 398 mib[1] = PF_ROUTE; 399 mib[2] = 0; 400 mib[3] = 0; 401 mib[4] = NET_RT_DUMP; 402 mib[5] = 0; 403 if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) { 404 log_Printf(LogERROR, "route_IfDelete: sysctl: estimate: %s\n", 405 strerror(errno)); 406 return; 407 } 408 409 sp = malloc(needed); 410 if (sp == NULL) 411 return; 412 413 if (sysctl(mib, 6, sp, &needed, NULL, 0) < 0) { 414 log_Printf(LogERROR, "route_IfDelete: sysctl: getroute: %s\n", 415 strerror(errno)); 416 free(sp); 417 return; 418 } 419 ep = sp + needed; 420 421 for (pass = 0; pass < 2; pass++) { 422 /* 423 * We do 2 passes. The first deletes all cloned routes. The second 424 * deletes all non-cloned routes. This is done to avoid 425 * potential errors from trying to delete route X after route Y where 426 * route X was cloned from route Y (and is no longer there 'cos it 427 * may have gone with route Y). 428 */ 429 if (RTF_WASCLONED == 0 && pass == 0) 430 /* So we can't tell ! */ 431 continue; 432 for (cp = sp; cp < ep; cp += rtm->rtm_msglen) { 433 rtm = (struct rt_msghdr *)cp; 434 route_ParseHdr(rtm, sa); 435 if (rtm->rtm_index == bundle->iface->index && 436 sa[RTAX_DST] && sa[RTAX_GATEWAY] && 437 (sa[RTAX_DST]->sa_family == AF_INET 438#ifndef NOINET6 439 || sa[RTAX_DST]->sa_family == AF_INET6 440#endif 441 ) && 442 (all || (rtm->rtm_flags & RTF_GATEWAY))) { 443 if (log_IsKept(LogDEBUG)) { 444 char gwstr[41]; 445 struct ncpaddr gw; 446 ncprange_setsa(&range, sa[RTAX_DST], sa[RTAX_NETMASK]); 447 ncpaddr_setsa(&gw, sa[RTAX_GATEWAY]); 448 snprintf(gwstr, sizeof gwstr, "%s", ncpaddr_ntoa(&gw)); 449 log_Printf(LogDEBUG, "Found %s %s\n", ncprange_ntoa(&range), gwstr); 450 } 451 if (sa[RTAX_GATEWAY]->sa_family == AF_INET || 452#ifndef NOINET6 453 sa[RTAX_GATEWAY]->sa_family == AF_INET6 || 454#endif 455 sa[RTAX_GATEWAY]->sa_family == AF_LINK) { 456 if ((pass == 0 && (rtm->rtm_flags & RTF_WASCLONED)) || 457 (pass == 1 && !(rtm->rtm_flags & RTF_WASCLONED))) { 458 ncprange_setsa(&range, sa[RTAX_DST], sa[RTAX_NETMASK]); 459 rt_Set(bundle, RTM_DELETE, &range, NULL, 0, 0); 460 } else 461 log_Printf(LogDEBUG, "route_IfDelete: Skip it (pass %d)\n", pass); 462 } else 463 log_Printf(LogDEBUG, 464 "route_IfDelete: Can't remove routes for family %d\n", 465 sa[RTAX_GATEWAY]->sa_family); 466 } 467 } 468 } 469 free(sp); 470} 471 472 473/* 474 * Update the MTU on all routes for the given interface 475 */ 476void 477route_UpdateMTU(struct bundle *bundle) 478{ 479 struct rt_msghdr *rtm; 480 struct sockaddr *sa[RTAX_MAX]; 481 struct ncprange dst; 482 size_t needed; 483 char *sp, *cp, *ep; 484 int mib[6]; 485 486 log_Printf(LogDEBUG, "route_UpdateMTU (%d)\n", bundle->iface->index); 487 488 mib[0] = CTL_NET; 489 mib[1] = PF_ROUTE; 490 mib[2] = 0; 491 mib[3] = 0; 492 mib[4] = NET_RT_DUMP; 493 mib[5] = 0; 494 if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0) { 495 log_Printf(LogERROR, "route_IfDelete: sysctl: estimate: %s\n", 496 strerror(errno)); 497 return; 498 } 499 500 sp = malloc(needed); 501 if (sp == NULL) 502 return; 503 504 if (sysctl(mib, 6, sp, &needed, NULL, 0) < 0) { 505 log_Printf(LogERROR, "route_IfDelete: sysctl: getroute: %s\n", 506 strerror(errno)); 507 free(sp); 508 return; 509 } 510 ep = sp + needed; 511 512 for (cp = sp; cp < ep; cp += rtm->rtm_msglen) { 513 rtm = (struct rt_msghdr *)cp; 514 route_ParseHdr(rtm, sa); 515 if (sa[RTAX_DST] && (sa[RTAX_DST]->sa_family == AF_INET 516#ifndef NOINET6 517 || sa[RTAX_DST]->sa_family == AF_INET6 518#endif 519 ) && 520 sa[RTAX_GATEWAY] && rtm->rtm_index == bundle->iface->index) { 521 if (log_IsKept(LogTCPIP)) { 522 ncprange_setsa(&dst, sa[RTAX_DST], sa[RTAX_NETMASK]); 523 log_Printf(LogTCPIP, "route_UpdateMTU: Netif: %d (%s), dst %s," 524 " mtu %lu\n", rtm->rtm_index, Index2Nam(rtm->rtm_index), 525 ncprange_ntoa(&dst), bundle->iface->mtu); 526 } 527 rt_Update(bundle, sa[RTAX_DST], sa[RTAX_GATEWAY], sa[RTAX_NETMASK]); 528 } 529 } 530 531 free(sp); 532} 533 534int 535GetIfIndex(char *name) 536{ 537 int idx; 538 539 idx = 1; 540 while (route_nifs == -1 || idx < route_nifs) 541 if (strcmp(Index2Nam(idx), name) == 0) 542 return idx; 543 else 544 idx++; 545 return -1; 546} 547 548void 549route_Change(struct bundle *bundle, struct sticky_route *r, 550 const struct ncpaddr *me, const struct ncpaddr *peer) 551{ 552 struct ncpaddr dst; 553 554 for (; r; r = r->next) { 555 ncprange_getaddr(&r->dst, &dst); 556 if (ncpaddr_family(me) == AF_INET) { 557 if ((r->type & ROUTE_DSTMYADDR) && !ncpaddr_equal(&dst, me)) { 558 rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0); 559 ncprange_sethost(&r->dst, me); 560 if (r->type & ROUTE_GWHISADDR) 561 ncpaddr_copy(&r->gw, peer); 562 } else if ((r->type & ROUTE_DSTHISADDR) && !ncpaddr_equal(&dst, peer)) { 563 rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0); 564 ncprange_sethost(&r->dst, peer); 565 if (r->type & ROUTE_GWHISADDR) 566 ncpaddr_copy(&r->gw, peer); 567 } else if ((r->type & ROUTE_DSTDNS0) && !ncpaddr_equal(&dst, peer)) { 568 if (bundle->ncp.ipcp.ns.dns[0].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_DSTDNS1) && !ncpaddr_equal(&dst, peer)) { 574 if (bundle->ncp.ipcp.ns.dns[1].s_addr == INADDR_NONE) 575 continue; 576 rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0); 577 if (r->type & ROUTE_GWHISADDR) 578 ncpaddr_copy(&r->gw, peer); 579 } else if ((r->type & ROUTE_GWHISADDR) && !ncpaddr_equal(&r->gw, peer)) 580 ncpaddr_copy(&r->gw, peer); 581#ifndef NOINET6 582 } else if (ncpaddr_family(me) == AF_INET6) { 583 if ((r->type & ROUTE_DSTMYADDR6) && !ncpaddr_equal(&dst, me)) { 584 rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0); 585 ncprange_sethost(&r->dst, me); 586 if (r->type & ROUTE_GWHISADDR) 587 ncpaddr_copy(&r->gw, peer); 588 } else if ((r->type & ROUTE_DSTHISADDR6) && !ncpaddr_equal(&dst, peer)) { 589 rt_Set(bundle, RTM_DELETE, &r->dst, NULL, 1, 0); 590 ncprange_sethost(&r->dst, peer); 591 if (r->type & ROUTE_GWHISADDR) 592 ncpaddr_copy(&r->gw, peer); 593 } else if ((r->type & ROUTE_GWHISADDR6) && !ncpaddr_equal(&r->gw, peer)) 594 ncpaddr_copy(&r->gw, peer); 595#endif 596 } 597 rt_Set(bundle, RTM_ADD, &r->dst, &r->gw, 1, 0); 598 } 599} 600 601void 602route_Add(struct sticky_route **rp, int type, const struct ncprange *dst, 603 const struct ncpaddr *gw) 604{ 605 struct sticky_route *r; 606 int dsttype = type & ROUTE_DSTANY; 607 608 r = NULL; 609 while (*rp) { 610 if ((dsttype && dsttype == ((*rp)->type & ROUTE_DSTANY)) || 611 (!dsttype && ncprange_equal(&(*rp)->dst, dst))) { 612 /* Oops, we already have this route - unlink it */ 613 free(r); /* impossible really */ 614 r = *rp; 615 *rp = r->next; 616 } else 617 rp = &(*rp)->next; 618 } 619 620 if (r == NULL) { 621 r = (struct sticky_route *)malloc(sizeof(struct sticky_route)); 622 if (r == NULL) { 623 log_Printf(LogERROR, "route_Add: Out of memory!\n"); 624 return; 625 } 626 } 627 r->type = type; 628 r->next = NULL; 629 ncprange_copy(&r->dst, dst); 630 ncpaddr_copy(&r->gw, gw); 631 *rp = r; 632} 633 634void 635route_Delete(struct sticky_route **rp, int type, const struct ncprange *dst) 636{ 637 struct sticky_route *r; 638 int dsttype = type & ROUTE_DSTANY; 639 640 for (; *rp; rp = &(*rp)->next) { 641 if ((dsttype && dsttype == ((*rp)->type & ROUTE_DSTANY)) || 642 (!dsttype && ncprange_equal(dst, &(*rp)->dst))) { 643 r = *rp; 644 *rp = r->next; 645 free(r); 646 break; 647 } 648 } 649} 650 651void 652route_DeleteAll(struct sticky_route **rp) 653{ 654 struct sticky_route *r, *rn; 655 656 for (r = *rp; r; r = rn) { 657 rn = r->next; 658 free(r); 659 } 660 *rp = NULL; 661} 662 663void 664route_ShowSticky(struct prompt *p, struct sticky_route *r, const char *tag, 665 int indent) 666{ 667 int tlen = strlen(tag); 668 669 if (tlen + 2 > indent) 670 prompt_Printf(p, "%s:\n%*s", tag, indent, ""); 671 else 672 prompt_Printf(p, "%s:%*s", tag, indent - tlen - 1, ""); 673 674 for (; r; r = r->next) { 675 prompt_Printf(p, "%*sadd ", tlen ? 0 : indent, ""); 676 tlen = 0; 677 if (r->type & ROUTE_DSTMYADDR) 678 prompt_Printf(p, "MYADDR"); 679 else if (r->type & ROUTE_DSTMYADDR6) 680 prompt_Printf(p, "MYADDR6"); 681 else if (r->type & ROUTE_DSTHISADDR) 682 prompt_Printf(p, "HISADDR"); 683 else if (r->type & ROUTE_DSTHISADDR6) 684 prompt_Printf(p, "HISADDR6"); 685 else if (r->type & ROUTE_DSTDNS0) 686 prompt_Printf(p, "DNS0"); 687 else if (r->type & ROUTE_DSTDNS1) 688 prompt_Printf(p, "DNS1"); 689 else if (ncprange_isdefault(&r->dst)) 690 prompt_Printf(p, "default"); 691 else 692 prompt_Printf(p, "%s", ncprange_ntoa(&r->dst)); 693 694 if (r->type & ROUTE_GWHISADDR) 695 prompt_Printf(p, " HISADDR\n"); 696 else if (r->type & ROUTE_GWHISADDR6) 697 prompt_Printf(p, " HISADDR6\n"); 698 else 699 prompt_Printf(p, " %s\n", ncpaddr_ntoa(&r->gw)); 700 } 701} 702 703struct rtmsg { 704 struct rt_msghdr m_rtm; 705 char m_space[256]; 706}; 707 708static size_t 709memcpy_roundup(char *cp, const void *data, size_t len) 710{ 711 size_t padlen; 712 713 padlen = ROUNDUP(len); 714 memcpy(cp, data, len); 715 if (padlen > len) 716 memset(cp + len, '\0', padlen - len); 717 718 return padlen; 719} 720 721#if defined(__KAME__) && !defined(NOINET6) 722static void 723add_scope(struct sockaddr *sa, int ifindex) 724{ 725 struct sockaddr_in6 *sa6; 726 727 if (sa->sa_family != AF_INET6) 728 return; 729 sa6 = (struct sockaddr_in6 *)sa; 730 if (!IN6_IS_ADDR_LINKLOCAL(&sa6->sin6_addr) && 731 !IN6_IS_ADDR_MC_LINKLOCAL(&sa6->sin6_addr)) 732 return; 733 if (*(u_int16_t *)&sa6->sin6_addr.s6_addr[2] != 0) 734 return; 735 *(u_int16_t *)&sa6->sin6_addr.s6_addr[2] = htons(ifindex); 736} 737#endif 738 739int 740rt_Set(struct bundle *bundle, int cmd, const struct ncprange *dst, 741 const struct ncpaddr *gw, int bang, int quiet) 742{ 743 struct rtmsg rtmes; 744 int s, nb, wb; 745 char *cp; 746 const char *cmdstr; 747 struct sockaddr_storage sadst, samask, sagw; 748 int result = 1; 749 750 if (bang) 751 cmdstr = (cmd == RTM_ADD ? "Add!" : "Delete!"); 752 else 753 cmdstr = (cmd == RTM_ADD ? "Add" : "Delete"); 754 s = ID0socket(PF_ROUTE, SOCK_RAW, 0); 755 if (s < 0) { 756 log_Printf(LogERROR, "rt_Set: socket(): %s\n", strerror(errno)); 757 return result; 758 } 759 memset(&rtmes, '\0', sizeof rtmes); 760 rtmes.m_rtm.rtm_version = RTM_VERSION; 761 rtmes.m_rtm.rtm_type = cmd; 762 rtmes.m_rtm.rtm_addrs = RTA_DST; 763 rtmes.m_rtm.rtm_seq = ++bundle->routing_seq; 764 rtmes.m_rtm.rtm_pid = getpid(); 765 rtmes.m_rtm.rtm_flags = RTF_UP | RTF_GATEWAY | RTF_STATIC; 766 767 if (cmd == RTM_ADD) { 768 if (bundle->ncp.cfg.sendpipe > 0) { 769 rtmes.m_rtm.rtm_rmx.rmx_sendpipe = bundle->ncp.cfg.sendpipe; 770 rtmes.m_rtm.rtm_inits |= RTV_SPIPE; 771 } 772 if (bundle->ncp.cfg.recvpipe > 0) { 773 rtmes.m_rtm.rtm_rmx.rmx_recvpipe = bundle->ncp.cfg.recvpipe; 774 rtmes.m_rtm.rtm_inits |= RTV_RPIPE; 775 } 776 } 777 778 ncprange_getsa(dst, &sadst, &samask); 779#if defined(__KAME__) && !defined(NOINET6) 780 add_scope((struct sockaddr *)&sadst, bundle->iface->index); 781#endif 782 783 cp = rtmes.m_space; 784 cp += memcpy_roundup(cp, &sadst, sadst.ss_len); 785 if (cmd == RTM_ADD) { 786 if (gw == NULL) { 787 log_Printf(LogERROR, "rt_Set: Program error\n"); 788 close(s); 789 return result; 790 } 791 ncpaddr_getsa(gw, &sagw); 792#if defined(__KAME__) && !defined(NOINET6) 793 add_scope((struct sockaddr *)&sagw, bundle->iface->index); 794#endif 795 if (ncpaddr_isdefault(gw)) { 796 if (!quiet) 797 log_Printf(LogERROR, "rt_Set: Cannot add a route with" 798 " gateway 0.0.0.0\n"); 799 close(s); 800 return result; 801 } else { 802 cp += memcpy_roundup(cp, &sagw, sagw.ss_len); 803 rtmes.m_rtm.rtm_addrs |= RTA_GATEWAY; 804 } 805 } 806 807 if (!ncprange_ishost(dst)) { 808 cp += memcpy_roundup(cp, &samask, samask.ss_len); 809 rtmes.m_rtm.rtm_addrs |= RTA_NETMASK; 810 } 811 812 nb = cp - (char *)&rtmes; 813 rtmes.m_rtm.rtm_msglen = nb; 814 wb = ID0write(s, &rtmes, nb); 815 if (wb < 0) { 816 log_Printf(LogTCPIP, "rt_Set failure:\n"); 817 log_Printf(LogTCPIP, "rt_Set: Cmd = %s\n", cmdstr); 818 log_Printf(LogTCPIP, "rt_Set: Dst = %s\n", ncprange_ntoa(dst)); 819 if (gw != NULL) 820 log_Printf(LogTCPIP, "rt_Set: Gateway = %s\n", ncpaddr_ntoa(gw)); 821failed: 822 if (cmd == RTM_ADD && (rtmes.m_rtm.rtm_errno == EEXIST || 823 (rtmes.m_rtm.rtm_errno == 0 && errno == EEXIST))) { 824 if (!bang) { 825 log_Printf(LogWARN, "Add route failed: %s already exists\n", 826 ncprange_ntoa(dst)); 827 result = 0; /* Don't add to our dynamic list */ 828 } else { 829 rtmes.m_rtm.rtm_type = cmd = RTM_CHANGE; 830 if ((wb = ID0write(s, &rtmes, nb)) < 0) 831 goto failed; 832 } 833 } else if (cmd == RTM_DELETE && 834 (rtmes.m_rtm.rtm_errno == ESRCH || 835 (rtmes.m_rtm.rtm_errno == 0 && errno == ESRCH))) { 836 if (!bang) 837 log_Printf(LogWARN, "Del route failed: %s: Non-existent\n", 838 ncprange_ntoa(dst)); 839 } else if (rtmes.m_rtm.rtm_errno == 0) { 840 if (!quiet || errno != ENETUNREACH) 841 log_Printf(LogWARN, "%s route failed: %s: errno: %s\n", cmdstr, 842 ncprange_ntoa(dst), strerror(errno)); 843 } else 844 log_Printf(LogWARN, "%s route failed: %s: %s\n", 845 cmdstr, ncprange_ntoa(dst), strerror(rtmes.m_rtm.rtm_errno)); 846 } 847 848 if (log_IsKept(LogDEBUG)) { 849 char gwstr[40]; 850 851 if (gw) 852 snprintf(gwstr, sizeof gwstr, "%s", ncpaddr_ntoa(gw)); 853 else 854 snprintf(gwstr, sizeof gwstr, "<none>"); 855 log_Printf(LogDEBUG, "wrote %d: cmd = %s, dst = %s, gateway = %s\n", 856 wb, cmdstr, ncprange_ntoa(dst), gwstr); 857 } 858 close(s); 859 860 return result; 861} 862 863void 864rt_Update(struct bundle *bundle, const struct sockaddr *dst, 865 const struct sockaddr *gw, const struct sockaddr *mask) 866{ 867 struct ncprange ncpdst; 868 struct rtmsg rtmes; 869 char *p; 870 int s, wb; 871 872 s = ID0socket(PF_ROUTE, SOCK_RAW, 0); 873 if (s < 0) { 874 log_Printf(LogERROR, "rt_Update: socket(): %s\n", strerror(errno)); 875 return; 876 } 877 878 memset(&rtmes, '\0', sizeof rtmes); 879 rtmes.m_rtm.rtm_version = RTM_VERSION; 880 rtmes.m_rtm.rtm_type = RTM_CHANGE; 881 rtmes.m_rtm.rtm_addrs = 0; 882 rtmes.m_rtm.rtm_seq = ++bundle->routing_seq; 883 rtmes.m_rtm.rtm_pid = getpid(); 884 rtmes.m_rtm.rtm_flags = RTF_UP | RTF_STATIC; 885 886 if (bundle->ncp.cfg.sendpipe > 0) { 887 rtmes.m_rtm.rtm_rmx.rmx_sendpipe = bundle->ncp.cfg.sendpipe; 888 rtmes.m_rtm.rtm_inits |= RTV_SPIPE; 889 } 890 891 if (bundle->ncp.cfg.recvpipe > 0) { 892 rtmes.m_rtm.rtm_rmx.rmx_recvpipe = bundle->ncp.cfg.recvpipe; 893 rtmes.m_rtm.rtm_inits |= RTV_RPIPE; 894 } 895 896 rtmes.m_rtm.rtm_rmx.rmx_mtu = bundle->iface->mtu; 897 rtmes.m_rtm.rtm_inits |= RTV_MTU; 898 p = rtmes.m_space; 899 900 if (dst) { 901 rtmes.m_rtm.rtm_addrs |= RTA_DST; 902 p += memcpy_roundup(p, dst, dst->sa_len); 903 } 904 905 rtmes.m_rtm.rtm_addrs |= RTA_GATEWAY; 906 p += memcpy_roundup(p, gw, gw->sa_len); 907 if (mask) { 908 rtmes.m_rtm.rtm_addrs |= RTA_NETMASK; 909 p += memcpy_roundup(p, mask, mask->sa_len); 910 } 911 912 rtmes.m_rtm.rtm_msglen = p - (char *)&rtmes; 913 914 wb = ID0write(s, &rtmes, rtmes.m_rtm.rtm_msglen); 915 if (wb < 0) { 916 ncprange_setsa(&ncpdst, dst, mask); 917 918 log_Printf(LogTCPIP, "rt_Update failure:\n"); 919 log_Printf(LogTCPIP, "rt_Update: Dst = %s\n", ncprange_ntoa(&ncpdst)); 920 921 if (rtmes.m_rtm.rtm_errno == 0) 922 log_Printf(LogWARN, "%s: Change route failed: errno: %s\n", 923 ncprange_ntoa(&ncpdst), strerror(errno)); 924 else 925 log_Printf(LogWARN, "%s: Change route failed: %s\n", 926 ncprange_ntoa(&ncpdst), strerror(rtmes.m_rtm.rtm_errno)); 927 } 928 close(s); 929} 930