sbin/route/route.c

   1 /*-
   2  * SPDX-License-Identifier: BSD-3-Clause
   3  *
   4  * Copyright (c) 1983, 1989, 1991, 1993
   5  *      The Regents of the University of California.  All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  * 3. Neither the name of the University nor the names of its contributors
  16  *    may be used to endorse or promote products derived from this software
  17  *    without specific prior written permission.
  18  *
  19  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
  20  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  22  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
  23  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  24  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  25  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  29  * SUCH DAMAGE.
  30  */
  31
  32 #ifndef lint
  33 static const char copyright[] =
  34 "@(#) Copyright (c) 1983, 1989, 1991, 1993\n\
  35         The Regents of the University of California.  All rights reserved.\n";
  36 #endif /* not lint */
  37
  38 #ifndef lint
  39 #if 0
  40 static char sccsid[] = "@(#)route.c     8.6 (Berkeley) 4/28/95";
  41 #endif
  42 #endif /* not lint */
  43
  44 #include <sys/cdefs.h>
  45 #include <sys/param.h>
  46 #include <sys/file.h>
  47 #include <sys/socket.h>
  48 #include <sys/ioctl.h>
  49 #ifdef JAIL
  50 #include <sys/jail.h>
  51 #endif
  52 #include <sys/sysctl.h>
  53 #include <sys/types.h>
  54 #include <sys/queue.h>
  55
  56 #include <net/if.h>
  57 #include <net/route.h>
  58 #include <net/if_dl.h>
  59 #include <netinet/in.h>
  60 #include <netinet/if_ether.h>
  61 #include <arpa/inet.h>
  62 #include <netdb.h>
  63
  64 #include <ctype.h>
  65 #include <err.h>
  66 #include <errno.h>
  67 #ifdef JAIL
  68 #include <jail.h>
  69 #endif
  70 #include <paths.h>
  71 #include <signal.h>
  72 #include <stdbool.h>
  73 #include <stdio.h>
  74 #include <stdlib.h>
  75 #include <string.h>
  76 #include <sysexits.h>
  77 #include <time.h>
  78 #include <unistd.h>
  79 #include <ifaddrs.h>
  80
  81 struct fibl {
  82         TAILQ_ENTRY(fibl)       fl_next;
  83
  84         int     fl_num;
  85         int     fl_error;
  86         int     fl_errno;
  87 };
  88
  89 static struct keytab {
  90         const char      *kt_cp;
  91         int     kt_i;
  92 } const keywords[] = {
  93 #include "keywords.h"
  94         {0, 0}
  95 };
  96
  97 #ifdef JAIL
  98 char * jail_name;
  99 #endif
 100 static struct sockaddr_storage so[RTAX_MAX];
 101 static int      pid, rtm_addrs;
 102 static int      s;
 103 static int      nflag, af, qflag, tflag;
 104 static int      verbose, aflen;
 105 static int      locking, lockrest, debugonly;
 106 static struct rt_metrics rt_metrics;
 107 static u_long  rtm_inits;
 108 static uid_t    uid;
 109 static int      defaultfib;
 110 static int      numfibs;
 111 static char     domain[MAXHOSTNAMELEN + 1];
 112 static bool     domain_initialized;
 113 static int      rtm_seq;
 114 static char     rt_line[NI_MAXHOST];
 115 static char     net_line[MAXHOSTNAMELEN + 1];
 116
 117 static struct {
 118         struct  rt_msghdr m_rtm;
 119         char    m_space[512];
 120 } m_rtmsg;
 121
 122 static TAILQ_HEAD(fibl_head_t, fibl) fibl_head;
 123
 124 static void     printb(int, const char *);
 125 static void     flushroutes(int argc, char *argv[]);
 126 static int      flushroutes_fib(int);
 127 static int      getaddr(int, char *, int);
 128 static int      keyword(const char *);
 129 #ifdef INET
 130 static void     inet_makemask(struct sockaddr_in *, u_long);
 131 #endif
 132 #ifdef INET6
 133 static int      inet6_makenetandmask(struct sockaddr_in6 *, const char *);
 134 #endif
 135 static void     interfaces(void);
 136 static void     monitor(int, char*[]);
 137 static const char       *netname(struct sockaddr *);
 138 static void     newroute(int, char **);
 139 static int      newroute_fib(int, char *, int);
 140 static void     pmsg_addrs(char *, int, size_t);
 141 static void     pmsg_common(struct rt_msghdr *, size_t);
 142 static int      prefixlen(const char *);
 143 static void     print_getmsg(struct rt_msghdr *, int, int);
 144 static void     print_rtmsg(struct rt_msghdr *, size_t);
 145 static const char       *routename(struct sockaddr *);
 146 static int      rtmsg(int, int, int);
 147 static void     set_metric(char *, int);
 148 static int      set_sofib(int);
 149 static void     sockaddr(char *, struct sockaddr *, size_t);
 150 static void     sodump(struct sockaddr *, const char *);
 151 static int      fiboptlist_csv(const char *, struct fibl_head_t *);
 152 static int      fiboptlist_range(const char *, struct fibl_head_t *);
 153
 154 static void usage(const char *) __dead2;
 155
 156 #define READ_TIMEOUT    10
 157 static volatile sig_atomic_t stop_read;
 158
 159 static void
 160 stopit(int sig __unused)
 161 {
 162
 163         stop_read = 1;
 164 }
 165
 166 static void
 167 usage(const char *cp)
 168 {
 169         if (cp != NULL)
 170                 warnx("bad keyword: %s", cp);
 171         errx(EX_USAGE, "usage: route [-j jail] [-46dnqtv] command [[modifiers] args]");
 172         /* NOTREACHED */
 173 }
 174
 175 int
 176 main(int argc, char **argv)
 177 {
 178         int ch;
 179 #ifdef JAIL
 180         int jid;
 181 #endif
 182         size_t len;
 183
 184         if (argc < 2)
 185                 usage(NULL);
 186
 187         while ((ch = getopt(argc, argv, "46nqdtvj:")) != -1)
 188                 switch(ch) {
 189                 case '4':
 190 #ifdef INET
 191                         af = AF_INET;
 192                         aflen = sizeof(struct sockaddr_in);
 193 #else
 194                         errx(1, "IPv4 support is not compiled in");
 195 #endif
 196                         break;
 197                 case '6':
 198 #ifdef INET6
 199                         af = AF_INET6;
 200                         aflen = sizeof(struct sockaddr_in6);
 201 #else
 202                         errx(1, "IPv6 support is not compiled in");
 203 #endif
 204                         break;
 205                 case 'n':
 206                         nflag = 1;
 207                         break;
 208                 case 'q':
 209                         qflag = 1;
 210                         break;
 211                 case 'v':
 212                         verbose = 1;
 213                         break;
 214                 case 't':
 215                         tflag = 1;
 216                         break;
 217                 case 'd':
 218                         debugonly = 1;
 219                         break;
 220                 case 'j':
 221 #ifdef JAIL
 222                         if (optarg == NULL)
 223                                 usage(NULL);
 224                         jail_name = optarg;
 225 #else
 226                         errx(1, "Jail support is not compiled in");
 227 #endif
 228                         break;
 229                 case '?':
 230                 default:
 231                         usage(NULL);
 232                 }
 233         argc -= optind;
 234         argv += optind;
 235
 236         pid = getpid();
 237         uid = geteuid();
 238
 239 #ifdef JAIL
 240         if (jail_name != NULL) {
 241                 jid = jail_getid(jail_name);
 242                 if (jid == -1)
 243                         errx(1, "Jail not found");
 244                 if (jail_attach(jid) != 0)
 245                         errx(1, "Cannot attach to jail");
 246         }
 247 #endif
 248
 249         if (tflag)
 250                 s = open(_PATH_DEVNULL, O_WRONLY, 0);
 251         else
 252                 s = socket(PF_ROUTE, SOCK_RAW, 0);
 253         if (s < 0)
 254                 err(EX_OSERR, "socket");
 255
 256         len = sizeof(numfibs);
 257         if (sysctlbyname("net.fibs", (void *)&numfibs, &len, NULL, 0) == -1)
 258                 numfibs = -1;
 259
 260         len = sizeof(defaultfib);
 261         if (numfibs != -1 &&
 262             sysctlbyname("net.my_fibnum", (void *)&defaultfib, &len, NULL,
 263                 0) == -1)
 264                 defaultfib = -1;
 265
 266         if (*argv != NULL)
 267                 switch (keyword(*argv)) {
 268                 case K_GET:
 269                 case K_SHOW:
 270                         uid = 0;
 271                         /* FALLTHROUGH */
 272
 273                 case K_CHANGE:
 274                 case K_ADD:
 275                 case K_DEL:
 276                 case K_DELETE:
 277                         newroute(argc, argv);
 278                         /* NOTREACHED */
 279
 280                 case K_MONITOR:
 281                         monitor(argc, argv);
 282                         /* NOTREACHED */
 283
 284                 case K_FLUSH:
 285                         flushroutes(argc, argv);
 286                         exit(0);
 287                         /* NOTREACHED */
 288                 }
 289         usage(*argv);
 290         /* NOTREACHED */
 291 }
 292
 293 static int
 294 set_sofib(int fib)
 295 {
 296
 297         if (fib < 0)
 298                 return (0);
 299         return (setsockopt(s, SOL_SOCKET, SO_SETFIB, (void *)&fib,
 300             sizeof(fib)));
 301 }
 302
 303 static int
 304 fiboptlist_range(const char *arg, struct fibl_head_t *flh)
 305 {
 306         struct fibl *fl;
 307         char *str0, *str, *token, *endptr;
 308         int fib[2], i, error;
 309
 310         str0 = str = strdup(arg);
 311         error = 0;
 312         i = 0;
 313         while ((token = strsep(&str, "-")) != NULL) {
 314                 switch (i) {
 315                 case 0:
 316                 case 1:
 317                         errno = 0;
 318                         fib[i] = strtol(token, &endptr, 0);
 319                         if (errno == 0) {
 320                                 if (*endptr != '\0' ||
 321                                     fib[i] < 0 ||
 322                                     (numfibs != -1 && fib[i] > numfibs - 1))
 323                                         errno = EINVAL;
 324                         }
 325                         if (errno)
 326                                 error = 1;
 327                         break;
 328                 default:
 329                         error = 1;
 330                 }
 331                 if (error)
 332                         goto fiboptlist_range_ret;
 333                 i++;
 334         }
 335         if (fib[0] >= fib[1]) {
 336                 error = 1;
 337                 goto fiboptlist_range_ret;
 338         }
 339         for (i = fib[0]; i <= fib[1]; i++) {
 340                 fl = calloc(1, sizeof(*fl));
 341                 if (fl == NULL) {
 342                         error = 1;
 343                         goto fiboptlist_range_ret;
 344                 }
 345                 fl->fl_num = i;
 346                 TAILQ_INSERT_TAIL(flh, fl, fl_next);
 347         }
 348 fiboptlist_range_ret:
 349         free(str0);
 350         return (error);
 351 }
 352
 353 #define ALLSTRLEN       64
 354 static int
 355 fiboptlist_csv(const char *arg, struct fibl_head_t *flh)
 356 {
 357         struct fibl *fl;
 358         char *str0, *str, *token, *endptr;
 359         int fib, error;
 360
 361         str0 = str = NULL;
 362         if (strcmp("all", arg) == 0) {
 363                 str = calloc(1, ALLSTRLEN);
 364                 if (str == NULL) {
 365                         error = 1;
 366                         goto fiboptlist_csv_ret;
 367                 }
 368                 if (numfibs > 1)
 369                         snprintf(str, ALLSTRLEN - 1, "%d-%d", 0, numfibs - 1);
 370                 else
 371                         snprintf(str, ALLSTRLEN - 1, "%d", 0);
 372         } else if (strcmp("default", arg) == 0) {
 373                 str0 = str = calloc(1, ALLSTRLEN);
 374                 if (str == NULL) {
 375                         error = 1;
 376                         goto fiboptlist_csv_ret;
 377                 }
 378                 snprintf(str, ALLSTRLEN - 1, "%d", defaultfib);
 379         } else
 380                 str0 = str = strdup(arg);
 381
 382         error = 0;
 383         while ((token = strsep(&str, ",")) != NULL) {
 384                 if (*token != '-' && strchr(token, '-') != NULL) {
 385                         error = fiboptlist_range(token, flh);
 386                         if (error)
 387                                 goto fiboptlist_csv_ret;
 388                 } else {
 389                         errno = 0;
 390                         fib = strtol(token, &endptr, 0);
 391                         if (errno == 0) {
 392                                 if (*endptr != '\0' ||
 393                                     fib < 0 ||
 394                                     (numfibs != -1 && fib > numfibs - 1))
 395                                         errno = EINVAL;
 396                         }
 397                         if (errno) {
 398                                 error = 1;
 399                                 goto fiboptlist_csv_ret;
 400                         }
 401                         fl = calloc(1, sizeof(*fl));
 402                         if (fl == NULL) {
 403                                 error = 1;
 404                                 goto fiboptlist_csv_ret;
 405                         }
 406                         fl->fl_num = fib;
 407                         TAILQ_INSERT_TAIL(flh, fl, fl_next);
 408                 }
 409         }
 410 fiboptlist_csv_ret:
 411         if (str0 != NULL)
 412                 free(str0);
 413         return (error);
 414 }
 415
 416 /*
 417  * Purge all entries in the routing tables not
 418  * associated with network interfaces.
 419  */
 420 static void
 421 flushroutes(int argc, char *argv[])
 422 {
 423         struct fibl *fl;
 424         int error;
 425
 426         if (uid != 0 && !debugonly && !tflag)
 427                 errx(EX_NOPERM, "must be root to alter routing table");
 428         shutdown(s, SHUT_RD); /* Don't want to read back our messages */
 429
 430         TAILQ_INIT(&fibl_head);
 431         while (argc > 1) {
 432                 argc--;
 433                 argv++;
 434                 if (**argv != '-')
 435                         usage(*argv);
 436                 switch (keyword(*argv + 1)) {
 437 #ifdef INET
 438                 case K_4:
 439                 case K_INET:
 440                         af = AF_INET;
 441                         break;
 442 #endif
 443 #ifdef INET6
 444                 case K_6:
 445                 case K_INET6:
 446                         af = AF_INET6;
 447                         break;
 448 #endif
 449                 case K_LINK:
 450                         af = AF_LINK;
 451                         break;
 452                 case K_FIB:
 453                         if (!--argc)
 454                                 usage(*argv);
 455                         error = fiboptlist_csv(*++argv, &fibl_head);
 456                         if (error)
 457                                 errx(EX_USAGE, "invalid fib number: %s", *argv);
 458                         break;
 459                 default:
 460                         usage(*argv);
 461                 }
 462         }
 463         if (TAILQ_EMPTY(&fibl_head)) {
 464                 error = fiboptlist_csv("default", &fibl_head);
 465                 if (error)
 466                         errx(EX_OSERR, "fiboptlist_csv failed.");
 467         }
 468         TAILQ_FOREACH(fl, &fibl_head, fl_next)
 469                 flushroutes_fib(fl->fl_num);
 470 }
 471
 472 static int
 473 flushroutes_fib(int fib)
 474 {
 475         struct rt_msghdr *rtm;
 476         size_t needed;
 477         char *buf, *next, *lim;
 478         int mib[7], rlen, seqno, count = 0;
 479         int error;
 480
 481         error = set_sofib(fib);
 482         if (error) {
 483                 warn("fib number %d is ignored", fib);
 484                 return (error);
 485         }
 486
 487 retry:
 488         mib[0] = CTL_NET;
 489         mib[1] = PF_ROUTE;
 490         mib[2] = 0;             /* protocol */
 491         mib[3] = AF_UNSPEC;
 492         mib[4] = NET_RT_DUMP;
 493         mib[5] = 0;             /* no flags */
 494         mib[6] = fib;
 495         if (sysctl(mib, nitems(mib), NULL, &needed, NULL, 0) < 0)
 496                 err(EX_OSERR, "route-sysctl-estimate");
 497         if ((buf = malloc(needed)) == NULL)
 498                 errx(EX_OSERR, "malloc failed");
 499         if (sysctl(mib, nitems(mib), buf, &needed, NULL, 0) < 0) {
 500                 if (errno == ENOMEM && count++ < 10) {
 501                         warnx("Routing table grew, retrying");
 502                         sleep(1);
 503                         free(buf);
 504                         goto retry;
 505                 }
 506                 err(EX_OSERR, "route-sysctl-get");
 507         }
 508         lim = buf + needed;
 509         if (verbose)
 510                 (void)printf("Examining routing table from sysctl\n");
 511         seqno = 0;              /* ??? */
 512         for (next = buf; next < lim; next += rtm->rtm_msglen) {
 513                 rtm = (struct rt_msghdr *)(void *)next;
 514                 if (verbose)
 515                         print_rtmsg(rtm, rtm->rtm_msglen);
 516                 if ((rtm->rtm_flags & RTF_GATEWAY) == 0)
 517                         continue;
 518                 if (af != 0) {
 519                         struct sockaddr *sa = (struct sockaddr *)(rtm + 1);
 520
 521                         if (sa->sa_family != af)
 522                                 continue;
 523                 }
 524                 if (debugonly)
 525                         continue;
 526                 rtm->rtm_type = RTM_DELETE;
 527                 rtm->rtm_seq = seqno;
 528                 rlen = write(s, next, rtm->rtm_msglen);
 529                 if (rlen < 0 && errno == EPERM)
 530                         err(1, "write to routing socket");
 531                 if (rlen < (int)rtm->rtm_msglen) {
 532                         warn("write to routing socket");
 533                         (void)printf("got only %d for rlen\n", rlen);
 534                         free(buf);
 535                         goto retry;
 536                         break;
 537                 }
 538                 seqno++;
 539                 if (qflag)
 540                         continue;
 541                 if (verbose)
 542                         print_rtmsg(rtm, rlen);
 543                 else {
 544                         struct sockaddr *sa = (struct sockaddr *)(rtm + 1);
 545
 546                         printf("%-20.20s ", rtm->rtm_flags & RTF_HOST ?
 547                             routename(sa) : netname(sa));
 548                         sa = (struct sockaddr *)(SA_SIZE(sa) + (char *)sa);
 549                         printf("%-20.20s ", routename(sa));
 550                         if (fib >= 0)
 551                                 printf("-fib %-3d ", fib);
 552                         printf("done\n");
 553                 }
 554         }
 555         free(buf);
 556         return (error);
 557 }
 558
 559 static const char *
 560 routename(struct sockaddr *sa)
 561 {
 562         struct sockaddr_dl *sdl;
 563         const char *cp;
 564         int n;
 565
 566         if (!domain_initialized) {
 567                 domain_initialized = true;
 568                 if (gethostname(domain, MAXHOSTNAMELEN) == 0 &&
 569                     (cp = strchr(domain, '.'))) {
 570                         domain[MAXHOSTNAMELEN] = '\0';
 571                         (void)strcpy(domain, cp + 1);
 572                 } else
 573                         domain[0] = '\0';
 574         }
 575
 576         /* If the address is zero-filled, use "default". */
 577         if (sa->sa_len == 0 && nflag == 0)
 578                 return ("default");
 579 #if defined(INET) || defined(INET6)
 580         switch (sa->sa_family) {
 581 #ifdef INET
 582         case AF_INET:
 583                 /* If the address is zero-filled, use "default". */
 584                 if (nflag == 0 &&
 585                     ((struct sockaddr_in *)(void *)sa)->sin_addr.s_addr ==
 586                     INADDR_ANY)
 587                         return("default");
 588                 break;
 589 #endif
 590 #ifdef INET6
 591         case AF_INET6:
 592                 /* If the address is zero-filled, use "default". */
 593                 if (nflag == 0 &&
 594                     IN6_IS_ADDR_UNSPECIFIED(&((struct sockaddr_in6 *)(void *)sa)->sin6_addr))
 595                         return("default");
 596                 break;
 597 #endif
 598         }
 599 #endif
 600
 601         switch (sa->sa_family) {
 602 #if defined(INET) || defined(INET6)
 603 #ifdef INET
 604         case AF_INET:
 605 #endif
 606 #ifdef INET6
 607         case AF_INET6:
 608 #endif
 609         {
 610                 struct sockaddr_storage ss;
 611                 int error;
 612                 char *p;
 613
 614                 memset(&ss, 0, sizeof(ss));
 615                 if (sa->sa_len == 0)
 616                         ss.ss_family = sa->sa_family;
 617                 else
 618                         memcpy(&ss, sa, sa->sa_len);
 619                 /* Expand sa->sa_len because it could be shortened. */
 620                 if (sa->sa_family == AF_INET)
 621                         ss.ss_len = sizeof(struct sockaddr_in);
 622                 else if (sa->sa_family == AF_INET6)
 623                         ss.ss_len = sizeof(struct sockaddr_in6);
 624                 error = getnameinfo((struct sockaddr *)&ss, ss.ss_len,
 625                     rt_line, sizeof(rt_line), NULL, 0,
 626                     (nflag == 0) ? 0 : NI_NUMERICHOST);
 627                 if (error) {
 628                         warnx("getnameinfo(): %s", gai_strerror(error));
 629                         strncpy(rt_line, "invalid", sizeof(rt_line));
 630                 }
 631
 632                 /* Remove the domain part if any. */
 633                 p = strchr(rt_line, '.');
 634                 if (p != NULL && strcmp(p + 1, domain) == 0)
 635                         *p = '\0';
 636
 637                 return (rt_line);
 638                 break;
 639         }
 640 #endif
 641         case AF_LINK:
 642                 sdl = (struct sockaddr_dl *)(void *)sa;
 643
 644                 if (sdl->sdl_nlen == 0 &&
 645                     sdl->sdl_alen == 0 &&
 646                     sdl->sdl_slen == 0) {
 647                         n = snprintf(rt_line, sizeof(rt_line), "link#%d",
 648                             sdl->sdl_index);
 649                         if (n > (int)sizeof(rt_line))
 650                             rt_line[0] = '\0';
 651                         return (rt_line);
 652                 } else
 653                         return (link_ntoa(sdl));
 654                 break;
 655
 656         default:
 657             {
 658                 u_short *sp = (u_short *)(void *)sa;
 659                 u_short *splim = sp + ((sa->sa_len + 1) >> 1);
 660                 char *cps = rt_line + sprintf(rt_line, "(%d)", sa->sa_family);
 661                 char *cpe = rt_line + sizeof(rt_line);
 662
 663                 while (++sp < splim && cps < cpe) /* start with sa->sa_data */
 664                         if ((n = snprintf(cps, cpe - cps, " %x", *sp)) > 0)
 665                                 cps += n;
 666                         else
 667                                 *cps = '\0';
 668                 break;
 669             }
 670         }
 671         return (rt_line);
 672 }
 673
 674 /*
 675  * Return the name of the network whose address is given.
 676  * The address is assumed to be that of a net, not a host.
 677  */
 678 static const char *
 679 netname(struct sockaddr *sa)
 680 {
 681         struct sockaddr_dl *sdl;
 682         int n;
 683 #ifdef INET
 684         struct netent *np = NULL;
 685         const char *cp = NULL;
 686         u_long i;
 687 #endif
 688
 689         switch (sa->sa_family) {
 690 #ifdef INET
 691         case AF_INET:
 692         {
 693                 struct in_addr in;
 694
 695                 in = ((struct sockaddr_in *)(void *)sa)->sin_addr;
 696                 i = in.s_addr = ntohl(in.s_addr);
 697                 if (in.s_addr == 0)
 698                         cp = "default";
 699                 else if (!nflag) {
 700                         np = getnetbyaddr(i, AF_INET);
 701                         if (np != NULL)
 702                                 cp = np->n_name;
 703                 }
 704 #define C(x)    (unsigned)((x) & 0xff)
 705                 if (cp != NULL)
 706                         strncpy(net_line, cp, sizeof(net_line));
 707                 else if ((in.s_addr & 0xffffff) == 0)
 708                         (void)sprintf(net_line, "%u", C(in.s_addr >> 24));
 709                 else if ((in.s_addr & 0xffff) == 0)
 710                         (void)sprintf(net_line, "%u.%u", C(in.s_addr >> 24),
 711                             C(in.s_addr >> 16));
 712                 else if ((in.s_addr & 0xff) == 0)
 713                         (void)sprintf(net_line, "%u.%u.%u", C(in.s_addr >> 24),
 714                             C(in.s_addr >> 16), C(in.s_addr >> 8));
 715                 else
 716                         (void)sprintf(net_line, "%u.%u.%u.%u", C(in.s_addr >> 24),
 717                             C(in.s_addr >> 16), C(in.s_addr >> 8),
 718                             C(in.s_addr));
 719 #undef C
 720                 break;
 721         }
 722 #endif
 723 #ifdef INET6
 724         case AF_INET6:
 725         {
 726                 struct sockaddr_in6 sin6;
 727                 int niflags = 0;
 728
 729                 memset(&sin6, 0, sizeof(sin6));
 730                 memcpy(&sin6, sa, sa->sa_len);
 731                 sin6.sin6_len = sizeof(sin6);
 732                 sin6.sin6_family = AF_INET6;
 733                 if (nflag)
 734                         niflags |= NI_NUMERICHOST;
 735                 if (getnameinfo((struct sockaddr *)&sin6, sin6.sin6_len,
 736                     net_line, sizeof(net_line), NULL, 0, niflags) != 0)
 737                         strncpy(net_line, "invalid", sizeof(net_line));
 738
 739                 return(net_line);
 740         }
 741 #endif
 742         case AF_LINK:
 743                 sdl = (struct sockaddr_dl *)(void *)sa;
 744
 745                 if (sdl->sdl_nlen == 0 &&
 746                     sdl->sdl_alen == 0 &&
 747                     sdl->sdl_slen == 0) {
 748                         n = snprintf(net_line, sizeof(net_line), "link#%d",
 749                             sdl->sdl_index);
 750                         if (n > (int)sizeof(net_line))
 751                             net_line[0] = '\0';
 752                         return (net_line);
 753                 } else
 754                         return (link_ntoa(sdl));
 755                 break;
 756
 757         default:
 758             {
 759                 u_short *sp = (u_short *)(void *)sa->sa_data;
 760                 u_short *splim = sp + ((sa->sa_len + 1)>>1);
 761                 char *cps = net_line + sprintf(net_line, "af %d:", sa->sa_family);
 762                 char *cpe = net_line + sizeof(net_line);
 763
 764                 while (sp < splim && cps < cpe)
 765                         if ((n = snprintf(cps, cpe - cps, " %x", *sp++)) > 0)
 766                                 cps += n;
 767                         else
 768                                 *cps = '\0';
 769                 break;
 770             }
 771         }
 772         return (net_line);
 773 }
 774
 775 static void
 776 set_metric(char *value, int key)
 777 {
 778         int flag = 0;
 779         char *endptr;
 780         u_long noval, *valp = &noval;
 781
 782         switch (key) {
 783 #define caseof(x, y, z) case x: valp = &rt_metrics.z; flag = y; break
 784         caseof(K_MTU, RTV_MTU, rmx_mtu);
 785         caseof(K_HOPCOUNT, RTV_HOPCOUNT, rmx_hopcount);
 786         caseof(K_EXPIRE, RTV_EXPIRE, rmx_expire);
 787         caseof(K_RECVPIPE, RTV_RPIPE, rmx_recvpipe);
 788         caseof(K_SENDPIPE, RTV_SPIPE, rmx_sendpipe);
 789         caseof(K_SSTHRESH, RTV_SSTHRESH, rmx_ssthresh);
 790         caseof(K_RTT, RTV_RTT, rmx_rtt);
 791         caseof(K_RTTVAR, RTV_RTTVAR, rmx_rttvar);
 792         caseof(K_WEIGHT, RTV_WEIGHT, rmx_weight);
 793         }
 794         rtm_inits |= flag;
 795         if (lockrest || locking)
 796                 rt_metrics.rmx_locks |= flag;
 797         if (locking)
 798                 locking = 0;
 799         errno = 0;
 800         *valp = strtol(value, &endptr, 0);
 801         if (errno == 0 && *endptr != '\0')
 802                 errno = EINVAL;
 803         if (errno)
 804                 err(EX_USAGE, "%s", value);
 805         if (flag & RTV_EXPIRE && (value[0] == '+' || value[0] == '-')) {
 806                 struct timespec ts;
 807
 808                 clock_gettime(CLOCK_REALTIME_FAST, &ts);
 809                 *valp += ts.tv_sec;
 810         }
 811 }
 812
 813 #define F_ISHOST        0x01
 814 #define F_FORCENET      0x02
 815 #define F_FORCEHOST     0x04
 816 #define F_PROXY         0x08
 817 #define F_INTERFACE     0x10
 818
 819 static void
 820 newroute(int argc, char **argv)
 821 {
 822         struct sigaction sa;
 823         struct fibl *fl;
 824         char *cmd;
 825         const char *dest, *gateway, *errmsg;
 826         int key, error, flags, nrflags, fibnum;
 827
 828         if (uid != 0 && !debugonly && !tflag)
 829                 errx(EX_NOPERM, "must be root to alter routing table");
 830         dest = NULL;
 831         gateway = NULL;
 832         flags = RTF_STATIC;
 833         nrflags = 0;
 834         TAILQ_INIT(&fibl_head);
 835
 836         sigemptyset(&sa.sa_mask);
 837         sa.sa_flags = 0;
 838         sa.sa_handler = stopit;
 839         if (sigaction(SIGALRM, &sa, 0) == -1)
 840                 warn("sigaction SIGALRM");
 841
 842         cmd = argv[0];
 843         if (*cmd != 'g' && *cmd != 's')
 844                 shutdown(s, SHUT_RD); /* Don't want to read back our messages */
 845         while (--argc > 0) {
 846                 if (**(++argv)== '-') {
 847                         switch (key = keyword(1 + *argv)) {
 848                         case K_LINK:
 849                                 af = AF_LINK;
 850                                 aflen = sizeof(struct sockaddr_dl);
 851                                 break;
 852 #ifdef INET
 853                         case K_4:
 854                         case K_INET:
 855                                 af = AF_INET;
 856                                 aflen = sizeof(struct sockaddr_in);
 857                                 break;
 858 #endif
 859 #ifdef INET6
 860                         case K_6:
 861                         case K_INET6:
 862                                 af = AF_INET6;
 863                                 aflen = sizeof(struct sockaddr_in6);
 864                                 break;
 865 #endif
 866                         case K_SA:
 867                                 af = PF_ROUTE;
 868                                 aflen = sizeof(struct sockaddr_storage);
 869                                 break;
 870                         case K_IFACE:
 871                         case K_INTERFACE:
 872                                 nrflags |= F_INTERFACE;
 873                                 break;
 874                         case K_NOSTATIC:
 875                                 flags &= ~RTF_STATIC;
 876                                 break;
 877                         case K_LOCK:
 878                                 locking = 1;
 879                                 break;
 880                         case K_LOCKREST:
 881                                 lockrest = 1;
 882                                 break;
 883                         case K_HOST:
 884                                 nrflags |= F_FORCEHOST;
 885                                 break;
 886                         case K_REJECT:
 887                                 flags |= RTF_REJECT;
 888                                 break;
 889                         case K_BLACKHOLE:
 890                                 flags |= RTF_BLACKHOLE;
 891                                 break;
 892                         case K_PROTO1:
 893                                 flags |= RTF_PROTO1;
 894                                 break;
 895                         case K_PROTO2:
 896                                 flags |= RTF_PROTO2;
 897                                 break;
 898                         case K_PROXY:
 899                                 nrflags |= F_PROXY;
 900                                 break;
 901                         case K_XRESOLVE:
 902                                 flags |= RTF_XRESOLVE;
 903                                 break;
 904                         case K_STATIC:
 905                                 flags |= RTF_STATIC;
 906                                 break;
 907                         case K_STICKY:
 908                                 flags |= RTF_STICKY;
 909                                 break;
 910                         case K_NOSTICK:
 911                                 flags &= ~RTF_STICKY;
 912                                 break;
 913                         case K_FIB:
 914                                 if (!--argc)
 915                                         usage(NULL);
 916                                 error = fiboptlist_csv(*++argv, &fibl_head);
 917                                 if (error)
 918                                         errx(EX_USAGE,
 919                                             "invalid fib number: %s", *argv);
 920                                 break;
 921                         case K_IFA:
 922                                 if (!--argc)
 923                                         usage(NULL);
 924                                 getaddr(RTAX_IFA, *++argv, nrflags);
 925                                 break;
 926                         case K_IFP:
 927                                 if (!--argc)
 928                                         usage(NULL);
 929                                 getaddr(RTAX_IFP, *++argv, nrflags);
 930                                 break;
 931                         case K_GENMASK:
 932                                 if (!--argc)
 933                                         usage(NULL);
 934                                 getaddr(RTAX_GENMASK, *++argv, nrflags);
 935                                 break;
 936                         case K_GATEWAY:
 937                                 if (!--argc)
 938                                         usage(NULL);
 939                                 getaddr(RTAX_GATEWAY, *++argv, nrflags);
 940                                 gateway = *argv;
 941                                 break;
 942                         case K_DST:
 943                                 if (!--argc)
 944                                         usage(NULL);
 945                                 if (getaddr(RTAX_DST, *++argv, nrflags))
 946                                         nrflags |= F_ISHOST;
 947                                 dest = *argv;
 948                                 break;
 949                         case K_NETMASK:
 950                                 if (!--argc)
 951                                         usage(NULL);
 952                                 getaddr(RTAX_NETMASK, *++argv, nrflags);
 953                                 /* FALLTHROUGH */
 954                         case K_NET:
 955                                 nrflags |= F_FORCENET;
 956                                 break;
 957                         case K_PREFIXLEN:
 958                                 if (!--argc)
 959                                         usage(NULL);
 960                                 if (prefixlen(*++argv) == -1) {
 961                                         nrflags &= ~F_FORCENET;
 962                                         nrflags |= F_ISHOST;
 963                                 } else {
 964                                         nrflags |= F_FORCENET;
 965                                         nrflags &= ~F_ISHOST;
 966                                 }
 967                                 break;
 968                         case K_MTU:
 969                         case K_HOPCOUNT:
 970                         case K_EXPIRE:
 971                         case K_RECVPIPE:
 972                         case K_SENDPIPE:
 973                         case K_SSTHRESH:
 974                         case K_RTT:
 975                         case K_RTTVAR:
 976                         case K_WEIGHT:
 977                                 if (!--argc)
 978                                         usage(NULL);
 979                                 set_metric(*++argv, key);
 980                                 break;
 981                         default:
 982                                 usage(1+*argv);
 983                         }
 984                 } else {
 985                         if ((rtm_addrs & RTA_DST) == 0) {
 986                                 dest = *argv;
 987                                 if (getaddr(RTAX_DST, *argv, nrflags))
 988                                         nrflags |= F_ISHOST;
 989                         } else if ((rtm_addrs & RTA_GATEWAY) == 0) {
 990                                 gateway = *argv;
 991                                 getaddr(RTAX_GATEWAY, *argv, nrflags);
 992                         } else {
 993                                 getaddr(RTAX_NETMASK, *argv, nrflags);
 994                                 nrflags |= F_FORCENET;
 995                         }
 996                 }
 997         }
 998
 999         /* Do some sanity checks on resulting request */
1000         if (so[RTAX_DST].ss_len == 0) {
1001                 warnx("destination parameter required");
1002                 usage(NULL);
1003         }
1004
1005         if (so[RTAX_NETMASK].ss_len != 0 &&
1006             so[RTAX_DST].ss_family != so[RTAX_NETMASK].ss_family) {
1007                 warnx("destination and netmask family need to be the same");
1008                 usage(NULL);
1009         }
1010
1011         if (nrflags & F_FORCEHOST) {
1012                 nrflags |= F_ISHOST;
1013 #ifdef INET6
1014                 if (af == AF_INET6) {
1015                         rtm_addrs &= ~RTA_NETMASK;
1016                         memset(&so[RTAX_NETMASK], 0, sizeof(so[RTAX_NETMASK]));
1017                 }
1018 #endif
1019         }
1020         if (nrflags & F_FORCENET)
1021                 nrflags &= ~F_ISHOST;
1022         flags |= RTF_UP;
1023         if (nrflags & F_ISHOST)
1024                 flags |= RTF_HOST;
1025         if ((nrflags & F_INTERFACE) == 0)
1026                 flags |= RTF_GATEWAY;
1027         if (nrflags & F_PROXY)
1028                 flags |= RTF_ANNOUNCE;
1029         if (dest == NULL)
1030                 dest = "";
1031         if (gateway == NULL)
1032                 gateway = "";
1033
1034         if (TAILQ_EMPTY(&fibl_head)) {
1035                 error = fiboptlist_csv("default", &fibl_head);
1036                 if (error)
1037                         errx(EX_OSERR, "fiboptlist_csv failed.");
1038         }
1039         error = 0;
1040         TAILQ_FOREACH(fl, &fibl_head, fl_next) {
1041                 fl->fl_error = newroute_fib(fl->fl_num, cmd, flags);
1042                 if (fl->fl_error)
1043                         fl->fl_errno = errno;
1044                 error += fl->fl_error;
1045         }
1046         if (*cmd == 'g' || *cmd == 's')
1047                 exit(error);
1048
1049         error = 0;
1050         if (!qflag) {
1051                 fibnum = 0;
1052                 TAILQ_FOREACH(fl, &fibl_head, fl_next) {
1053                         if (fl->fl_error == 0)
1054                                 fibnum++;
1055                 }
1056                 if (fibnum > 0) {
1057                         int firstfib = 1;
1058
1059                         printf("%s %s %s", cmd,
1060                             (nrflags & F_ISHOST) ? "host" : "net", dest);
1061                         if (*gateway)
1062                                 printf(": gateway %s", gateway);
1063
1064                         if (numfibs > 1) {
1065                                 TAILQ_FOREACH(fl, &fibl_head, fl_next) {
1066                                         if (fl->fl_error == 0
1067                                             && fl->fl_num >= 0) {
1068                                                 if (firstfib) {
1069                                                         printf(" fib ");
1070                                                         firstfib = 0;
1071                                                 }
1072                                                 printf("%d", fl->fl_num);
1073                                                 if (fibnum-- > 1)
1074                                                         printf(",");
1075                                         }
1076                                 }
1077                         }
1078                         printf("\n");
1079                 }
1080         }
1081
1082         fibnum = 0;
1083         TAILQ_FOREACH(fl, &fibl_head, fl_next) {
1084                 if (fl->fl_error != 0) {
1085                         error = 1;
1086                         if (!qflag) {
1087                                 printf("%s %s %s", cmd, (nrflags & F_ISHOST)
1088                                     ? "host" : "net", dest);
1089                                 if (*gateway)
1090                                         printf(": gateway %s", gateway);
1091
1092                                 if (fl->fl_num >= 0)
1093                                         printf(" fib %d", fl->fl_num);
1094
1095                                 switch (fl->fl_errno) {
1096                                 case ESRCH:
1097                                         errmsg = "not in table";
1098                                         break;
1099                                 case EBUSY:
1100                                         errmsg = "entry in use";
1101                                         break;
1102                                 case ENOBUFS:
1103                                         errmsg = "not enough memory";
1104                                         break;
1105                                 case EADDRINUSE:
1106                                         /*
1107                                          * handle recursion avoidance
1108                                          * in rt_setgate()
1109                                          */
1110                                         errmsg = "gateway uses the same route";
1111                                         break;
1112                                 case EEXIST:
1113                                         errmsg = "route already in table";
1114                                         break;
1115                                 default:
1116                                         errmsg = strerror(fl->fl_errno);
1117                                         break;
1118                                 }
1119                                 printf(": %s\n", errmsg);
1120                         }
1121                 }
1122         }
1123         exit(error);
1124 }
1125
1126 static int
1127 newroute_fib(int fib, char *cmd, int flags)
1128 {
1129         int error;
1130
1131         error = set_sofib(fib);
1132         if (error) {
1133                 warn("fib number %d is ignored", fib);
1134                 return (error);
1135         }
1136
1137         error = rtmsg(*cmd, flags, fib);
1138         return (error);
1139 }
1140
1141 #ifdef INET
1142 static void
1143 inet_makemask(struct sockaddr_in *sin_mask, u_long bits)
1144 {
1145         u_long mask = 0;
1146
1147         rtm_addrs |= RTA_NETMASK;
1148
1149         if (bits != 0)
1150                 mask = 0xffffffff << (32 - bits);
1151
1152         sin_mask->sin_addr.s_addr = htonl(mask);
1153         sin_mask->sin_len = sizeof(struct sockaddr_in);
1154         sin_mask->sin_family = AF_INET;
1155 }
1156 #endif
1157
1158 #ifdef INET6
1159 /*
1160  * XXX the function may need more improvement...
1161  */
1162 static int
1163 inet6_makenetandmask(struct sockaddr_in6 *sin6, const char *plen)
1164 {
1165
1166         if (plen == NULL) {
1167                 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr) &&
1168                     sin6->sin6_scope_id == 0)
1169                         plen = "0";
1170         }
1171
1172         if (plen == NULL || strcmp(plen, "128") == 0)
1173                 return (1);
1174         rtm_addrs |= RTA_NETMASK;
1175         prefixlen(plen);
1176         return (0);
1177 }
1178 #endif
1179
1180 /*
1181  * Interpret an argument as a network address of some kind,
1182  * returning 1 if a host address, 0 if a network address.
1183  */
1184 static int
1185 getaddr(int idx, char *str, int nrflags)
1186 {
1187         struct sockaddr *sa;
1188 #if defined(INET)
1189         struct sockaddr_in *sin;
1190         struct hostent *hp;
1191         char *q;
1192 #elif defined(INET6)
1193         char *q;
1194 #endif
1195
1196         if (idx < 0 || idx >= RTAX_MAX)
1197                 usage("internal error");
1198         if (af == 0) {
1199 #if defined(INET)
1200                 af = AF_INET;
1201                 aflen = sizeof(struct sockaddr_in);
1202 #elif defined(INET6)
1203                 af = AF_INET6;
1204                 aflen = sizeof(struct sockaddr_in6);
1205 #else
1206                 af = AF_LINK;
1207                 aflen = sizeof(struct sockaddr_dl);
1208 #endif
1209         }
1210         rtm_addrs |= (1 << idx);
1211         sa = (struct sockaddr *)&so[idx];
1212         sa->sa_family = af;
1213         sa->sa_len = aflen;
1214
1215         switch (idx) {
1216         case RTAX_GATEWAY:
1217                 if (nrflags & F_INTERFACE) {
1218                         struct ifaddrs *ifap, *ifa;
1219                         struct sockaddr_dl *sdl0 = (struct sockaddr_dl *)(void *)sa;
1220                         struct sockaddr_dl *sdl = NULL;
1221
1222                         if (getifaddrs(&ifap))
1223                                 err(EX_OSERR, "getifaddrs");
1224
1225                         for (ifa = ifap; ifa != NULL; ifa = ifa->ifa_next) {
1226                                 if (ifa->ifa_addr->sa_family != AF_LINK)
1227                                         continue;
1228
1229                                 if (strcmp(str, ifa->ifa_name) != 0)
1230                                         continue;
1231
1232                                 sdl = (struct sockaddr_dl *)(void *)ifa->ifa_addr;
1233                         }
1234                         /* If we found it, then use it */
1235                         if (sdl != NULL) {
1236                                 /*
1237                                  * Note that we need to copy before calling
1238                                  * freeifaddrs().
1239                                  */
1240                                 memcpy(sdl0, sdl, sdl->sdl_len);
1241                         }
1242                         freeifaddrs(ifap);
1243                         if (sdl != NULL)
1244                                 return(1);
1245                         else
1246                                 errx(EX_DATAERR,
1247                                     "interface '%s' does not exist", str);
1248                 }
1249                 break;
1250         case RTAX_IFP:
1251                 sa->sa_family = AF_LINK;
1252                 break;
1253         }
1254         if (strcmp(str, "default") == 0) {
1255                 /*
1256                  * Default is net 0.0.0.0/0
1257                  */
1258                 switch (idx) {
1259                 case RTAX_DST:
1260                         nrflags |= F_FORCENET;
1261                         getaddr(RTAX_NETMASK, str, nrflags);
1262                         break;
1263                 }
1264                 return (0);
1265         }
1266         switch (sa->sa_family) {
1267 #ifdef INET6
1268         case AF_INET6:
1269         {
1270                 struct addrinfo hints, *res;
1271                 int ecode;
1272
1273                 q = NULL;
1274                 if (idx == RTAX_DST && (q = strchr(str, '/')) != NULL)
1275                         *q = '\0';
1276                 memset(&hints, 0, sizeof(hints));
1277                 hints.ai_family = sa->sa_family;
1278                 hints.ai_socktype = SOCK_DGRAM;
1279                 ecode = getaddrinfo(str, NULL, &hints, &res);
1280                 if (ecode != 0 || res->ai_family != AF_INET6 ||
1281                     res->ai_addrlen != sizeof(struct sockaddr_in6))
1282                         errx(EX_OSERR, "%s: %s", str, gai_strerror(ecode));
1283                 memcpy(sa, res->ai_addr, res->ai_addrlen);
1284                 freeaddrinfo(res);
1285                 if (q != NULL)
1286                         *q++ = '/';
1287                 if (idx == RTAX_DST)
1288                         return (inet6_makenetandmask((struct sockaddr_in6 *)(void *)sa, q));
1289                 return (0);
1290         }
1291 #endif /* INET6 */
1292         case AF_LINK:
1293                 link_addr(str, (struct sockaddr_dl *)(void *)sa);
1294                 return (1);
1295
1296         case PF_ROUTE:
1297                 sockaddr(str, sa, sizeof(struct sockaddr_storage));
1298                 return (1);
1299 #ifdef INET
1300         case AF_INET:
1301 #endif
1302         default:
1303                 break;
1304         }
1305
1306 #ifdef INET
1307         sin = (struct sockaddr_in *)(void *)sa;
1308
1309         q = strchr(str,'/');
1310         if (q != NULL && idx == RTAX_DST) {
1311                 /* A.B.C.D/NUM */
1312                 *q = '\0';
1313                 if (inet_aton(str, &sin->sin_addr) == 0)
1314                         errx(EX_NOHOST, "bad address: %s", str);
1315
1316                 int masklen = strtol(q + 1, NULL, 10);
1317                 if (masklen < 0 || masklen > 32)
1318                         errx(EX_NOHOST, "bad mask length: %s", q + 1);
1319
1320                 inet_makemask((struct sockaddr_in *)&so[RTAX_NETMASK],masklen);
1321                 return (0);
1322         }
1323         if (inet_aton(str, &sin->sin_addr) != 0)
1324                 return (1);
1325
1326         hp = gethostbyname(str);
1327         if (hp != NULL) {
1328                 sin->sin_family = hp->h_addrtype;
1329                 memmove((char *)&sin->sin_addr, hp->h_addr,
1330                     MIN((size_t)hp->h_length, sizeof(sin->sin_addr)));
1331                 return (1);
1332         }
1333 #endif
1334         errx(EX_NOHOST, "bad address: %s", str);
1335 }
1336
1337 static int
1338 prefixlen(const char *str)
1339 {
1340         int len = atoi(str), q, r;
1341         int max;
1342         char *p;
1343
1344         rtm_addrs |= RTA_NETMASK;
1345         switch (af) {
1346 #ifdef INET6
1347         case AF_INET6:
1348         {
1349                 struct sockaddr_in6 *sin6 =
1350                     (struct sockaddr_in6 *)&so[RTAX_NETMASK];
1351
1352                 max = 128;
1353                 p = (char *)&sin6->sin6_addr;
1354                 sin6->sin6_family = AF_INET6;
1355                 sin6->sin6_len = sizeof(*sin6);
1356                 break;
1357         }
1358 #endif
1359 #ifdef INET
1360         case AF_INET:
1361         {
1362                 struct sockaddr_in *sin =
1363                     (struct sockaddr_in *)&so[RTAX_NETMASK];
1364
1365                 max = 32;
1366                 p = (char *)&sin->sin_addr;
1367                 sin->sin_family = AF_INET;
1368                 sin->sin_len = sizeof(*sin);
1369                 break;
1370         }
1371 #endif
1372         default:
1373                 errx(EX_OSERR, "prefixlen not supported in this af");
1374         }
1375
1376         if (len < 0 || max < len)
1377                 errx(EX_USAGE, "%s: invalid prefixlen", str);
1378
1379         q = len >> 3;
1380         r = len & 7;
1381         memset((void *)p, 0, max / 8);
1382         if (q > 0)
1383                 memset((void *)p, 0xff, q);
1384         if (r > 0)
1385                 *((u_char *)p + q) = (0xff00 >> r) & 0xff;
1386         if (len == max)
1387                 return (-1);
1388         else
1389                 return (len);
1390 }
1391
1392 static void
1393 interfaces(void)
1394 {
1395         size_t needed;
1396         int mib[6];
1397         char *buf, *lim, *next, count = 0;
1398         struct rt_msghdr *rtm;
1399
1400 retry2:
1401         mib[0] = CTL_NET;
1402         mib[1] = PF_ROUTE;
1403         mib[2] = 0;             /* protocol */
1404         mib[3] = AF_UNSPEC;
1405         mib[4] = NET_RT_IFLIST;
1406         mib[5] = 0;             /* no flags */
1407         if (sysctl(mib, nitems(mib), NULL, &needed, NULL, 0) < 0)
1408                 err(EX_OSERR, "route-sysctl-estimate");
1409         if ((buf = malloc(needed)) == NULL)
1410                 errx(EX_OSERR, "malloc failed");
1411         if (sysctl(mib, nitems(mib), buf, &needed, NULL, 0) < 0) {
1412                 if (errno == ENOMEM && count++ < 10) {
1413                         warnx("Routing table grew, retrying");
1414                         sleep(1);
1415                         free(buf);
1416                         goto retry2;
1417                 }
1418                 err(EX_OSERR, "actual retrieval of interface table");
1419         }
1420         lim = buf + needed;
1421         for (next = buf; next < lim; next += rtm->rtm_msglen) {
1422                 rtm = (struct rt_msghdr *)(void *)next;
1423                 print_rtmsg(rtm, rtm->rtm_msglen);
1424         }
1425         free(buf);
1426 }
1427
1428 static void
1429 monitor(int argc, char *argv[])
1430 {
1431         int n, fib, error;
1432         char msg[2048], *endptr;
1433
1434         fib = defaultfib;
1435         while (argc > 1) {
1436                 argc--;
1437                 argv++;
1438                 if (**argv != '-')
1439                         usage(*argv);
1440                 switch (keyword(*argv + 1)) {
1441                 case K_FIB:
1442                         if (!--argc)
1443                                 usage(*argv);
1444                         errno = 0;
1445                         fib = strtol(*++argv, &endptr, 0);
1446                         if (errno == 0) {
1447                                 if (*endptr != '\0' ||
1448                                     fib < 0 ||
1449                                     (numfibs != -1 && fib > numfibs - 1))
1450                                         errno = EINVAL;
1451                         }
1452                         if (errno)
1453                                 errx(EX_USAGE, "invalid fib number: %s", *argv);
1454                         break;
1455                 default:
1456                         usage(*argv);
1457                 }
1458         }
1459         error = set_sofib(fib);
1460         if (error)
1461                 errx(EX_USAGE, "invalid fib number: %d", fib);
1462
1463         verbose = 1;
1464         if (debugonly) {
1465                 interfaces();
1466                 exit(0);
1467         }
1468
1469 #ifdef SO_RERROR
1470         n = 1;
1471         if (setsockopt(s, SOL_SOCKET, SO_RERROR, &n, sizeof(n)) == -1)
1472                 warn("SO_RERROR");
1473 #endif
1474
1475         for (;;) {
1476                 time_t now;
1477                 n = read(s, msg, sizeof(msg));
1478                 if (n == -1) {
1479                         warn("read");
1480                         continue;
1481                 }
1482                 now = time(NULL);
1483                 (void)printf("\ngot message of size %d on %s", n, ctime(&now));
1484                 print_rtmsg((struct rt_msghdr *)(void *)msg, n);
1485         }
1486 }
1487
1488 static int
1489 rtmsg(int cmd, int flags, int fib)
1490 {
1491         int rlen;
1492         char *cp = m_rtmsg.m_space;
1493         int l;
1494
1495 #define NEXTADDR(w, u)                                                  \
1496         if (rtm_addrs & (w)) {                                          \
1497                 l = SA_SIZE(&(u));                                      \
1498                 memmove(cp, (char *)&(u), l);                           \
1499                 cp += l;                                                \
1500                 if (verbose)                                            \
1501                         sodump((struct sockaddr *)&(u), #w);            \
1502         }
1503
1504         errno = 0;
1505         memset(&m_rtmsg, 0, sizeof(m_rtmsg));
1506         if (cmd == 'a')
1507                 cmd = RTM_ADD;
1508         else if (cmd == 'c')
1509                 cmd = RTM_CHANGE;
1510         else if (cmd == 'g' || cmd == 's') {
1511                 cmd = RTM_GET;
1512                 if (so[RTAX_IFP].ss_family == 0) {
1513                         so[RTAX_IFP].ss_family = AF_LINK;
1514                         so[RTAX_IFP].ss_len = sizeof(struct sockaddr_dl);
1515                         rtm_addrs |= RTA_IFP;
1516                 }
1517         } else {
1518                 cmd = RTM_DELETE;
1519                 flags |= RTF_PINNED;
1520         }
1521 #define rtm m_rtmsg.m_rtm
1522         rtm.rtm_type = cmd;
1523         rtm.rtm_flags = flags;
1524         rtm.rtm_version = RTM_VERSION;
1525         rtm.rtm_seq = ++rtm_seq;
1526         rtm.rtm_addrs = rtm_addrs;
1527         rtm.rtm_rmx = rt_metrics;
1528         rtm.rtm_inits = rtm_inits;
1529
1530         NEXTADDR(RTA_DST, so[RTAX_DST]);
1531         NEXTADDR(RTA_GATEWAY, so[RTAX_GATEWAY]);
1532         NEXTADDR(RTA_NETMASK, so[RTAX_NETMASK]);
1533         NEXTADDR(RTA_GENMASK, so[RTAX_GENMASK]);
1534         NEXTADDR(RTA_IFP, so[RTAX_IFP]);
1535         NEXTADDR(RTA_IFA, so[RTAX_IFA]);
1536         rtm.rtm_msglen = l = cp - (char *)&m_rtmsg;
1537         if (verbose)
1538                 print_rtmsg(&rtm, l);
1539         if (debugonly)
1540                 return (0);
1541         if ((rlen = write(s, (char *)&m_rtmsg, l)) < 0) {
1542                 switch (errno) {
1543                 case EPERM:
1544                         err(1, "writing to routing socket");
1545                         break;
1546                 case ESRCH:
1547                         warnx("route has not been found");
1548                         break;
1549                 case EEXIST:
1550                         /* Handled by newroute() */
1551                         break;
1552                 default:
1553                         warn("writing to routing socket");
1554                 }
1555                 return (-1);
1556         }
1557         if (cmd == RTM_GET) {
1558                 stop_read = 0;
1559                 alarm(READ_TIMEOUT);
1560                 do {
1561                         l = read(s, (char *)&m_rtmsg, sizeof(m_rtmsg));
1562                 } while (l > 0 && stop_read == 0 &&
1563                     (rtm.rtm_type != RTM_GET || rtm.rtm_seq != rtm_seq ||
1564                         rtm.rtm_pid != pid));
1565                 if (stop_read != 0) {
1566                         warnx("read from routing socket timed out");
1567                         return (-1);
1568                 } else
1569                         alarm(0);
1570                 if (l < 0)
1571                         warn("read from routing socket");
1572                 else
1573                         print_getmsg(&rtm, l, fib);
1574         }
1575 #undef rtm
1576         return (0);
1577 }
1578
1579 static const char *const msgtypes[] = {
1580         "",
1581         "RTM_ADD: Add Route",
1582         "RTM_DELETE: Delete Route",
1583         "RTM_CHANGE: Change Metrics or flags",
1584         "RTM_GET: Report Metrics",
1585         "RTM_LOSING: Kernel Suspects Partitioning",
1586         "RTM_REDIRECT: Told to use different route",
1587         "RTM_MISS: Lookup failed on this address",
1588         "RTM_LOCK: fix specified metrics",
1589         "RTM_OLDADD: caused by SIOCADDRT",
1590         "RTM_OLDDEL: caused by SIOCDELRT",
1591         "RTM_RESOLVE: Route created by cloning",
1592         "RTM_NEWADDR: address being added to iface",
1593         "RTM_DELADDR: address being removed from iface",
1594         "RTM_IFINFO: iface status change",
1595         "RTM_NEWMADDR: new multicast group membership on iface",
1596         "RTM_DELMADDR: multicast group membership removed from iface",
1597         "RTM_IFANNOUNCE: interface arrival/departure",
1598         "RTM_IEEE80211: IEEE 802.11 wireless event",
1599 };
1600
1601 static const char metricnames[] =
1602     "\011weight\010rttvar\7rtt\6ssthresh\5sendpipe\4recvpipe\3expire"
1603     "\1mtu";
1604 static const char routeflags[] =
1605     "\1UP\2GATEWAY\3HOST\4REJECT\5DYNAMIC\6MODIFIED\7DONE"
1606     "\012XRESOLVE\013LLINFO\014STATIC\015BLACKHOLE"
1607     "\017PROTO2\020PROTO1\021PRCLONING\022WASCLONED\023PROTO3"
1608     "\024FIXEDMTU\025PINNED\026LOCAL\027BROADCAST\030MULTICAST\035STICKY";
1609 static const char ifnetflags[] =
1610     "\1UP\2BROADCAST\3DEBUG\4LOOPBACK\5PTP\6b6\7RUNNING\010NOARP"
1611     "\011PPROMISC\012ALLMULTI\013OACTIVE\014SIMPLEX\015LINK0\016LINK1"
1612     "\017LINK2\020MULTICAST";
1613 static const char addrnames[] =
1614     "\1DST\2GATEWAY\3NETMASK\4GENMASK\5IFP\6IFA\7AUTHOR\010BRD";
1615
1616 static const char errfmt[] =
1617     "\n%s: truncated route message, only %zu bytes left\n";
1618
1619 static void
1620 print_rtmsg(struct rt_msghdr *rtm, size_t msglen)
1621 {
1622         struct if_msghdr *ifm;
1623         struct ifa_msghdr *ifam;
1624 #ifdef RTM_NEWMADDR
1625         struct ifma_msghdr *ifmam;
1626 #endif
1627         struct if_announcemsghdr *ifan;
1628         const char *state;
1629
1630         if (verbose == 0)
1631                 return;
1632         if (rtm->rtm_version != RTM_VERSION) {
1633                 (void)printf("routing message version %d not understood\n",
1634                     rtm->rtm_version);
1635                 return;
1636         }
1637         if (rtm->rtm_type < nitems(msgtypes))
1638                 (void)printf("%s: ", msgtypes[rtm->rtm_type]);
1639         else
1640                 (void)printf("unknown type %d: ", rtm->rtm_type);
1641         (void)printf("len %d, ", rtm->rtm_msglen);
1642
1643 #define REQUIRE(x)      do {            \
1644         if (msglen < sizeof(x))         \
1645                 goto badlen;            \
1646         else                            \
1647                 msglen -= sizeof(x);    \
1648         } while (0)
1649
1650         switch (rtm->rtm_type) {
1651         case RTM_IFINFO:
1652                 REQUIRE(struct if_msghdr);
1653                 ifm = (struct if_msghdr *)rtm;
1654                 (void)printf("if# %d, ", ifm->ifm_index);
1655                 switch (ifm->ifm_data.ifi_link_state) {
1656                 case LINK_STATE_DOWN:
1657                         state = "down";
1658                         break;
1659                 case LINK_STATE_UP:
1660                         state = "up";
1661                         break;
1662                 default:
1663                         state = "unknown";
1664                         break;
1665                 }
1666                 (void)printf("link: %s, flags:", state);
1667                 printb(ifm->ifm_flags, ifnetflags);
1668                 pmsg_addrs((char *)(ifm + 1), ifm->ifm_addrs, msglen);
1669                 break;
1670         case RTM_NEWADDR:
1671         case RTM_DELADDR:
1672                 REQUIRE(struct ifa_msghdr);
1673                 ifam = (struct ifa_msghdr *)rtm;
1674                 (void)printf("metric %d, flags:", ifam->ifam_metric);
1675                 printb(ifam->ifam_flags, routeflags);
1676                 pmsg_addrs((char *)(ifam + 1), ifam->ifam_addrs, msglen);
1677                 break;
1678 #ifdef RTM_NEWMADDR
1679         case RTM_NEWMADDR:
1680         case RTM_DELMADDR:
1681                 REQUIRE(struct ifma_msghdr);
1682                 ifmam = (struct ifma_msghdr *)rtm;
1683                 pmsg_addrs((char *)(ifmam + 1), ifmam->ifmam_addrs, msglen);
1684                 break;
1685 #endif
1686         case RTM_IFANNOUNCE:
1687                 REQUIRE(struct if_announcemsghdr);
1688                 ifan = (struct if_announcemsghdr *)rtm;
1689                 (void)printf("if# %d, what: ", ifan->ifan_index);
1690                 switch (ifan->ifan_what) {
1691                 case IFAN_ARRIVAL:
1692                         (void)printf("arrival");
1693                         break;
1694                 case IFAN_DEPARTURE:
1695                         printf("departure");
1696                         break;
1697                 default:
1698                         printf("#%d", ifan->ifan_what);
1699                         break;
1700                 }
1701                 printf("\n");
1702                 fflush(stdout);
1703                 break;
1704
1705         default:
1706                 if (rtm->rtm_type <= RTM_RESOLVE) {
1707                         printf("pid: %ld, seq %d, errno %d, flags:",
1708                             (long)rtm->rtm_pid, rtm->rtm_seq, rtm->rtm_errno);
1709                         printb(rtm->rtm_flags, routeflags);
1710                         pmsg_common(rtm, msglen);
1711                 } else
1712                         printf("type: %u, len: %zu\n", rtm->rtm_type, msglen);
1713         }
1714
1715         return;
1716
1717 badlen:
1718         (void)printf(errfmt, __func__, msglen);
1719 #undef  REQUIRE
1720 }
1721
1722 static void
1723 print_getmsg(struct rt_msghdr *rtm, int msglen, int fib)
1724 {
1725         struct sockaddr *sp[RTAX_MAX];
1726         struct timespec ts;
1727         char *cp;
1728         int i;
1729
1730         memset(sp, 0, sizeof(sp));
1731         (void)printf("   route to: %s\n",
1732             routename((struct sockaddr *)&so[RTAX_DST]));
1733         if (rtm->rtm_version != RTM_VERSION) {
1734                 warnx("routing message version %d not understood",
1735                      rtm->rtm_version);
1736                 return;
1737         }
1738         if (rtm->rtm_msglen > msglen) {
1739                 warnx("message length mismatch, in packet %d, returned %d",
1740                       rtm->rtm_msglen, msglen);
1741                 return;
1742         }
1743         if (rtm->rtm_errno)  {
1744                 errno = rtm->rtm_errno;
1745                 warn("message indicates error %d", errno);
1746                 return;
1747         }
1748         cp = ((char *)(rtm + 1));
1749         for (i = 0; i < RTAX_MAX; i++)
1750                 if (rtm->rtm_addrs & (1 << i)) {
1751                         sp[i] = (struct sockaddr *)cp;
1752                         cp += SA_SIZE((struct sockaddr *)cp);
1753                 }
1754         if ((rtm->rtm_addrs & RTA_IFP) &&
1755             (sp[RTAX_IFP]->sa_family != AF_LINK ||
1756              ((struct sockaddr_dl *)(void *)sp[RTAX_IFP])->sdl_nlen == 0))
1757                         sp[RTAX_IFP] = NULL;
1758         if (sp[RTAX_DST])
1759                 (void)printf("destination: %s\n", routename(sp[RTAX_DST]));
1760         if (sp[RTAX_NETMASK])
1761                 (void)printf("       mask: %s\n", routename(sp[RTAX_NETMASK]));
1762         if (sp[RTAX_GATEWAY] && (rtm->rtm_flags & RTF_GATEWAY))
1763                 (void)printf("    gateway: %s\n", routename(sp[RTAX_GATEWAY]));
1764         if (fib >= 0)
1765                 (void)printf("        fib: %u\n", (unsigned int)fib);
1766         if (sp[RTAX_IFP])
1767                 (void)printf("  interface: %.*s\n",
1768                     ((struct sockaddr_dl *)(void *)sp[RTAX_IFP])->sdl_nlen,
1769                     ((struct sockaddr_dl *)(void *)sp[RTAX_IFP])->sdl_data);
1770         (void)printf("      flags: ");
1771         printb(rtm->rtm_flags, routeflags);
1772
1773 #define lock(f) ((rtm->rtm_rmx.rmx_locks & __CONCAT(RTV_,f)) ? 'L' : ' ')
1774 #define msec(u) (((u) + 500) / 1000)            /* usec to msec */
1775         printf("\n%9s %9s %9s %9s %9s %10s %9s\n", "recvpipe",
1776             "sendpipe", "ssthresh", "rtt,msec", "mtu   ", "weight", "expire");
1777         printf("%8lu%c ", rtm->rtm_rmx.rmx_recvpipe, lock(RPIPE));
1778         printf("%8lu%c ", rtm->rtm_rmx.rmx_sendpipe, lock(SPIPE));
1779         printf("%8lu%c ", rtm->rtm_rmx.rmx_ssthresh, lock(SSTHRESH));
1780         printf("%8lu%c ", msec(rtm->rtm_rmx.rmx_rtt), lock(RTT));
1781         printf("%8lu%c ", rtm->rtm_rmx.rmx_mtu, lock(MTU));
1782         printf("%8lu%c ", rtm->rtm_rmx.rmx_weight, lock(WEIGHT));
1783         if (rtm->rtm_rmx.rmx_expire > 0)
1784                 clock_gettime(CLOCK_REALTIME_FAST, &ts);
1785         else
1786                 ts.tv_sec = 0;
1787         printf("%8ld%c\n", (long)(rtm->rtm_rmx.rmx_expire - ts.tv_sec),
1788             lock(EXPIRE));
1789 #undef lock
1790 #undef msec
1791 #define RTA_IGN (RTA_DST|RTA_GATEWAY|RTA_NETMASK|RTA_IFP|RTA_IFA|RTA_BRD)
1792         if (verbose)
1793                 pmsg_common(rtm, msglen);
1794         else if (rtm->rtm_addrs &~ RTA_IGN) {
1795                 (void)printf("sockaddrs: ");
1796                 printb(rtm->rtm_addrs, addrnames);
1797                 putchar('\n');
1798         }
1799 #undef  RTA_IGN
1800 }
1801
1802 static void
1803 pmsg_common(struct rt_msghdr *rtm, size_t msglen)
1804 {
1805
1806         (void)printf("\nlocks: ");
1807         printb(rtm->rtm_rmx.rmx_locks, metricnames);
1808         (void)printf(" inits: ");
1809         printb(rtm->rtm_inits, metricnames);
1810         if (msglen > sizeof(struct rt_msghdr))
1811                 pmsg_addrs(((char *)(rtm + 1)), rtm->rtm_addrs,
1812                     msglen - sizeof(struct rt_msghdr));
1813         else
1814                 (void)fflush(stdout);
1815 }
1816
1817 static void
1818 pmsg_addrs(char *cp, int addrs, size_t len)
1819 {
1820         struct sockaddr *sa;
1821         int i;
1822
1823         if (addrs == 0) {
1824                 (void)putchar('\n');
1825                 return;
1826         }
1827         (void)printf("\nsockaddrs: ");
1828         printb(addrs, addrnames);
1829         putchar('\n');
1830         for (i = 0; i < RTAX_MAX; i++)
1831                 if (addrs & (1 << i)) {
1832                         sa = (struct sockaddr *)cp;
1833                         if (len == 0 || len < SA_SIZE(sa)) {
1834                                 (void)printf(errfmt, __func__, len);
1835                                 break;
1836                         }
1837                         (void)printf(" %s", routename(sa));
1838                         len -= SA_SIZE(sa);
1839                         cp += SA_SIZE(sa);
1840                 }
1841         (void)putchar('\n');
1842         (void)fflush(stdout);
1843 }
1844
1845 static void
1846 printb(int b, const char *str)
1847 {
1848         int i;
1849         int gotsome = 0;
1850
1851         if (b == 0)
1852                 return;
1853         while ((i = *str++) != 0) {
1854                 if (b & (1 << (i-1))) {
1855                         if (gotsome == 0)
1856                                 i = '<';
1857                         else
1858                                 i = ',';
1859                         putchar(i);
1860                         gotsome = 1;
1861                         for (; (i = *str) > 32; str++)
1862                                 putchar(i);
1863                 } else
1864                         while (*str > 32)
1865                                 str++;
1866         }
1867         if (gotsome)
1868                 putchar('>');
1869 }
1870
1871 int
1872 keyword(const char *cp)
1873 {
1874         const struct keytab *kt = keywords;
1875
1876         while (kt->kt_cp != NULL && strcmp(kt->kt_cp, cp) != 0)
1877                 kt++;
1878         return (kt->kt_i);
1879 }
1880
1881 static void
1882 sodump(struct sockaddr *sa, const char *which)
1883 {
1884 #ifdef INET6
1885         char nbuf[INET6_ADDRSTRLEN];
1886 #endif
1887
1888         switch (sa->sa_family) {
1889         case AF_LINK:
1890                 (void)printf("%s: link %s; ", which,
1891                     link_ntoa((struct sockaddr_dl *)(void *)sa));
1892                 break;
1893 #ifdef INET
1894         case AF_INET:
1895                 (void)printf("%s: inet %s; ", which,
1896                     inet_ntoa(((struct sockaddr_in *)(void *)sa)->sin_addr));
1897                 break;
1898 #endif
1899 #ifdef INET6
1900         case AF_INET6:
1901                 (void)printf("%s: inet6 %s; ", which, inet_ntop(sa->sa_family,
1902                     &((struct sockaddr_in6 *)(void *)sa)->sin6_addr, nbuf,
1903                     sizeof(nbuf)));
1904                 break;
1905 #endif
1906         }
1907         (void)fflush(stdout);
1908 }
1909
1910 /* States*/
1911 #define VIRGIN  0
1912 #define GOTONE  1
1913 #define GOTTWO  2
1914 /* Inputs */
1915 #define DIGIT   (4*0)
1916 #define END     (4*1)
1917 #define DELIM   (4*2)
1918
1919 static void
1920 sockaddr(char *addr, struct sockaddr *sa, size_t size)
1921 {
1922         char *cp = (char *)sa;
1923         char *cplim = cp + size;
1924         int byte = 0, state = VIRGIN, new = 0 /* foil gcc */;
1925
1926         memset(cp, 0, size);
1927         cp++;
1928         do {
1929                 if ((*addr >= '0') && (*addr <= '9')) {
1930                         new = *addr - '0';
1931                 } else if ((*addr >= 'a') && (*addr <= 'f')) {
1932                         new = *addr - 'a' + 10;
1933                 } else if ((*addr >= 'A') && (*addr <= 'F')) {
1934                         new = *addr - 'A' + 10;
1935                 } else if (*addr == '\0')
1936                         state |= END;
1937                 else
1938                         state |= DELIM;
1939                 addr++;
1940                 switch (state /* | INPUT */) {
1941                 case GOTTWO | DIGIT:
1942                         *cp++ = byte; /*FALLTHROUGH*/
1943                 case VIRGIN | DIGIT:
1944                         state = GOTONE; byte = new; continue;
1945                 case GOTONE | DIGIT:
1946                         state = GOTTWO; byte = new + (byte << 4); continue;
1947                 default: /* | DELIM */
1948                         state = VIRGIN; *cp++ = byte; byte = 0; continue;
1949                 case GOTONE | END:
1950                 case GOTTWO | END:
1951                         *cp++ = byte; /* FALLTHROUGH */
1952                 case VIRGIN | END:
1953                         break;
1954                 }
1955                 break;
1956         } while (cp < cplim);
1957         sa->sa_len = cp - (char *)sa;
1958 }