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