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