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