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