sbin/route/route.c

   1 /*
   2  * Copyright (c) 1983, 1989, 1991, 1993
   3  *      The Regents of the University of California.  All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice, this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright
  11  *    notice, this list of conditions and the following disclaimer in the
  12  *    documentation and/or other materials provided with the distribution.
  13  * 3. Neither the name of the University nor the names of its contributors
  14  *    may be used to endorse or promote products derived from this software
  15  *    without specific prior written permission.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27  * SUCH DAMAGE.
  28  *
  29  * @(#) Copyright (c) 1983, 1989, 1991, 1993 The Regents of the University of California.  All rights reserved.
  30  * @(#)route.c  8.6 (Berkeley) 4/28/95
  31  * $FreeBSD: src/sbin/route/route.c,v 1.40.2.11 2003/02/27 23:10:10 ru Exp $
  32  */
  33
  34 #include <sys/param.h>
  35 #include <sys/file.h>
  36 #include <sys/socket.h>
  37 #include <sys/ioctl.h>
  38 #include <sys/sysctl.h>
  39 #include <sys/types.h>
  40
  41 #include <net/if.h>
  42 #include <net/route.h>
  43 #include <net/if_dl.h>
  44 #include <netinet/in.h>
  45 #include <netinet/if_ether.h>
  46 #include <arpa/inet.h>
  47 #include <netdb.h>
  48
  49 #include <netproto/mpls/mpls.h>
  50
  51 #include <ctype.h>
  52 #include <err.h>
  53 #include <errno.h>
  54 #include <paths.h>
  55 #include <stdio.h>
  56 #include <stdlib.h>
  57 #include <string.h>
  58 #include <sysexits.h>
  59 #include <unistd.h>
  60 #include <ifaddrs.h>
  61
  62 #include "extern.h"
  63
  64 union   sockunion {
  65         struct  sockaddr sa;
  66         struct  sockaddr_in sin;
  67 #ifdef INET6
  68         struct  sockaddr_in6 sin6;
  69 #endif
  70         struct  sockaddr_mpls smpls;
  71         struct  sockaddr_dl sdl;
  72         struct  sockaddr_inarp sinarp;
  73         struct  sockaddr_storage ss; /* added to avoid memory overrun */
  74 } so_dst, so_gate, so_mask, so_genmask, so_ifa, so_ifp, so_mpls1,
  75         so_mpls2, so_mpls3;
  76
  77 typedef union sockunion *sup;
  78
  79 int     nflag, wflag;
  80 int     cpuflag = -1;
  81
  82 static struct keytab {
  83         const char      *kt_cp;
  84         int     kt_i;
  85 } const keywords[] = {
  86 #include "keywords.h"
  87         {0, 0}
  88 };
  89
  90 static struct sockaddr_in so_gate_tried;
  91 static struct rt_metrics rt_metrics;
  92 static int      pid, rtm_addrs;
  93 static int      s;
  94 static int      forcehost, forcenet, af, qflag, tflag;
  95 static int      iflag, verbose, aflen = sizeof(struct sockaddr_in);
  96 static int      locking, lockrest, debugonly;
  97 static int      mplsop, popcount, pushcount, swapcount;
  98 static u_long   rtm_inits;
  99 static uid_t    uid;
 100
 101 static void      flushroutes(int, char **);
 102 static void      set_metric(char *, int);
 103 static void      newroute(int, char **) __dead2;
 104 static void      inet_makenetandmask(u_long, struct sockaddr_in *, u_long);
 105 static void      interfaces(void);
 106 static void      monitor(void) __dead2;
 107 static void      sockaddr(const char *, struct sockaddr *);
 108 static void      sodump(sup, const char *);
 109 static void      bprintf(FILE *, int, u_char *);
 110 static void      print_getmsg(struct rt_msghdr *, int);
 111 static void      print_rtmsg(struct rt_msghdr *, int);
 112 static void      pmsg_common(struct rt_msghdr *);
 113 static void      pmsg_addrs(char *, int);
 114 static void      mask_addr(void);
 115 static int       getaddr(int, const char *, struct hostent **);
 116 static int       rtmsg(int, int);
 117 static int       prefixlen(const char *);
 118 #ifdef INET6
 119 static int       inet6_makenetandmask(struct sockaddr_in6 *, const char *);
 120 #endif
 121
 122 void
 123 usage(const char *cp)
 124 {
 125         if (cp != NULL)
 126                 warnx("bad keyword: %s", cp);
 127         fprintf(stderr, "usage: route [-dnqtvw] [-c cpu] command [[modifiers] args]\n");
 128         exit(EX_USAGE);
 129         /* NOTREACHED */
 130 }
 131
 132 int
 133 main(int argc, char **argv)
 134 {
 135         int ch;
 136
 137         if (argc < 2)
 138                 usage(NULL);
 139
 140         while ((ch = getopt(argc, argv, "c:wnqdtv")) != -1)
 141                 switch(ch) {
 142                 case 'c':
 143                         cpuflag = strtol(optarg, NULL, 0);
 144                         break;
 145                 case 'w':
 146                         wflag = 1;
 147                         break;
 148                 case 'n':
 149                         nflag = 1;
 150                         break;
 151                 case 'q':
 152                         qflag = 1;
 153                         break;
 154                 case 'v':
 155                         verbose = 1;
 156                         break;
 157                 case 't':
 158                         tflag = 1;
 159                         break;
 160                 case 'd':
 161                         debugonly = 1;
 162                         break;
 163                 case '?':
 164                 default:
 165                         usage(NULL);
 166                 }
 167         argc -= optind;
 168         argv += optind;
 169
 170         pid = getpid();
 171         uid = geteuid();
 172         if (tflag)
 173                 s = open(_PATH_DEVNULL, O_WRONLY, 0);
 174         else
 175                 s = socket(PF_ROUTE, SOCK_RAW, 0);
 176         if (s < 0)
 177                 err(EX_OSERR, "socket");
 178         if (*argv != NULL)
 179                 switch (keyword(*argv)) {
 180                 case K_GET:
 181                         uid = 0;
 182                         /* FALLTHROUGH */
 183
 184                 case K_CHANGE:
 185                 case K_ADD:
 186                 case K_DELETE:
 187                         newroute(argc, argv);
 188                         /* NOTREACHED */
 189
 190                 case K_SHOW:
 191                         show(argc, argv);
 192                         return(0);
 193
 194                 case K_MONITOR:
 195                         monitor();
 196                         /* NOTREACHED */
 197
 198                 case K_FLUSH:
 199                         flushroutes(argc, argv);
 200                         exit(0);
 201                         /* NOTREACHED */
 202                 }
 203         usage(*argv);
 204         /* NOTREACHED */
 205 }
 206
 207 /*
 208  * Purge all entries in the routing tables not
 209  * associated with network interfaces.
 210  */
 211 static void
 212 flushroutes(int argc, char **argv)
 213 {
 214         size_t needed;
 215         int mib[7], rlen, seqno;
 216         int miblen;
 217         char *buf, *next, *lim;
 218         struct rt_msghdr *rtm;
 219
 220         if (uid != 0) {
 221                 errx(EX_NOPERM, "must be root to alter routing table");
 222         }
 223         shutdown(s, SHUT_RD); /* Don't want to read back our messages */
 224         if (argc > 1) {
 225                 argv++;
 226                 if (argc == 2 && **argv == '-')
 227                     switch (keyword(*argv + 1)) {
 228                         case K_INET:
 229                                 af = AF_INET;
 230                                 break;
 231 #ifdef INET6
 232                         case K_INET6:
 233                                 af = AF_INET6;
 234                                 break;
 235 #endif
 236                         case K_LINK:
 237                                 af = AF_LINK;
 238                                 break;
 239                         case K_MPLS:
 240                                 af = AF_MPLS;
 241                                 break;
 242                         default:
 243                                 goto bad;
 244                 } else
 245 bad:                    usage(*argv);
 246         }
 247         mib[0] = CTL_NET;
 248         mib[1] = PF_ROUTE;
 249         mib[2] = 0;             /* protocol */
 250         mib[3] = 0;             /* wildcard address family */
 251         mib[4] = NET_RT_DUMP;
 252         mib[5] = 0;             /* no flags */
 253         if (cpuflag >= 0) {
 254                 mib[6] = cpuflag;
 255                 miblen = 7;
 256         } else {
 257                 miblen = 6;
 258         }
 259         if (sysctl(mib, miblen, NULL, &needed, NULL, 0) < 0)
 260                 err(EX_OSERR, "route-sysctl-estimate");
 261         if ((buf = malloc(needed)) == NULL)
 262                 errx(EX_OSERR, "malloc failed");
 263         if (sysctl(mib, miblen, buf, &needed, NULL, 0) < 0)
 264                 err(EX_OSERR, "route-sysctl-get");
 265         lim = buf + needed;
 266         if (verbose)
 267                 printf("Examining routing table from sysctl\n");
 268         seqno = 0;              /* ??? */
 269         for (next = buf; next < lim; next += rtm->rtm_msglen) {
 270                 rtm = (struct rt_msghdr *)next;
 271                 if (verbose)
 272                         print_rtmsg(rtm, rtm->rtm_msglen);
 273                 if ((rtm->rtm_flags & RTF_GATEWAY) == 0)
 274                         continue;
 275                 if (af != 0) {
 276                         struct sockaddr *sa = (struct sockaddr *)(rtm + 1);
 277
 278                         if (sa->sa_family != af)
 279                                 continue;
 280                 }
 281                 if (debugonly)
 282                         continue;
 283                 rtm->rtm_type = RTM_DELETE;
 284                 rtm->rtm_seq = seqno;
 285                 rlen = write(s, next, rtm->rtm_msglen);
 286                 if (rlen < (int)rtm->rtm_msglen) {
 287                         warn("write to routing socket");
 288                         printf("got only %d for rlen\n", rlen);
 289                         break;
 290                 }
 291                 seqno++;
 292                 if (qflag)
 293                         continue;
 294                 if (verbose) {
 295                         print_rtmsg(rtm, rlen);
 296                 } else {
 297                         struct sockaddr *sa = (struct sockaddr *)(rtm + 1);
 298                         if (wflag) {
 299                             printf("%-20s ", rtm->rtm_flags & RTF_HOST ?
 300                                 routename(sa) : netname(sa));
 301                         } else {
 302                             printf("%-20.20s ", rtm->rtm_flags & RTF_HOST ?
 303                                 routename(sa) : netname(sa));
 304                         }
 305                         sa = (struct sockaddr *)(RT_ROUNDUP(sa->sa_len) +
 306                             (char *)sa);
 307                         if (wflag) {
 308                             printf("%-20s ", routename(sa));
 309                         } else {
 310                             printf("%-20.20s ", routename(sa));
 311                         }
 312                         printf("done\n");
 313                 }
 314         }
 315 }
 316
 317 char *
 318 routename(struct sockaddr *sa)
 319 {
 320         const char *cp;
 321         static char line[MAXHOSTNAMELEN + 1];
 322         struct hostent *hp;
 323         static char domain[MAXHOSTNAMELEN + 1];
 324         static int first = 1;
 325
 326         if (first) {
 327                 first = 0;
 328                 if (gethostname(domain, MAXHOSTNAMELEN) == 0 &&
 329                     (cp = strchr(domain, '.'))) {
 330                         domain[MAXHOSTNAMELEN] = '\0';
 331                         strcpy(domain, cp + 1);
 332                 } else
 333                         domain[0] = 0;
 334         }
 335
 336         if (sa->sa_len == 0)
 337                 strcpy(line, "default");
 338         else switch (sa->sa_family) {
 339
 340         case AF_INET:
 341             {   struct in_addr in;
 342                 in = ((struct sockaddr_in *)sa)->sin_addr;
 343
 344                 cp = NULL;
 345                 if (in.s_addr == INADDR_ANY || sa->sa_len < 4)
 346                         cp = "default";
 347                 if (cp == NULL && !nflag) {
 348                         hp = gethostbyaddr(&in, sizeof(struct in_addr),
 349                                 AF_INET);
 350                         if (hp != NULL) {
 351                                 char *cptr;
 352                                 cptr = strchr(hp->h_name, '.');
 353                                 if (cptr != NULL && !wflag &&
 354                                     strcmp(cptr + 1, domain) == 0)
 355                                         *cptr = '\0';
 356                                 cp = hp->h_name;
 357                         }
 358                 }
 359                 if (cp != NULL) {
 360                         strncpy(line, cp, sizeof(line) - 1);
 361                         line[sizeof(line) - 1] = '\0';
 362                 } else
 363                         sprintf(line, "%s", inet_ntoa(in));
 364                 break;
 365             }
 366
 367 #ifdef INET6
 368         case AF_INET6:
 369         {
 370                 struct sockaddr_in6 sin6; /* use static var for safety */
 371                 int niflags = 0;
 372 #ifdef NI_WITHSCOPEID
 373                 niflags = NI_WITHSCOPEID;
 374 #endif
 375
 376                 memset(&sin6, 0, sizeof(sin6));
 377                 memcpy(&sin6, sa, sa->sa_len);
 378                 sin6.sin6_len = sizeof(struct sockaddr_in6);
 379                 sin6.sin6_family = AF_INET6;
 380 #ifdef __KAME__
 381                 if (sa->sa_len == sizeof(struct sockaddr_in6) &&
 382                     (IN6_IS_ADDR_LINKLOCAL(&sin6.sin6_addr) ||
 383                      IN6_IS_ADDR_MC_LINKLOCAL(&sin6.sin6_addr)) &&
 384                     sin6.sin6_scope_id == 0) {
 385                         sin6.sin6_scope_id =
 386                             ntohs(*(u_int16_t *)&sin6.sin6_addr.s6_addr[2]);
 387                         sin6.sin6_addr.s6_addr[2] = 0;
 388                         sin6.sin6_addr.s6_addr[3] = 0;
 389                 }
 390 #endif
 391                 if (nflag)
 392                         niflags |= NI_NUMERICHOST;
 393                 if (getnameinfo((struct sockaddr *)&sin6, sin6.sin6_len,
 394                     line, sizeof(line), NULL, 0, niflags) != 0)
 395                         strncpy(line, "invalid", sizeof(line));
 396
 397                 return(line);
 398         }
 399 #endif
 400
 401         case AF_LINK:
 402                 return(link_ntoa((struct sockaddr_dl *)sa));
 403
 404         default:
 405             {
 406                 /*
 407                  * Unknown address family; just render the raw
 408                  * data in sa->sa_data as hex values.
 409                  */
 410                 uint8_t *sp = (uint8_t *)sa->sa_data;
 411                 uint8_t *splim = (uint8_t *)sa + sa->sa_len;
 412                 char *cps = line + sprintf(line, "(%d)", sa->sa_family);
 413                 char *cpe = line + sizeof(line);
 414
 415                 while (sp < splim && cps < cpe)
 416                         cps += snprintf(cps, cpe - cps, " %02x", *sp++);
 417                 break;
 418             }
 419         }
 420         return(line);
 421 }
 422
 423 /*
 424  * Return the name of the network whose address is given.
 425  * The address is assumed to be that of a net or subnet, not a host.
 426  */
 427 char *
 428 netname(struct sockaddr *sa)
 429 {
 430         const char *cp = NULL;
 431         static char line[MAXHOSTNAMELEN + 1];
 432         struct netent *np = NULL;
 433         u_long net, mask;
 434         u_long i;
 435         int subnetshift;
 436
 437         switch (sa->sa_family) {
 438
 439         case AF_INET:
 440             {   struct in_addr in;
 441                 in = ((struct sockaddr_in *)sa)->sin_addr;
 442
 443                 i = in.s_addr = ntohl(in.s_addr);
 444                 if (in.s_addr == 0)
 445                         cp = "default";
 446                 else if (!nflag) {
 447                         if (IN_CLASSA(i)) {
 448                                 mask = IN_CLASSA_NET;
 449                                 subnetshift = 8;
 450                         } else if (IN_CLASSB(i)) {
 451                                 mask = IN_CLASSB_NET;
 452                                 subnetshift = 8;
 453                         } else {
 454                                 mask = IN_CLASSC_NET;
 455                                 subnetshift = 4;
 456                         }
 457                         /*
 458                          * If there are more bits than the standard mask
 459                          * would suggest, subnets must be in use.
 460                          * Guess at the subnet mask, assuming reasonable
 461                          * width subnet fields.
 462                          */
 463                         while (in.s_addr &~ mask)
 464                                 mask |= mask >> subnetshift;
 465                         net = in.s_addr & mask;
 466                         while ((mask & 1) == 0)
 467                                 mask >>= 1, net >>= 1;
 468                         np = getnetbyaddr(net, AF_INET);
 469                         if (np != NULL)
 470                                 cp = np->n_name;
 471                 }
 472 #define C(x)    (unsigned)((x) & 0xff)
 473                 if (cp != NULL)
 474                         strncpy(line, cp, sizeof(line));
 475                 else if ((in.s_addr & 0xffffff) == 0)
 476                         sprintf(line, "%u", C(in.s_addr >> 24));
 477                 else if ((in.s_addr & 0xffff) == 0)
 478                         sprintf(line, "%u.%u", C(in.s_addr >> 24),
 479                             C(in.s_addr >> 16));
 480                 else if ((in.s_addr & 0xff) == 0)
 481                         sprintf(line, "%u.%u.%u", C(in.s_addr >> 24),
 482                             C(in.s_addr >> 16), C(in.s_addr >> 8));
 483                 else
 484                         sprintf(line, "%u.%u.%u.%u", C(in.s_addr >> 24),
 485                             C(in.s_addr >> 16), C(in.s_addr >> 8),
 486                             C(in.s_addr));
 487 #undef C
 488                 break;
 489             }
 490
 491 #ifdef INET6
 492         case AF_INET6:
 493         {
 494                 struct sockaddr_in6 sin6; /* use static var for safety */
 495                 int niflags = 0;
 496 #ifdef NI_WITHSCOPEID
 497                 niflags = NI_WITHSCOPEID;
 498 #endif
 499
 500                 memset(&sin6, 0, sizeof(sin6));
 501                 memcpy(&sin6, sa, sa->sa_len);
 502                 sin6.sin6_len = sizeof(struct sockaddr_in6);
 503                 sin6.sin6_family = AF_INET6;
 504 #ifdef __KAME__
 505                 if (sa->sa_len == sizeof(struct sockaddr_in6) &&
 506                     (IN6_IS_ADDR_LINKLOCAL(&sin6.sin6_addr) ||
 507                      IN6_IS_ADDR_MC_LINKLOCAL(&sin6.sin6_addr)) &&
 508                     sin6.sin6_scope_id == 0) {
 509                         sin6.sin6_scope_id =
 510                             ntohs(*(u_int16_t *)&sin6.sin6_addr.s6_addr[2]);
 511                         sin6.sin6_addr.s6_addr[2] = 0;
 512                         sin6.sin6_addr.s6_addr[3] = 0;
 513                 }
 514 #endif
 515                 if (nflag)
 516                         niflags |= NI_NUMERICHOST;
 517                 if (getnameinfo((struct sockaddr *)&sin6, sin6.sin6_len,
 518                     line, sizeof(line), NULL, 0, niflags) != 0)
 519                         strncpy(line, "invalid", sizeof(line));
 520
 521                 return(line);
 522         }
 523 #endif
 524
 525         case AF_LINK:
 526                 return(link_ntoa((struct sockaddr_dl *)sa));
 527
 528
 529         default:
 530             {
 531                 /*
 532                  * Unknown address family; just render the raw
 533                  * data in sa->sa_data as hex values.
 534                  */
 535                 uint8_t *sp = (uint8_t *)sa->sa_data;
 536                 uint8_t *splim = (uint8_t *)sa + sa->sa_len;
 537                 char *cps = line + sprintf(line, "af %d:", sa->sa_family);
 538                 char *cpe = line + sizeof(line);
 539
 540                 while (sp < splim && cps < cpe)
 541                         cps += snprintf(cps, cpe - cps, " %02x", *sp++);
 542                 break;
 543             }
 544         }
 545         return(line);
 546 }
 547
 548 static void
 549 set_metric(char *value, int key)
 550 {
 551         int flag = 0;
 552         u_long noval, *valp = &noval;
 553
 554         switch (key) {
 555 #define caseof(x, y, z) case x: valp = &rt_metrics.z; flag = y; break
 556         caseof(K_MTU, RTV_MTU, rmx_mtu);
 557         caseof(K_HOPCOUNT, RTV_HOPCOUNT, rmx_hopcount);
 558         caseof(K_EXPIRE, RTV_EXPIRE, rmx_expire);
 559         caseof(K_RECVPIPE, RTV_RPIPE, rmx_recvpipe);
 560         caseof(K_SENDPIPE, RTV_SPIPE, rmx_sendpipe);
 561         caseof(K_SSTHRESH, RTV_SSTHRESH, rmx_ssthresh);
 562         caseof(K_RTT, RTV_RTT, rmx_rtt);
 563         caseof(K_RTTVAR, RTV_RTTVAR, rmx_rttvar);
 564         caseof(K_MSL, RTV_MSL, rmx_msl);
 565         caseof(K_IWMAX, RTV_IWMAXSEGS, rmx_iwmaxsegs);
 566         caseof(K_IW, RTV_IWCAPSEGS, rmx_iwcapsegs);
 567         }
 568         rtm_inits |= flag;
 569         if (lockrest || locking)
 570                 rt_metrics.rmx_locks |= flag;
 571         if (locking)
 572                 locking = 0;
 573         *valp = atoi(value);
 574 }
 575
 576 static void
 577 newroute(int argc, char **argv)
 578 {
 579         char *cmd;
 580         const char *err_str, *dest = "", *gateway = "";
 581         int ishost = 0, proxy = 0, ret, attempts, oerrno, flags = RTF_STATIC;
 582         int key;
 583         struct hostent *hp = NULL;
 584
 585         if (uid != 0) {
 586                 errx(EX_NOPERM, "must be root to alter routing table");
 587         }
 588         cmd = argv[0];
 589         if (*cmd != 'g')
 590                 shutdown(s, SHUT_RD); /* Don't want to read back our messages */
 591         while (--argc > 0) {
 592                 if (**(++argv)== '-') {
 593                         switch (key = keyword(1 + *argv)) {
 594                         case K_LINK:
 595                                 af = AF_LINK;
 596                                 aflen = sizeof(struct sockaddr_dl);
 597                                 break;
 598                         case K_INET:
 599                                 af = AF_INET;
 600                                 aflen = sizeof(struct sockaddr_in);
 601                                 break;
 602 #ifdef INET6
 603                         case K_INET6:
 604                                 af = AF_INET6;
 605                                 aflen = sizeof(struct sockaddr_in6);
 606                                 break;
 607 #endif
 608                         case K_SA:
 609                                 af = PF_ROUTE;
 610                                 aflen = sizeof(union sockunion);
 611                                 break;
 612                         case K_IFACE:
 613                         case K_INTERFACE:
 614                                 iflag++;
 615                                 break;
 616                         case K_NOSTATIC:
 617                                 flags &= ~RTF_STATIC;
 618                                 break;
 619                         case K_LLINFO:
 620                                 flags |= RTF_LLINFO;
 621                                 break;
 622                         case K_LOCK:
 623                                 locking = 1;
 624                                 break;
 625                         case K_LOCKREST:
 626                                 lockrest = 1;
 627                                 break;
 628                         case K_HOST:
 629                                 forcehost++;
 630                                 break;
 631                         case K_REJECT:
 632                                 flags |= RTF_REJECT;
 633                                 break;
 634                         case K_BLACKHOLE:
 635                                 flags |= RTF_BLACKHOLE;
 636                                 break;
 637                         case K_PROTO1:
 638                                 flags |= RTF_PROTO1;
 639                                 break;
 640                         case K_PROTO2:
 641                                 flags |= RTF_PROTO2;
 642                                 break;
 643                         case K_PROXY:
 644                                 proxy = 1;
 645                                 break;
 646                         case K_CLONING:
 647                                 flags |= RTF_CLONING;
 648                                 break;
 649                         case K_XRESOLVE:
 650                                 flags |= RTF_XRESOLVE;
 651                                 break;
 652                         case K_STATIC:
 653                                 flags |= RTF_STATIC;
 654                                 break;
 655                         case K_IFA:
 656                                 if (--argc == 0)
 657                                         usage(NULL);
 658                                 getaddr(RTA_IFA, *++argv, 0);
 659                                 break;
 660                         case K_IFP:
 661                                 if (--argc == 0)
 662                                         usage(NULL);
 663                                 getaddr(RTA_IFP, *++argv, 0);
 664                                 break;
 665                         case K_GENMASK:
 666                                 if (--argc == 0)
 667                                         usage(NULL);
 668                                 getaddr(RTA_GENMASK, *++argv, 0);
 669                                 break;
 670                         case K_GATEWAY:
 671                                 if (--argc == 0)
 672                                         usage(NULL);
 673                                 getaddr(RTA_GATEWAY, *++argv, 0);
 674                                 break;
 675                         case K_DST:
 676                                 if (--argc == 0)
 677                                         usage(NULL);
 678                                 ishost = getaddr(RTA_DST, *++argv, &hp);
 679                                 dest = *argv;
 680                                 break;
 681                         case K_NETMASK:
 682                                 if (--argc == 0)
 683                                         usage(NULL);
 684                                 getaddr(RTA_NETMASK, *++argv, 0);
 685                                 /* FALLTHROUGH */
 686                         case K_NET:
 687                                 forcenet++;
 688                                 break;
 689                         case K_PREFIXLEN:
 690                                 if (--argc == 0)
 691                                         usage(NULL);
 692                                 if (prefixlen(*++argv) == -1) {
 693                                         forcenet = 0;
 694                                         ishost = 1;
 695                                 } else {
 696                                         forcenet = 1;
 697                                         ishost = 0;
 698                                 }
 699                                 break;
 700                         case K_MPLS:
 701                                 af = AF_MPLS;
 702                                 aflen = sizeof(struct sockaddr_mpls);
 703                                 break;
 704                         case K_POP:
 705                                 flags |= RTF_MPLSOPS;
 706                                 af = AF_MPLS;
 707                                 mplsop = MPLSLOP_POP;
 708                                 switch(++popcount){
 709                                         case 1:
 710                                                 getaddr(RTA_MPLS1, "", 0);
 711                                                 break;
 712                                         case 2:
 713                                                 getaddr(RTA_MPLS2, "", 0);
 714                                                 break;
 715                                         case 3:
 716                                                 getaddr(RTA_MPLS3, "", 0);
 717                                                 break;
 718                                 }
 719                                 break;
 720                         case K_PUSH:
 721                         case K_SWAP:
 722                                 if (popcount > 0) {
 723                                         warnx("Push or swap after pop. Ignoring.");
 724                                         break;
 725                                 }
 726                                 if (key == K_PUSH) {
 727                                         mplsop = MPLSLOP_PUSH;
 728                                         ++pushcount;
 729                                 } else {
 730                                         if (pushcount > 0) {
 731                                                 warnx("Swap after push. Ignoring.");
 732                                                 break;
 733                                         }
 734                                         if (swapcount > 0) {
 735                                                 warnx("Too many swaps. Ignoring.");
 736                                                 break;
 737                                         }
 738                                         mplsop = MPLSLOP_SWAP;
 739                                         ++swapcount;
 740                                 }
 741                                 flags |= RTF_MPLSOPS;
 742                                 af = AF_MPLS;
 743                                 aflen = sizeof(struct sockaddr_mpls);
 744                                 if (--argc == 0)
 745                                         usage(NULL);
 746                                 switch(pushcount + swapcount){
 747                                         case 1:
 748                                                 getaddr(RTA_MPLS1, *++argv, 0);
 749                                                 break;
 750                                         case 2:
 751                                                 getaddr(RTA_MPLS2, *++argv, 0);
 752                                                 break;
 753                                         case 3:
 754                                                 getaddr(RTA_MPLS3, *++argv, 0);
 755                                                 break;
 756                                 }
 757                                 break;
 758                         case K_MTU:
 759                         case K_HOPCOUNT:
 760                         case K_EXPIRE:
 761                         case K_RECVPIPE:
 762                         case K_SENDPIPE:
 763                         case K_SSTHRESH:
 764                         case K_RTT:
 765                         case K_RTTVAR:
 766                         case K_MSL:
 767                         case K_IWMAX:
 768                         case K_IW:
 769                                 if (--argc == 0)
 770                                         usage(NULL);
 771                                 set_metric(*++argv, key);
 772                                 break;
 773                         default:
 774                                 usage(1+*argv);
 775                         }
 776                 } else {
 777                         if ((rtm_addrs & RTA_DST) == 0) {
 778                                 dest = *argv;
 779                                 ishost = getaddr(RTA_DST, *argv, &hp);
 780                         } else if ((rtm_addrs & RTA_GATEWAY) == 0) {
 781                                 gateway = *argv;
 782                                 getaddr(RTA_GATEWAY, *argv, &hp);
 783                         } else {
 784                                 getaddr(RTA_NETMASK, *argv, 0);
 785                                 forcenet = 1;
 786                         }
 787                 }
 788         }
 789         if (forcehost) {
 790                 ishost = 1;
 791 #ifdef INET6
 792                 if (af == AF_INET6) {
 793                         rtm_addrs &= ~RTA_NETMASK;
 794                         memset((void *)&so_mask, 0, sizeof(so_mask));
 795                 }
 796 #endif
 797         }
 798         if (forcenet)
 799                 ishost = 0;
 800         flags |= RTF_UP;
 801         if (ishost)
 802                 flags |= RTF_HOST;
 803         if (iflag == 0)
 804                 flags |= RTF_GATEWAY;
 805         if (proxy) {
 806                 so_dst.sinarp.sin_other = SIN_PROXY;
 807                 flags |= RTF_ANNOUNCE;
 808         }
 809         for (attempts = 1; ; attempts++) {
 810                 errno = 0;
 811                 if ((ret = rtmsg(*cmd, flags)) == 0)
 812                         break;
 813                 if (errno != ENETUNREACH && errno != ESRCH)
 814                         break;
 815                 if (af == AF_INET && *gateway != '\0' &&
 816                     hp != NULL && hp->h_addr_list[1] != NULL) {
 817                         so_gate_tried = so_gate.sin;
 818                         hp->h_addr_list++;
 819                         memmove(&so_gate.sin.sin_addr,
 820                                 hp->h_addr_list[0],
 821                                 MIN((size_t)hp->h_length,
 822                                     sizeof(so_gate.sin.sin_addr)));
 823                 } else
 824                         break;
 825         }
 826         if (*cmd == 'g')
 827                 exit(0);
 828         if (!qflag) {
 829                 oerrno = errno;
 830                 printf("%s %s %s", cmd, ishost? "host" : "net", dest);
 831                 if (*gateway != '\0') {
 832                         printf(": gateway %s", gateway);
 833                         if (attempts > 1 && ret == 0 && af == AF_INET) {
 834                                 printf(" (%s)",
 835                                     inet_ntoa(so_gate_tried.sin_addr));
 836                         }
 837                 }
 838                 if (ret == 0) {
 839                         printf("\n");
 840                 } else {
 841                         switch (oerrno) {
 842                         case ESRCH:
 843                                 err_str = "not in table";
 844                                 break;
 845                         case EBUSY:
 846                                 err_str = "entry in use";
 847                                 break;
 848                         case ENOBUFS:
 849                                 err_str = "routing table overflow";
 850                                 break;
 851                         case EDQUOT: /* handle recursion avoidance in
 852                                         rt_setgate() */
 853                                 err_str = "gateway uses the same route";
 854                                 break;
 855                         default:
 856                                 err_str = strerror(oerrno);
 857                                 break;
 858                         }
 859                         printf(": %s\n", err_str);
 860                 }
 861         }
 862         exit(ret != 0);
 863 }
 864
 865 static void
 866 inet_makenetandmask(u_long net, struct sockaddr_in *in, u_long bits)
 867 {
 868         u_long addr, mask = 0;
 869         char *cp;
 870
 871         rtm_addrs |= RTA_NETMASK;
 872         /*
 873          * XXX: This approach unable to handle 0.0.0.1/32 correctly
 874          * as inet_network() converts 0.0.0.1 and 1 equally.
 875          */
 876         if (net <= 0xff)
 877                 addr = net << IN_CLASSA_NSHIFT;
 878         else if (net <= 0xffff)
 879                 addr = net << IN_CLASSB_NSHIFT;
 880         else if (net <= 0xffffff)
 881                 addr = net << IN_CLASSC_NSHIFT;
 882         else
 883                 addr = net;
 884
 885         if (bits != 0)
 886                 mask = 0xffffffff << (32 - bits);
 887         else if (net == 0)
 888                 mask = 0;
 889         else if (IN_CLASSA(addr))
 890                 mask = IN_CLASSA_NET;
 891         else if (IN_CLASSB(addr))
 892                 mask = IN_CLASSB_NET;
 893         else if (IN_CLASSC(addr))
 894                 mask = IN_CLASSC_NET;
 895         else if (IN_MULTICAST(addr))
 896                 mask = IN_CLASSD_NET;
 897         else
 898                 mask = 0xffffffff;
 899
 900         in->sin_addr.s_addr = htonl(addr);
 901         in = &so_mask.sin;
 902         in->sin_addr.s_addr = htonl(mask);
 903         in->sin_len = 0;
 904         in->sin_family = 0;
 905         cp = (char *)(&in->sin_addr + 1);
 906         while (*--cp == 0 && cp > (char *)in)
 907                 ;
 908         in->sin_len = 1 + cp - (char *)in;
 909 }
 910
 911 #ifdef INET6
 912 /*
 913  * XXX the function may need more improvement...
 914  */
 915 static int
 916 inet6_makenetandmask(struct sockaddr_in6 *sin6, const char *plen)
 917 {
 918         struct in6_addr in6;
 919
 920         if (plen == NULL) {
 921                 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr) &&
 922                     sin6->sin6_scope_id == 0) {
 923                         plen = "0";
 924                 } else if ((sin6->sin6_addr.s6_addr[0] & 0xe0) == 0x20) {
 925                         /* aggregatable global unicast - RFC2374 */
 926                         memset(&in6, 0, sizeof(in6));
 927                         if (memcmp(&sin6->sin6_addr.s6_addr[8],
 928                                    &in6.s6_addr[8], 8) == 0)
 929                                 plen = "64";
 930                 }
 931         }
 932
 933         if (plen == NULL || strcmp(plen, "128") == 0)
 934                 return(1);
 935         rtm_addrs |= RTA_NETMASK;
 936         prefixlen(plen);
 937         return(0);
 938 }
 939 #endif
 940
 941 /*
 942  * Interpret an argument as a network address of some kind,
 943  * returning 1 if a host address, 0 if a network address.
 944  */
 945 static int
 946 getaddr(int which, const char *str, struct hostent **hpp)
 947 {
 948         sup su;
 949         struct hostent *hp;
 950         struct netent *np;
 951         u_long val;
 952         char *q;
 953         int afamily;  /* local copy of af so we can change it */
 954
 955         if (af == 0) {
 956                 af = AF_INET;
 957                 aflen = sizeof(struct sockaddr_in);
 958         }
 959         afamily = af;
 960         rtm_addrs |= which;
 961         switch (which) {
 962         case RTA_DST:
 963                 su = &so_dst;
 964                 break;
 965         case RTA_GATEWAY:
 966                 su = &so_gate;
 967                 if (iflag) {
 968                         struct ifaddrs *ifap, *ifa;
 969                         struct sockaddr_dl *sdl = NULL;
 970
 971                         if (getifaddrs(&ifap))
 972                                 err(1, "getifaddrs");
 973
 974                         for (ifa = ifap; ifa != NULL; ifa = ifa->ifa_next) {
 975                                 if (ifa->ifa_addr->sa_family != AF_LINK)
 976                                         continue;
 977
 978                                 if (strcmp(str, ifa->ifa_name) != 0)
 979                                         continue;
 980
 981                                 sdl = (struct sockaddr_dl *)ifa->ifa_addr;
 982                         }
 983                         /* If we found it, then use it */
 984                         if (sdl != NULL) {
 985                                 /*
 986                                  * Copy is safe since we have a
 987                                  * sockaddr_storage member in sockunion{}.
 988                                  * Note that we need to copy before calling
 989                                  * freeifaddrs().
 990                                  *
 991                                  * Interface routes are routed only by their
 992                                  * sdl_index or interface name (we provide
 993                                  * both here), not by the ARP address of the
 994                                  * local interface (alen, slen = 0).
 995                                  */
 996                                 memcpy(&su->sdl, sdl, sdl->sdl_len);
 997                                 su->sdl.sdl_alen = 0;
 998                                 su->sdl.sdl_slen = 0;
 999                         }
1000                         freeifaddrs(ifap);
1001                         if (sdl != NULL)
1002                                 return(1);
1003                 }
1004                 break;
1005         case RTA_NETMASK:
1006                 su = &so_mask;
1007                 break;
1008         case RTA_GENMASK:
1009                 su = &so_genmask;
1010                 break;
1011         case RTA_IFP:
1012                 su = &so_ifp;
1013                 afamily = AF_LINK;
1014                 break;
1015         case RTA_IFA:
1016                 su = &so_ifa;
1017                 break;
1018         case RTA_MPLS1:
1019                 su = &so_mpls1;
1020                 break;
1021         case RTA_MPLS2:
1022                 su = &so_mpls2;
1023                 break;
1024         case RTA_MPLS3:
1025                 su = &so_mpls3;
1026                 break;
1027         default:
1028                 usage("internal error");
1029                 /*NOTREACHED*/
1030         }
1031         su->sa.sa_len = aflen;
1032         su->sa.sa_family = afamily; /* cases that don't want it have left
1033                                        already */
1034         if (strcmp(str, "default") == 0) {
1035                 /*
1036                  * Default is net 0.0.0.0/0
1037                  */
1038                 switch (which) {
1039                 case RTA_DST:
1040                         forcenet++;
1041                         /* bzero(su, sizeof(*su)); *//* for readability */
1042                         getaddr(RTA_NETMASK, str, 0);
1043                         break;
1044                 case RTA_NETMASK:
1045                 case RTA_GENMASK:
1046                         /* bzero(su, sizeof(*su)); *//* for readability */
1047                         break;
1048                 }
1049                 return(0);
1050         }
1051         switch (afamily) {
1052 #ifdef INET6
1053         case AF_INET6:
1054         {
1055                 struct addrinfo hints, *res;
1056
1057                 q = NULL;
1058                 if (which == RTA_DST && (q = strchr(str, '/')) != NULL)
1059                         *q = '\0';
1060                 memset(&hints, 0, sizeof(hints));
1061                 hints.ai_family = afamily;      /*AF_INET6*/
1062                 hints.ai_flags = AI_NUMERICHOST;
1063                 hints.ai_socktype = SOCK_DGRAM;         /*dummy*/
1064                 if (getaddrinfo(str, "0", &hints, &res) != 0 ||
1065                     res->ai_family != AF_INET6 ||
1066                     res->ai_addrlen != sizeof(su->sin6)) {
1067                         fprintf(stderr, "%s: bad value\n", str);
1068                         exit(1);
1069                 }
1070                 memcpy(&su->sin6, res->ai_addr, sizeof(su->sin6));
1071 #ifdef __KAME__
1072                 if ((IN6_IS_ADDR_LINKLOCAL(&su->sin6.sin6_addr) ||
1073                      IN6_IS_ADDR_LINKLOCAL(&su->sin6.sin6_addr)) &&
1074                     su->sin6.sin6_scope_id) {
1075                         *(u_int16_t *)&su->sin6.sin6_addr.s6_addr[2] =
1076                                 htons(su->sin6.sin6_scope_id);
1077                         su->sin6.sin6_scope_id = 0;
1078                 }
1079 #endif
1080                 freeaddrinfo(res);
1081                 if (q != NULL)
1082                         *q++ = '/';
1083                 if (which == RTA_DST)
1084                         return(inet6_makenetandmask(&su->sin6, q));
1085                 return(0);
1086         }
1087 #endif /* INET6 */
1088
1089         case AF_LINK:
1090                 link_addr(str, &su->sdl);
1091                 return(1);
1092
1093         case PF_ROUTE:
1094                 su->sa.sa_len = sizeof(*su);
1095                 sockaddr(str, &su->sa);
1096                 return(1);
1097
1098         case AF_MPLS:
1099         {
1100                 mpls_label_t label;
1101
1102                 bzero(su, sizeof(*su));
1103                 su->sa.sa_len = sizeof(*su);
1104                 su->sa.sa_family = AF_MPLS;
1105                 su->smpls.smpls_op = mplsop;
1106                 if (mplsop != MPLSLOP_POP && mplsop != MPLSLOP_POPALL &&
1107                     *str != '\0') {
1108                         if (sscanf(str, "%u", &label) != 1)
1109                                 errx(EX_NOHOST, "bad address: %s", str);
1110                         su->smpls.smpls_label = htonl(label);
1111                 }
1112                 return(1);
1113         }
1114
1115         case AF_INET:
1116         default:
1117                 break;
1118         }
1119
1120         if (hpp == NULL)
1121                 hpp = &hp;
1122         *hpp = NULL;
1123
1124         q = strchr(str,'/');
1125         if (q != NULL && which == RTA_DST) {
1126                 *q = '\0';
1127                 if ((val = inet_network(str)) != INADDR_NONE) {
1128                         inet_makenetandmask(
1129                                 val, &su->sin, strtoul(q+1, 0, 0));
1130                         return(0);
1131                 }
1132                 *q = '/';
1133         }
1134         if ((which != RTA_DST || forcenet == 0) &&
1135             inet_aton(str, &su->sin.sin_addr)) {
1136                 val = su->sin.sin_addr.s_addr;
1137                 if (which != RTA_DST ||
1138                     inet_lnaof(su->sin.sin_addr) != INADDR_ANY)
1139                         return(1);
1140                 else {
1141                         val = ntohl(val);
1142                         goto netdone;
1143                 }
1144         }
1145         if (which == RTA_DST && forcehost == 0 &&
1146             ((val = inet_network(str)) != INADDR_NONE ||
1147             ((np = getnetbyname(str)) != NULL && (val = np->n_net) != 0))) {
1148 netdone:
1149                 inet_makenetandmask(val, &su->sin, 0);
1150                 return(0);
1151         }
1152         hp = gethostbyname(str);
1153         if (hp != NULL) {
1154                 *hpp = hp;
1155                 su->sin.sin_family = hp->h_addrtype;
1156                 memmove((char *)&su->sin.sin_addr, hp->h_addr,
1157                     MIN((size_t)hp->h_length, sizeof(su->sin.sin_addr)));
1158                 return(1);
1159         }
1160         errx(EX_NOHOST, "bad address: %s", str);
1161 }
1162
1163 static int
1164 prefixlen(const char *len_str)
1165 {
1166         int len = atoi(len_str), q, r;
1167         int max;
1168         char *p;
1169
1170         rtm_addrs |= RTA_NETMASK;
1171         switch (af) {
1172 #ifdef INET6
1173         case AF_INET6:
1174                 max = 128;
1175                 p = (char *)&so_mask.sin6.sin6_addr;
1176                 break;
1177 #endif
1178         case AF_INET:
1179                 max = 32;
1180                 p = (char *)&so_mask.sin.sin_addr;
1181                 break;
1182         default:
1183                 fprintf(stderr, "prefixlen not supported in this af\n");
1184                 exit(1);
1185                 /*NOTREACHED*/
1186         }
1187
1188         if (len < 0 || max < len) {
1189                 fprintf(stderr, "%s: bad value\n", len_str);
1190                 exit(1);
1191         }
1192
1193         q = len >> 3;
1194         r = len & 7;
1195         so_mask.sa.sa_family = af;
1196         so_mask.sa.sa_len = aflen;
1197         memset((void *)p, 0, max / 8);
1198         if (q > 0)
1199                 memset((void *)p, 0xff, q);
1200         if (r > 0)
1201                 *((u_char *)p + q) = (0xff00 >> r) & 0xff;
1202         if (len == max)
1203                 return(-1);
1204         else
1205                 return(len);
1206 }
1207
1208 static void
1209 interfaces(void)
1210 {
1211         size_t needed;
1212         int mib[6];
1213         char *buf, *lim, *next;
1214         struct rt_msghdr *rtm;
1215
1216         mib[0] = CTL_NET;
1217         mib[1] = PF_ROUTE;
1218         mib[2] = 0;             /* protocol */
1219         mib[3] = 0;             /* wildcard address family */
1220         mib[4] = NET_RT_IFLIST;
1221         mib[5] = 0;             /* no flags */
1222         if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0)
1223                 err(EX_OSERR, "route-sysctl-estimate");
1224         if ((buf = malloc(needed)) == NULL)
1225                 errx(EX_OSERR, "malloc failed");
1226         if (sysctl(mib, 6, buf, &needed, NULL, 0) < 0)
1227                 err(EX_OSERR, "actual retrieval of interface table");
1228         lim = buf + needed;
1229         for (next = buf; next < lim; next += rtm->rtm_msglen) {
1230                 rtm = (struct rt_msghdr *)next;
1231                 print_rtmsg(rtm, rtm->rtm_msglen);
1232         }
1233 }
1234
1235 static void
1236 monitor(void)
1237 {
1238         int n;
1239         char msg[2048];
1240
1241         verbose = 1;
1242         if (debugonly) {
1243                 interfaces();
1244                 exit(0);
1245         }
1246         for (;;) {
1247                 time_t now;
1248                 n = read(s, msg, 2048);
1249                 now = time(NULL);
1250                 printf("\ngot message of size %d on %s", n, ctime(&now));
1251                 print_rtmsg((struct rt_msghdr *)msg, n);
1252         }
1253 }
1254
1255 struct {
1256         struct  rt_msghdr m_rtm;
1257         char    m_space[512];
1258 } m_rtmsg;
1259
1260 static int
1261 rtmsg(int cmd, int flags)
1262 {
1263         static int seq;
1264         int rlen;
1265         char *cp = m_rtmsg.m_space;
1266         int l;
1267
1268 #define NEXTADDR(w, u) \
1269         if (rtm_addrs & (w)) {\
1270             l = RT_ROUNDUP(u.sa.sa_len); memmove(cp, &(u), l); cp += l;\
1271             if (verbose) sodump(&(u),"u");\
1272         }
1273
1274         errno = 0;
1275         memset(&m_rtmsg, 0, sizeof(m_rtmsg));
1276         if (cmd == 'a')
1277                 cmd = RTM_ADD;
1278         else if (cmd == 'c')
1279                 cmd = RTM_CHANGE;
1280         else if (cmd == 'g') {
1281                 cmd = RTM_GET;
1282                 if (so_ifp.sa.sa_family == 0) {
1283                         so_ifp.sa.sa_family = AF_LINK;
1284                         so_ifp.sa.sa_len = sizeof(struct sockaddr_dl);
1285                         rtm_addrs |= RTA_IFP;
1286                 }
1287         } else
1288                 cmd = RTM_DELETE;
1289 #define rtm m_rtmsg.m_rtm
1290         rtm.rtm_type = cmd;
1291         rtm.rtm_flags = flags;
1292         rtm.rtm_version = RTM_VERSION;
1293         rtm.rtm_seq = ++seq;
1294         rtm.rtm_addrs = rtm_addrs;
1295         rtm.rtm_rmx = rt_metrics;
1296         rtm.rtm_inits = rtm_inits;
1297
1298         if (rtm_addrs & RTA_NETMASK)
1299                 mask_addr();
1300         NEXTADDR(RTA_DST, so_dst);
1301         NEXTADDR(RTA_GATEWAY, so_gate);
1302         NEXTADDR(RTA_NETMASK, so_mask);
1303         NEXTADDR(RTA_GENMASK, so_genmask);
1304         NEXTADDR(RTA_IFP, so_ifp);
1305         NEXTADDR(RTA_IFA, so_ifa);
1306         NEXTADDR(RTA_MPLS1, so_mpls1);
1307         NEXTADDR(RTA_MPLS2, so_mpls2);
1308         NEXTADDR(RTA_MPLS3, so_mpls3);
1309         rtm.rtm_msglen = l = cp - (char *)&m_rtmsg;
1310         if (verbose)
1311                 print_rtmsg(&rtm, l);
1312         if (debugonly)
1313                 return(0);
1314         if ((rlen = write(s, (char *)&m_rtmsg, l)) < 0) {
1315                 warn("writing to routing socket");
1316                 return(-1);
1317         }
1318         if (cmd == RTM_GET) {
1319                 do {
1320                         l = read(s, (char *)&m_rtmsg, sizeof(m_rtmsg));
1321                 } while (l > 0 && (rtm.rtm_seq != seq || rtm.rtm_pid != pid));
1322                 if (l < 0)
1323                         warn("read from routing socket");
1324                 else
1325                         print_getmsg(&rtm, l);
1326         }
1327 #undef rtm
1328         return(0);
1329 }
1330
1331 static void
1332 mask_addr(void)
1333 {
1334         int olen = so_mask.sa.sa_len;
1335         char *cp1 = olen + (char *)&so_mask, *cp2;
1336
1337         for (so_mask.sa.sa_len = 0; cp1 > (char *)&so_mask; )
1338                 if (*--cp1 != 0) {
1339                         so_mask.sa.sa_len = 1 + cp1 - (char *)&so_mask;
1340                         break;
1341                 }
1342         if ((rtm_addrs & RTA_DST) == 0)
1343                 return;
1344         switch (so_dst.sa.sa_family) {
1345         case AF_INET:
1346 #ifdef INET6
1347         case AF_INET6:
1348 #endif
1349         case 0:
1350                 return;
1351         }
1352         cp1 = so_mask.sa.sa_len + 1 + (char *)&so_dst;
1353         cp2 = so_dst.sa.sa_len + 1 + (char *)&so_dst;
1354         while (cp2 > cp1)
1355                 *--cp2 = 0;
1356         cp2 = so_mask.sa.sa_len + 1 + (char *)&so_mask;
1357         while (cp1 > so_dst.sa.sa_data)
1358                 *--cp1 &= *--cp2;
1359 }
1360
1361 const char *msgtypes[] = {
1362         "",
1363         "RTM_ADD: Add Route",
1364         "RTM_DELETE: Delete Route",
1365         "RTM_CHANGE: Change Metrics or flags",
1366         "RTM_GET: Report Metrics",
1367         "RTM_LOSING: Kernel Suspects Partitioning",
1368         "RTM_REDIRECT: Told to use different route",
1369         "RTM_MISS: Lookup failed on this address",
1370         "RTM_LOCK: fix specified metrics",
1371         "0x9: unused",
1372         "0xa: unused",
1373         "RTM_RESOLVE: Route created by cloning",
1374         "RTM_NEWADDR: address being added to iface",
1375         "RTM_DELADDR: address being removed from iface",
1376         "RTM_IFINFO: iface status change",
1377         "RTM_NEWMADDR: new multicast group membership on iface",
1378         "RTM_DELMADDR: multicast group membership removed from iface",
1379         "RTM_IFANNOUNCE: interface arrival/departure",
1380         0,
1381 };
1382
1383 char metricnames[] =
1384 "\013iw\012iwmax\011msl\010rttvar\7rtt\6ssthresh\5sendpipe\4recvpipe\3expire"
1385 "\2hopcount\1mtu";
1386 char routeflags[] =
1387 "\1UP\2GATEWAY\3HOST\4REJECT\5DYNAMIC\6MODIFIED\7DONE\010MASK_PRESENT"
1388 "\011CLONING\012XRESOLVE\013LLINFO\014STATIC\015BLACKHOLE\016b016"
1389 "\017PROTO2\020PROTO1\021PRCLONING\022WASCLONED\023PROTO3\024CHAINDELETE"
1390 "\025PINNED\026LOCAL\027BROADCAST\030MULTICAST";
1391 char ifnetflags[] =
1392 "\1UP\2BROADCAST\3DEBUG\4LOOPBACK\5PTP\6b6\7RUNNING\010NOARP"
1393 "\011PPROMISC\012ALLMULTI\013OACTIVE\014SIMPLEX\015LINK0\016LINK1"
1394 "\017LINK2\020MULTICAST";
1395 char addrnames[] =
1396 "\1DST\2GATEWAY\3NETMASK\4GENMASK\5IFP\6IFA\7AUTHOR\010BRD"
1397 "\011MPLS1\012MPLS2\013MPLS3";
1398
1399 static void
1400 print_rtmsg(struct rt_msghdr *rtm, int msglen __unused)
1401 {
1402         struct if_msghdr *ifm;
1403         struct ifa_msghdr *ifam;
1404 #ifdef RTM_NEWMADDR
1405         struct ifma_msghdr *ifmam;
1406 #endif
1407         struct if_announcemsghdr *ifan;
1408
1409         if (verbose == 0)
1410                 return;
1411         if (rtm->rtm_version != RTM_VERSION) {
1412                 printf("routing message version %d not understood\n",
1413                     rtm->rtm_version);
1414                 return;
1415         }
1416         if (msgtypes[rtm->rtm_type] != NULL)
1417                 printf("%s: ", msgtypes[rtm->rtm_type]);
1418         else
1419                 printf("#%d: ", rtm->rtm_type);
1420         printf("len %d, ", rtm->rtm_msglen);
1421         switch (rtm->rtm_type) {
1422         case RTM_IFINFO:
1423                 ifm = (struct if_msghdr *)rtm;
1424                 printf("if# %d, flags:", ifm->ifm_index);
1425                 bprintf(stdout, ifm->ifm_flags, ifnetflags);
1426                 pmsg_addrs((char *)(ifm + 1), ifm->ifm_addrs);
1427                 break;
1428         case RTM_NEWADDR:
1429         case RTM_DELADDR:
1430                 ifam = (struct ifa_msghdr *)rtm;
1431                 printf("metric %d, flags:", ifam->ifam_metric);
1432                 bprintf(stdout, ifam->ifam_flags, routeflags);
1433                 pmsg_addrs((char *)(ifam + 1), ifam->ifam_addrs);
1434                 break;
1435 #ifdef RTM_NEWMADDR
1436         case RTM_NEWMADDR:
1437         case RTM_DELMADDR:
1438                 ifmam = (struct ifma_msghdr *)rtm;
1439                 pmsg_addrs((char *)(ifmam + 1), ifmam->ifmam_addrs);
1440                 break;
1441 #endif
1442         case RTM_IFANNOUNCE:
1443                 ifan = (struct if_announcemsghdr *)rtm;
1444                 printf("if# %d, what: ", ifan->ifan_index);
1445                 switch (ifan->ifan_what) {
1446                 case IFAN_ARRIVAL:
1447                         printf("arrival");
1448                         break;
1449                 case IFAN_DEPARTURE:
1450                         printf("departure");
1451                         break;
1452                 default:
1453                         printf("#%d", ifan->ifan_what);
1454                         break;
1455                 }
1456                 printf("\n");
1457                 break;
1458
1459         default:
1460                 printf("pid: %ld, seq %d, errno %d, flags:",
1461                         (long)rtm->rtm_pid, rtm->rtm_seq, rtm->rtm_errno);
1462                 bprintf(stdout, rtm->rtm_flags, routeflags);
1463                 pmsg_common(rtm);
1464         }
1465 }
1466
1467 static void
1468 print_getmsg(struct rt_msghdr *rtm, int msglen)
1469 {
1470         struct sockaddr *dst = NULL, *gate = NULL, *mask = NULL;
1471         struct sockaddr_dl *ifp = NULL;
1472         struct sockaddr *sa;
1473         char *cp;
1474         int i;
1475
1476         printf("   route to: %s\n", routename(&so_dst.sa));
1477         if (rtm->rtm_version != RTM_VERSION) {
1478                 warnx("routing message version %d not understood",
1479                      rtm->rtm_version);
1480                 return;
1481         }
1482         if (rtm->rtm_msglen > msglen) {
1483                 warnx("message length mismatch, in packet %d, returned %d",
1484                       rtm->rtm_msglen, msglen);
1485         }
1486         if (rtm->rtm_errno != 0)  {
1487                 errno = rtm->rtm_errno;
1488                 warn("message indicates error %d", errno);
1489                 return;
1490         }
1491         cp = ((char *)(rtm + 1));
1492         if (rtm->rtm_addrs)
1493                 for (i = 1; i != 0; i <<= 1)
1494                         if (i & rtm->rtm_addrs) {
1495                                 sa = (struct sockaddr *)cp;
1496                                 switch (i) {
1497                                 case RTA_DST:
1498                                         dst = sa;
1499                                         break;
1500                                 case RTA_GATEWAY:
1501                                         gate = sa;
1502                                         break;
1503                                 case RTA_NETMASK:
1504                                         mask = sa;
1505                                         break;
1506                                 case RTA_IFP:
1507                                         if (sa->sa_family == AF_LINK &&
1508                                            ((struct sockaddr_dl *)sa)->sdl_nlen)
1509                                                 ifp = (struct sockaddr_dl *)sa;
1510                                         break;
1511                                 }
1512                                 RT_ADVANCE(cp, sa);
1513                         }
1514         if (dst != NULL && mask != NULL)
1515                 mask->sa_family = dst->sa_family;       /* XXX */
1516         if (dst != NULL)
1517                 printf("destination: %s\n", routename(dst));
1518         if (mask != NULL) {
1519                 int savenflag = nflag;
1520
1521                 nflag = 1;
1522                 printf("       mask: %s\n", routename(mask));
1523                 nflag = savenflag;
1524         }
1525         if (gate != NULL && rtm->rtm_flags & RTF_GATEWAY)
1526                 printf("    gateway: %s\n", routename(gate));
1527         if (ifp != NULL)
1528                 printf("  interface: %.*s\n",
1529                     ifp->sdl_nlen, ifp->sdl_data);
1530         printf("      flags: ");
1531         bprintf(stdout, rtm->rtm_flags, routeflags);
1532
1533 #define lock(f) ((rtm->rtm_rmx.rmx_locks & __CONCAT(RTV_,f)) ? 'L' : ' ')
1534 #define msec(u) (((u) + 500) / 1000)            /* usec to msec */
1535
1536         printf("\n%s\n", "\
1537  recvpipe  sendpipe  ssthresh  rtt,msec    rttvar  hopcount      mtu     expire  msl,msec iwmax iw");
1538         printf("%8ld%c ", rtm->rtm_rmx.rmx_recvpipe, lock(RPIPE));
1539         printf("%8ld%c ", rtm->rtm_rmx.rmx_sendpipe, lock(SPIPE));
1540         printf("%8ld%c ", rtm->rtm_rmx.rmx_ssthresh, lock(SSTHRESH));
1541         printf("%8ld%c ", msec(rtm->rtm_rmx.rmx_rtt), lock(RTT));
1542         printf("%8ld%c ", msec(rtm->rtm_rmx.rmx_rttvar), lock(RTTVAR));
1543         printf("%8ld%c ", rtm->rtm_rmx.rmx_hopcount, lock(HOPCOUNT));
1544         printf("%8ld%c ", rtm->rtm_rmx.rmx_mtu, lock(MTU));
1545         if (rtm->rtm_rmx.rmx_expire != 0) {
1546                 struct timespec sp;
1547                 clock_gettime(CLOCK_MONOTONIC, &sp);
1548                 rtm->rtm_rmx.rmx_expire -= sp.tv_sec;
1549         }
1550         printf("%8ld%c ", rtm->rtm_rmx.rmx_expire, lock(EXPIRE));
1551         printf("%8ld ", rtm->rtm_rmx.rmx_msl);
1552         printf("%5ld ", rtm->rtm_rmx.rmx_iwmaxsegs);
1553         printf("%3ld\n", rtm->rtm_rmx.rmx_iwcapsegs);
1554 #undef lock
1555 #undef msec
1556 #define RTA_IGN (RTA_DST|RTA_GATEWAY|RTA_NETMASK|RTA_IFP|RTA_IFA|RTA_BRD)
1557         if (verbose)
1558                 pmsg_common(rtm);
1559         else if (rtm->rtm_addrs &~ RTA_IGN) {
1560                 printf("sockaddrs: ");
1561                 bprintf(stdout, rtm->rtm_addrs, addrnames);
1562                 putchar('\n');
1563         }
1564 #undef  RTA_IGN
1565 }
1566
1567 static void
1568 pmsg_common(struct rt_msghdr *rtm)
1569 {
1570         printf("\nlocks: ");
1571         bprintf(stdout, rtm->rtm_rmx.rmx_locks, metricnames);
1572         printf(" inits: ");
1573         bprintf(stdout, rtm->rtm_inits, metricnames);
1574         pmsg_addrs(((char *)(rtm + 1)), rtm->rtm_addrs);
1575 }
1576
1577 static void
1578 pmsg_addrs(char *cp, int addrs)
1579 {
1580         struct sockaddr *sa;
1581         int i;
1582
1583         if (addrs == 0) {
1584                 putchar('\n');
1585                 return;
1586         }
1587         printf("\nsockaddrs: ");
1588         bprintf(stdout, addrs, addrnames);
1589         putchar('\n');
1590         for (i = 1; i != 0; i <<= 1)
1591                 if (i & addrs) {
1592                         sa = (struct sockaddr *)cp;
1593                         printf(" %s", routename(sa));
1594                         RT_ADVANCE(cp, sa);
1595                 }
1596         putchar('\n');
1597         fflush(stdout);
1598 }
1599
1600 static void
1601 bprintf(FILE *fp, int b, u_char *str)
1602 {
1603         int i;
1604         int gotsome = 0;
1605
1606         if (b == 0)
1607                 return;
1608         while ((i = *str++) != 0) {
1609                 if (b & (1 << (i-1))) {
1610                         if (!gotsome)
1611                                 i = '<';
1612                         else
1613                                 i = ',';
1614                         putc(i, fp);
1615                         gotsome = 1;
1616                         for (; (i = *str) > 32; str++)
1617                                 putc(i, fp);
1618                 } else
1619                         while (*str > 32)
1620                                 str++;
1621         }
1622         if (gotsome)
1623                 putc('>', fp);
1624 }
1625
1626 int
1627 keyword(const char *cp)
1628 {
1629         const struct keytab *kt = keywords;
1630
1631         while (kt->kt_cp != NULL && strcmp(kt->kt_cp, cp) != 0)
1632                 kt++;
1633         return(kt->kt_i);
1634 }
1635
1636 static void
1637 sodump(sup su, const char *which)
1638 {
1639         switch (su->sa.sa_family) {
1640         case AF_LINK:
1641                 printf("%s: link %s; ",
1642                     which, link_ntoa(&su->sdl));
1643                 break;
1644         case AF_INET:
1645                 printf("%s: inet %s; ",
1646                     which, inet_ntoa(su->sin.sin_addr));
1647                 break;
1648         }
1649         fflush(stdout);
1650 }
1651
1652 /* States*/
1653 #define VIRGIN  0
1654 #define GOTONE  1
1655 #define GOTTWO  2
1656 /* Inputs */
1657 #define DIGIT   (4*0)
1658 #define END     (4*1)
1659 #define DELIM   (4*2)
1660
1661 static void
1662 sockaddr(const char *addr, struct sockaddr *sa)
1663 {
1664         char *cp = (char *)sa;
1665         int size = sa->sa_len;
1666         char *cplim = cp + size;
1667         int byte = 0, state = VIRGIN, new = 0 /* foil gcc */;
1668
1669         memset(cp, 0, size);
1670         cp++;
1671         do {
1672                 if ((*addr >= '0') && (*addr <= '9')) {
1673                         new = *addr - '0';
1674                 } else if ((*addr >= 'a') && (*addr <= 'f')) {
1675                         new = *addr - 'a' + 10;
1676                 } else if ((*addr >= 'A') && (*addr <= 'F')) {
1677                         new = *addr - 'A' + 10;
1678                 } else if (*addr == '\0')
1679                         state |= END;
1680                 else
1681                         state |= DELIM;
1682                 addr++;
1683                 switch (state /* | INPUT */) {
1684                 case GOTTWO | DIGIT:
1685                         *cp++ = byte; /*FALLTHROUGH*/
1686                 case VIRGIN | DIGIT:
1687                         state = GOTONE; byte = new; continue;
1688                 case GOTONE | DIGIT:
1689                         state = GOTTWO; byte = new + (byte << 4); continue;
1690                 default: /* | DELIM */
1691                         state = VIRGIN; *cp++ = byte; byte = 0; continue;
1692                 case GOTONE | END:
1693                 case GOTTWO | END:
1694                         *cp++ = byte; /* FALLTHROUGH */
1695                 case VIRGIN | END:
1696                         break;
1697                 }
1698                 break;
1699         } while (cp < cplim);
1700         sa->sa_len = cp - (char *)sa;
1701 }