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