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