]> CyberLeo.Net >> Repos - FreeBSD/releng/9.2.git/blob - sbin/route/route.c
- Copy stable/9 to releng/9.2 as part of the 9.2-RELEASE cycle.
[FreeBSD/releng/9.2.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                                 gateway = *argv;
899                                 break;
900                         case K_DST:
901                                 if (!--argc)
902                                         usage(NULL);
903                                 if (getaddr(RTA_DST, *++argv, &hp, nrflags))
904                                         nrflags |= F_ISHOST;
905                                 dest = *argv;
906                                 break;
907                         case K_NETMASK:
908                                 if (!--argc)
909                                         usage(NULL);
910                                 getaddr(RTA_NETMASK, *++argv, 0, nrflags);
911                                 /* FALLTHROUGH */
912                         case K_NET:
913                                 nrflags |= F_FORCENET;
914                                 break;
915                         case K_PREFIXLEN:
916                                 if (!--argc)
917                                         usage(NULL);
918                                 if (prefixlen(*++argv) == -1) {
919                                         nrflags &= ~F_FORCENET;
920                                         nrflags |= F_ISHOST;
921                                 } else {
922                                         nrflags |= F_FORCENET;
923                                         nrflags &= ~F_ISHOST;
924                                 }
925                                 break;
926                         case K_MTU:
927                         case K_HOPCOUNT:
928                         case K_EXPIRE:
929                         case K_RECVPIPE:
930                         case K_SENDPIPE:
931                         case K_SSTHRESH:
932                         case K_RTT:
933                         case K_RTTVAR:
934                         case K_WEIGHT:
935                                 if (!--argc)
936                                         usage(NULL);
937                                 set_metric(*++argv, key);
938                                 break;
939                         default:
940                                 usage(1+*argv);
941                         }
942                 } else {
943                         if ((rtm_addrs & RTA_DST) == 0) {
944                                 dest = *argv;
945                                 if (getaddr(RTA_DST, *argv, &hp, nrflags))
946                                         nrflags |= F_ISHOST;
947                         } else if ((rtm_addrs & RTA_GATEWAY) == 0) {
948                                 gateway = *argv;
949                                 getaddr(RTA_GATEWAY, *argv, &hp, nrflags);
950                         } else {
951                                 getaddr(RTA_NETMASK, *argv, 0, nrflags);
952                                 nrflags |= F_FORCENET;
953                         }
954                 }
955         }
956
957         if (nrflags & F_FORCEHOST) {
958                 nrflags |= F_ISHOST;
959 #ifdef INET6
960                 if (af == AF_INET6) {
961                         rtm_addrs &= ~RTA_NETMASK;
962                         memset((void *)&so_mask, 0, sizeof(so_mask));
963                 }
964 #endif
965         }
966         if (nrflags & F_FORCENET)
967                 nrflags &= ~F_ISHOST;
968         flags |= RTF_UP;
969         if (nrflags & F_ISHOST)
970                 flags |= RTF_HOST;
971         if ((nrflags & F_INTERFACE) == 0)
972                 flags |= RTF_GATEWAY;
973         if (nrflags & F_PROXY) {
974                 so_dst.sinarp.sin_other = SIN_PROXY;
975                 flags |= RTF_ANNOUNCE;
976         }
977         if (dest == NULL)
978                 dest = "";
979         if (gateway == NULL)
980                 gateway = "";
981
982         if (TAILQ_EMPTY(&fibl_head)) {
983                 error = fiboptlist_csv("default", &fibl_head);
984                 if (error)
985                         errx(EX_OSERR, "fiboptlist_csv failed.");
986         }
987         error = 0;
988         TAILQ_FOREACH(fl, &fibl_head, fl_next) {
989                 fl->fl_error = newroute_fib(fl->fl_num, cmd, flags);
990                 if (fl->fl_error)
991                         fl->fl_errno = errno;
992                 error += fl->fl_error;
993         }
994         if (*cmd == 'g' || *cmd == 's')
995                 exit(error);
996
997         error = 0;
998         if (!qflag) {
999                 fibnum = 0;
1000                 TAILQ_FOREACH(fl, &fibl_head, fl_next) {
1001                         if (fl->fl_error == 0)
1002                                 fibnum++;
1003                 }
1004                 if (fibnum > 0) {
1005                         int firstfib = 1;
1006
1007                         printf("%s %s %s", cmd,
1008                             (nrflags & F_ISHOST) ? "host" : "net", dest);
1009                         if (*gateway)
1010                                 printf(": gateway %s", gateway);
1011
1012                         if (numfibs > 1) {
1013                                 TAILQ_FOREACH(fl, &fibl_head, fl_next) {
1014                                         if (fl->fl_error == 0
1015                                             && fl->fl_num >= 0) {
1016                                                 if (firstfib) {
1017                                                         printf(" fib ");
1018                                                         firstfib = 0;
1019                                                 }
1020                                                 printf("%d", fl->fl_num);
1021                                                 if (fibnum-- > 1)
1022                                                         printf(",");
1023                                         }
1024                                 }
1025                         }
1026                         printf("\n");
1027                 }
1028
1029                 fibnum = 0;
1030                 TAILQ_FOREACH(fl, &fibl_head, fl_next) {
1031                         if (fl->fl_error != 0) {
1032                                 printf("%s %s %s", cmd, (nrflags & F_ISHOST)
1033                                     ? "host" : "net", dest);
1034                                 if (*gateway)
1035                                         printf(": gateway %s", gateway);
1036
1037                                 if (fl->fl_num >= 0)
1038                                         printf(" fib %d", fl->fl_num);
1039
1040                                 switch (fl->fl_errno) {
1041                                 case ESRCH:
1042                                         errmsg = "not in table";
1043                                         break;
1044                                 case EBUSY:
1045                                         errmsg = "entry in use";
1046                                         break;
1047                                 case ENOBUFS:
1048                                         errmsg = "not enough memory";
1049                                         break;
1050                                 case EADDRINUSE:
1051                                         /*
1052                                          * handle recursion avoidance
1053                                          * in rt_setgate()
1054                                          */
1055                                         errmsg = "gateway uses the same route";
1056                                         break;
1057                                 case EEXIST:
1058                                         errmsg = "route already in table";
1059                                         break;
1060                                 default:
1061                                         errmsg = strerror(fl->fl_errno);
1062                                         break;
1063                                 }
1064                                 printf(": %s\n", errmsg);
1065                                 error = 1;
1066                         }
1067                 }
1068         }
1069         exit(error);
1070 }
1071
1072 static int
1073 newroute_fib(int fib, char *cmd, int flags)
1074 {
1075         int error;
1076
1077         error = set_sofib(fib);
1078         if (error) {
1079                 warn("fib number %d is ignored", fib);
1080                 return (error);
1081         }
1082
1083         error = rtmsg(*cmd, flags, fib);
1084         return (error);
1085 }
1086
1087 static void
1088 inet_makenetandmask(u_long net, struct sockaddr_in *sin, u_long bits)
1089 {
1090         u_long addr, mask = 0;
1091         char *cp;
1092
1093         rtm_addrs |= RTA_NETMASK;
1094         /*
1095          * XXX: This approach unable to handle 0.0.0.1/32 correctly
1096          * as inet_network() converts 0.0.0.1 and 1 equally.
1097          */
1098         if (net <= 0xff)
1099                 addr = net << IN_CLASSA_NSHIFT;
1100         else if (net <= 0xffff)
1101                 addr = net << IN_CLASSB_NSHIFT;
1102         else if (net <= 0xffffff)
1103                 addr = net << IN_CLASSC_NSHIFT;
1104         else
1105                 addr = net;
1106         /*
1107          * If no /xx was specified we must calculate the
1108          * CIDR address.
1109          */
1110         if ((bits == 0)  && (addr != 0)) {
1111                 u_long i, j;
1112                 for(i=0,j=0xff; i<4; i++)  {
1113                         if (addr & j) {
1114                                 break;
1115                         }
1116                         j <<= 8;
1117                 }
1118                 /* i holds the first non zero bit */
1119                 bits = 32 - (i*8);      
1120         }
1121         if (bits != 0)
1122                 mask = 0xffffffff << (32 - bits);
1123
1124         sin->sin_addr.s_addr = htonl(addr);
1125         sin = &so_mask.sin;
1126         sin->sin_addr.s_addr = htonl(mask);
1127         sin->sin_len = 0;
1128         sin->sin_family = 0;
1129         cp = (char *)(&sin->sin_addr + 1);
1130         while (*--cp == 0 && cp > (char *)sin)
1131                 ;
1132         sin->sin_len = 1 + cp - (char *)sin;
1133 }
1134
1135 #ifdef INET6
1136 /*
1137  * XXX the function may need more improvement...
1138  */
1139 static int
1140 inet6_makenetandmask(struct sockaddr_in6 *sin6, const char *plen)
1141 {
1142         struct in6_addr in6;
1143
1144         if (plen == NULL) {
1145                 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr) &&
1146                     sin6->sin6_scope_id == 0) {
1147                         plen = "0";
1148                 } else if ((sin6->sin6_addr.s6_addr[0] & 0xe0) == 0x20) {
1149                         /* aggregatable global unicast - RFC2374 */
1150                         memset(&in6, 0, sizeof(in6));
1151                         if (!memcmp(&sin6->sin6_addr.s6_addr[8],
1152                                     &in6.s6_addr[8], 8))
1153                                 plen = "64";
1154                 }
1155         }
1156
1157         if (plen == NULL || strcmp(plen, "128") == 0)
1158                 return (1);
1159         rtm_addrs |= RTA_NETMASK;
1160         prefixlen(plen);
1161         return (0);
1162 }
1163 #endif
1164
1165 /*
1166  * Interpret an argument as a network address of some kind,
1167  * returning 1 if a host address, 0 if a network address.
1168  */
1169 static int
1170 getaddr(int which, char *str, struct hostent **hpp, int nrflags)
1171 {
1172         sup su;
1173         struct hostent *hp;
1174         struct netent *np;
1175         u_long val;
1176         char *q;
1177         int afamily;  /* local copy of af so we can change it */
1178
1179         if (af == 0) {
1180                 af = AF_INET;
1181                 aflen = sizeof(struct sockaddr_in);
1182         }
1183         afamily = af;
1184         rtm_addrs |= which;
1185         switch (which) {
1186         case RTA_DST:
1187                 su = &so_dst;
1188                 break;
1189         case RTA_GATEWAY:
1190                 su = &so_gate;
1191                 if (nrflags & F_INTERFACE) {
1192                         struct ifaddrs *ifap, *ifa;
1193                         struct sockaddr_dl *sdl = NULL;
1194
1195                         if (getifaddrs(&ifap))
1196                                 err(1, "getifaddrs");
1197
1198                         for (ifa = ifap; ifa != NULL; ifa = ifa->ifa_next) {
1199                                 if (ifa->ifa_addr->sa_family != AF_LINK)
1200                                         continue;
1201
1202                                 if (strcmp(str, ifa->ifa_name) != 0)
1203                                         continue;
1204
1205                                 sdl = (struct sockaddr_dl *)ifa->ifa_addr;
1206                         }
1207                         /* If we found it, then use it */
1208                         if (sdl != NULL) {
1209                                 /*
1210                                  * Copy is safe since we have a
1211                                  * sockaddr_storage member in sockunion{}.
1212                                  * Note that we need to copy before calling
1213                                  * freeifaddrs().
1214                                  */
1215                                 memcpy(&su->sdl, sdl, sdl->sdl_len);
1216                         }
1217                         freeifaddrs(ifap);
1218                         if (sdl != NULL)
1219                                 return(1);
1220                 }
1221                 break;
1222         case RTA_NETMASK:
1223                 su = &so_mask;
1224                 break;
1225         case RTA_GENMASK:
1226                 su = &so_genmask;
1227                 break;
1228         case RTA_IFP:
1229                 su = &so_ifp;
1230                 afamily = AF_LINK;
1231                 break;
1232         case RTA_IFA:
1233                 su = &so_ifa;
1234                 break;
1235         default:
1236                 usage("internal error");
1237                 /*NOTREACHED*/
1238         }
1239         su->sa.sa_len = aflen;
1240         su->sa.sa_family = afamily; /* cases that don't want it have left already */
1241         if (strcmp(str, "default") == 0) {
1242                 /*
1243                  * Default is net 0.0.0.0/0
1244                  */
1245                 switch (which) {
1246                 case RTA_DST:
1247                         forcenet++;
1248 #if 0
1249                         bzero(su, sizeof(*su)); /* for readability */
1250 #endif
1251                         getaddr(RTA_NETMASK, str, 0, nrflags);
1252                         break;
1253 #if 0
1254                 case RTA_NETMASK:
1255                 case RTA_GENMASK:
1256                         bzero(su, sizeof(*su)); /* for readability */
1257 #endif
1258                 }
1259                 return (0);
1260         }
1261         switch (afamily) {
1262 #ifdef INET6
1263         case AF_INET6:
1264         {
1265                 struct addrinfo hints, *res;
1266                 int ecode;
1267
1268                 q = NULL;
1269                 if (which == RTA_DST && (q = strchr(str, '/')) != NULL)
1270                         *q = '\0';
1271                 memset(&hints, 0, sizeof(hints));
1272                 hints.ai_family = afamily;      /*AF_INET6*/
1273                 hints.ai_socktype = SOCK_DGRAM;         /*dummy*/
1274                 ecode = getaddrinfo(str, NULL, &hints, &res);
1275                 if (ecode != 0 || res->ai_family != AF_INET6 ||
1276                     res->ai_addrlen != sizeof(su->sin6)) {
1277                         (void) fprintf(stderr, "%s: %s\n", str,
1278                             gai_strerror(ecode));
1279                         exit(1);
1280                 }
1281                 memcpy(&su->sin6, res->ai_addr, sizeof(su->sin6));
1282 #ifdef __KAME__
1283                 if ((IN6_IS_ADDR_LINKLOCAL(&su->sin6.sin6_addr) ||
1284                      IN6_IS_ADDR_MC_LINKLOCAL(&su->sin6.sin6_addr) ||
1285                      IN6_IS_ADDR_MC_NODELOCAL(&su->sin6.sin6_addr)) &&
1286                     su->sin6.sin6_scope_id) {
1287                         *(u_int16_t *)&su->sin6.sin6_addr.s6_addr[2] =
1288                                 htons(su->sin6.sin6_scope_id);
1289                         su->sin6.sin6_scope_id = 0;
1290                 }
1291 #endif
1292                 freeaddrinfo(res);
1293                 if (q != NULL)
1294                         *q++ = '/';
1295                 if (which == RTA_DST)
1296                         return (inet6_makenetandmask(&su->sin6, q));
1297                 return (0);
1298         }
1299 #endif /* INET6 */
1300
1301         case AF_APPLETALK:
1302                 if (!atalk_aton(str, &su->sat.sat_addr))
1303                         errx(EX_NOHOST, "bad address: %s", str);
1304                 rtm_addrs |= RTA_NETMASK;
1305                 return(forcehost || su->sat.sat_addr.s_node != 0);
1306
1307         case AF_LINK:
1308                 link_addr(str, &su->sdl);
1309                 return (1);
1310
1311
1312         case PF_ROUTE:
1313                 su->sa.sa_len = sizeof(*su);
1314                 sockaddr(str, &su->sa);
1315                 return (1);
1316
1317         case AF_INET:
1318         default:
1319                 break;
1320         }
1321
1322         if (hpp == NULL)
1323                 hpp = &hp;
1324         *hpp = NULL;
1325
1326         q = strchr(str,'/');
1327         if (q != NULL && which == RTA_DST) {
1328                 *q = '\0';
1329                 if ((val = inet_network(str)) != INADDR_NONE) {
1330                         inet_makenetandmask(
1331                                 val, &su->sin, strtoul(q+1, 0, 0));
1332                         return (0);
1333                 }
1334                 *q = '/';
1335         }
1336         if ((which != RTA_DST || forcenet == 0) &&
1337             inet_aton(str, &su->sin.sin_addr)) {
1338                 val = su->sin.sin_addr.s_addr;
1339                 if (which != RTA_DST || forcehost ||
1340                     inet_lnaof(su->sin.sin_addr) != INADDR_ANY)
1341                         return (1);
1342                 else {
1343                         val = ntohl(val);
1344                         goto netdone;
1345                 }
1346         }
1347         if (which == RTA_DST && forcehost == 0 &&
1348             ((val = inet_network(str)) != INADDR_NONE ||
1349             ((np = getnetbyname(str)) != NULL && (val = np->n_net) != 0))) {
1350 netdone:
1351                 inet_makenetandmask(val, &su->sin, 0);
1352                 return (0);
1353         }
1354         hp = gethostbyname(str);
1355         if (hp != NULL) {
1356                 *hpp = hp;
1357                 su->sin.sin_family = hp->h_addrtype;
1358                 memmove((char *)&su->sin.sin_addr, hp->h_addr,
1359                     MIN((size_t)hp->h_length, sizeof(su->sin.sin_addr)));
1360                 return (1);
1361         }
1362         errx(EX_NOHOST, "bad address: %s", str);
1363 }
1364
1365 static int
1366 prefixlen(const char *str)
1367 {
1368         int len = atoi(str), q, r;
1369         int max;
1370         char *p;
1371
1372         rtm_addrs |= RTA_NETMASK;       
1373         switch (af) {
1374 #ifdef INET6
1375         case AF_INET6:
1376                 max = 128;
1377                 p = (char *)&so_mask.sin6.sin6_addr;
1378                 break;
1379 #endif
1380         case AF_INET:
1381                 max = 32;
1382                 p = (char *)&so_mask.sin.sin_addr;
1383                 break;
1384         default:
1385                 fprintf(stderr, "prefixlen not supported in this af\n");
1386                 exit(1);
1387         }
1388
1389         if (len < 0 || max < len) {
1390                 fprintf(stderr, "%s: bad value\n", str);
1391                 exit(1);
1392         }
1393         
1394         q = len >> 3;
1395         r = len & 7;
1396         so_mask.sa.sa_family = af;
1397         so_mask.sa.sa_len = aflen;
1398         memset((void *)p, 0, max / 8);
1399         if (q > 0)
1400                 memset((void *)p, 0xff, q);
1401         if (r > 0)
1402                 *((u_char *)p + q) = (0xff00 >> r) & 0xff;
1403         if (len == max)
1404                 return (-1);
1405         else
1406                 return (len);
1407 }
1408
1409 static void
1410 interfaces(void)
1411 {
1412         size_t needed;
1413         int mib[6];
1414         char *buf, *lim, *next, count = 0;
1415         struct rt_msghdr *rtm;
1416
1417 retry2:
1418         mib[0] = CTL_NET;
1419         mib[1] = PF_ROUTE;
1420         mib[2] = 0;             /* protocol */
1421         mib[3] = 0;             /* wildcard address family */
1422         mib[4] = NET_RT_IFLIST;
1423         mib[5] = 0;             /* no flags */
1424         if (sysctl(mib, 6, NULL, &needed, NULL, 0) < 0)
1425                 err(EX_OSERR, "route-sysctl-estimate");
1426         if ((buf = malloc(needed)) == NULL)
1427                 errx(EX_OSERR, "malloc failed");
1428         if (sysctl(mib, 6, buf, &needed, NULL, 0) < 0) {
1429                 if (errno == ENOMEM && count++ < 10) {
1430                         warnx("Routing table grew, retrying");
1431                         sleep(1);
1432                         free(buf);
1433                         goto retry2;
1434                 }
1435                 err(EX_OSERR, "actual retrieval of interface table");
1436         }
1437         lim = buf + needed;
1438         for (next = buf; next < lim; next += rtm->rtm_msglen) {
1439                 rtm = (struct rt_msghdr *)next;
1440                 print_rtmsg(rtm, rtm->rtm_msglen);
1441         }
1442 }
1443
1444 static void
1445 monitor(int argc, char *argv[])
1446 {
1447         int n, fib, error;
1448         char msg[2048], *endptr;
1449
1450         fib = defaultfib;
1451         while (argc > 1) {
1452                 argc--;
1453                 argv++;
1454                 if (**argv != '-')
1455                         usage(*argv);
1456                 switch (keyword(*argv + 1)) {
1457                 case K_FIB:
1458                         if (!--argc)
1459                                 usage(*argv);
1460                         errno = 0;
1461                         fib = strtol(*++argv, &endptr, 0);
1462                         if (errno == 0) {
1463                                 if (*endptr != '\0' ||
1464                                     fib < 0 ||
1465                                     (numfibs != -1 && fib > numfibs - 1))
1466                                         errno = EINVAL;
1467                         }
1468                         if (errno)
1469                                 errx(EX_USAGE, "invalid fib number: %s", *argv);
1470                         break;
1471                 default:
1472                         usage(*argv);
1473                 }
1474         }
1475         error = set_sofib(fib);
1476         if (error)
1477                 errx(EX_USAGE, "invalid fib number: %d", fib);
1478
1479         verbose = 1;
1480         if (debugonly) {
1481                 interfaces();
1482                 exit(0);
1483         }
1484         for (;;) {
1485                 time_t now;
1486                 n = read(s, msg, 2048);
1487                 now = time(NULL);
1488                 (void) printf("\ngot message of size %d on %s", n, ctime(&now));
1489                 print_rtmsg((struct rt_msghdr *)msg, n);
1490         }
1491 }
1492
1493 struct {
1494         struct  rt_msghdr m_rtm;
1495         char    m_space[512];
1496 } m_rtmsg;
1497
1498 static int
1499 rtmsg(int cmd, int flags, int fib)
1500 {
1501         static int seq;
1502         int rlen;
1503         char *cp = m_rtmsg.m_space;
1504         int l;
1505
1506 #define NEXTADDR(w, u) \
1507         if (rtm_addrs & (w)) {\
1508             l = SA_SIZE(&(u.sa)); memmove(cp, &(u), l); cp += l;\
1509             if (verbose) sodump(&(u),#u);\
1510         }
1511
1512         errno = 0;
1513         memset(&m_rtmsg, 0, sizeof(m_rtmsg));
1514         if (cmd == 'a')
1515                 cmd = RTM_ADD;
1516         else if (cmd == 'c')
1517                 cmd = RTM_CHANGE;
1518         else if (cmd == 'g' || cmd == 's') {
1519                 cmd = RTM_GET;
1520                 if (so_ifp.sa.sa_family == 0) {
1521                         so_ifp.sa.sa_family = AF_LINK;
1522                         so_ifp.sa.sa_len = sizeof(struct sockaddr_dl);
1523                         rtm_addrs |= RTA_IFP;
1524                 }
1525         } else
1526                 cmd = RTM_DELETE;
1527 #define rtm m_rtmsg.m_rtm
1528         rtm.rtm_type = cmd;
1529         rtm.rtm_flags = flags;
1530         rtm.rtm_version = RTM_VERSION;
1531         rtm.rtm_seq = ++seq;
1532         rtm.rtm_addrs = rtm_addrs;
1533         rtm.rtm_rmx = rt_metrics;
1534         rtm.rtm_inits = rtm_inits;
1535
1536         if (rtm_addrs & RTA_NETMASK)
1537                 mask_addr();
1538         NEXTADDR(RTA_DST, so_dst);
1539         NEXTADDR(RTA_GATEWAY, so_gate);
1540         NEXTADDR(RTA_NETMASK, so_mask);
1541         NEXTADDR(RTA_GENMASK, so_genmask);
1542         NEXTADDR(RTA_IFP, so_ifp);
1543         NEXTADDR(RTA_IFA, so_ifa);
1544         rtm.rtm_msglen = l = cp - (char *)&m_rtmsg;
1545         if (verbose)
1546                 print_rtmsg(&rtm, l);
1547         if (debugonly)
1548                 return (0);
1549         if ((rlen = write(s, (char *)&m_rtmsg, l)) < 0) {
1550                 if (errno == EPERM)
1551                         err(1, "writing to routing socket");
1552                 warn("writing to routing socket");
1553                 return (-1);
1554         }
1555         if (cmd == RTM_GET) {
1556                 do {
1557                         l = read(s, (char *)&m_rtmsg, sizeof(m_rtmsg));
1558                 } while (l > 0 && (rtm.rtm_seq != seq || rtm.rtm_pid != pid));
1559                 if (l < 0)
1560                         warn("read from routing socket");
1561                 else
1562                         print_getmsg(&rtm, l, fib);
1563         }
1564 #undef rtm
1565         return (0);
1566 }
1567
1568 static void
1569 mask_addr(void)
1570 {
1571         int olen = so_mask.sa.sa_len;
1572         char *cp1 = olen + (char *)&so_mask, *cp2;
1573
1574         for (so_mask.sa.sa_len = 0; cp1 > (char *)&so_mask; )
1575                 if (*--cp1 != 0) {
1576                         so_mask.sa.sa_len = 1 + cp1 - (char *)&so_mask;
1577                         break;
1578                 }
1579         if ((rtm_addrs & RTA_DST) == 0)
1580                 return;
1581         switch (so_dst.sa.sa_family) {
1582         case AF_INET:
1583 #ifdef INET6
1584         case AF_INET6:
1585 #endif
1586         case AF_APPLETALK:
1587         case 0:
1588                 return;
1589         }
1590         cp1 = so_mask.sa.sa_len + 1 + (char *)&so_dst;
1591         cp2 = so_dst.sa.sa_len + 1 + (char *)&so_dst;
1592         while (cp2 > cp1)
1593                 *--cp2 = 0;
1594         cp2 = so_mask.sa.sa_len + 1 + (char *)&so_mask;
1595         while (cp1 > so_dst.sa.sa_data)
1596                 *--cp1 &= *--cp2;
1597 }
1598
1599 const char *msgtypes[] = {
1600         "",
1601         "RTM_ADD: Add Route",
1602         "RTM_DELETE: Delete Route",
1603         "RTM_CHANGE: Change Metrics or flags",
1604         "RTM_GET: Report Metrics",
1605         "RTM_LOSING: Kernel Suspects Partitioning",
1606         "RTM_REDIRECT: Told to use different route",
1607         "RTM_MISS: Lookup failed on this address",
1608         "RTM_LOCK: fix specified metrics",
1609         "RTM_OLDADD: caused by SIOCADDRT",
1610         "RTM_OLDDEL: caused by SIOCDELRT",
1611         "RTM_RESOLVE: Route created by cloning",
1612         "RTM_NEWADDR: address being added to iface",
1613         "RTM_DELADDR: address being removed from iface",
1614         "RTM_IFINFO: iface status change",
1615         "RTM_NEWMADDR: new multicast group membership on iface",
1616         "RTM_DELMADDR: multicast group membership removed from iface",
1617         "RTM_IFANNOUNCE: interface arrival/departure",
1618         "RTM_IEEE80211: IEEE 802.11 wireless event",
1619 };
1620
1621 char metricnames[] =
1622 "\011weight\010rttvar\7rtt\6ssthresh\5sendpipe\4recvpipe\3expire"
1623 "\1mtu";
1624 char routeflags[] =
1625 "\1UP\2GATEWAY\3HOST\4REJECT\5DYNAMIC\6MODIFIED\7DONE"
1626 "\012XRESOLVE\013LLINFO\014STATIC\015BLACKHOLE"
1627 "\017PROTO2\020PROTO1\021PRCLONING\022WASCLONED\023PROTO3"
1628 "\025PINNED\026LOCAL\027BROADCAST\030MULTICAST\035STICKY";
1629 char ifnetflags[] =
1630 "\1UP\2BROADCAST\3DEBUG\4LOOPBACK\5PTP\6b6\7RUNNING\010NOARP"
1631 "\011PPROMISC\012ALLMULTI\013OACTIVE\014SIMPLEX\015LINK0\016LINK1"
1632 "\017LINK2\020MULTICAST";
1633 char addrnames[] =
1634 "\1DST\2GATEWAY\3NETMASK\4GENMASK\5IFP\6IFA\7AUTHOR\010BRD";
1635
1636 static const char errfmt[] =
1637 "\n%s: truncated route message, only %zu bytes left\n";
1638
1639 static void
1640 print_rtmsg(struct rt_msghdr *rtm, size_t msglen)
1641 {
1642         struct if_msghdr *ifm;
1643         struct ifa_msghdr *ifam;
1644 #ifdef RTM_NEWMADDR
1645         struct ifma_msghdr *ifmam;
1646 #endif
1647         struct if_announcemsghdr *ifan;
1648         const char *state;
1649
1650         if (verbose == 0)
1651                 return;
1652         if (rtm->rtm_version != RTM_VERSION) {
1653                 (void) printf("routing message version %d not understood\n",
1654                     rtm->rtm_version);
1655                 return;
1656         }
1657         if (rtm->rtm_type < sizeof(msgtypes) / sizeof(msgtypes[0]))
1658                 (void)printf("%s: ", msgtypes[rtm->rtm_type]);
1659         else
1660                 (void)printf("unknown type %d: ", rtm->rtm_type);
1661         (void)printf("len %d, ", rtm->rtm_msglen);
1662
1663 #define REQUIRE(x)      do {            \
1664         if (msglen < sizeof(x))         \
1665                 goto badlen;            \
1666         else                            \
1667                 msglen -= sizeof(x);    \
1668         } while (0)
1669
1670         switch (rtm->rtm_type) {
1671         case RTM_IFINFO:
1672                 REQUIRE(struct if_msghdr);
1673                 ifm = (struct if_msghdr *)rtm;
1674                 (void) printf("if# %d, ", ifm->ifm_index);
1675                 switch (ifm->ifm_data.ifi_link_state) {
1676                 case LINK_STATE_DOWN:
1677                         state = "down";
1678                         break;
1679                 case LINK_STATE_UP:
1680                         state = "up";
1681                         break;
1682                 default:
1683                         state = "unknown";
1684                         break;
1685                 }
1686                 (void) printf("link: %s, flags:", state);
1687                 bprintf(stdout, ifm->ifm_flags, ifnetflags);
1688                 pmsg_addrs((char *)(ifm + 1), ifm->ifm_addrs, msglen);
1689                 break;
1690         case RTM_NEWADDR:
1691         case RTM_DELADDR:
1692                 REQUIRE(struct ifa_msghdr);
1693                 ifam = (struct ifa_msghdr *)rtm;
1694                 (void) printf("metric %d, flags:", ifam->ifam_metric);
1695                 bprintf(stdout, ifam->ifam_flags, routeflags);
1696                 pmsg_addrs((char *)(ifam + 1), ifam->ifam_addrs, msglen);
1697                 break;
1698 #ifdef RTM_NEWMADDR
1699         case RTM_NEWMADDR:
1700         case RTM_DELMADDR:
1701                 REQUIRE(struct ifma_msghdr);
1702                 ifmam = (struct ifma_msghdr *)rtm;
1703                 pmsg_addrs((char *)(ifmam + 1), ifmam->ifmam_addrs, msglen);
1704                 break;
1705 #endif
1706         case RTM_IFANNOUNCE:
1707                 REQUIRE(struct if_announcemsghdr);
1708                 ifan = (struct if_announcemsghdr *)rtm;
1709                 (void) printf("if# %d, what: ", ifan->ifan_index);
1710                 switch (ifan->ifan_what) {
1711                 case IFAN_ARRIVAL:
1712                         printf("arrival");
1713                         break;
1714                 case IFAN_DEPARTURE:
1715                         printf("departure");
1716                         break;
1717                 default:
1718                         printf("#%d", ifan->ifan_what);
1719                         break;
1720                 }
1721                 printf("\n");
1722                 fflush(stdout);
1723                 break;
1724
1725         default:
1726                 (void) printf("pid: %ld, seq %d, errno %d, flags:",
1727                         (long)rtm->rtm_pid, rtm->rtm_seq, rtm->rtm_errno);
1728                 bprintf(stdout, rtm->rtm_flags, routeflags);
1729                 pmsg_common(rtm, msglen);
1730         }
1731
1732         return;
1733
1734 badlen:
1735         (void)printf(errfmt, __func__, msglen);
1736 #undef  REQUIRE
1737 }
1738
1739 static void
1740 print_getmsg(struct rt_msghdr *rtm, int msglen, int fib)
1741 {
1742         struct sockaddr *dst = NULL, *gate = NULL, *mask = NULL;
1743         struct sockaddr_dl *ifp = NULL;
1744         struct sockaddr *sa;
1745         char *cp;
1746         int i;
1747
1748         (void) printf("   route to: %s\n",
1749             routename((struct sockaddr *)&so_dst));
1750         if (rtm->rtm_version != RTM_VERSION) {
1751                 warnx("routing message version %d not understood",
1752                      rtm->rtm_version);
1753                 return;
1754         }
1755         if (rtm->rtm_msglen > msglen) {
1756                 warnx("message length mismatch, in packet %d, returned %d",
1757                       rtm->rtm_msglen, msglen);
1758         }
1759         if (rtm->rtm_errno)  {
1760                 errno = rtm->rtm_errno;
1761                 warn("message indicates error %d", errno);
1762                 return;
1763         }
1764         cp = ((char *)(rtm + 1));
1765         if (rtm->rtm_addrs)
1766                 for (i = 1; i; i <<= 1)
1767                         if (i & rtm->rtm_addrs) {
1768                                 sa = (struct sockaddr *)cp;
1769                                 switch (i) {
1770                                 case RTA_DST:
1771                                         dst = sa;
1772                                         break;
1773                                 case RTA_GATEWAY:
1774                                         gate = sa;
1775                                         break;
1776                                 case RTA_NETMASK:
1777                                         mask = sa;
1778                                         break;
1779                                 case RTA_IFP:
1780                                         if (sa->sa_family == AF_LINK &&
1781                                            ((struct sockaddr_dl *)sa)->sdl_nlen)
1782                                                 ifp = (struct sockaddr_dl *)sa;
1783                                         break;
1784                                 }
1785                                 cp += SA_SIZE(sa);
1786                         }
1787         if (dst && mask)
1788                 mask->sa_family = dst->sa_family;       /* XXX */
1789         if (dst)
1790                 (void)printf("destination: %s\n", routename(dst));
1791         if (mask) {
1792                 int savenflag = nflag;
1793
1794                 nflag = 1;
1795                 (void)printf("       mask: %s\n", routename(mask));
1796                 nflag = savenflag;
1797         }
1798         if (gate && rtm->rtm_flags & RTF_GATEWAY)
1799                 (void)printf("    gateway: %s\n", routename(gate));
1800         if (fib >= 0)
1801                 (void)printf("        fib: %u\n", (unsigned int)fib);
1802         if (ifp)
1803                 (void)printf("  interface: %.*s\n",
1804                     ifp->sdl_nlen, ifp->sdl_data);
1805         (void)printf("      flags: ");
1806         bprintf(stdout, rtm->rtm_flags, routeflags);
1807
1808 #define lock(f) ((rtm->rtm_rmx.rmx_locks & __CONCAT(RTV_,f)) ? 'L' : ' ')
1809 #define msec(u) (((u) + 500) / 1000)            /* usec to msec */
1810
1811         (void) printf("\n%s\n", "\
1812  recvpipe  sendpipe  ssthresh  rtt,msec    mtu        weight    expire");
1813         printf("%8ld%c ", rtm->rtm_rmx.rmx_recvpipe, lock(RPIPE));
1814         printf("%8ld%c ", rtm->rtm_rmx.rmx_sendpipe, lock(SPIPE));
1815         printf("%8ld%c ", rtm->rtm_rmx.rmx_ssthresh, lock(SSTHRESH));
1816         printf("%8ld%c ", msec(rtm->rtm_rmx.rmx_rtt), lock(RTT));
1817         printf("%8ld%c ", rtm->rtm_rmx.rmx_mtu, lock(MTU));
1818         printf("%8ld%c ", rtm->rtm_rmx.rmx_weight, lock(WEIGHT));
1819         if (rtm->rtm_rmx.rmx_expire)
1820                 rtm->rtm_rmx.rmx_expire -= time(0);
1821         printf("%8ld%c\n", rtm->rtm_rmx.rmx_expire, lock(EXPIRE));
1822 #undef lock
1823 #undef msec
1824 #define RTA_IGN (RTA_DST|RTA_GATEWAY|RTA_NETMASK|RTA_IFP|RTA_IFA|RTA_BRD)
1825         if (verbose)
1826                 pmsg_common(rtm, msglen);
1827         else if (rtm->rtm_addrs &~ RTA_IGN) {
1828                 (void) printf("sockaddrs: ");
1829                 bprintf(stdout, rtm->rtm_addrs, addrnames);
1830                 putchar('\n');
1831         }
1832 #undef  RTA_IGN
1833 }
1834
1835 static void
1836 pmsg_common(struct rt_msghdr *rtm, size_t msglen)
1837 {
1838         (void) printf("\nlocks: ");
1839         bprintf(stdout, rtm->rtm_rmx.rmx_locks, metricnames);
1840         (void) printf(" inits: ");
1841         bprintf(stdout, rtm->rtm_inits, metricnames);
1842         if (msglen > sizeof(struct rt_msghdr))
1843                 pmsg_addrs(((char *)(rtm + 1)), rtm->rtm_addrs,
1844                     msglen - sizeof(struct rt_msghdr));
1845         else
1846                 (void) fflush(stdout);
1847 }
1848
1849 static void
1850 pmsg_addrs(char *cp, int addrs, size_t len)
1851 {
1852         struct sockaddr *sa;
1853         int i;
1854
1855         if (addrs == 0) {
1856                 (void) putchar('\n');
1857                 return;
1858         }
1859         (void) printf("\nsockaddrs: ");
1860         bprintf(stdout, addrs, addrnames);
1861         (void) putchar('\n');
1862         for (i = 1; i != 0; i <<= 1)
1863                 if (i & addrs) {
1864                         sa = (struct sockaddr *)cp;
1865                         if (len == 0 || len < SA_SIZE(sa)) {
1866                                 (void) printf(errfmt, __func__, len);
1867                                 break;
1868                         }
1869                         (void) printf(" %s", routename(sa));
1870                         len -= SA_SIZE(sa);
1871                         cp += SA_SIZE(sa);
1872                 }
1873         (void) putchar('\n');
1874         (void) fflush(stdout);
1875 }
1876
1877 static void
1878 bprintf(FILE *fp, int b, u_char *str)
1879 {
1880         int i;
1881         int gotsome = 0;
1882
1883         if (b == 0)
1884                 return;
1885         while ((i = *str++) != 0) {
1886                 if (b & (1 << (i-1))) {
1887                         if (gotsome == 0)
1888                                 i = '<';
1889                         else
1890                                 i = ',';
1891                         (void) putc(i, fp);
1892                         gotsome = 1;
1893                         for (; (i = *str) > 32; str++)
1894                                 (void) putc(i, fp);
1895                 } else
1896                         while (*str > 32)
1897                                 str++;
1898         }
1899         if (gotsome)
1900                 (void) putc('>', fp);
1901 }
1902
1903 int
1904 keyword(const char *cp)
1905 {
1906         struct keytab *kt = keywords;
1907
1908         while (kt->kt_cp != NULL && strcmp(kt->kt_cp, cp) != 0)
1909                 kt++;
1910         return (kt->kt_i);
1911 }
1912
1913 static void
1914 sodump(sup su, const char *which)
1915 {
1916         switch (su->sa.sa_family) {
1917         case AF_LINK:
1918                 (void) printf("%s: link %s; ",
1919                     which, link_ntoa(&su->sdl));
1920                 break;
1921         case AF_INET:
1922                 (void) printf("%s: inet %s; ",
1923                     which, inet_ntoa(su->sin.sin_addr));
1924                 break;
1925         case AF_APPLETALK:
1926                 (void) printf("%s: atalk %s; ",
1927                     which, atalk_ntoa(su->sat.sat_addr));
1928                 break;
1929         }
1930         (void) fflush(stdout);
1931 }
1932
1933 /* States*/
1934 #define VIRGIN  0
1935 #define GOTONE  1
1936 #define GOTTWO  2
1937 /* Inputs */
1938 #define DIGIT   (4*0)
1939 #define END     (4*1)
1940 #define DELIM   (4*2)
1941
1942 static void
1943 sockaddr(char *addr, struct sockaddr *sa)
1944 {
1945         char *cp = (char *)sa;
1946         int size = sa->sa_len;
1947         char *cplim = cp + size;
1948         int byte = 0, state = VIRGIN, new = 0 /* foil gcc */;
1949
1950         memset(cp, 0, size);
1951         cp++;
1952         do {
1953                 if ((*addr >= '0') && (*addr <= '9')) {
1954                         new = *addr - '0';
1955                 } else if ((*addr >= 'a') && (*addr <= 'f')) {
1956                         new = *addr - 'a' + 10;
1957                 } else if ((*addr >= 'A') && (*addr <= 'F')) {
1958                         new = *addr - 'A' + 10;
1959                 } else if (*addr == '\0')
1960                         state |= END;
1961                 else
1962                         state |= DELIM;
1963                 addr++;
1964                 switch (state /* | INPUT */) {
1965                 case GOTTWO | DIGIT:
1966                         *cp++ = byte; /*FALLTHROUGH*/
1967                 case VIRGIN | DIGIT:
1968                         state = GOTONE; byte = new; continue;
1969                 case GOTONE | DIGIT:
1970                         state = GOTTWO; byte = new + (byte << 4); continue;
1971                 default: /* | DELIM */
1972                         state = VIRGIN; *cp++ = byte; byte = 0; continue;
1973                 case GOTONE | END:
1974                 case GOTTWO | END:
1975                         *cp++ = byte; /* FALLTHROUGH */
1976                 case VIRGIN | END:
1977                         break;
1978                 }
1979                 break;
1980         } while (cp < cplim);
1981         sa->sa_len = cp - (char *)sa;
1982 }
1983
1984 static int
1985 atalk_aton(const char *text, struct at_addr *addr)
1986 {
1987         u_int net, node;
1988
1989         if (sscanf(text, "%u.%u", &net, &node) != 2
1990             || net > 0xffff || node > 0xff)
1991                 return(0);
1992         addr->s_net = htons(net);
1993         addr->s_node = node;
1994         return(1);
1995 }
1996
1997 static char *
1998 atalk_ntoa(struct at_addr at)
1999 {
2000         static char buf[20];
2001
2002         (void) snprintf(buf, sizeof(buf), "%u.%u", ntohs(at.s_net), at.s_node);
2003         return(buf);
2004 }